冗余机械臂控制方法、装置、可读存储介质及设备
授权
摘要
本申请公开了一种冗余机械臂控制方法、装置、可读存储介质及设备,所述方法包括:获取所述机械臂的末端所受到的外力以及每个关节所受到的外力力矩;根据每个关节对末端在每个运动维度上的影响程度以及所述末端受到的外力,计算每个关节的第一关节速度;根据连杆所受到的外力对每个关节产生的连杆力矩,确定各个关节对应末端当前位置的零空间速度,所述零空间速度为在连杆外力作用下维持末端位置不变时各个所述关节对应的速度;根据所述第一关节速度以及所述零空间速度计算总关节速度;根据所述总关节速度控制所述机械臂运动。由于在控制机械臂时,叠加了末端零空间,因此,机械臂受到外力时,不会影响末端上任务的执行。
基本信息
专利标题 :
冗余机械臂控制方法、装置、可读存储介质及设备
专利标题(英):
暂无
公开(公告)号 :
CN113119100A
申请号 :
CN201911403020.2
公开(公告)日 :
2021-07-16
申请日 :
2019-12-30
授权号 :
CN113119100B
授权日 :
2022-05-13
发明人 :
黄荔群任晓雨王岳嵩熊友军
申请人 :
深圳市优必选科技股份有限公司
申请人地址 :
广东省深圳市南山区学苑大道1001号南山智园C1栋16、22楼
代理机构 :
北京超凡宏宇专利代理事务所(特殊普通合伙)
代理人 :
曹瑞敏
优先权 :
CN201911403020.2
主分类号 :
B25J9/16
IPC分类号 :
B25J9/16
IPC结构图谱
B
B部——作业;运输
B25
手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
B25J
机械手;装有操纵装置的容器
B25J9/00
程序控制机械手
B25J9/16
程序控制
法律状态
2022-05-13 :
授权
2021-08-03 :
实质审查的生效
IPC(主分类) : B25J 9/16
申请日 : 20191230
申请日 : 20191230
2021-07-16 :
公开
注:本法律状态信息仅供参考,即时准确的法律状态信息须到国家知识产权局办理专利登记簿副本。
文件下载
1、
CN113119100A.PDF
PDF下载