摘要
本发明公开了一种手术机器人持镜臂控制方法、装置、设备和介质,其中,方法包括:获取双主机械臂的末端点的位姿数据,并确定末端点间的端点距离;根据端点距离构建虚拟对象的参考坐标系,并根据双主机械臂的结构参数和参考坐标系相对于基坐标系的位姿参数,确定双主机械臂的末端点在预设运动约束下的阻抗控制关系;根据持镜臂的结构参数和持镜臂与双主机械臂之间的同步运动约束关系,确定持镜臂与双主机械臂之间的运动映射关系;在获取到持镜臂的运动控制目标时,根据运动控制目标、阻抗控制关系和运动映射关系确定对双主机械臂的运动控制指令,以实现对持镜臂的运动控制。本发明的技术方案可以实现通过双主机械臂控制持镜臂。
技术关键词
虚拟对象
手术机器人
机械臂
矩阵
关节运动速度
三角函数关系
笛卡尔坐标系
端点
手术平台
表达式
参数
控制台
指令