一种无力/力矩传感器机械臂软浮动控制方法
基本信息
申请号 | CN202011515806.6 | 申请日 | - |
公开(公告)号 | CN112743541B | 公开(公告)日 | 2022-03-04 |
申请公布号 | CN112743541B | 申请公布日 | 2022-03-04 |
分类号 | B25J9/16(2006.01)I | 分类 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手; |
发明人 | 冒建亮;王继虎 | 申请(专利权)人 | 南京埃斯顿机器人工程有限公司 |
代理机构 | 南京天翼专利代理有限责任公司 | 代理人 | 王秀娟 |
地址 | 211100江苏省南京市江宁区江宁经济开发区将军大道155号 | ||
法律状态 | - |
摘要
摘要 | 本发明公开了一种无力/力矩传感器机械臂软浮动控制方法,包括:在每一个伺服控制周期内,通过离线建立的机械臂最小惯性参数集动力学模型,在线计算机械臂的模型参数集合;根据机械臂关节角度、关节输入转矩以及模型参数集合,构造外部作用耦合力矩的估算单元;根据外部作用耦合力矩的估算值,计算机械臂末端受到的外部作用力/力矩;根据外部作用力/力矩,计算机械臂在笛卡尔空间内期望的位姿矩阵;将笛卡尔空间期望的位姿矩阵发送至机器人运动控制单元,完成一个伺服控制周期内的软浮动控制。本发明可提供笛卡尔空间内6自由度任意方向上的软浮动功能,提高外力“软测量”精度,适用于不同的应用场合。 |
