CN114469354B - 一种介入手术机器人从端初始化方法和可读存储介质 - Google Patents
一种介入手术机器人从端初始化方法和可读存储介质 Download PDFInfo
- Publication number
- CN114469354B CN114469354B CN202210381223.1A CN202210381223A CN114469354B CN 114469354 B CN114469354 B CN 114469354B CN 202210381223 A CN202210381223 A CN 202210381223A CN 114469354 B CN114469354 B CN 114469354B
- Authority
- CN
- China
- Prior art keywords
- driving
- induction units
- fed back
- units
- initialization
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000011423 initialization method Methods 0.000 title claims abstract description 23
- 230000006698 induction Effects 0.000 claims abstract description 317
- 238000000034 method Methods 0.000 claims abstract description 9
- 238000004590 computer program Methods 0.000 claims description 6
- 238000012360 testing method Methods 0.000 claims description 3
- 210000004204 blood vessel Anatomy 0.000 description 10
- 238000001514 detection method Methods 0.000 description 5
- 230000002792 vascular Effects 0.000 description 4
- 230000036512 infertility Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 2
- 230000002452 interceptive effect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000005855 radiation Effects 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000001356 surgical procedure Methods 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
- A61B34/35—Surgical robots for telesurgery
Abstract
一种介入手术机器人从端初始化方法和可读存储介质，包括：获取启动指令，基于所述启动指令，控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果；判断N个所述驱动感应单元反馈的去误差结果是否满足初始化条件；若N个所述驱动感应单元反馈的去误差结果满足初始化条件，则控制N个所述驱动感应单元执行初始化操作，以使每一个所述驱动感应单元移动至相应目标初始化位置，完成初始化。本发明的方法可以使N个驱动感应单元精准快速地移动至对应的目标初始化位置，以便后续医生操作。
Description
技术领域
本发明涉及一种医疗机器人的控制技术领域，尤其涉及一种介入手术机器人从端初始化方法和可读存储介质。
背景技术
血管介入手术中医生需要长期接收X射线的辐射，为此工程上开发了远程操作的介入手术机器人。医生远程控制介入手术机器人，以使介入手术机器人可以在强烈辐射的环境下执行血管介入手术，有效保护医生。
通常情况下，利用介入手术机器人执行血管介入手术，是利用介入手术机器人中的N个驱动感应单元共同配合驱动导管导丝等细长型医疗器械。但是，目前执行血管介入手术前，N个驱动感应单元的初始化位置不精准，不利于医生后续控制介入手术机器人执行精准的血管介入手术。
发明内容
基于此，有必要针对现有技术中的不足，提供一种介入手术机器人从端初始化方法，以保证手术前，N个驱动感应单元处于精准的初始化位置。
一种介入手术机器人从端初始化方法，控制介入手术机器人从端启动后执行初始化操作，所述介入手术机器人包括：机架、可滑动地安装在所述机架上的N个驱动感应单元、以及与N个驱动感应单元连接的处理器，包括所述处理器执行的如下步骤：
获取启动指令，基于所述启动指令，控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果；
判断N个所述驱动感应单元反馈的去误差结果是否满足初始化条件；
若N个所述驱动感应单元反馈的去误差结果满足初始化条件，则控制N个所述驱动感应单元执行初始化操作，以使每一个所述驱动感应单元移动至相应目标初始化位置，完成初始化。
优选地，所述基于所述启动指令，控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
基于所述启动指令，获取N个所述驱动感应单元反馈的自检结果；
判断N个所述驱动感应单元反馈的自检结果是否满足去误差条件；
若N个所述驱动感应单元反馈的自检结果满足去误差条件，则控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果。
优选地，所述自检结果为驱动感应单元携带无菌盒或者驱动感应单元不携带无菌盒；
所述判断N个所述驱动感应单元反馈的自检结果是否满足去误差条件，包括：
若N个所述驱动感应单元反馈的自检结果均为驱动感应单元不携带无菌盒，则N个所述驱动感应单元反馈的自检结果满足去误差条件。
优选地，所述控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
获取N个所述驱动感应单元反馈的初始信号；
判断N个所述驱动感应单元反馈的初始信号是否满足目标复位条件；
若存在一个所述驱动感应单元反馈的初始信号不满足目标复位条件，则查询数据库，获取N个所述驱动感应单元的操作顺序；
基于所述操作顺序，控制N个所述驱动感应单元依次向同一方向运动，直至获取到N个所述驱动感应单元反馈的当前信号；
当N个所述驱动感应单元反馈的当前信号满足目标复位条件，则控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果。
优选地，在所述判断N个所述驱动感应单元反馈的初始信号是否满足目标复位条件之后，所述方法还包括：
若N个所述驱动感应单元反馈的初始信号满足目标复位条件，则控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果。
优选地，所述初始信号为接触信号或者非接触信号；若N个所述驱动感应单元反馈的初始信号存在一个为非接触信号，则N个所述驱动感应单元反馈的初始信号不满足目标复位条件；若N个所述驱动感应单元反馈的初始信号均为接触信号，则N个所述驱动感应单元反馈的初始信号满足目标复位条件。
优选地，所述控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
控制N个所述驱动感应单元运动至预设位置，获取N个所述驱动感应单元反馈的移动结果；
基于所述移动结果和N个所述驱动感应单元的操作顺序，依次控制N个所述驱动感应单元运动值目标复位位置，以获取N个所述驱动感应单元反馈的去误差结果。
优选地，所述控制N个所述驱动感应单元运动至预设位置，获取N个所述驱动感应单元反馈的移动结果，包括：
向N个所述驱动感应单元发送携带有预设长度和移动方向的移位指令，以使N个所述驱动感应单元同时沿移动方向移动预设长度，到达预设位置；
获取N个驱动感应单元移动到预设位置后反馈的移动结果。
优选地，所述控制N个所述驱动感应单元执行初始化操作，以使每一个所述驱动感应单元移动至相应目标初始化位置，完成初始化，包括：
获取N个所述驱动感应单元对应的操作顺序和每一所述驱动感应单元对应的目标初始化长度；
基于所述操作顺序，依次控制N个所述驱动感应单元移动到目标初始化长度对应的目标初始化位置，以使N个所述驱动感应单元完成初始化。
本发明提供一种可读存储介质，所述可读存储介质存储有计算机程序，其特征在于，所述计算机程序被处理器执行以实现如上所述的一种介入手术机器人从端初始化方法。
本发明提供一种介入手术机器人从端初始化方法，在血管介入手术前，控制N个驱动感应单元进行去误差操作和初始化操作，以使N个驱动感应单元移动至各自的目标初始化位置，为后续的血管介入手术提供技术支持，解决驱动感应单元数量较多、N个驱动感应单元相互分离、嵌套等问题，避免影响后续的血管介入手术。
附图说明
图1为本发明介入手术机器人从端初始化方法的一流程图；
图2为图1中步骤S101的流程图1；
图3为图1中步骤S101的流程图2；
图4为图3中步骤S305或者步骤S306的流程图；
图5为图4中步骤S401的流程图；
图6为图1中步骤S103的流程图；
图7为本发明介入手术机器人的原理图。
具体实施方式
为了使发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释发明，并不用于限定发明。
一种介入手术机器人从端初始化方法，应用在介入手术机器人中，介入手术机器人包括：机架、可滑动地逐次安装在所述机架上的N个驱动感应单元、以及与N个驱动感应单元连接的处理器，其中，N为大于1的整数，可以根据实际应用进行限定，在此不做限定。本实施例中，驱动感应单元用于安装并驱动导管或者导丝等细长型医疗器械进入血管，进行治疗，即血管介入手术时，医生通过主端控制装置远程控制驱动感应单元，以控制导管或者导丝等细长型医疗器械进入血管。
介入手术机器人从端初始化方法，应用在介入手术机器人中，用于在介入手术前，使N个驱动感应单元精准地位于各自对应的目标初始化位置，为医生实际进行介入手术时，精准有效控制驱动感应单元提供支持。所述处理器用于执行如下步骤：
S101：获取启动指令，基于所述启动指令，控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果。
其中，启动指令是控制N个驱动感应单元启动的指令。具体地，处理器与主端控制模组通信连接，主端控制模组上设有交互界面；医生点击或者触碰交互界面的启动按钮，以在主端控制模组生成启动指令，主端控制模组向处理器发送启动指令，以使处理器控制N个驱动感应单元开始执行去误差操作，为后续的初始化提供技术支持。
一开始机架上N 个驱动感应单元存在嵌套或者远离等问题。本实施例中，去误差操作是处理器控制N个驱动感应单元执行的，用于解决N 个驱动感应单元存在的误差问题（即解决N 个驱动感应单元嵌套或者远离的问题），为后续处理提供技术支持。去误差结果是指每一个驱动感应单元向处理器反馈的，自身执行去误差操作的结果。本实施例中，N 个驱动感应单元嵌套或者远离具体是指：N个驱动感应单元中，相邻两个驱动感应单元相互嵌套或者远离。
本实施例，通过控制N个驱动感应单元执行去误差操作，以使存在嵌套或者远离情况的N个驱动感应单元有序且规整地排列在机架上，为N个驱动感应单元进行精准地初始化提供技术支持，保证初始化后的N个驱动感应单元精准地到达机架各自对应的目标初始化位置。目标初始化位置是预先设定的N个驱动感应单元在开始手术前各自所处的位置，需要指出的是，一个驱动感应单元对应一个目标初始化位置，以保证手术时，任意两个驱动感应单元进行精准配合，驱动导管导丝等介入器件旋转或者移动，避免发生碰撞。
作为一实施例，如图2所示，步骤S101，即基于所述启动指令，控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
S201：基于所述启动指令，获取N个所述驱动感应单元反馈的自检结果。
S202：判断N个所述驱动感应单元反馈的自检结果是否满足去误差条件。
S203：若N个所述驱动感应单元反馈的自检结果满足去误差条件，则控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果。
其中，无菌盒自检操作是每一驱动感应单元检测自身是否携带有无菌盒的操作。自检结果是每一驱动感应单元执行无菌盒自检操作后，向处理器反馈的结果，其中，自检结果为驱动感应单元携带无菌盒或者驱动感应单元没有携带无菌盒。示例性地，当N等于2，则自检结果可能为：第一个驱动感应单元携带无菌盒，第二个驱动感应单元携带无菌盒；第一个驱动感应单元携带无菌盒，第二个驱动感应单元没有携带无菌盒；第一个驱动感应单元没有携带无菌盒，第二个驱动感应单元携带无菌盒；第一个驱动感应单元没有携带无菌盒，第二个驱动感应单元没有携带无菌盒。
去误差条件是N个所述驱动感应单元能够执行去误差操作的条件，去误差条件具体为N个所述驱动感应单元均没有携带无菌盒。即当N个所述驱动感应单元反馈的自检结果均为没有携带无菌盒，则N个所述驱动感应单元反馈的自检结果满足去误差条件，此时，处理器控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果，以保证后续的初始化精度。
通常情况下，无菌盒安装在驱动感应单元上，具有一定的体积，若是驱动感应单元在安装有无菌盒的情况下进行初始化，将导致初始化结果出错。本实施例中，每一驱动感应单元包括无菌盒检测感应器；处理器与每一驱动感应单元的无菌盒检测感应器连接。当处理器接收到启动指令后，则自动查询数据库，得到N个所述驱动感应单元反馈的自检结果，处理器对N个所述驱动感应单元反馈的自检结果与去误差条件进行比对，当N个所述驱动感应单元反馈的自检结果均为没有携带无菌盒时，则N个所述驱动感应单元反馈的自检结果满足去误差条件，此时，处理器控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果，以保证后续的初始化精度。本实施例，每一驱动感应单元反馈的自检结果携带有驱动标识，且每一驱动感应单元每隔预设的无菌检测时长则自动向处理器发送携带有驱动标识的自检结果；当存在一个驱动感应单元的自检结果为携带无菌盒，则基于驱动标识，启动自检结果为携带无菌盒的驱动感应单元对应的警示器，以提醒医生将无菌盒拆卸下来。且处理器在无菌检测时长后，查询数据库，得到N个所述驱动感应单元反馈的自检结果，直至确保所有的驱动感应单元上均没有携带无菌盒；并在自检结果为没有携带无菌盒的情况下，控制N个所述驱动感应单元执行去误差操作。其中，驱动标识是用于唯一识别驱动感应单元的标识，该驱动标识可以是序号或者字母等，例如，第一个驱动标识可以是A1，第二个驱动标识可以是A2。
作为一实施例，如图3所示，步骤S101或者步骤S203，即控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
S301：获取N个所述驱动感应单元反馈的初始信号。
本实施例中，每一驱动感应单元还包括距离感应器和与所述距离感应器配合的距离感应片，处理器与每一驱动感应单元的距离感应器连接。每一个驱动感应单元的距离感应器安装驱动感应单元上，其中，第一个驱动感应单元的距离感应片被确定为定位感应片，定位感应片安装在机架上，且位于机架近端部位，其余驱动感应单元的距离感应片安装在相邻前一驱动感应单元上，也就是说第二个驱动感应单元的距离感应片安装在第一个驱动感应单元。本实施例中，操作者在无辐射的主端控制室内控制介入手术机器人从端，“近端”为靠近操作者的一端。“远端”为远离操作者的一端。
其中，初始信号是启动电源后，每一驱动感应单元的距离感应器向处理器发送的信号，该初始信号为接触信号或者非接触信号，接触信号是指驱动感应单元的距离感应器与相应距离感应片接触,即当驱动感应单元的距离感应器和相应距离感应片接触时，则发送的初始信号为接触信号，也就是说相邻两个驱动感应单元接触或者嵌套。反之，非接触信号是指驱动感应单元的距离感应器与相应距离感应片不接触，即当驱动感应单元的距离感应器和对应的距离感应片不接触时，则发送的初始信号为非接触信号，也就是说相邻两个驱动感应单元远离。
S302：判断N个所述驱动感应单元反馈的初始信号是否满足目标复位条件。
其中，目标复位条件是能够执行目标复位操作的条件，具体是每一驱动感应单元的距离感应器与相应距离感应片接触，即每一所述驱动感应单元反馈的初始信号为接触信号，此时，N个所述驱动感应单元两两之间相互抵接或者嵌套的情况，此时，控制N个所述驱动感应单元执行目标复位操作，以排除相邻两个驱动感应单元嵌套的情况。
S303：若存在一个所述驱动感应单元反馈的初始信号不满足目标复位条件，则查询数据库，获取N个所述驱动感应单元的操作顺序。
S304：基于所述操作顺序，控制N个所述驱动感应单元依次向同一方向运动，直至获取到N个所述驱动感应单元反馈的当前信号。
操作顺序是预先设定的操作顺序，该初始复位顺序是依据N个驱动感应单元与定位感应片的距离，决定驱动感应单元运动的顺序。具体地，操作顺序为最靠近定位感应片的驱动感应单元确定为执行初始复位操作的第一个驱动感应单元，与第一个驱动感应单元相邻的后一驱动感应单元为执行初始复位操作的第二个驱动感应单元，依次类推，距离定位感应片最远的驱动感应单元为执行初始复位操作的第N个驱动感应单元。
当处理器确定N个驱动感应单元发送的初始信号不满足目标复位条件，此时，N个驱动感应单元中的两个或者多个存在分离的情况。本实施例中，处理器查询数据库，以确定N个驱动感应单元的操作顺序；控制N个所述驱动感应单元向同一个方向（即向定位感应片的方向）进行运动，直至获取到N个所述驱动感应单元反馈的当前信号（此处的当前信号为接触信号），以使相邻两个驱动感应单元接触或者嵌套，为后续的精准初始化提供技术支持。本实施例中，当前信号为接触信号，即驱动感应单元中的距离感应器与相应距离感应片基础。
具体地，初始信号还携带有用于唯一识别驱动感应单元的驱动标识；基于所述操作顺序，控制N个所述驱动感应单元依次向同一方向运动，直至获取到N个所述驱动感应单元反馈的当前信号，包括：根据所述操作顺序和驱动标识，控制距离定位感应片最近的驱动感应单元向定位感应片移动，直至接收到距离定位感应片最近的驱动感应单元反馈的接触的当前信号；……，直至控制最后一个驱动感应单元的距离感应器与前一驱动感应单元上的距离感应片抵接。
示例性地，第一个驱动感应单元的初始信号为接触信号，第二个驱动感应单元的初始信号为非接触信号，其余驱动感应单元的初始信号为接触信号。此时，第一个驱动感应单元的距离感应器可能刚好与定位感应片接触，也可能第一个驱动感应单元的距离感应器嵌套在定位感应片内。第二个驱动感应单元的初始信号为非接触信号，则第二个驱动感应单元与第一个驱动感应单元相互远离，此时，根据操作顺序和驱动标识，控制第二个驱动感应单元向定位感应片的方向移动，当第二个驱动感应单元与第一个驱动感应单元抵接，则停止运动，并向处理器发送携带有第二个驱动感应单元对应的驱动标识的当前信号，此时，当前信号可以理解为第二个驱动感应单元对应的接触信号。根据第二个驱动感应单元对应的驱动标识和操作顺序，控制第三个驱动感应单元向定位感应片的方向移动，当第二个驱动感应单元与第一个驱动感应单元抵接（即第三个驱动感应单元的距离感应器和安装在第二个驱动感应单元上的相应距离感应片接触），则第三个驱动感应单元停止运动，并向处理器发送当前信号，此时，当前信号可以理解为第三个驱动感应单元对应的接触信号；处理器依次控制第三个驱动感应单元之后的驱动感应单元向定位感应片的方向移动，直至第N个驱动感应单元与第N-1个驱动感应单元接触，则可以获取到每一所述驱动感应单元反馈的当前信号，以便进行后续操作。
S305：当N个所述驱动感应单元反馈的当前信号满足目标复位条件，则控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果。
其中，目标复位操作是用于排除相邻两个驱动感应单元嵌套的操作，为后续精准初始化提供技术支持。
S306：若N个所述驱动感应单元反馈的初始信号满足目标复位条件，则控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果。
本实施例中，N个所述驱动感应单元反馈的初始信号均为接触信号，则说明相邻两个驱动感应单元接触，此时相邻两个驱动感应单元可能存在抵接或者嵌套的情况，因此，还需要控制N个驱动感应单元进行目标复位操作，以消除相邻两个驱动感应单元嵌套的问题，保证所有的驱动感应单元有序规整地排列在机架上，为后续的初始化提供技术支持。
本实施例中，当驱动感应单元反馈的当前信号满足目标复位条件，则说明相邻两个驱动感应单元接触，此时相邻两个驱动感应单元抵接或者嵌套，因此，还需要控制N个驱动感应单元进行去误差操作，以保证所有的驱动感应单元有序排列在机架上，为后续的初始化提供技术支持。
作为一实施例，如图4所示，步骤S305或者步骤S306，即控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
S401：控制N个所述驱动感应单元运动至预设位置，获取N个所述驱动感应单元反馈的移动结果。
其中，预设位置是预定的位置，该预设位置位于机架的定位传感器和机架的远端之间。
本实施例中，当相邻两个驱动感应单元均为接触时，此时可能存在相邻两个驱动感应单元相互嵌套，因此，需要向N个驱动感应单元发送移动指令，以控制N个所述驱动感应单元向远离定位传感器的方向运动至预设位置，获取N个所述驱动感应单元运动至预设位置反馈的移动结果，以便根据移动结果，控制N个驱动感应单元进行目标复位操作。
作为一实施例，如图5所示，步骤S401，即所述控制N个所述驱动感应单元运动至预设位置，获取N个所述驱动感应单元反馈的移动结果，包括：
S501：向N个所述驱动感应单元发送携带有预设长度和移动方向的移位指令，以使N个所述驱动感应单元同时沿移动方向移动预设长度，到达预设位置。
本实施例中，N个所述驱动感应单元同时沿移动方向移动预设长度时，N个所述驱动感应单元同时移动。
S502：获取N个驱动感应单元移动到预设位置后反馈的移动结果。
其中，预设长度是预先设定的长度，可以理解为预设位置和定位传感器之间的长度。移动方向是指向远离定位传感器移动的方向。
移位指令是用于控制N个驱动感应单元移动的指令。
本实施例中，当N个所述驱动感应单元反馈的信号均为接触信号时，N个所述驱动感应单元反馈的初始信号或者当前信号满足目标复位条件，此时，向N个驱动感应单元发送携带有移动方向和预设长度的移位指令，当N个驱动感应单元接收到移位指令，则沿移动方向移动预设长度，到达预设位置；当N个驱动感应单元移动到预设位置，则向处理器反馈移动结果，以处理器根据移动结果控制N个驱动感应单元执行后续的复位操作。
S402：基于所述移动结果和N个所述驱动感应单元的操作顺序，依次控制N个所述驱动感应单元运动至目标复位位置，以获取N个所述驱动感应单元反馈的去误差结果。
其中，目标复位位置是预先设定的位置，一个驱动感应单元对应一个目标复位位置，以使相邻两个驱动感应单元距离相等的位置，例如，相邻两个驱动感应单元距离的目标复位位置相差58毫米。
当N个所述驱动感应单元反馈的当前信号满足目标复位条件或N个所述驱动感应单元反馈的初始信号满足目标复位条件时，则相邻驱动感应单元抵接或者嵌套，本实施例中，向第一个所述驱动感应单元发送移动距离和移动方向，让第一个驱动感应单元和第二个驱动感应单元分离，然后使第一个驱动感应单元停止，接着，使第二个驱动感应单元向第一个驱动感应单元移动，当第二个驱动感应单元的距离感应器与第一个驱动感应单元的距离感应片抵接，则第二个驱动感应单元停止；……，直至第N个驱动感应单元与第N-1个驱动感应单元接触，则可以获取到每一所述驱动感应单元反馈的目标复位结果，保证相邻驱动感应单元抵接，而无嵌套的情况，以便进行初始化。
S102：判断N个所述驱动感应单元反馈的去误差结果是否满足初始化条件。
其中，初始化条件是用N个驱动感应单元能够进行初始化的条件，具体为N个所述驱动感应单元经过去误差操作。
具体地，处理器中预先设置有初始化条件，当N个所述驱动感应单元反馈的去误差结果满足初始化条件，则处理器将控制N个所述驱动感应单元执行初始化操作。
S103：若N个所述驱动感应单元反馈的去误差结果满足初始化条件，则控制N个所述驱动感应单元执行初始化操作，以使每一个所述驱动感应单元移动至相应目标初始化位置，完成初始化。
其中，初始化操作是用于控制N个驱动感应单元运动到预先设定的对应目标初始化位置的操作。
本实施中，N个驱动感应单元去误差操作后，处理器控制N个驱动感应单元运动各自对应的目标初始化位置，提高初始化精度，保证后续任意两个驱动感应单元进行精准配合。
作为一实施例，如图6所示，步骤S103，即所述控制N个所述驱动感应单元执行初始化操作，以使每一个所述驱动感应单元移动至相应目标初始化位置，完成初始化，包括：
S601：获取N个所述驱动感应单元对应的操作顺序和每一所述驱动感应单元对应的目标初始化长度。
S602：基于所述操作顺序，依次控制N个所述驱动感应单元移动到目标初始化长度对应的目标初始化位置，以使N个所述驱动感应单元完成初始化。
本实施例中，处理器根据初始操作顺序，控制第一个驱动感应单元向对应的目标初始化位置移动，当第一个驱动感应单元运动对应的目标初始化位置则停止，并向处理器发送携带有第一个驱动感应单元对应的驱动标识的初始化完成信号；处理器根据携带有驱动标识的初始化完成信号和操作顺序，控制第二个驱动感应单元（即与第一个驱动感应单元相邻的后一驱动感应单元）向对应的目标初始化位置移动，当第二个驱动感应单元运动对应的目标初始化位置则停止，并向处理器发送携带有驱动标识的初始化完成信号；依次类推，直至所有驱动感应单元运动至相应目标初始化位置，则N个所述驱动感应单元完成初始化，此时可以进行血管介入手术。
本实施例所提供的介入手术机器人从端初始化方法，控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果；当所述去误差结果满足初始化条件，则控制N个所述驱动感应单元执行初始化操作，以使每一个所述驱动感应单元移动至相应目标初始化位置，完成初始化。
本发明提供的介入手术机器人从端初始化方法，在血管介入手术前，控制介入手术机器人的N个驱动感应单元进行去误差操作和初始化操作，以使N个驱动感应单元位于精准的目标初始化位置，解决驱动感应单元数量较多、N个驱动感应单元相互分离、嵌套等问题，避免影响后续的血管介入手术。
在一实施例中，如图7所示，提供一可读存储介质，该可读存储介质上存储有计算机程序，该计算机程序被处理器执行时实现上述实施例中介入手术机器人从端初始化方法的步骤，例如图1所示的步骤S101-S103，或者图2至图6中所示的步骤，为避免重复，这里不再赘述。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程，是可以通过计算机程序来指令相关的硬件来完成，所述的计算机程序可存储于一非易失性计算机可读取存储介质中，该计算机程序在执行时，可包括如上述各方法的实施例的流程。其中，本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用，均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器（ROM）、可编程ROM（PROM）、电可编程ROM（EPROM）、电可擦除可编程ROM（EEPROM）或闪存。易失性存储器可包括随机存取存储器（RAM）或者外部高速缓冲存储器。作为说明而非局限，RAM以多种形式可得，诸如静态RAM（SRAM）、动态RAM（DRAM）、同步DRAM（SDRAM）、双数据率SDRAM（DDRSDRAM）、增强型SDRAM（ESDRAM）、同步链路（Synchlink） DRAM（SLDRAM）、存储器总线（Rambus）直接RAM（RDRAM）、直接存储器总线动态RAM（DRDRAM）、以及存储器总线动态RAM（RDRAM）等。
所属领域的技术人员可以清楚地了解到，为了描述的方便和简洁，仅以上述各功能单元、模块的划分进行举例说明，实际应用中，可以根据需要而将上述功能分配由不同的功能单元、模块完成，即将所述装置的内部单元划分成不同的功能单元或模块，以完成以上描述的全部或者部分功能。
以上所述实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围，均应包含在本发明的保护范围之内。
以上所述实施例仅表达了发明的一种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离发明构思的前提下，还可以做出若干变形和改进，这些都属于发明的保护范围。因此，发明专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种介入手术机器人从端初始化方法，控制介入手术机器人从端启动后执行初始化操作，所述介入手术机器人包括：机架、可滑动地安装在所述机架上的N个驱动感应单元、以及与N个驱动感应单元连接的处理器，其特征在于，包括所述处理器执行的如下步骤：
获取启动指令，基于所述启动指令，控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果；其中，去误差操作是处理器控制N个驱动感应单元执行的，用于解决N 个驱动感应单元嵌套或者远离的操作；
判断N个所述驱动感应单元反馈的去误差结果是否满足初始化条件；
若N个所述驱动感应单元反馈的去误差结果满足初始化条件，则控制N个所述驱动感应单元执行初始化操作，以使每一个所述驱动感应单元移动至相应目标初始化位置，完成初始化。
2.如权利要求1所述的一种介入手术机器人从端初始化方法，其特征在于，所述基于所述启动指令，控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
基于所述启动指令，获取N个所述驱动感应单元反馈的自检结果；
判断N个所述驱动感应单元反馈的自检结果是否满足去误差条件；
若N个所述驱动感应单元反馈的自检结果满足去误差条件，则控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果。
3.如权利要求2所述的一种介入手术机器人从端初始化方法，其特征在于，所述自检结果为驱动感应单元携带无菌盒或者驱动感应单元不携带无菌盒；
所述判断N个所述驱动感应单元反馈的自检结果是否满足去误差条件，包括：若N个所述驱动感应单元反馈的自检结果均为驱动感应单元不携带无菌盒，则N个所述驱动感应单元反馈的自检结果满足去误差条件。
4.如权利要求2所述的一种介入手术机器人从端初始化方法，其特征在于，所述控制N个所述驱动感应单元执行去误差操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
获取N个所述驱动感应单元反馈的初始信号；
判断N个所述驱动感应单元反馈的初始信号是否满足目标复位条件；
若存在一个所述驱动感应单元反馈的初始信号不满足目标复位条件，则查询数据库，获取N个所述驱动感应单元的操作顺序；
基于所述操作顺序，控制N个所述驱动感应单元依次向同一方向运动，直至获取到N个所述驱动感应单元反馈的当前信号；
当N个所述驱动感应单元反馈的当前信号满足目标复位条件，则控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果。
5.如权利要求4所述的一种介入手术机器人从端初始化方法，其特征在于，在所述判断N个所述驱动感应单元反馈的初始信号是否满足目标复位条件之后，所述方法还包括：
若N个所述驱动感应单元反馈的初始信号满足目标复位条件，则控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果。
6.如权利要求4或5所述的一种介入手术机器人从端初始化方法，其特征在于，所述初始信号为接触信号或者非接触信号；若N个所述驱动感应单元反馈的初始信号存在一个为非接触信号，则N个所述驱动感应单元反馈的初始信号不满足目标复位条件；若N个所述驱动感应单元反馈的初始信号均为接触信号，则N个所述驱动感应单元反馈的初始信号满足目标复位条件。
7.如权利要求4或5所述的一种介入手术机器人从端初始化方法，其特征在于，所述控制N个所述驱动感应单元执行目标复位操作，获取N个所述驱动感应单元反馈的去误差结果，包括：
控制N个所述驱动感应单元运动至预设位置，获取N个所述驱动感应单元反馈的移动结果；
基于所述移动结果和N个所述驱动感应单元的操作顺序，依次控制N个所述驱动感应单元运动至目标复位位置，以获取N个所述驱动感应单元反馈的去误差结果。
8.如权利要求7所述的一种介入手术机器人从端初始化方法，其特征在于，所述控制N个所述驱动感应单元运动至预设位置，获取N个所述驱动感应单元反馈的移动结果，包括：
向N个所述驱动感应单元发送携带有预设长度和移动方向的移位指令，以使N个所述驱动感应单元同时沿移动方向移动预设长度，到达预设位置；
获取N个驱动感应单元移动到预设位置后反馈的移动结果。
9.如权利要求1所述的一种介入手术机器人从端初始化方法，其特征在于，所述控制N个所述驱动感应单元执行初始化操作，以使每一个所述驱动感应单元移动至相应目标初始化位置，完成初始化，包括：
获取N个所述驱动感应单元对应的操作顺序和每一所述驱动感应单元对应的目标初始化长度；
基于所述操作顺序，依次控制N个所述驱动感应单元移动到目标初始化长度对应的目标初始化位置，以使N个所述驱动感应单元完成初始化。
10.一种可读存储介质，所述可读存储介质存储有计算机程序，其特征在于，所述计算机程序被处理器执行以实现权利要求1至9任一项所述的一种介入手术机器人从端初始化方法。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210381223.1A CN114469354B (zh) | 2022-04-13 | 2022-04-13 | 一种介入手术机器人从端初始化方法和可读存储介质 |
| PCT/CN2022/113596 WO2023197489A1 (zh) | 2022-04-13 | 2022-08-19 | 一种介入手术机器人从端初始化方法和可读存储介质 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210381223.1A CN114469354B (zh) | 2022-04-13 | 2022-04-13 | 一种介入手术机器人从端初始化方法和可读存储介质 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114469354A CN114469354A (zh) | 2022-05-13 |
| CN114469354B true CN114469354B (zh) | 2022-06-24 |
Family
ID=81487865
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202210381223.1A Active CN114469354B (zh) | 2022-04-13 | 2022-04-13 | 一种介入手术机器人从端初始化方法和可读存储介质 |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN114469354B (zh) |
| WO (1) | WO2023197489A1 (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114469354B (zh) * | 2022-04-13 | 2022-06-24 | 深圳市爱博医疗机器人有限公司 | 一种介入手术机器人从端初始化方法和可读存储介质 |
Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06274215A (ja) * | 1993-03-19 | 1994-09-30 | Tokyo Kasoode Kenkyusho:Kk | ワーク検査装置 |
| JPH08268024A (ja) * | 1995-03-31 | 1996-10-15 | Nissan Motor Co Ltd | サスペンション制御装置 |
| JP2007011493A (ja) * | 2005-06-28 | 2007-01-18 | Daihatsu Motor Co Ltd | 生産システム及び生産方法 |
| CN107361847A (zh) * | 2017-08-17 | 2017-11-21 | 成都中科博恩思医学机器人有限公司 | 一种初始化手术机器人中手术器械的方法及对应装置 |
| CN107744405A (zh) * | 2017-08-31 | 2018-03-02 | 首都医科大学附属北京天坛医院 | 一种机器人从端装置、操作系统及其控制方法 |
| CN207890660U (zh) * | 2017-12-19 | 2018-09-21 | 广东北玻臻兴玻璃技术工业有限公司 | 一种玻璃自动对位移动装置 |
| CN108742846A (zh) * | 2018-04-08 | 2018-11-06 | 上海联影医疗科技有限公司 | 手术机器人空间坐标系校验装置及应用其的校验方法 |
| CN109784499A (zh) * | 2018-12-21 | 2019-05-21 | 华南理工大学广州学院 | 一种学习机器人及控制方法 |
| CN109878961A (zh) * | 2019-04-01 | 2019-06-14 | 深圳普智联科机器人技术有限公司 | 一种多层货架轮廓的初始化自动标定装置和方法 |
| CN111200986A (zh) * | 2017-11-02 | 2020-05-26 | 直观外科手术操作公司 | 用于末端执行器位置设定点校正的系统和方法 |
| CN111670011A (zh) * | 2017-12-13 | 2020-09-15 | 威博外科公司 | 用于定位机器人操纵器的控制模式和过程 |
| CN111685883A (zh) * | 2019-07-23 | 2020-09-22 | 成都博恩思医学机器人有限公司 | 微创手术机器人的手术器械的自动识别与控制参数更新方法及装置 |
| CN111840777A (zh) * | 2020-07-09 | 2020-10-30 | 佛山市柏康机器人技术有限公司 | 基于协作机器人的前列腺粒子植入系统及方法 |
| CN112587243A (zh) * | 2020-12-15 | 2021-04-02 | 深圳市精锋医疗科技有限公司 | 手术机器人及其控制方法、控制装置 |
| CN113304393A (zh) * | 2021-06-30 | 2021-08-27 | 深圳市爱博医疗机器人有限公司 | 一种手术机器人y阀组件及其连接件 |
| CN113693733A (zh) * | 2021-07-05 | 2021-11-26 | 深圳市爱博医疗机器人有限公司 | 一种介入手术机器人从端装置 |
Family Cites Families (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9161817B2 (en) * | 2008-03-27 | 2015-10-20 | St. Jude Medical, Atrial Fibrillation Division, Inc. | Robotic catheter system |
| US9649160B2 (en) * | 2012-08-14 | 2017-05-16 | OrthAlign, Inc. | Hip replacement navigation system and method |
| KR101527176B1 (ko) * | 2013-12-09 | 2015-06-09 | (주)미래컴퍼니 | 수술 로봇 장치 및 수술 로봇 장치의 제어 방법 |
| JP6165080B2 (ja) * | 2014-02-21 | 2017-07-19 | オリンパス株式会社 | マニピュレータシステムの初期化方法 |
| EP3319540B1 (en) * | 2015-07-07 | 2024-01-24 | Intuitive Surgical Operations, Inc. | Control of multiple devices |
| JP7145599B2 (ja) * | 2016-10-10 | 2022-10-03 | グローバス メディカル インコーポレイティッド | ２ｄ－３ｄ位置合わせの収束を改善するための方法及びシステム |
| CN107049492B (zh) * | 2017-05-26 | 2020-02-21 | 微创（上海）医疗机器人有限公司 | 手术机器人系统及手术器械位置的显示方法 |
| US11076921B2 (en) * | 2017-12-28 | 2021-08-03 | Cilag Gmbh International | Adaptive control program updates for surgical hubs |
| US20190201140A1 (en) * | 2017-12-28 | 2019-07-04 | Ethicon Llc | Surgical hub situational awareness |
| KR102356752B1 (ko) * | 2019-04-16 | 2022-01-28 | 주식회사 유진로봇 | 모바일 로봇의 초기화 진단 방법 및 시스템 |
| CN112643664B (zh) * | 2019-10-10 | 2022-09-23 | 深圳市优必选科技股份有限公司 | 定位误差消除方法、装置、机器人及存储介质 |
| US11730349B2 (en) * | 2019-10-25 | 2023-08-22 | Canon U.S.A., Inc. | Steerable medical device with bending sections and improved connector therefor |
| JP7352452B2 (ja) * | 2019-11-25 | 2023-09-28 | 川崎重工業株式会社 | 外科手術システム及びポジショナの操作方法 |
| GB2593739A (en) * | 2020-03-31 | 2021-10-06 | Cmr Surgical Ltd | Control system of a surgical robot |
| CN113967080A (zh) * | 2020-07-24 | 2022-01-25 | 北京术锐技术有限公司 | 一种遥操作主手夹持机构 |
| CN112587237A (zh) * | 2020-12-09 | 2021-04-02 | 南京凌华微电子科技有限公司 | 一种骨科手术机器人降低操作误差的方法 |
| CN114469354B (zh) * | 2022-04-13 | 2022-06-24 | 深圳市爱博医疗机器人有限公司 | 一种介入手术机器人从端初始化方法和可读存储介质 |
-
2022
- 2022-04-13 CN CN202210381223.1A patent/CN114469354B/zh active Active
- 2022-08-19 WO PCT/CN2022/113596 patent/WO2023197489A1/zh unknown
Patent Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06274215A (ja) * | 1993-03-19 | 1994-09-30 | Tokyo Kasoode Kenkyusho:Kk | ワーク検査装置 |
| JPH08268024A (ja) * | 1995-03-31 | 1996-10-15 | Nissan Motor Co Ltd | サスペンション制御装置 |
| JP2007011493A (ja) * | 2005-06-28 | 2007-01-18 | Daihatsu Motor Co Ltd | 生産システム及び生産方法 |
| CN107361847A (zh) * | 2017-08-17 | 2017-11-21 | 成都中科博恩思医学机器人有限公司 | 一种初始化手术机器人中手术器械的方法及对应装置 |
| CN107744405A (zh) * | 2017-08-31 | 2018-03-02 | 首都医科大学附属北京天坛医院 | 一种机器人从端装置、操作系统及其控制方法 |
| CN111200986A (zh) * | 2017-11-02 | 2020-05-26 | 直观外科手术操作公司 | 用于末端执行器位置设定点校正的系统和方法 |
| CN111670011A (zh) * | 2017-12-13 | 2020-09-15 | 威博外科公司 | 用于定位机器人操纵器的控制模式和过程 |
| CN207890660U (zh) * | 2017-12-19 | 2018-09-21 | 广东北玻臻兴玻璃技术工业有限公司 | 一种玻璃自动对位移动装置 |
| CN108742846A (zh) * | 2018-04-08 | 2018-11-06 | 上海联影医疗科技有限公司 | 手术机器人空间坐标系校验装置及应用其的校验方法 |
| CN109784499A (zh) * | 2018-12-21 | 2019-05-21 | 华南理工大学广州学院 | 一种学习机器人及控制方法 |
| CN109878961A (zh) * | 2019-04-01 | 2019-06-14 | 深圳普智联科机器人技术有限公司 | 一种多层货架轮廓的初始化自动标定装置和方法 |
| CN111685883A (zh) * | 2019-07-23 | 2020-09-22 | 成都博恩思医学机器人有限公司 | 微创手术机器人的手术器械的自动识别与控制参数更新方法及装置 |
| CN111840777A (zh) * | 2020-07-09 | 2020-10-30 | 佛山市柏康机器人技术有限公司 | 基于协作机器人的前列腺粒子植入系统及方法 |
| CN112587243A (zh) * | 2020-12-15 | 2021-04-02 | 深圳市精锋医疗科技有限公司 | 手术机器人及其控制方法、控制装置 |
| CN113304393A (zh) * | 2021-06-30 | 2021-08-27 | 深圳市爱博医疗机器人有限公司 | 一种手术机器人y阀组件及其连接件 |
| CN113693733A (zh) * | 2021-07-05 | 2021-11-26 | 深圳市爱博医疗机器人有限公司 | 一种介入手术机器人从端装置 |
Non-Patent Citations (2)
| Title |
|---|
| 眼科显微手术辅助机器人控制方法研究;廖一博;《万方》;20201126;全文 * |
| 粒子群优化的手术机器人从手夹持力模糊控制;张禹,刘群,刘慧芳,王哲;《机械设计与制造》;20181231(第4期);全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114469354A (zh) | 2022-05-13 |
| WO2023197489A1 (zh) | 2023-10-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| AU2016246745B2 (en) | System and method of controlling a surgical tool during autonomous movement of the surgical tool | |
| CN114469354B (zh) | 一种介入手术机器人从端初始化方法和可读存储介质 | |
| CN109640864B (zh) | 基于所感测的参数进行外科工具定位 | |
| US11376053B2 (en) | Surgical rod bending system and method | |
| CN111200986A (zh) | 用于末端执行器位置设定点校正的系统和方法 | |
| US20220015846A1 (en) | Method and system for preventing collision between mechanical arms, and medical robot | |
| CN114469343B (zh) | 标定件、手术导航坐标系配准系统、方法、设备和介质 | |
| KR20190010860A (ko) | 로봇 수술 절차 동안 물리적 오브젝트를 식별하고 추적하기 위한 시스템 및 방법 | |
| JP2016512073A5 (zh) | ||
| CN110584784A (zh) | 机器人辅助手术系统 | |
| CN101657231A (zh) | 确定用于放射治疗输送系统的最优化路径行进 | |
| US20110054449A1 (en) | Surgical tool calibrating device having electronic sensing module | |
| CN115068825A (zh) | 用于促进经颅磁刺激的递送的系统和方法 | |
| CN114521971A (zh) | 一种介入机器人系统和可读存储介质 | |
| CN109044530A (zh) | 一种前列腺手术机器人的多模态感知系统及数据融合方法 | |
| CN115245387A (zh) | 细长型医疗器械递送系统、递送方法、设备及介质 | |
| EP4026509A2 (en) | Device for guiding position of robot, method therefor, and system comprising same | |
| US8601185B2 (en) | System and methods for avoiding data collisions over a data bus | |
| US20150196368A1 (en) | Assisting in Navigation of a Medical Instrument | |
| AU2020386613B2 (en) | Osteotomy verification method and verification apparatus, readable storage medium, and orthopedic surgery system | |
| US20190090838A1 (en) | X-ray fluoroscopy and imaging apparatus | |
| CN114767265A (zh) | 手术路径规划方法、系统、电子设备和存储介质 | |
| CN113576666A (zh) | 监测方法和医学系统 | |
| CN113925551A (zh) | 用于确认电动手术钉合系统正确组装的方法和结构 | |
| US11701191B1 (en) | Interventional robot system, and control method and readable-storage medium thereof |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CP03 | Change of name, title or address |
Address after: 518112 801-806, building 12, China Hisense innovation industry city, No. 12, Ganli Sixth Road, gankeng community, Jihua street, Longgang District, Shenzhen, Guangdong Province Patentee after: Shenzhen Aibo Hechuang Medical Robot Co.,Ltd. Address before: 518112 801-806, building 12, China Hisense innovation industry city, No. 12, Ganli Sixth Road, gankeng community, Jihua street, Longgang District, Shenzhen, Guangdong Province Patentee before: Shenzhen Aibo medical robot Co.,Ltd. |
|
| CP03 | Change of name, title or address |