发明公开
- 专利标题: 一种基于冗余自由度利用的旋翼飞行机械臂协调运动规划方法
-
申请号: CN202310138230.3申请日: 2023-02-20
-
公开(公告)号: CN116237938A公开(公告)日: 2023-06-09
- 发明人: 余翔 , 陈瑞 , 郭克信 , 李文硕 , 郭雷 , 刘钱源 , 王萌
- 申请人: 北京航空航天大学杭州创新研究院
- 申请人地址: 浙江省杭州市滨江区长河街道创慧街18号
- 专利权人: 北京航空航天大学杭州创新研究院
- 当前专利权人: 北京航空航天大学杭州创新研究院
- 当前专利权人地址: 浙江省杭州市滨江区长河街道创慧街18号
- 代理机构: 北京科迪生专利代理有限责任公司
- 代理商 江亚平
- 主分类号: B25J9/16
- IPC分类号: B25J9/16
摘要:
本发明提出一种基于冗余自由度利用的旋翼飞行机械臂协调运动规划方法,生成满足运动约束并最小化系统质心偏移的协调运动轨迹。首先建立机械臂的运动学模型,以及飞行机械臂的一体化运动学模型,计算对应的雅各比矩阵。根据四旋翼无人机的欠驱动性,将雅各比矩阵分解为可控部分与不可控部分。随后建立系统的质心偏移模型,计算对应的雅各比矩阵。利用分层二次规划框架,以飞行机械臂末端跟踪精度为优化目标,建立并求解一个二次规划问题;在此基础上,将质心偏移量纳入优化目标函数,建立并求解新的二次规划问题,得到满足末端目标跟踪性能且最小化质心偏移的参考运动轨迹。本发明适用用于目标捕获、设备操作等空中作业任务。
IPC分类: