一种小型高机动救援机器人行走及作业稳定控制方法

基本信息

申请号 CN202111355916.5 申请日 -
公开(公告)号 CN114102584A 公开(公告)日 2022-03-01
申请公布号 CN114102584A 申请公布日 2022-03-01
分类号 B25J9/16(2006.01)I 分类 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手;
发明人 秦绪坤;陈彤;张新;李兰芸;杨玲;宋黎 申请(专利权)人 新兴际华集团有限公司
代理机构 北京中南长风知识产权代理事务所(普通合伙) 代理人 李青
地址 100022北京市朝阳区东三环中路5号楼62层、63层
法律状态 -

摘要

摘要 本发明公开了一种小型高机动救援机器人行走及作业稳定控制方法,包括:基于位姿估计器获得小型高机动救援机器人的路径稳定性指标;获得小型高机动救援机器人的受力;基于路径稳定性指标以及受力指标获得小型高机动救援机器人的力角稳定裕度指标;基于小型高机动救援机器人的路径稳定性指标以及力角稳定裕度指标建立路径的稳定性代价函数,从而获得路径执行的总时间;或者建立路径规划超图模型,在路径规划超图模型中选取所需的起点和终点,从而获得基于稳定型的最优路径和次优路径,小型高机动救援机器人根据需要选择最优路径或次优路径。还公开了对应的控制装置、电子设备以及计算机可读存储介质,提高了稳定控制精度和效果。