← 返回列表
手术机器人升降示教控制方法、装置、设备和介质
摘要文本
本发明实施例公开了一种手术机器人升降示教控制方法、装置、设备和介质，其中，方法包括：当目标控制升降关节在外部控制力作用下，控制所述目标控制升降关节进行抖动；确定所述外部控制力的施力方向；根据所述施力方向以及所述目标控制升降关节的实时位置信息和实时速度信息，以及预设的力矩与关节运动参数映射关系进行动力学模型参数辨识，确定目标动力学模型；基于所述目标动力学模型控制所述目标控制升降关节进行运动。本发明实施例的技术方案，通过抖动前馈确定手术机器人的外部控制力方向，无需力矩传感器降低升降示教成本，并基于电流环控制模式下采集的控制数据对动力学模型进行参数辨识，提高手术机器人升降示教控制过程的稳定性。 更多数据：搜索专利查询网来源：
申请人信息
- 申请人:苏州康多机器人有限公司
- 申请人地址:215163 江苏省苏州市苏州高新区青城山路300号工业村标准厂房2号厂房
- 发明人: 苏州康多机器人有限公司
专利详细信息
| 项目 | 内容 |
|---|---|
| 专利名称 | 手术机器人升降示教控制方法、装置、设备和介质 |
| 专利类型 | 发明申请 |
| 申请号 | CN202311729383.1 |
| 申请日 | 2023/12/15 |
| 公告号 | CN117706931A |
| 公开日 | 2024/3/15 |
| IPC主分类号 | G05B13/04 |
| 权利人 | 苏州康多机器人有限公司 |
| 发明人 | 任宏帅; 王伟; 赵彦丞; 周德刚; 苏衍宇 |
| 地址 | 江苏省苏州市高新区青城山路300号工业村标准厂房2号厂房 |
专利主权项内容
1.一种手术机器人升降示教控制方法，其特征在于，包括：当目标控制升降关节在外部控制力作用下，且运动速度处于预设低速阈值区间时，控制所述目标控制升降关节进行抖动；在所述目标控制升降关节抖动过程中，确定所述外部控制力的施力方向；根据所述施力方向以及所述目标控制升降关节的实时位置信息和实时速度信息，以及预设的力矩与关节运动参数映射关系进行动力学模型参数辨识，确定目标动力学模型；基于所述目标动力学模型控制所述目标控制升降关节进行运动，以完成手术机器人升降示教控制；其中，所述预设的力矩与关节运动参数映射关系是基于所述目标控制升降关节在电机的电流环控制模式下进行运动确定的。