一种用于远程控制医疗器械的控制系统及其控制方法

摘要

本发明公开了一种用于远程控制医疗器械的控制系统，包括用于实现各种输入方式输入并转化为电信号、显示相关信息及通过通讯模块将控制信号传输给执行控制器模块的中央控制器、用于提供各种信号传输通道及信号转换的通讯模块、用于实现多维运动控制的执行控制器模块；其中，中央控制器、通讯模块及执行控制器模块依次信号连接。本发明还公开了一种用于远程控制医疗器械的控制系统的控制方法。本发明克服现有技术中操控柔性器械效果较差、手动控制及自动控制不能有机结合、操作精度低及多维运动操作不便等问题，具有结构简单、造价便宜、手动控制及自动控制相结合、适于操控柔性器械、精度高及能灵活多维运动等特点。

权利要求

1.一种用于远程控制医疗器械的控制系统，其特征在于：包括用于实现各种输入方式输入并转化为电信号、显示相关信息及通过通讯模块将控制信号传输给执行控制器模块的中央控制器、用于提供各种信号传输通道及信号转换的通讯模块、用于实现多维运动控制的执行控制器模块；其中，中央控制器、通讯模块及执行控制器模块依次信号连接；

所述中央控制器包括主控制模块、操作杆输入模块、触摸屏输入模块、显示模块和第一CAN模块；其中，主控制模块分别与操作杆输入模块、触摸屏输入模块、显示模块和第一CAN模块连接，第一CAN模块与通讯模块连接；

所述通讯模块包括第一信号隔离模块、第一CAN收发芯片、第二CAN收发芯片及第二信号隔离模块；其中，第一CAN模块输出信号给第一CAN收发芯片，第一CAN收发芯片输出信号给第二信号隔离模块，第二信号隔离模块把信号输送给执行控制器模块，执行控制器模块反馈信号给第二CAN收发芯片，第二CAN收发芯片输出信号给第一信号隔离模块，第一信号隔离模块输出信号给第一CAN模块，第一CAN模块给主控制模块信号，主控制模块给显示模块信号，显示模块显示结果。

2.根据权利要求1所述的用于远程控制医疗器械的控制系统，其特征在于：所述执行控制器模块包括多维运动控制模块、辅助设备接口、若干伺服驱动器、若干伺服电机、第二CAN模块及若干转速位移检测传感器；其中，多维运动控制模块分别与辅助设备接口、若干伺服驱动器和第二CAN模块连接，第二CAN模块与第二信号隔离模块连接，每个伺服驱动器对应连接1个伺服电机，每个伺服电机的后轴处设有1个转速位移检测传感器。

3.根据权利要求2所述的用于远程控制医疗器械的控制系统，其特征在于：所述伺服驱动器包括前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器，前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器分别对应连接前后维伺服电机、上下维伺服电机、左右维伺服电机、转轴维伺服电机及拨盘维伺服电机，每个伺服电机与伺服驱动器形成闭环控制系统。

4.根据权利要求3所述的用于远程控制医疗器械的控制系统，其特征在于：所述操作杆输入模块包括第一操作杆、第一操作杆位置传感器、第二操作杆、第二操作杆位置传感器；其中，第一操作杆位置传感器设于第一操作杆内，第二操作杆位置传感器设于第二操作杆内；第一操作杆具有5个自由度运动方向，分别是前、后、左、右以及旋转，前、后两个方向分别对应着上下维的向上、向下；左、右两个方向分别对应着左右维的向左、向右；旋转对应着转轴维的旋转，当顺时针旋转时，医疗器械也顺时针旋转，逆时针旋转时，医疗器械也逆时针旋转；第二操作杆具有3个自由度运动方向，分别是前、后及旋转，前、后两个方向对应着前后维的向前、向后，旋转则对应着拨盘维，控制着医疗器械的弯曲度。

5.根据权利要求3所述的用于远程控制医疗器械的控制系统，其特征在于：所述触摸屏输入模块包括触摸屏，在触摸屏上设置启动按钮、停止按钮、自动回直按钮、恢复回直前状态按钮、记录数据按钮、恢复数据按钮、参数设置按钮及辅助设备控制按钮。

6.根据权利要求2所述的用于远程控制医疗器械的控制系统，其特征在于：所述第一CAN模块及第二CAN模块为CAN总线。

7.一种用于远程控制医疗器械的控制系统的控制方法，其特征在于，包括以下步骤：

(1)、根据实际需要，对中央控制器进行操作，通过操控操作杆输入模块及触摸屏输入模块进行输入，显示模块对相应的操作进行显示，主控制模块对操作杆输入模块、触摸屏输入模块输入的信号进行收集和处理，并通过第一CAN模块传递给通讯模块；

(2)、通讯模块的第一CAN收发芯片接收第一CAN模块传递过来的电信号，第一CAN收发芯片输出信号给第二信号隔离模块，第二信号隔离模块把信号输送给执行控制器模块；

(3)、第二CAN模块接收信号后传递给多维运动控制模块，多维运动控制模块根据信号内容分别控制前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器，前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器分别驱动相应的伺服电机运动，实现多维操作，每个伺服电机的后轴处的转速位移检测传感器，用于检测各伺服电机的位移，辅助设备接口连接辅助设备；

(4)、多维运动控制模块反馈信号给第二CAN收发芯片，第二CAN收发芯片输出信号给第一信号隔离模块，第一信号隔离模块输出信号给第一CAN模块，第一CAN模块给主控制模块信号，主控制模块给显示模块信号，显示模块显示结果；

(5)、操作者根据显示结果进行操作。

8.根据权利要求7所述的用于远程控制医疗器械的控制系统的控制方法，其特征在于：所述步骤(3)先调节好各伺服电机的速度环和电流环并组成内环，然后调整好位置环，构成位置、速度双闭环系统，因为伺服控制器本身能够通过转速位移检测传感器的数据进行速度和电流的三环闭环调节，同时，转速位移检测传感器的监测信息也将反馈到执行控制器模块，将反馈的信息转换成位置信息，传输到主控制模块；所述前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器对应前后维伺服电机、上下维伺服电机、左右维伺服电机、转轴维伺服电机及拨盘维伺服电机，在每个伺服电机连接1个减速箱，传动比是1:n，设伺服电机转一个角度W，医疗器械机械臂的滑轨移动距离是L，转速位移检测传感器返回脉冲数为N，则位移为：Displacement＝(360/nW)*N*L。

说明书

一种用于远程控制医疗器械的控制系统及其控制方法

技术领域

[0001] 本发明涉及医疗器械控制技术，具体来说是一种用于远程控制医疗器械的控制系统及其控制方法。

背景技术

[0002] 随着软镜技术进步，输尿管软镜手术逐渐成为腔内泌尿外科的主要手术，与传统输尿管硬镜相比，输尿管软镜具有高柔韧度的可弯曲镜体，弯曲自如，灵巧方便，可以从人体自然通道尿道进入到膀胱并经输尿管口到输尿管直达肾盂以及各肾盏。由于具有灌注和工作通道，输尿管软镜可处理肾脏集合系统各种疾病，如结石，肿瘤。不仅相对安全，且治疗效果显著，相对于经皮肾镜治疗方法，具有更安全、损伤小、恢复快等优点。在诊断和治疗难于确诊的肾盂肿瘤、肾结石、输尿管上段结石中具有其他设备无法比拟和取代的优势。具体如下：

[0003] 1)检查无盲区：这也是软镜最突出的优点。由于镜体柔软，且镜体头端可以向上向下弯曲很大角度，做到不漏诊，可以看到硬镜来看不到的盲区。

[0004] 2)损伤小：由于镜体柔软(与导尿管相似)，管径细(<6Fr)，麻醉下，直视轻柔地插入基本不会对尿道、膀胱、输尿管等造成损伤。相对于硬镜，软镜更容易为病人所接受。

[0005] 3)视野相对清晰：软镜损伤小，可以最大限度的减少损伤性血尿对观察的影响，从而保证视野清晰。此外，软镜属于电子数码成像，具有极高的图像分辨率，可以清晰发现更早期及微小的病变，使疾病在早期即得到有效治疗，提高了病人的疗效。软镜还可以通过图像采集系统将数字化的图像传至电脑，甚至上网实现同步远程会诊。

[0006] 4)对体位的要求低：病人于截石位、仰卧位及侧卧位都可以进行检查，特别适合于不能摆截石位和腑卧位的患者(如下肢畸形、严重关节炎及偏瘫患者等)。

[0007] 5)可以同时检查尿道、膀胱，输尿管，肾盂及各肾盏整个尿路系统：而硬镜是不能做到。

[0008] 但在做输尿管软镜手术时，特别是行肾脏结石手术时，需要依靠X光照射定位，手术医师受到放射线辐射量较大，为此，如何减少医师受到的放射线辐射，实现软镜准确、稳定定位，避免医师长时间手术疲劳而造成手颤动是刻不容缓的问题。

[0009] 近年来，国内外在医疗机器人和机械手发明和应用比较多，比较成熟的有达芬奇(DaVinci)系统、Zeus系统、伊索(AESOP)3000医疗外科手术机器人等。

[0010] 达芬奇(DaVinci)系统主要由医生控制台(Surgeon Console)；一个装有四支7自由度交互手臂的床旁机械臂塔(Patient Cart)和一个高精度的3D HD视觉系统(Vision Cart)构成。借助于高清立体成像、多关节臂自动化控制及光缆信号传送等高科技设备，使其具备了三维高清术野、手臂无抖动、镜头固定、活动范围广、器械移动度大等优点，并且改变了术者站在手术台旁操作的传统模式，由主刀医师坐在控制台前完成手术全过程，符合人体工程学原理，更适合于长时间复杂手术。该系统广泛应用于普外科、心外科、泌尿外科、妇科和小儿外科。

[0011] ZEUS机器人手术系统由Computer Motion公司制作，在欧洲已经可以使用，ZEUS系统与达芬奇的装置类似，它有一个计算机工作站、一个视频显示器、控制手柄(用于移动手术台上安装的手术仪器)。ZEUS系统目前在美国只被批准用于医疗试验，而德国医生已经使用此系统进行了冠心病搭桥手术。

[0012] 伊索(AESOP)3000机器人系统由Computer Motion公司于1994年发布，AESOP是FDA批准使用的第一台可以用于手术室协助手术的机器人。AESOP比达芬奇系统和ZEUS系统要简单得多，AESOP基本上只是一个机械臂，用于医生定位内窥镜——一种插入病人体内的外科照相机。脚踏板或声音软件用于医生定位照相机，这就让医生的手空出来继续进行手术。AESOP提供了几种内窥镜控制形式，包括语音控制、人工定位和手动控制。

[0013] 现有技术中存在以下技术问题：

[0014] (1)、现有的控制系统一般用于刚性器械操控，在操控柔性器械，如软镜方面存在一定的局限；

[0015] (2)、现有的控制系统中一般严格区分手动控制和自动控制，在一套系统里一般采用手动控制或者自动控制，没有将两者有机结合；

[0016] (3)、现有的控制系统没法灵活操控柔性器械各个自由度如弯曲等的运动，精度也不够。

发明内容

[0017] 本发明的目的在于克服以上现有技术存在的不足，提供了一种结构简单、造价便宜、手动控制及自动控制相结合、适于操控柔性器械、精度高及能灵活多维运动的用于远程控制医疗器械的控制系统。

[0018] 本发明另一目的在于提供一种用于远程控制医疗器械的控制系统的控制方法。

[0019] 为了达到上述目的，本发明采用以下技术方案：一种用于远程控制医疗器械的控制系统，包括用于实现各种输入方式输入并转化为电信号、显示相关信息及通过通讯模块将控制信号传输给执行控制器模块的中央控制器、用于提供各种信号传输通道及信号转换的通讯模块、用于实现多维运动控制的执行控制器模块；其中，中央控制器、通讯模块及执行控制器模块依次信号连接。

[0020] 所述中央控制器包括主控制模块、操作杆输入模块、触摸屏输入模块、显示模块和第一CAN模块；其中，主控制模块分别与操作杆输入模块、触摸屏输入模块、显示模块和第一CAN模块连接，第一CAN模块与通讯模块连接。主控制模块主要作用是：采集输入信号，通过采集到操作杆输入信号和触控输入信号，将信号进行处理后通过CAN模块将信号传输到执行控制端。执行控制端的状态信息也通过CAN模块传回主控制模块，然后把输入信号和返回的状态信息通过显示模块显示出来。

[0021] 所述通讯模块包括第一信号隔离模块、第一CAN收发芯片、第二CAN收发芯片及第二信号隔离模块；其中，第一CAN模块输出信号给第一CAN收发芯片，第一CAN收发芯片输出信号给第二信号隔离模块，第二信号隔离模块把信号输送给执行控制器模块，执行控制器模块反馈信号给第二CAN收发芯片，第二CAN收发芯片输出信号给第一信号隔离模块，第一信号隔离模块输出信号给第一CAN模块，第一CAN模块给主控制模块信号，主控制模块给显示模块信号，显示模块显示结果。信号隔离模块主要保证信号、电源、地之间绝对独立，避免干扰。

[0022] 所述执行控制器模块包括多维运动控制模块、辅助设备接口、若干伺服驱动器、若干伺服电机、第二CAN模块及若干转速位移检测传感器；其中，多维运动控制模块分别与、辅助设备接口、若干伺服驱动器和第二CAN模块连接，第二CAN模块与第二信号隔离模块连接，每个伺服驱动器对应连接1个伺服电机，每个伺服电机的后轴处设有1个转速位移检测传感器。

[0023] 所述伺服驱动器包括前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器，前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器分别对应连接前后维伺服电机、上下维伺服电机、左右维伺服电机、转轴维伺服电机及拨盘维伺服电机，每个伺服电机与伺服驱动器形成闭环控制系统。

[0024] 所述操作杆输入模块包括第一操作杆、第一操作杆位置传感器、第二操作杆、第二操作杆位置传感器；其中，第一操作杆位置传感器设于第一操作杆内，第二操作杆位置传感器设于第二操作杆内；第一操作杆具有5个自由度运动方向，分别是前、后、左、右以及旋转，前、后两个方向分别对应着上下维的向上、向下；左、右两个方向分别对应着左右维的向左、向右；旋转对应着转轴维的旋转，当顺时针旋转时，医疗器械也顺时针旋转，逆时针旋转时，医疗器械也逆时针旋转；第二操作杆具有3个自由度运动方向，分别是前、后及旋转，前、后两个方向对应着前后维的向前、向后，旋转则对应着拨盘维，控制着医疗器械的弯曲度。操作杆的信号是通过操作杆内安装位置传感器来检测的，在操作杆的各个方向安装位置传感器，当操纵操作杆时对应方向的位置传感器获得信号，传感器采集到这些信号并将该信号发送给主控制器，主控制器将信号的处理后通过CAN把信号传输到执行端控制器，执行端控制器接收到信号即时驱动伺服控制系统驱动电机动作。

[0025] 所述触摸屏输入模块包括触摸屏，在触摸屏上设置启动按钮、停止按钮、自动回直按钮、恢复回直前状态按钮、记录数据按钮、恢复数据按钮、参数设置按钮及辅助设备控制按钮。当在触摸屏按下按钮时，主控制模块获得一个数据，不同的按钮对应的数据不同。主控制模块一旦读到有数据，则判断这些数据分别对应的是哪个按钮的数据，然后把数据实时的传输到执行端控制器，执行端控制器接收到数据马上驱动对应维的伺服控制器来驱动伺服电机动作，实现输入信号与伺服电机的同步性。其中自动回直按钮和还原输入按钮，设有自动回直、空间位置记忆功能。点击“自动回直”按钮时，控制端自动保存当前空间位置数据，医疗器械自动回到平直状态，需回到原来所记录的空间位置时，点击“恢复回直前状态按钮”按钮，机械手自控控制医疗器械回到原来记忆的控制位置上。此方法能更好操控医疗器械(如软镜)灵活实现各种动作，加快机械手的操纵效率。

[0026] 所述第一CAN模块及第二CAN模块为CAN总线或串口通信。

[0027] 一种用于远程控制医疗器械的控制系统的控制方法，包括以下步骤：

[0028] (1)、根据实际需要，对中央控制器进行操作，通过操控操作杆输入模块及触摸屏输入模块进行输入，显示模块对相应的操作进行显示，主控制模块对操作杆输入模块、触摸屏输入模块输入的信号进行收集和处理，并通过第一CAN模块传递给通讯模块；

[0029] (2)、通讯模块的第一CAN收发芯片接收第一CAN模块传递过来的电信号，第一CAN收发芯片输出信号给第二信号隔离模块，第二信号隔离模块把信号输送给执行控制器模块；

[0030] (3)、第二CAN模块接收信号后传递给多维运动控制模块，多维运动控制模块根据信号内容分别控制前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器，前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器分别驱动相应的伺服电机运动，实现多维操作，每个伺服电机的后轴处的转速位移检测传感器，用于检测各伺服电机的位移，辅助设备接口连接辅助设备；

[0031] (4)、多维运动控制模块反馈信号给第二CAN收发芯片，第二CAN收发芯片输出信号给第一信号隔离模块，第一信号隔离模块输出信号给第一CAN模块，第一CAN模块给主控制模块信号，主控制模块给显示模块信号，显示模块显示结果；

[0032] (5)、操作者根据显示结果进行操作。

[0033] 所述步骤(3)先调节好各伺服电机的速度环和电流环并组成内环，然后调整好位置环，构成位置、速度双闭环系统，因为伺服控制器本身能够通过转速位移检测传感器的数据进行速度和电流的三环闭环调节，同时，转速位移检测传感器的监测信息也将反馈到执行控制器模块，将反馈的信息转换成位置信息，传输到主控制模块；所述前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器对应前后维伺服电机、上下维伺服电机、左右维伺服电机、转轴维伺服电机及拨盘维伺服电机，在每个伺服电机连接1个减速箱，传动比是1:n，设伺服电机转一个角度W，医疗器械机械臂的滑轨移动距离是L，转速位移检测传感器返回脉冲数为N，则位移为：Displacement＝(360/nW)*N*L。

[0034] 本发明相对于现有技术，具有如下的优点及效果：

[0035] 1、本发明采用了包括用于实现各种输入方式输入并转化为电信号及显示相关信息的中央控制器、用于提供各种信号传输通道及信号转换的通讯模块及用于实现多维运动控制的执行控制器模块，具有结构简单、造价便宜、手动控制及自动控制相结合、适于操控柔性器械、精度高及能灵活多维运动等特点。

[0036] 2、本发明适用于各医疗器械，如软镜、胃镜等，特别适用于柔性器械。

[0037] 3、本发明可以通过多维运动控制模块根据信号内容分别控制前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器，驱动器驱动相应伺服电机，伺服电机还可以根据需要对应设置减速箱，从而实现灵活运动，以便应对复杂的手术情况。

[0038] 4、本发明中的前后维伺服电机、上下维伺服电机、左右维伺服电机、转轴维伺服电机及拨盘维伺服电机，先设置好各个伺服电机位置转角精度，然后通过信号控制各伺服电机连续微小控制。

[0039] 5、本发明可实现多维运动控制，先调节好各伺服电机的速度环和电流环并组成内环，然后调整好位置环，构成位置、速度双闭环系统，将同步电机的给定位置参考量和多个电机的位置反馈差值调整量做比值，通过差补算法实现位置的同步控制。

[0040] 6、本发明中的第一操作杆具有5个自由度运动方向，第二操作杆具有3个自由度运动方向，触摸屏上设置自动回直按钮及恢复回直前状态按钮，可以根据需要，实现各种动作。

[0041] 7、本发明设有操作杆输入模块及触摸屏输入模块，操作杆输入模式使医生操作时更有位置感，灵活实现各种高难度动作；如需自动回直或恢复回直前状态时，采用触摸屏输入模式，这两种控制方式可以配合使用，方便使用，提高准确率。

附图说明

[0042] 图1为一种用于远程控制医疗器械的控制系统的结构框图；

[0043] 图2为一种用于远程控制医疗器械的控制系统的控制方法流程框图；

[0044] 图3为本发明中主令系统的闭环控制算法示意图。

[0045] 图中标号与名称如下：

[0046]1 中央控制器 2 通讯模块
3 执行控制器模块

具体实施方式

[0047] 为便于本领域技术人员理解，下面结合附图及实施例对本发明作进一步的详细说明。

[0048] 实施例1：

[0049] 如图1～2所示，本实施例中的医疗器械为软镜，一种用于远程控制医疗器械的控制系统，用于实现各种输入方式输入并转化为电信号、显示相关信息及通过通讯模块将控制信号传输给执行控制器模块的中央控制器1、用于提供各种信号传输通道及信号转换的通讯模块2、用于实现多维运动控制的执行控制器模块3；其中，中央控制器1、通讯模块2及执行控制器模块3依次信号连接。

[0050] 本实施例中的中央控制器1包括主控制模块、操作杆输入模块、触摸屏输入模块、显示模块和第一CAN模块；其中，主控制模块分别与操作杆输入模块、触摸屏输入模块、显示模块和第一CAN模块连接，第一CAN模块与通讯模块连接。主控制模块主要作用是：采集输入信号，通过采集到操作杆输入信号和触控输入信号，将信号进行处理后通过CAN模块将信号传输到执行控制端。执行控制端的状态信息也通过CAN模块传回主控制模块，然后把输入信号和返回的状态信息通过显示模块显示出来。本实施例中的主控制模块是由意法半导体(STMicroelectronics)集团生产的STM32系列微控制器，这是一款基于专为要求高性能、低成本、低功耗的嵌入式应用专门设计的ARM Cortex-M3内核。STM32自带的是bxCAN，即基本扩展CAN。它支持CAN协议2.0A和2.0B。只需外接一个CAN的收发芯片JTA1050即可。

[0051] 显示模块是用来形象的显示出输入信息以及反馈回来的各维的状态信息。在每一维的机械输出终端配备高精度转速位移检测传感器，此传感用于校验每一维的伺服运动控制系统的执行情况，确保执行机构安全、稳定、准确、可靠。我们在每一维的伺服电机上都安装了转速位移检测传感器以检测伺服电机的速度及位置。在上下维，左右维和前后维，我们先设置好各伺服电机的位置转角精度，通过检验得出伺服电机转一个角度W，机械臂的滑轨移动距离是L，然后通过对转速位移检测传感器返回脉冲数N进行计数，一个脉冲表示电机转了一圈，则可以计算出位移为：

[0052] Displacement＝(360/W)*N*L

[0053] 而在转轴维和拨盘维，我们只需要通过转速位移检测传感器检测出伺服电机所转动的一个角度值就行了。上下维，左右维和前后维，三个维度构成了一个三维空间。通过检测这三个维度的位置信息可以明确知道软镜的空间位(x,y,z)，而转轴维和拨盘维通过位移或角度检测检测传感器检测出的角度位置w1,w2，是对软镜的空间位置的更加具体的定位，因此软镜的空间位置坐标(x,y,z,w1,w2)。

[0054] 但是这里考虑到了精度问题，因为软镜在人体内的各维的动作都要求很缓慢，很精确，而且动作幅度也是很小的，一般是几毫米，可是如果位移只是几毫米，伺服电机转动的角度也会变的很小，这样测量不够精确，误差会比较大。因此，我们在伺服电机上加了一个齿轮减速箱，传动比是1:n，可以给电机起到一个减速的效果，达到了动作需要缓慢的要求，同时传动比是1:n，就是说没加之前是伺服电机转一个角度W，机械臂的滑轨移动距离是L；加上齿轮减速箱之后，机械臂的滑轨移动距离是L，那么电机转动的角度变为nW，则计算出的位移变为：

[0055] Displacement＝(360/nW)*N*L

[0056] 而转轴维和拨盘维也是一样，没加齿轮减速箱之前是伺服电机转动的角度就是软镜转动的角度w1、w2，加上齿轮减速箱之后伺服电机转动的角度w1’、w2’，是软镜转动角度的n倍：

[0057] w1＝nw1’

[0058] w2＝nw2’

[0059] 这些数据经过执行端控制器的处理后传输到主控制模块，主控制模块把这些数据通过液晶显示屏显示出来，使用者就能实时的看到当前伺服电机的执行状态。能让操控医师更快找到机械的位置感，灵活实现各种高难度动作，并降低操控医师工作强度。

[0060] 本实施例中的通讯模块包括第一信号隔离模块、第一CAN收发芯片、第二CAN收发芯片及第二信号隔离模块；其中，第一CAN模块输出信号给第一CAN收发芯片，第一CAN收发芯片输出信号给第二信号隔离模块，第二信号隔离模块把信号输送给执行控制器模块，执行控制器模块反馈信号给第二CAN收发芯片，第二CAN收发芯片输出信号给第一信号隔离模块，第一信号隔离模块输出信号给第一CAN模块，第一CAN模块给主控制模块信号，主控制模块给显示模块信号，显示模块显示结果。信号隔离模块主要保证信号、电源、地之间绝对独立，避免干扰。

[0061] 本实施例中的执行控制器模块包括多维运动控制模块、辅助设备接口、若干伺服驱动器、若干伺服电机、第二CAN模块及若干转速位移检测传感器；其中，多维运动控制模块分别与辅助设备接口、若干伺服驱动器和第二CAN模块连接，第二CAN模块与第二信号隔离模块连接，每个伺服驱动器对应连接1个伺服电机，每个伺服电机的后轴处设有1个转速位移检测传感器。执行端控制器接收到主控制模块传输过来的各个维度的驱动信号，从而控制伺服驱动器来驱动伺服电机进行相应的动作。转速位移检测传感器监测伺服电机的动作情况，并实时的将监测信息反馈给伺服控制器和执行端控制器。本实施例采用双闭环调节的控制方式，因为伺服控制器本身能够通过转速位移检测传感器的数据进行速度和电流的三环闭环调节。同时转速位移检测传感器的监测信息也将反馈到执行端控制器。执行端控制器可以根据反馈的信息，将转速位移检测传感器的数据转换成位置信息，传输到主控制模块，经显示模块显示出来。

[0062] 如图3所示，图中V为输入的转速，x为比较符号，上下维、左右维、转轴维及拨盘维的算法均如图3所示结构，只是驱动器和电机不相同而已。

[0063] 本实施例中的伺服驱动器包括前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器，前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器分别对应连接前后维伺服电机、上下维伺服电机、左右维伺服电机、转轴维伺服电机及拨盘维伺服电机，每个伺服电机与伺服驱动器形成闭环控制系统。

[0064] 所述操作杆输入模块包括第一操作杆、第一操作杆位置传感器、第二操作杆、第二操作杆位置传感器；其中，第一操作杆位置传感器设于第一操作杆内，第二操作杆位置传感器设于第二操作杆内；第一操作杆具有5个自由度运动方向，分别是前、后、左、右以及旋转，前、后两个方向分别对应着上下维的向上、向下；左、右两个方向分别对应着左右维的向左、向右；旋转对应着转轴维的旋转，当顺时针旋转时，医疗器械也顺时针旋转，逆时针旋转时，医疗器械也逆时针旋转；第二操作杆具有3个自由度运动方向，分别是前、后及旋转，前、后两个方向对应着前后维的向前、向后，旋转则对应着拨盘维，控制着医疗器械的弯曲度。操作杆的信号是通过操作杆内安装位置传感器来检测的，在操作杆的各个方向安装位置传感器，当操纵操作杆时对应方向的位置传感器获得信号，传感器采集到这些信号并将该信号发送给主控制器，主控制器将信号的处理后通过CAN把信号传输到执行端控制器，执行端控制器接收到信号即时驱动伺服控制系统驱动电机动作。

[0065] 本实施例中的触摸屏输入模块包括触摸屏，在触摸屏上设置启动按钮、停止按钮、自动回直按钮、恢复回直前状态按钮、记录数据按钮、恢复数据按钮、参数设置按钮及辅助设备控制按钮。当在触摸屏按下按钮时，主控制模块获得一个数据，不同的按钮对应的数据不同。主控制模块一旦读到有数据，则判断这些数据分别对应的是哪个按钮的数据，然后把数据实时的传输到执行端控制器，执行端控制器接收到数据马上驱动对应维的伺服控制器来驱动伺服电机动作，实现输入信号与伺服电机的同步性。其中自动回直按钮和还原输入按钮，设有自动回直、空间位置记忆功能。点击“自动回直”按钮时，控制端自动保存当前空间位置数据，医疗器械自动回到平直状态，需回到原来所记录的空间位置时，点击“恢复回直前状态按钮”按钮，机械手自控控制医疗器械回到原来记忆的控制位置上。此方法能更好操控医疗器械(如软镜)灵活实现各种动作，加快机械手的操纵效率。

[0066] 本实施例中的第一CAN模块及第二CAN模块为CAN-2.0总线。

[0067] 一种用于远程控制医疗器械的控制系统的控制方法，包括以下步骤：

[0068] (1)、根据实际需要，对中央控制器进行操作，通过操控操作杆输入模块及触摸屏输入模块进行输入，显示模块对相应的操作进行显示，主控制模块对操作杆输入模块、触摸屏输入模块输入的信号进行收集和处理，并通过第一CAN模块传递给通讯模块；

[0069] (2)、通讯模块的第一CAN收发芯片接收第一CAN模块传递过来的电信号，第一CAN收发芯片输出信号给第二信号隔离模块，第二信号隔离模块把信号输送给执行控制器模块；

[0070] (3)、第二CAN模块接收信号后传递给多维运动控制模块，多维运动控制模块根据信号内容分别控制前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器，前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器分别驱动相应的伺服电机运动，实现多维操作，每个伺服电机的后轴处的转速位移检测传感器，用于检测各伺服电机的位移，辅助设备接口连接辅助设备；

[0071] (4)、多维运动控制模块反馈信号给第二CAN收发芯片，第二CAN收发芯片输出信号给第一信号隔离模块，第一信号隔离模块输出信号给第一CAN模块，第一CAN模块给主控制模块信号，主控制模块给显示模块信号，显示模块显示结果；

[0072] (5)、操作者根据显示结果进行操作。

[0073] 所述步骤(3)先调节好各伺服电机的速度环和电流环并组成内环，然后调整好位置环，构成位置、速度双闭环系统，因为伺服控制器本身能够通过转速位移检测传感器的数据进行速度和电流的三环闭环调节，同时，转速位移检测传感器的监测信息也将反馈到执行控制器模块，将反馈的信息转换成位置信息，传输到主控制模块；所述前后维驱动器、上下维驱动器、左右维驱动器、转轴维驱动器及拨盘维驱动器对应前后维伺服电机、上下维伺服电机、左右维伺服电机、转轴维伺服电机及拨盘维伺服电机，在每个伺服电机连接1个减速箱，传动比是1:n，设伺服电机转一个角度W，医疗器械机械臂的滑轨移动距离是L，转速位移检测传感器返回脉冲数为N，则位移为：Displacement＝(360/nW)*N*L。

[0074] 上述控制方法可用于手术或非医疗目的的科研假体当中，本实施例具体控制方法作用于假体之上。具体实际应用时，可以进行如下操作：

[0075] 先将软镜通过输尿管导引鞘进入假体的尿道、输尿管，并送入肾盂，然后将软镜手柄按照要求通过人工方式放置和固定在软镜夹持器上。在触摸屏(具有显示图像功能)上显示软镜进入肾脏集合系统整个过程，包括肾盂、上盏、中盏、下盏，并对肾脏集合系统观察；通过点击控制操作台触摸屏上的相应功能按钮开启控制钬激光的激发设备发射钬激光；在手术中，通过控制操作台开启灌注水的流速和水压控制设备灌注水以增加视野的清晰度；在进入肾脏集合系统时，开启控制X光暴露设备进行X光照射以确定软镜的位置；手术中，通过触摸屏随时查看肾脏集合系统，同时进行X光照射以确定软镜的实际位置。根据软镜手术规程，操作控制操作台上的操作手柄，或者点击触摸屏上相应功能按钮，操作机械臂的上下、前后、左右运动，机械手的旋转和回转运动。同时，根据实际情况，可以控制机械手系统的刹车片轮脚，进行紧急制动，进而控制软镜的上下、前后、左右、旋转和回转运动，调整软镜位置和状态。

[0076] 实施例2

[0077] 本实施例和实施例1不同之处在于：本实施例采用的医疗器械为胃镜，每个伺服电机均不连接齿轮减速箱。

[0078] 上述具体实施方式为本发明的优选实施例，并不能对本发明进行限定，其他的任何未背离本发明的技术方案而所做的改变或其它等效的置换方式，都包含在本发明的保护范围之内。