用于机械臂的控制系统、控制方法及一种手术机器人
- 专利权人:
- 微创(上海)医疗机器人有限公司
- 发明人:
- 郝晶晶,师云雷,何超,王家寅,朱祥,袁帅,施吉超
- 申请号:
- CN201610375739.X
- 公开号:
- CN106137400B
- 申请日:
- 2016.31.05
- 申请国别(地区):
- CN
- 年份:
- 2019
- 代理人:
- 摘要:
- 本发明涉及一种用于机械臂的控制系统、控制方法及一种手术机器人,其中的方法提供一个与各关节位置误差和速度误差相关的终端滑模面,计算机械臂的关节位置在状态空间中到终端滑模面的距离,所述状态空间的状态变量包括所述位置误差和速度误差;针对关节位置到终端滑模面的距离,设计一个快速趋近律;根据机械臂的动力学模型以及所述快速趋近律得出滑模控制律的完整表达;根据所述滑模控制律输出力矩指令;以及对所述力矩指令进行饱和限制,得到最终的力矩输出指令,用于控制各关节的电机动作,以驱动机械臂的各个关节达到设计位置。该方法可以提高该机械臂的控制性能。
- 来源网站:
- 中国工程科技知识中心