- 专利标题: 基于IMU的绳驱械臂臂段末端姿态等效控制方法及装置
-
申请号: CN202410796710.3申请日: 2024-06-20
-
公开(公告)号: CN118372253A公开(公告)日: 2024-07-23
- 发明人: 徐文福 , 梁斌 , 王学谦 , 赵商羽 , 闫磊 , 袁晗
- 申请人: 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院)
- 申请人地址: 广东省深圳市南山区桃源街道深圳大学城哈尔滨工业大学校区
- 专利权人: 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院)
- 当前专利权人: 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院)
- 当前专利权人地址: 广东省深圳市南山区桃源街道深圳大学城哈尔滨工业大学校区
- 代理机构: 深圳市英睿深联知识产权代理事务所
- 代理商 陈佩婷
- 主分类号: B25J9/16
- IPC分类号: B25J9/16 ; B25J9/10 ; G05B11/42 ; G01C1/00
摘要:
本发明涉及一种基于IMU的绳驱械臂臂段末端姿态等效控制方法及装置,其中方法包括对期望的臂段两个旋转方向的总角度进行五次多项式插值,得到期望关节角度,基于正运动学计算,得到当前期望的末端姿态;获得当前联动臂段末端的实际姿态,得到当前末端姿态差;计算联动臂段当前角度差;输入PID控制器,输出角度控制量;将角度控制量映射为驱动绳索的速度,并再次映射为驱动电机的转速;输入所述电机控制器,所述电机控制器控制驱动电机按期望的转速转动。本发明解决现有技术中,对绳驱分段联动机械臂的联动臂段进行关节角度取平均值的闭环控制无法精确控制末端姿态,以及编码器占据机械臂内部较多空间的问题。
公开/授权文献
- CN118372253B 基于IMU的绳驱械臂臂段末端姿态等效控制方法及装置 公开/授权日:2024-08-16