一种应用于内窥镜手术机器人的控制系统及方法技术方案

本发明专利技术提供一种应用于内窥镜手术机器人的控制系统，具有控制装置以及执行末端，控制装置发送控制指令控制执行末端运动；其中控制装置包括触发装置以及控制主体，触发装置与控制主体相连接；触发装置输出第一控制指令选择执行末端的运动模式；控制主体能够进行多自由度的移动，输出第二控制指令控制执行末端的转动。本发明专利技术还提供与上述控制系统对应的控制方法，本发明专利技术的控制系统与控制方法通过编码器与触发装置的配合使用，降低控制输入的数量，完成对多种工作模式的控制，降低了使用者的操作难度，提高控制效率。

Control system and method for endoscopic surgery robot

The invention provides a control system applied to an endoscopic surgery robot, with the control device and the execution end, and the control device sends control instructions to control the execution of the terminal motion; the control device includes the trigger and the control body, the trigger device is connected with the control body, and the trigger device outputs the first control finger. The movement mode of the execution terminal is selected, and the control main body can carry out multi degree of freedom movement, and output second control commands to control the rotation of the execution end. The invention also provides a control method corresponding to the control system mentioned above. The control system and the control method of the invention can reduce the number of control input, complete the control of a variety of working modes, reduce the user's operation difficulty and improve the control efficiency by the combination of the encoder and the trigger device.

【技术实现步骤摘要】
一种应用于内窥镜手术机器人的控制系统及方法
本专利技术涉及内窥镜手术机器人领域，尤其涉及一种应用于内窥镜手术机器人的控制系统及方法。
技术介绍
自然腔道内窥镜手术(NOTES)利用腔道内窥镜手术机器人(NaturalOrificeTransluminalEndoscopicSurgeryRobot)实现，目前有两种驱动模式：一种是通过人手直接驱动，另外一种就是通过驱动器驱动。通过驱动器驱动可以使医生不直接接触病人进行手术，并且允许两个医生同时操作该机器人进行同一个手术，对应驱动控制方案的代表为MASTER(MasterAndSlaveTransluminalEndoscopicRobot)的控制方案，但是MASTER的各个关节由与其对应的外部输入端进行控制，导致其输入端复杂，医生操作起来相对困难。
技术实现思路
为了解决上述问题，本专利技术的主要目的是提供一种应用于内窥镜手术机器人的控制系统。为了解决上述问题，本专利技术的另一目的是提供一种应用于上述控制系统的一种应用于内窥镜手术机器人的控制方法。为了实现本专利技术的主要目的，本专利技术提供的一种应用于内窥镜手术机器人的控制系统，具有控制装置以及执行末端，控制装置发送控制指令控制执行末端运动；其中控制装置包括触发装置以及控制主体，触发装置与控制主体相连接；触发装置输出第一控制指令选择执行末端的运动模式；控制主体能够进行多自由度的移动，输出第二控制指令控制执行末端的转动。更进一步的方案是，控制主体为具有二自由度的万向节，万向节具有第一编码器以及第二编码器，第一编码器所在部件上连接有触发装置；第一编码器输出所在自由度的第一移动信号，第二编码器输出所在自由度的第二移动信号；第一移动信号输出控制执行末端第一方向的摆动，第二移动信号输出控制执行末端第二方向的摆动。更进一步的方案是，执行末端为机械臂，机械臂包括夹持机构、多个臂段以及驱动机构，驱动机构驱动夹持机构的开合以及多个臂段的转动。更进一步的方案是，运动模式包括提拉模式，转动模式，抱闸模式以及调整模式；在提拉模式中，第一编码器输出第一移动信号控制第二臂段的第一方向的摆动，第二编码器输出第二移动信号控制第三臂段的第二方向的摆动；在转动模式中，第一编码器输出第一移动信号控制夹持机构的第一方向的摆动，第二编码器输出第二移动信号控制第三臂段的第二方向的摆动；在抱闸模式中，执行末端被锁死；在调整模式中，执行末端保持位置不变，操作控制主体移动到任意位置。更进一步的方案是，触发装置为多个触发结构，通过第一触发结构和第二触发结构之间的通断组合输出第一控制指令控制执行末端进入运动模式；通过第三触发结构控制夹持机构的开合角度。为了实现本专利技术的另一目的，本专利技术提供的一种应用于内窥镜手术机器人的控制方法，检测触发装置状态，输出第一控制指令控制执行末端进入不同的运动模式；操作控制主体进行多自由度的移动，输出第二控制指令控制执行末端的转动。本专利技术的有益效果是：本专利技术的通过编码器与触发装置的配合使用，降低控制输入的数量，完成对多种工作模式的控制，降低了使用者的操作难度，提高控制效率。附图说明图1是本专利技术第一实施例中控制系统的功能模块图。图2是本专利技术第一实施例中控制系统中控制主体的结构示意图。图3是本专利技术第一实施例的控制系统中执行末端的结构示意图。图4是本专利技术第二实施例的控制方法的方法流程图。图5是本专利技术第二实施例中步骤S1进入提拉模式的具体流程图。图6是本专利技术第二实施例中步骤S1进入转动模式的具体流程图。图7是本专利技术第二实施例中步骤S1进入抱闸模式的具体流程图。图8是本专利技术第二实施例中步骤S1进入调整模式的具体流程图。以下结合附图及实施例对本专利技术作进一步说明。具体实施方式第一实施例结合图1至图3可知，本实施例的一种应用于内窥镜手术机器人的控制系统具有控制装置1以及执行末端2，控制装置1发送控制指令控制执行末端运动；其中，控制装置1包括触发装置12以及控制主体11，触发装置12与控制主体11连接，触发装置12可以设置在设置控制主体11上或者控制主体11外部；触发装置12输出第一控制指令选择执行末端2的运动模式；控制主体11能够进行多自由度的移动，输出第二控制指令控制执行末端2的转动。具体的，控制主体11为具有二自由度的万向节，万向节具有第一编码器1111以及第二编码器1131；第一编码器1111输出所在自由度的第一移动信号，第二编码器1131输出所在自由度的第二移动信号；第一移动信号输出控制执行末端2第一方向的摆动，如上下方向的摆动,即图中A方向的位置摆动，第二移动信号输出控制执行末端2第二方向的摆动，如左右方向的摆动，即图中B方向的位置摆动。本实施例的万向节具有固定件113，固定件113固定在底盘上，主动件111通过中间件112与固定件113连接；主动件111、中间件112以及固定件113之间上下依次垂直设置，主动件111、中间件112以及固定件113之间的中轴线重合，主动件111与固定件113为U型结构，其中主动件111的U型开口向下，固定件113的U型开口向上，主动件111和固定件113的U型开口上下垂直交叉且相对设置，本实施例的万向节的端口上设置有第一编码器1111、第二编码器1131以及制动器1112、1132；第一编码器1111所在的主动件111与触发装置12连接，控制执行末端2执行进入不同的运动模式，具体的万向节结构参见申请号为201721518434.6的在先申请，在此不再赘述。具体的，执行末端2为机械臂，机械臂包括夹持机构214、第一臂段211、第二臂段212、第三臂段213以及驱动机构215，驱动机构215驱动夹持机构214的开合以及第一臂段211、第二臂段212、第三臂段213的转动，具体的机械臂结构参见申请号为201710676874.2的在先申请，在此不再赘述，机械臂的结构不限于该申请的具体结构。具体的触发装置12为多个触发结构，通过第一触发结构121和第二触发结构122之间的通断组合输出第一控制指令控制执行末端2进入运动模式；通过第三触发结构123控制夹持机构214的开合角度。具体的，运动模式包括提拉模式，转动模式，抱闸模式以及调整模式；在提拉模式中，第一编码器1111输出第一移动信号控制第二臂段212的上下摆动，即控制第二臂段212带动夹持机构214和第三臂段213相对第一臂段211转动；第二编码器1131输出第二移动信号控制第三臂段213的左右摆动，即控制第三臂段213带动夹持机构214相对第二臂段212转动，第二臂段212的转动方向与第三臂段213的转动方向各异，优选为相互垂直。在转动模式中，第一编码器1111输出第一移动信号控制夹持机构214的上下摆动，第二编码器1131输出第二移动信号控制第三臂段213的左右摆动；即夹持机构214的两个夹子可相对第三臂段213转动，两个夹子同向运动即为夹子闭合，背向运动即夹子张开。在抱闸模式中，控制主体11被锁死，即控制系统被限制活动。在抱闸模式下内窥镜手术机器人的机械结构被锁死，医生不能继续对该设备进行操作，防止误操作。在调整模式中，执行末端2保持位置不变，操作控制主体11移动到任意位置。由于控制主体11在同一方向上连续操作的运动范围存在限制，提拉模式的转动角度、转动模式的转动本文档来自技高网...

【技术保护点】
一种应用于内窥镜手术机器人的控制系统，具有控制装置以及执行末端，所述控制装置发送控制指令控制所述执行末端运动；其特征在于：所述控制装置包括触发装置以及控制主体，所述触发装置与所述控制主体相连接；所述触发装置输出第一控制指令选择所述执行末端的运动模式；所述控制主体能够进行多自由度的移动，输出第二控制指令控制所述执行末端的转动。

【技术特征摘要】
1.一种应用于内窥镜手术机器人的控制系统，具有控制装置以及执行末端，所述控制装置发送控制指令控制所述执行末端运动；其特征在于：所述控制装置包括触发装置以及控制主体，所述触发装置与所述控制主体相连接；所述触发装置输出第一控制指令选择所述执行末端的运动模式；所述控制主体能够进行多自由度的移动，输出第二控制指令控制所述执行末端的转动。2.根据权利要求1所述控制系统，其特征在于：所述控制主体为具有二自由度的万向节，所述万向节具有第一编码器以及第二编码器，所述第一编码器所在部件上连接有所述触发装置；所述第一编码器输出所在自由度的第一移动信号，所述第二编码器输出所在自由度的第二移动信号；所述第一移动信号输出控制所述执行末端第一方向的摆动，所述第二移动信号输出控制所述执行末端第二方向的摆动。3.根据权利要求1至2任一项所述的控制系统，其特征在于：所述执行末端为机械臂，所述机械臂包括夹持机构、多个臂段以及驱动机构，所述驱动机构驱动所述夹持机构的开合以及多个所述臂段的转动。4.根据权利要求3所述的控制系统，其特征在于：所述运动模式包括提拉模式，转动模式，抱闸模式以及调整模式；在所述提拉模式中，所述第一编码器输出所述第一移动信号控制第二臂段的第一方向的摆动，所述第二编码器输出所述第二移动信号控制第三臂段的第二方向的摆动；在所述转动模式中，所述第一编码器输出所述第一移动信号控制所述夹持机构的第一方向的摆动，所述第二编码器输出所述第二移动信号控制第三臂段的第二方向的摆动；在所述抱闸模式中，所述控制主体被锁死；在所述调整模式中，所述执行末端保持位置不变，操作所述控制主体移动到任意位置。5.根据权利要求4所述的控制系统，其特征在于：所述触发装置为多个触发结构，通过第一触发结构和第二触发结构之间的通断组合输出所述第一控制指令控制所述执...

【专利技术属性】
技术研发人员：侯西龙，宿敬然，汪坤，李鹏，李延青，杨嘉林，
申请(专利权)人：深圳市罗伯医疗科技有限公司，
类型：发明
国别省市：广东,44