- 专利标题: 一种对于静止或低速工况下机械臂高精度力反馈的方法
-
申请号: CN202010494425.8申请日: 2020-06-03
-
公开(公告)号: CN111618859B公开(公告)日: 2021-04-13
- 发明人: 甘博涵 , 许靖 , 乔天 , 文理为 , 杜思傲 , 董旭亮 , 荣健
- 申请人: 杭州键嘉机器人有限公司
- 申请人地址: 浙江省杭州市余杭区五常街道五常大道181号8幢305、306室
- 专利权人: 杭州键嘉机器人有限公司
- 当前专利权人: 杭州键嘉医疗科技股份有限公司
- 当前专利权人地址: 浙江省杭州市余杭区五常街道五常大道181号8幢305、306室
- 代理机构: 深圳知帮办专利代理有限公司
- 代理商 王敏
- 主分类号: B25J9/16
- IPC分类号: B25J9/16
摘要:
本发明公开了一种对于静止或低速工况下机械臂高精度力反馈的方法,包括以下步骤:S100,构建机械臂的各个关节坐标系,并计算关节的雅可比矩阵;S200,根据上述的关节坐标系,构建原点位于机械臂的每一段质心位置的坐标系,并计算质心位置的雅可比矩阵;S300,构建动力学方程中重力项的矩阵;S400,在机械臂运动过程中采集得到关节位置和力矩数据;S500,将S400的数据代入到S300中,计算出结果;S600,得到施加外力导致的额外关节扭矩;S700,结合S100中得到的关节雅可比矩阵和S600中得到的额外关节扭矩,计算得到机械臂末端外力的大小和方向。本发明提供的一种对于静止或低速工况下机械臂高精度力反馈的方法,简化计算步骤,提高力反馈精确性。
公开/授权文献
- CN111618859A 一种对于静止或低速工况下机械臂高精度力反馈的方法 公开/授权日:2020-09-04
IPC分类: