- 专利标题: 一种针对运动学冗余双臂空间机器人的协同路径规划方法
-
申请号: CN201910081351.2申请日: 2019-01-28
-
公开(公告)号: CN110104216B公开(公告)日: 2022-09-06
- 发明人: 王明明 , 罗建军 , 袁建平 , 朱战霞
- 申请人: 西北工业大学深圳研究院 , 西北工业大学
- 申请人地址: 广东省深圳市南山区高新南九道45号;
- 专利权人: 西北工业大学深圳研究院,西北工业大学
- 当前专利权人: 西北工业大学深圳研究院,西北工业大学
- 当前专利权人地址: 广东省深圳市南山区高新南九道45号;
- 代理机构: 西安通大专利代理有限责任公司
- 代理商 徐文权
- 主分类号: B64G1/24
- IPC分类号: B64G1/24 ; B25J9/16 ; B25J11/00
摘要:
本发明公开了一种针对运动学冗余双臂空间机器人的协同路径规划方法,包括以下步骤:建立空间机器人系统的动力学方程和运动学方程;求解末端执行器逆运动学方程冗余解,通过动量守恒方程得到系统非完整约束方程;通过系统非完整约束方程,得到末端执行器运动和基座姿态关系的任务空间约束方程;使用五阶贝塞尔曲线得到任务空间中末端执行器路径规划,通过末端执行器的速度和加速度边界确定路径执行时间;通过末端执行器运动方程和任务空间约束方程,得到对应不同任务优先级的关节运动轨迹规划。实现了空间双臂机器人的协同路径规划方法,可以根据任务的优先级执行各类不同的任务,多臂协同任务,动态平衡任务等,大大拓展了空间机械臂的操作能力。
公开/授权文献
- CN110104216A 一种针对运动学冗余双臂空间机器人的协同路径规划方法 公开/授权日:2019-08-09