Invention Publication
- Patent Title: 一种对于静止或低速工况下机械臂高精度力反馈的方法
-
Application No.: CN202010494425.8Application Date: 2020-06-03
-
Publication No.: CN111618859APublication Date: 2020-09-04
- Inventor: 甘博涵 , 许靖 , 乔天 , 文理为 , 杜思傲 , 董旭亮 , 荣健
- Applicant: 甘博涵
- Applicant Address: 广东省深圳市龙华区工业东路水斗新围村5巷4号
- Assignee: 甘博涵
- Current Assignee: 杭州键嘉医疗科技股份有限公司
- Current Assignee Address: 广东省深圳市龙华区工业东路水斗新围村5巷4号
- Agency: 深圳知帮办专利代理有限公司
- Agent 王敏
- Main IPC: B25J9/16
- IPC: B25J9/16

Abstract:
本发明公开了一种对于静止或低速工况下机械臂高精度力反馈的方法,包括以下步骤:S100,构建机械臂的各个关节坐标系,并计算关节的雅可比矩阵;S200,根据上述的关节坐标系,构建原点位于机械臂的每一段质心位置的坐标系,并计算质心位置的雅可比矩阵;S300,构建动力学方程中重力项的矩阵;S400,在机械臂运动过程中采集得到关节位置和力矩数据;S500,将S400的数据代入到S300中,计算出结果;S600,得到施加外力导致的额外关节扭矩;S700,结合S100中得到的关节雅可比矩阵和S600中得到的额外关节扭矩,计算得到机械臂末端外力的大小和方向。本发明提供的一种对于静止或低速工况下机械臂高精度力反馈的方法,简化计算步骤,提高力反馈精确性。
Public/Granted literature
- CN111618859B 一种对于静止或低速工况下机械臂高精度力反馈的方法 Public/Granted day:2021-04-13
Information query
IPC分类: