微创血管介入手术机器人送管机构的控制装置的制作方法

专利名称：微创血管介入手术机器人送管机构的控制装置的制作方法
技术领域：
本发明属于医疗设备技术领域，公开了一种微创血管介入手术机器人送管机构的 控制装置。
背景技术：
随着社会的日益进步和人们生活水平的不断提高，人类对自身疾病的诊断、治疗、 预防以及卫生健康给予越来越多的关注。这就要求医生不仅要在传统生理医学上有所突 破，还要应用操作灵活、定位精确的医疗器械，这为医疗机器人的研究提供了客观条件，医 疗机器人的应用降低了手术的风险，改善了手术的环境。微创外科的出现及其临床应用为 医学领域开辟了新的天地，它以手术切口小、出血量小、术后疤痕小、创伤轻、痛苦少、恢复 时间快为特点受到人们的普遍关注被应用于临床手术，早期的微创外科手术是以腹腔镜和 胸腔镜等内窥镜为基础的一种外科手术，微创血管介入手术是微创外科的一个新方向。然 而，在微创血管介入手术过程中，由于操作对象较小(人体血管的直径一般小于2mm)，而且 手术工作时间很长，使得医生感觉非常疲惫，可能会出现医生手的颤动、疲劳、肌肉神经的 反馈，导致动作的不准确，加大了患者的痛苦，降低了手术的成功率。并且，医生长期在X射 线环境下操作对身体伤害很大；专科医生必须经过长期训练才能够进行微创手术操作；现 有手术方法技巧性较强，风险性较高，这些缺点限制了血管介入手术的广泛应用。二十世纪机器人技术进入微创外科手术领域后，利用机器人的高精度、稳定性、灵 活性、可控性以及不怕辐射和感染，来完成手术的定位，为医生手术搭建一个稳固的手术操 作平台，改善了过去医生只能凭借主观判断和积累的手术经验来完成手术的状况，能够减 少人为因素引起的手术误差，提高手术质量。近年来微创手术机器人的研究已经成为机器 人应用的新领域，尤其是医疗机器人系统已经成为医疗机器人发展的一个新方向。医疗机器人的研究和开发受到了越来越多的关注，能够应用于临床的手术机器人 越来越多，但微创血管介入手术机器人的末端执行器的控制装置尚未得到全面的研究和推 广应用，目前还没有功能相同的控制装置。此类控制装置得满足如下设计要求1.由于此装置属于医疗设备，故该装置必须保证操作的安全性。2.能够实现送管机构导管介入的前进动作；3.能够实现送管机构导管介入的旋转动作；4.在操作过程中该装置需给操作者力反馈，模拟操作者在手术过程中的手感。图Ia为现有相似技术的原理框图，图中控制装置、第一电机、编码器、操作者、第 一驱动器、电脑、第二驱动器、电机；在操作者的操作下，第一电机旋转，与此同时固定于第一电机末端的第一编码器 输出第一电机的旋转角度信号至第一驱动器，第一驱动器将该角度信号输入电脑，电脑将 角度信号经过转换之后往第二驱动器发送指令，第二驱动器在接受电脑的指令后驱动电 机，从而使电机执行操作者施加于控制装置的命令。这种控制装置还存在不足之处该装置无法实现力反馈，即操作者在操作过程中没有力觉，如果该装置作为医疗手术机器人的控制装置的话，在没有力反馈的情况下，医生 对手术对象没有感觉，仅凭视觉和经验来进行手术，很可能出现用力幅度过大，导致组织血 管或器官的损伤。

发明内容
为了解决现有技术的问题，本发明的目的在于提供一种实现送管机构导管介入的 前进、旋转动作；在控制过程中能够给操作手力反馈，能够模拟医生在手术过程中的手感且 安全可靠的微创血管介入手术机器人送管机构的控制装置。为达成所述目的，本发明提供的一种微创血管介入手术机器人送管机构的控制装 置的技术方案是该装置包括控制部含有第一电机、第二电机、第一编码器、第二编码器； 操作手、第一驱动器、计算机、第二驱动器、送管机构第一电机、送管机构第二电机、扭矩传 感器和导管，其中第一电机和第二电机分别与操作手连接，由操作手控制第一电机和第二电机转 动；第一电机接收第一驱动器发送的第一控制信号并控制第一电机转动而生成对操作手的 作用力；第一编码器与第一电机连接，第一编码器将第一电机的旋转角度信号生成二进制 码；第二编码器与第二电机连接，第二编码器将第二电机的旋转角度信号生成二进制 码；第一驱动器分别连接第一电机、第二编码器和第一编码器，第一驱动器将第二编 码器和第一编码器的二进制码生成并输出符合CAN总线通讯协议格式的数据；第一驱动器 接收第一驱动信号生成并向第一电机发送第一控制信号；计算机分别与第一驱动器和扭矩传感器连接，计算机将CAN总线通讯协议格式的 数据生成并输出第二驱动信号；计算机根据扭矩传感器输出的扭力数据信号生成并输出第 一驱动信号；第二驱动器与计算机连接，第二驱动器接收第二驱动信号生成并生成第二控制信 号；送管机构第一电机和送管机构第二电机分别与第二驱动器连接，送管机构第一电 机接收第二控制信号而转动输出旋转角度信息；送管机构第二电机接收第二控制信号而转 动输出旋转角度信息；扭矩传感器与送管机构第一电机连接，扭矩传感器将旋转角度信息生成并输出扭 力数据信号；导管与送管机构第一电机送管机构第二电机带动的送管机构接触使导管做周 向旋转。其中计算机将该第二电机的旋转角度信号经过比例换算之后，计算机发送指令 至第二驱动器，第二驱动器按照指令驱动送管机构第二电机旋转导管，从而实现操作手对 导管的周向旋转操作。其中计算机将第一电机的旋转角度信号经过换算之后，计算机发送指令至第二 驱动器，第二驱动器驱动送管机构第一电机推进导管，从而实现操作手对导管的轴向推进 操作。
5
其中计算机接收由扭矩传感器发送的送管机构第一电机转轴上的扭矩信号并进 行的比例换算，计算机向第一驱动器发送电流指令，第一驱动器按照该电流指令驱动第一 电机产生扭矩，该扭矩传递到操作手，操作手受到阻力，则实现对操作手的操作力的反馈控 制。其中第一电机的固定法兰通过连接板固定在盖板上；第一电机的转动轴与第一 减速器的转动轴连接，第一减速器的转动轴通过第一联轴器与第一传动轴相连接，第一外 套筒位于盖板上的方孔中，第一外套筒的下端通过螺钉与第一传动轴紧密相连，第一外套 筒的上端通过螺钉与第二外套筒紧密连接。其中操作手柄置于第二传动轴上方，操作手柄的末端与第二传动轴相连；第二 电机的转动轴与第二减速器的转动轴连接，同时第二减速器的转动轴通过第二连轴器与第 二传动轴紧密相连；第一传动轴通过轴承座与盖板相连；第二传动轴位于第二外套筒内。本发明的有益效果本发明种实现送管机构的导管介入的前进、旋转动作；在控制过程中本发明能够 给操作手力反馈，因而能够模拟医生在手术过程中的手感，这样避免了在血管介入手术过 程中，医生仅凭视觉和经验来进行手术从而出现用力幅度过大，导致患者组织血管或器官 的损伤的情况发生；在实际操作过程中，根据操作手向前、后推进角度的大小，将送管机构 导管介入的速度划分为前进、后退3档，从而方便操作手控制送管机构操作的导管的介入 速度。为了避免误操作，在设置速度档位时利用软件，在计算机内设定0速度档，在该档位 送管机构停止导管的直线进给运动，保证操作的安全性。这样能有效地避免由于外部干扰 造成操作手柄的误操作，保证安全。


图Ia是现有控制装置原理框图；图Ib是本发明微创血管介入手术机器人送管机构控制装置原理框图；图2a和图2b是本发明微创血管介入手术机器人送管机构的控制装置结构示意 图。主要元件说明1盖板18第二编码器
2操作手柄a操作手
3第一电机b第一驱动器
4第二电机C计算机
5连接板C1CAN数据接收单元
6第一传动轴C2CAN数据发送单元
7第二传动轴C3比例运算单元
8第一联轴器C4CAN数据接收单元
9螺钉C5CAN数据发送单元
10第一外套筒d第二驱动器
11第二外套筒e电机
12第一减速器ei送管机构第一电机减速器e2送管机构第二电机
座f扭矩传感器
联轴器g导管
编码器131415161具体实施例方式为使本发明的目的、技术方案和优点更加清楚明白，以下结合具体实施例，并参照 附图，对本发明进一步详细说明。本发明的控制装置所操纵的送管机构是应用于微创血管介入手术，关乎人的生命 和健康，因此对控制装置的精度，可靠性等性能要求比较高。图Ib为本发明微创血管介入手术机器人送管机构控制装置原理框图，图中控制 部h;操作手a、第一驱动器b、计算机C、第二驱动器d、送管机构第一电机el、送管机构第二 电机e2、扭矩传感器f和导管g。控制部h包括第一电机3、第二电机4、第一编码器17、第二编码器18 ；计算机c选用主频1.6GHz，内存1GB，并配有PCI-58XX CAN接口卡用于CAN通信， 关于计算机的选用不仅限于上述描述，在此不再赘述计算机选用的其他形式。第一电机3和第二电机4分别与操作手a连接，由操作手a控制第一电机3和第 二电机4转动；第一电机3接收第一驱动器b发送的第一控制信号并控制第一电机3转动 而生成对操作手a的反作用力；第一编码器17与第一电机3连接，第一编码器17将第一电机3的旋转角度信号 生成二进制码；第二编码器18与第二电机4连接，第二编码器18将第二电机4的旋转角度信号 生成二进制码；第一驱动器b分别连接第一电机3、第二编码器18和第一编码器17，第一驱动器 b将第二编码器18和第一编码器17的二进制码生成并输出符合CAN总线通讯协议格式的 数据；第一驱动器b接收第一驱动信号生成并向第一电机3发送第一控制信号；CAN数据接收单元Cl、CAN数据发送单元c2、比例运算单元c3、CAN数据发送单元C4 和CAN数据接收单元C5由计算机c实现；其中CAN数据发送单元c4、CAN数据接收单元C5 分别与第一驱动器b和扭矩传感器f连接，比例运算单元C3将CAN数据接收单元C4接收到 的扭矩信号乘以一个比例常数得到扭矩值，比例运算单元C3将扭矩值生成第一驱动信号； CAN数据接收单元Cl、CAN数据发送单元C2分别于第一驱动器b和第二驱动器d连接，比例 运算单元C3将CAN接收单元C1接收到的信号乘以一个比例常数，根据所得到的值生成第二 驱动信号；第二驱动器d与CAN数据发送单元C2连接，第二驱动器接收第二驱动信号生成并 生成第二控制信号；送管机构第一电机el和送管机构第二电机e2分别与第二驱动器d连接，送管机 构第一电机el接收第二控制信号而转动输出旋转角度信息；送管机构第二电机e2接收第 二控制信号而转动输出旋转角度信息；
扭矩传感器f与送管机构第一电机el连接，扭矩传感器f测量第一电机el轴上 的扭矩大小，并输出该扭力数据信号；导管g与送管机构第一电机el和送管机构第二电机 e2带动的送管机构接触使导管g做周向旋转。在操作手a的操作下，第二电机4旋转，固定在第二电机4末端的第二编码器18 将第二电机4的旋转角度信号经第一驱动器b输入CAN数据接收单元Cl，比例运算单元C3 将该旋转角度信号经过比例换算单元C3的比例换算之后(第二驱动器d位置指令=旋转 角度信号X比例系数)，通过CAN数据发送单元C2发送导管g的周向旋转角度指令至第二 驱动器d，第二驱动器d按照该位置指令驱动送管机构第二电机e2旋转导管g，从而实现操 作手a对导管g的周向旋转操作。在操作手a的操作下，第一电机3旋转，固定在第一电机3末端的第一编码器17 将第一电机3的旋转角度信号经第一驱动器b输入CAN数据接收单元C1，经过比例运算单 元C3换算之后，通过CAN数据发送单元C2发送导管g的进给长度指令至第二驱动器d，第 二驱动器d驱动送管机构第一电机el推进导管g，从而实现操作手a对导管g的轴向推进 操作。在送管机构第一电机el转动的同时，扭矩传感器f测量送管机构第一电机el转轴 上的扭矩信号，并将该信号输入CAN数据接收单元C4，经过比例运算单元C3的比例换算之 后(第一驱动器b电流指令=扭矩传感器f扭矩信号X比例系数)，通过CAN数据发送单 元C5向第一驱动器b发送电流指令，第一驱动器b按照该电流指令驱动第一电机3产生扭 矩信号，该扭矩信号传输到操作手a时，操作手a能感觉到一定的阻力，这样实现了操作手a 在操作过程中力的反馈，使操作手a在实施手术时能够感觉送管机构所送导管g对组织或 血管的作用力。下面结合本发明的机械结构示意图详细地说明各机械部件的功能。图2a_图2b示出本发明的微创血管介入手术机器人送管机构结构示意图，其中第 一电机3的固定法兰通过连接板5固定在盖板1上；第一电机3的转动轴与第一减速器12 的转动轴连接，第一减速器12的转动轴通过第一联轴器8与第一传动轴6相连接，第一外 套筒10位于盖板1上的方孔16中，第一外套筒10的下端通过螺钉9与第一传动轴6紧密 相连，第一外套筒10的上端通过螺钉9与第二外套筒11紧密连接。图2b所示第二传动轴7位于第二外套筒11内；操作手柄2置于第二传动轴7上 方，操作手柄2的末端与第二传动轴7相连；第二电机4的转动轴与第二减速器13的转动 轴连接，同时第二减速器13的转动轴通过第二连轴器15与第二传动轴7紧密相连；第一传 动轴6通过轴承座14与盖板1相连。当操作手a在手术过程中推进操作手柄2时，带动第二外套筒11运动，由于第一 外套筒10通过螺钉9与第二外套筒11紧密相连，同时第一外套筒10通过螺钉9与第一传 动轴6紧密相连，故第二外套筒11、第一外套筒10同时绕第一转动轴6旋转，并将转动传至 第一传动轴6，第一传动轴6将转动通过与之相连的第一联轴器8传至第一减速器12的转 动轴，同时带动第一电机3的转轴旋转，而位于第一电机3末端的第一编码器17将该转动 信号经过图Ib中第一驱动器b输入计算机c中。经过转换之后，计算机c向第二驱动器d 发送指令，第二驱动器d按照指令驱动送管机构第一电机el，送管机构第一电机el操作导 管g作直线轴向进给运动。当导管在血管内触碰到血管壁和血斑受到阻力时，扭矩传感器 f会将此时送管机构第一电机e 1转动轴上的扭矩信号传送至计算机c，计算机c将该信号入第一驱动器b，第一驱动器b将输入第一电机3电流，由于输入第一电 机3上的电流将产生与第一电机3旋转方向相反的作用力，阻碍第一电机3的旋转，这种作 用力将反向传导在操作手柄2上进而传递给操作手a，实现操作手a在操作过程中的触觉力 反馈，操作手a会做相应的调整，保证了手术过程中的安全性。当操作手a在手术过程中旋转操作手柄2时，由于操作手柄2通过第二传动轴7、 第二轴承连接器15和第二减速器13的转动轴与第二电机4的转动轴相连，而第二电机4 末端装有第二编码器18，第二编码器18将第二电机4转轴的旋转角度，通过第一驱动器b 输入计算机c，计算机c将操作手a作用于操作手柄2的运动指令发送至第二驱动器d，第 二驱动器d按照指令驱动送管机构第二电机e2，操作导管g旋转。从而实现，当操作手a旋 转操作手柄2的时候，相应地送管机构第二电机e2操作导管g作周向旋转运动。以上所述，仅为本发明的具体实施方式
，但本发明的保护范围并不局限于此，任何 熟悉该技术的人在本发明所揭露的技术范围内，可理解想到的变换或替换，都应涵盖在本 发明的包含范围之内。
权利要求
一种微创血管介入手术机器人送管机构控制装置，其特征在于，该装置包括控制部含有第一电机、第二电机、第一编码器、第二编码器；操作手、第一驱动器、计算机、第二驱动器、送管机构第一电机、送管机构第二电机、扭矩传感器和导管，其中第一电机和第二电机分别与操作手连接，由操作手控制第一电机和第二电机转动；第一电机接收第一驱动器发送的第一控制信号并控制第一电机转动而生成对操作手的反作用力；第一编码器与第一电机连接，第一编码器将第一电机的旋转角度信号生成二进制码；第二编码器与第二电机连接，第二编码器将第二电机的旋转角度信号生成二进制码；第一驱动器分别连接第一电机、第二编码器和第一编码器，第一驱动器将第二编码器和第一编码器的二进制码生成并输出符合CAN总线通讯协议格式的数据；第一驱动器接收第一驱动信号生成并向第一电机发送第一控制信号；计算机分别与第一驱动器和扭矩传感器连接，计算机将CAN总线通讯协议格式的数据生成并输出第二驱动信号；计算机根据扭矩传感器输出的扭力数据信号生成并输出第一驱动信号；第二驱动器与计算机连接，第二驱动器接收第二驱动信号生成并生成第二控制信号；送管机构第一电机和送管机构第二电机分别与第二驱动器连接，送管机构第一电机接收第二控制信号而转动输出旋转角度信息；送管机构第二电机接收第二控制信号而转动输出旋转角度信息；扭矩传感器与送管机构第一电机连接，扭矩传感器将旋转角度信息生成并输出扭力数据信号；导管与送管机构第一电机送管机构第二电机带动的送管机构接触使导管做周向旋转。
2.如权利要求1所述的微创血管介入手术机器人送管机构控制装置，其特征在于，计 算机将该第二电机的旋转角度信号经过比例换算之后，计算机发送指令至第二驱动器，第 二驱动器按照指令驱动送管机构第二电机旋转导管，从而实现操作手对导管的周向旋转操 作。
3.如权利要求1所述的微创血管介入手术机器人送管机构控制装置，其特征在于，计 算机将第一电机的旋转角度信号经过换算之后，计算机发送指令至第二驱动器，第二驱动 器驱动送管机构第一电机推进导管，从而实现操作手对导管的轴向推进操作。
4.如权利要求1所述的微创血管介入手术机器人送管机构控制装置，其特征在于，计 算机接收由扭矩传感器发送的送管机构第一电机转轴上的扭矩信号并进行的比例换算，计 算机向第一驱动器发送电流指令，第一驱动器按照该电流指令驱动第一电机产生扭矩，该 扭矩传递到操作手，操作手受到阻力，则实现对操作手的操作力的反馈控制。
5.如权利要求1所述的微创血管介入手术机器人送管机构控制装置，其特征在于第 一电机的固定法兰通过连接板固定在盖板上；第一电机的转动轴与第一减速器的转动轴连 接，第一减速器的转动轴通过第一联轴器与第一传动轴相连接，第一外套筒位于盖板上的 方孔中，第一外套筒的下端通过螺钉与第一传动轴紧密相连，第一外套筒的上端通过螺钉 与第二外套筒紧密连接。
6.如权利要求1所述的微创血管介入手术机器人送管机构控制装置，其特征在于操 作手柄置于第二传动轴上方，操作手柄的末端与第二传动轴相连；第二电机的转动轴与第二减速器的转动轴连接，同时第二减速器的转动轴通过第二连轴器与第二传动轴紧密相 连；第一传动轴通过轴承座与盖板相连；第二传动轴位于第二外套筒内。
全文摘要
本发明公开一种微创血管介入手术机器人送管机构的控制装置，该装置包括第一电机和第二电机分别与操作手连接；第一编码器与第一电机连接；第二编码器与第二电机连接；第一驱动器分别连接第一电机、第二编码器和第一编码器；计算机分别与第一驱动器和扭矩传感器连接；第二驱动器与计算机连接；送管机构第一电机和送管机构第二电机分别与第二驱动器连接；扭矩传感器与送管机构第一电机连接，根据操作手向前、后推进角度的大小，将送管机构的导管介入的速度划分，从而方便操作手控制送管机构操作的导管的介入速度。
文档编号A61B19/00GK101904771SQ201010221159
公开日2010年12月8日 申请日期2010年7月8日 优先权日2010年7月8日
发明者侯增广, 吉程, 易新, 曾达幸, 杨雪, 王洪波, 程龙, 胡国清, 胡正伟, 谢晓亮, 谭民, 郑晓倩, 齐政彦 申请人:中国科学院自动化研究所