一种微创外科手术机器人简化运动学模型的建模方法
- 专利权人:
- 重庆金山医疗器械有限公司
- 发明人:
- 肖乔木,梁东,徐登
- 申请号:
- CN201710630714.4
- 公开号:
- CN107374727B
- 申请日:
- 2017.28.07
- 申请国别(地区):
- CN
- 年份:
- 2019
- 代理人:
- 摘要:
- 本发明公开了一种微创外科手术机器人简化运动学模型的建模方法,包括:建立主手腕点相对于主手基坐标系的齐次变换矩阵;根据预设的主从手之间的基座标旋转映射矩阵、比例映射系数和所述主手齐次变换矩阵得到从手相对于其基坐标系的腕点位置;根据从手中控制位置运动关节的齐次变换矩阵与从手腕点的位置建立等式,求解出从手中控制位置运动关节的角度值和/或位置值;根据主手在腕点位置的姿态角度和从手在其腕点的姿态角度一一对应的关系建立等式,求解出从手控制姿态运动关节的角度值和/或位置值。上述建模方法,依据位置和姿态分离的思路,简化运动学计算的复杂程度,提高了控制系统的实时性指标。
- 来源网站:
- 中国工程科技知识中心