CN115229806B - 一种机械臂控制方法、装置、***、设备及存储介质 - Google Patents
一种机械臂控制方法、装置、***、设备及存储介质 Download PDFInfo
- Publication number
- CN115229806B CN115229806B CN202211147679.8A CN202211147679A CN115229806B CN 115229806 B CN115229806 B CN 115229806B CN 202211147679 A CN202211147679 A CN 202211147679A CN 115229806 B CN115229806 B CN 115229806B
- Authority
- CN
- China
- Prior art keywords
- pose
- coordinate system
- mechanical arm
- probe
- tracer
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Abstract
本发明实施例提供了一种机械臂控制方法、装置、***、设备及存储介质,涉及数据处理技术领域,上述方法包括:获得探针的针尖多次触碰手术对象的手术部位时探针示踪器的第一位姿;根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置;根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置;根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。应用本发明实施例提供的机械臂控制方案,能够在控制机械臂移动的过程中避免机械臂与手术对象的手术部位发生碰撞。
Description
技术领域
本发明涉及数据处理技术领域,特别是涉及一种机械臂控制方法、装置、***、设备及存储介质。
背景技术
手术机器人上通常安装有机械臂,医生在使用手术机器人对手术对象进行手术时,手术机器人需要控制其机械臂移动到预先规划好的预期位置。手术机器人在控制其机械臂移动的过程中,需要避免机械臂与手术对象的手术部位发生碰撞。
发明内容
本发明实施例的目的在于提供一种机械臂控制方法、装置、***、设备及存储介质,以避免手术机器人机械臂与手术对象的手术部位发生碰撞。具体技术方案如下:
第一方面,本发明实施例提供了一种机械臂控制方法,所述方法包括:
获得探针的针尖多次触碰手术对象的手术部位时探针示踪器的第一位姿,其中,所述探针示踪器安装于所述探针上,所述探针针尖每一次触碰的手术部位上的位置不同;
根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置;
根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置;
根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
本发明的一个实施例中,所述根据所述障碍物空间所在位置和预设的目标位姿控制所述机械臂移动,包括:
根据所述障碍物空间所在位置,以预设的目标位姿为机械臂末端的最终位姿规划移动路径,其中,所述移动路径针对所述障碍物空间进行避障;
控制所述机械臂按照所规划的移动路径进行移动。
本发明的一个实施例中,所述根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,包括:
规划以预设的目标位姿为机械臂末端的最终位姿的移动路径;
控制所述机械臂按照所规划的移动路径进行移动;
在移动过程中,监测所述机械臂的实时位姿;
根据所述实时位姿以及所述障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间;
若为是,则根据所述障碍物空间所在位置,控制所述机械臂进行避障或停止运动。
本发明的一个实施例中,所述根据所述实时位姿以及所述障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间,包括:
获得在所述探针针尖触碰所述手术部位时所述手术对象的对象位姿;
根据所述障碍物空间所在位置以及对象位姿,确定所述障碍物空间在所述手术对象中的手术位置;
实时监测所述手术对象的位姿,并根据监测得到的位姿以及所述手术位置,更新所述障碍物空间所在位置;
根据所述实时位姿以及更新后的障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间。
本发明的一个实施例中,所述障碍物空间所在位置为所述障碍物空间在基座坐标系下的位置,所述基座坐标系为:根据所述机械臂的基座建立的坐标系。
本发明的一个实施例中,所述方法还包括:
获得在所述探针针尖触碰所述手术部位时标定示踪器的第二位姿,其中,所述第一位姿和第二位姿为同一坐标系下的位姿;
所述根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置,包括:
针对所述探针针尖触碰所述手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及所述探针示踪器与所述探针针尖之间的相对位置关系,确定在该触碰时刻下所述探针针尖在标定坐标系下的针尖位置,其中,所述标定坐标系为:根据所述标定示踪器建立的坐标系;
所述根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置,包括:
获得当前机械臂姿态、所述标定示踪器的第三位姿以及末端示踪器的第四位姿,其中,所述末端示踪器安装于所述机械臂的末端,所述第三位姿和第四位姿为同一坐标系下的位姿;
根据所获得的机械臂姿态,确定所述基座坐标系与末端坐标系之间的第一转换关系,其中,所述末端坐标系为:根据所述机械臂的末端建立的坐标系;
根据所述第三位姿以及第四位姿,计算所述标定坐标系与示踪器坐标系之间的第二转换关系,其中,所述示踪器坐标系为:根据所述末端示踪器建立的坐标系;
根据所述第一转换关系、第二转换关系、第三转换关系以及所述探针针尖在所述标定坐标系下的各个针尖位置,确定障碍物空间在所述基座坐标系下的位置,其中,所述第三转换关系为:所述示踪器坐标系与末端坐标系之间的转换关系。
第二方面,本发明实施例还提供了一种机械臂控制装置,所述装置包括:
第一获得模块,用于获得探针的针尖多次触碰手术对象的手术部位时探针示踪器的第一位姿,其中,所述探针示踪器安装于所述探针上,所述探针针尖每一次触碰的手术部位上的位置不同;
针尖确定模块,用于根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置;
障碍物确定模块,用于根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置;
机械臂控制模块,用于根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
本发明的一个实施例中,所述机械臂控制模块,具体用于:
根据所述障碍物空间所在位置,以预设的目标位姿为机械臂末端的最终位姿规划移动路径,其中,所述移动路径针对所述障碍物空间进行避障;
控制所述机械臂按照所规划的移动路径进行移动。
本发明的一个实施例中,所述机械臂控制模块,包括:
路径规划子模块,用于规划以预设的目标位姿为机械臂末端的最终位姿的移动路径;
机械臂控制子模块,用于控制所述机械臂按照所规划的移动路径进行移动;
位姿检测子模块,用于在移动过程中,监测所述机械臂的实时位姿;
触碰判断子模块,用于根据所述实时位姿以及所述障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间,若为是,则触发机械臂避障子模块;
所述机械臂避障子模块,用于根据所述障碍物空间所在位置,控制所述机械臂进行避障或停止运动。
本发明的一个实施例中,所述触碰判断子模块,具体用于:
获得在所述探针针尖触碰所述手术部位时所述手术对象的对象位姿;
根据所述障碍物空间所在位置以及对象位姿,确定所述障碍物空间在所述手术对象中的手术位置;
实时监测所述手术对象的位姿,并根据监测得到的位姿以及所述手术位置,更新所述障碍物空间所在位置;
根据所述实时位姿以及更新后的障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间。
本发明的一个实施例中,所述障碍物空间所在位置为所述障碍物空间在基座坐标系下的位置,所述基座坐标系为:根据所述机械臂的基座建立的坐标系。
本发明的一个实施例中,所述装置还包括:
第二获得模块,用于获得在所述探针针尖触碰所述手术部位时标定示踪器的第二位姿,其中,所述第一位姿和第二位姿为同一坐标系下的位姿;
所述针尖确定模块,具体用于:
针对所述探针针尖触碰所述手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及所述探针示踪器与所述探针针尖之间的相对位置关系,确定在该触碰时刻下所述探针针尖在标定坐标系下的针尖位置,其中,所述标定坐标系为:根据所述标定示踪器建立的坐标系;
所述障碍物确定模块,具体用于:
获得当前机械臂姿态、所述标定示踪器的第三位姿以及末端示踪器的第四位姿,其中,所述末端示踪器安装于所述机械臂的末端,所述第三位姿和第四位姿为同一坐标系下的位姿;
根据所获得的机械臂姿态,确定所述基座坐标系与末端坐标系之间的第一转换关系,其中,所述末端坐标系为:根据所述机械臂的末端建立的坐标系;
根据所述第三位姿以及第四位姿,计算所述标定坐标系与示踪器坐标系之间的第二转换关系,其中,所述示踪器坐标系为:根据所述末端示踪器建立的坐标系;
根据所述第一转换关系、第二转换关系、第三转换关系以及所述探针针尖在所述标定坐标系下的各个针尖位置,确定障碍物空间在所述基座坐标系下的位置,其中,所述第三转换关系为:所述示踪器坐标系与末端坐标系之间的转换关系。
第三方面,本发明实施例还提供了一种机械臂控制***,所述***包括:机械臂、安装有探针示踪器的探针、三维导航追踪设备、上位机、用于示出手术对象的位姿的对象示踪器、安装有定位示踪器的***;
所述***安装于所述机械臂的末端;
所述三维导航追踪设备,用于获得探针的针尖多次触碰手术对象的手术部位时所述探针示踪器的第一位姿以及所述对象示踪器的第二位姿,并将所述第一位姿、第二位姿发送给所述上位机,其中,所述探针针尖每一次触碰的手术部位上的位置不同,所述第一位姿和第二位姿为同一坐标系下的位姿;
所述上位机,用于针对所述探针针尖触碰所述手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及所述探针示踪器与所述探针针尖之间的相对位置关系,确定在该触碰时刻下所述探针针尖在对象坐标系下的针尖位置,根据所述探针针尖在所述对象坐标系下的各个针尖位置,确定障碍物空间在所述对象坐标系下的位置,其中,所述对象坐标系为:根据所述对象示踪器建立的坐标系;
所述上位机,还用于获得当前机械臂姿态、所述对象示踪器的第三位姿以及定位示踪器的第四位姿;根据所述机械臂姿态,确定所述基座坐标系与末端坐标系之间的第一转换关系;根据所述第三位姿以及第四位姿,计算所述对象坐标系与定位坐标系之间的第二转换关系;根据所述第一转换关系、第二转换关系以及第三转换关系,将所述对象坐标系下所述障碍物空间所在位置转换至所述基座坐标系下,其中,所述第三位姿和第四位姿为同一坐标系下的位姿,所述定位坐标系为:根据所述定位示踪器建立的坐标系,所述末端坐标系为:根据所述机械臂的末端建立的坐标系,所述基座坐标系为:根据所述机械臂的基座建立的坐标系,所述第三转换关系为:所述定位坐标系与所述末端坐标系之间的转换关系;
所述上位机,还用于根据所述基座坐标系下所述障碍物空间所在位置以及预设的目标位姿,控制所述机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
第四方面,本发明实施例还提供了一种电子设备,包括处理器、通信接口、存储器和通信总线,其中,处理器,通信接口,存储器通过通信总线完成相互间的通信;
存储器,用于存放计算机程序;
处理器,用于执行存储器上所存放的程序时,实现上述第一方面任一所述的方法步骤。
第五方面,本发明实施例还提供了一种计算机可读存储介质,所述计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现上述第一方面任一所述的方法步骤。
本发明实施例有益效果:
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据探针上安装的探针示踪器的第一位姿,确定探针针尖的针尖位置,从而根据各个针尖位置确定障碍物空间所在位置。由于上述针尖位置为探针针尖触碰手术对象的手术部位时的位置,因此,上述障碍物空间可以认为是包围上述手术部位的空间,这样根据障碍物空间所在位置以及目标位姿控制机械臂移动,能够使得机械臂准确避开手术部位进行移动。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,还可以根据这些附图获得其他的实施例。
图1为本发明实施例提供的第一种机械臂控制方法的流程示意图;
图2为本发明实施例提供的第二种机械臂控制方法的流程示意图;
图3为本发明实施例提供的第三种机械臂控制方法的流程示意图;
图4为本发明实施例提供的第四种机械臂控制方法的流程示意图;
图5为本发明实施例提供的第五种机械臂控制方法的流程示意图;
图6为本发明实施例提供的第一种机械臂控制装置的结构示意图;
图7为本发明实施例提供的第二种机械臂控制装置的结构示意图;
图8为本发明实施例提供的第三种机械臂控制装置的结构示意图;
图9为本发明实施例提供的一种机械臂控制***的结构示意图;
图10为本发明实施例提供的一种电子设备的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员基于本发明所获得的所有其他实施例,都属于本发明保护的范围。
参见图1,图1为本发明实施例提供的第一种机械臂控制方法的流程示意图,上述方法包括以下步骤S101-步骤S104。
步骤S101:获得探针的针尖多次触碰手术对象的手术部位时探针示踪器的第一位姿。
其中,探针示踪器安装于探针上,探针针尖每一次触碰的手术部位上的位置不同。
上述探针示踪器可以安装与探针的尾部,也可以安装于探针的其他位置。
具体的,医生在对手术对象进行手术时,可以使用探针触碰手术对象的手术部位,在医生每一次使用探针触碰手术部位时,可以获得在这一触碰时刻下探针示踪器的第一位姿,这样在医生使用探针多次触碰手术部位的不同位置时,可以获得探针示踪器的多个第一位姿。
获得示踪器的位姿可以通过现有技术实现,这里不再详述。
步骤S102:根据探针示踪器与探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定探针针尖在每一次触碰手术部位时的针尖位置。
具体的,在将探针示踪器安装于探针上之后,可以标定探针示踪器与探针针尖之间的相对位置关系,这样在获得上述各个第一位姿之后,针对探针针尖触碰手术部位的每一触碰时刻,可以根据该相对位置关系以及该触碰时刻下的第一位姿,确定探针针尖在该触碰时刻下的针尖位置。
步骤S103:根据探针针尖的各个针尖位置,确定障碍物空间所在位置。
具体的,在获得探针针尖的各个针尖位置后,可以生成以各个针尖位置作为端点的多面体空间,该多面体空间即为上述障碍物空间,该多面体空间所在位置即为上述障碍物空间所在位置。
步骤S104:根据障碍物空间所在位置和预设的目标位姿控制机械臂移动,以使得机械臂末端移动至目标位姿指示的位置。
具体的,在控制机械臂移动的过程中,根据预设的目标位姿进行控制,可以使得机械臂末端最终移动至目标位姿指示的位置,再结合上述障碍物空间所在位置进行控制,可以在控制机械臂移动过程中,保证机械臂始终不触碰障碍物空间,从而实现避障。
根据障碍物空间所在位置和上述目标位姿控制机械臂移动的具体实现方式可参见后续图3所示实施例中步骤S104A-步骤S104B以及图4所示实施例中步骤S104C-步骤S104G,这里暂不详述。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据探针上安装的探针示踪器的第一位姿,确定探针针尖的针尖位置,从而根据各个针尖位置确定障碍物空间所在位置。由于上述针尖位置为探针针尖触碰手术对象的手术部位时的位置,因此,上述障碍物空间可以认为是包围上述手术部位的空间,这样根据障碍物空间所在位置以及目标位姿控制机械臂移动,能够使得机械臂准确避开手术部位进行移动。
另外,本方案中,医生仅需使用探针触碰手术对象的手术部位即可实现机械臂控制,因此,本发明实施例提供的机械臂控制方案中医生所需执行的操作简单。
本发明的一个实施例中,上述障碍物空间所在位置为障碍物空间在基座坐标系下的位置,基座坐标系为:根据机械臂的基座建立的坐标系。
具体的,三维导航追踪设备可以观测到示踪器在自身导航坐标系下的位姿,因此,上述第一位姿可以是上述导航坐标系下的位姿,基于此,可以计算导航坐标系与基座坐标系之间的转换关系,将三维导航追踪设备观测到的第一位姿转换至基座坐标系下,从而根据基座坐标系下的第一位姿确定探针针尖在基座坐标系下的各个针尖位置,进而确定障碍物空间在基座坐标系下的位置。
另外,在获得导航坐标系下的第一位姿后,还可以首先根据导航坐标系下的第一位姿获得导航坐标系下障碍物空间的位置,然后再利用导航坐标系与基座坐标系之间的转换关系,将障碍物空间在导航坐标系下的位置转换至基座坐标系下。
计算上述导航坐标系与基座坐标系之间的转换关系的具体实现方式可参见后续图2所示实施例,这里暂不详述。
本方案中,由于机械臂通常按照手术机器人在基座坐标系下生成的控制指令进行移动,上述障碍物空间所在位置为障碍物空间在基座坐标系下的位置,因此,根据障碍物空间在基座坐标系下的位置能够准确生成控制指令,从而能够准确控制机械臂进行移动。因此,应用本发明实施例提供的机械臂控制方案,能够提高控制准确性。
下面对获得障碍物空间在基座坐标系下的位置的具体实现方式进行说明。
本发明的一个实施例中,参见图2,提供了第二种机械臂控制方法的流程示意图,本实施例中,上述方法还包括以下步骤S105,并且上述步骤S102可以通过以下步骤S102A实现,上述步骤S103可以通过以下步骤S103A-步骤S103D实现。
步骤S105:获得在探针针尖触碰手术部位时标定示踪器的第二位姿。
其中,第一位姿和第二位姿为同一坐标系下的位姿。
上述标定示踪器可以是用于示出手术对象的位姿的示踪器,还可以是其他的固定不动的示踪器。
获得上述第二位姿的方式可参见上述步骤S101中获得第一位姿的方式,这里不再赘述。
在获得上述第一位姿和第二位姿后,可以执行以下步骤S102A确定探针针尖在标定坐标系下的针尖位置。
步骤S102A:针对探针针尖触碰手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及探针示踪器与探针针尖之间的相对位置关系,确定在该触碰时刻下探针针尖在标定坐标系下的针尖位置。
其中,标定坐标系为:根据标定示踪器建立的坐标系。
具体的,探针示踪器与探针针尖之间的相对位置关系能够反映探针针尖在探针示踪器的探针坐标系下的位姿。另外,根据同一触碰时刻下的第一位姿和第二位姿,可以确定该时刻下探针坐标系与标定坐标系之间的转换关系,这样可以将探针针尖在探针坐标系下的位姿转换至标定坐标系下。
另外,由于标定示踪器可以是固定不动的,而探针示踪器是随着探针位姿的改变而改变,因此,每一触碰时刻下探针坐标系与标定坐标系之间的转换关系不同,这样探针每改变一次位置,可以计算出探针坐标系与标定坐标系之间新的转换关系,从而根据探针坐标系与标定坐标系之间新的转换关系以及探针针尖在探针坐标系下的位姿,确定探针针尖在标定坐标系下的针尖位置。
在获得探针针尖在标定坐标系下的各个针尖位置之后,可以通过以下步骤S103A-步骤S103D,利用所获得的针尖位置确定障碍物空间在基座坐标系下的位置。
步骤S103A:获得当前机械臂姿态、标定示踪器的第三位姿以及末端示踪器的第四位姿。
其中,末端示踪器安装于机械臂的末端。
第三位姿和第四位姿为同一坐标系下的位姿。
具体的,在控制机械臂过程中,可以实时监测机械臂的姿态,这样上述当前机械臂姿态可以是监测获得的。
上述第三位姿以及第四位姿的获得方式可参见上述图1所示实施例中步骤S101,这里不再赘述。
步骤S103B:根据所获得的机械臂姿态,确定基座坐标系与末端坐标系之间的第一转换关系。
其中,末端坐标系为:根据机械臂的末端建立的坐标系。
具体的,机械臂基座与机械臂末端通常通过一个或多个中间关节相连,机械臂姿态包括机械臂末端的姿态、机械臂基座的姿态以及各个中间关节的姿态,由于机械臂基座、中间关节、机械臂末端是依次首尾相连的,因此,确定了机械臂基座、中间关节、机械臂末端的姿态之后,也就确定了各个关节之间的相对位置,从而根据机械臂姿态,可以确定机械臂末端与机械臂基座之间的相对位置,根据机械臂末端与机械臂基座之间的相对位置,可以确定基座坐标系与末端坐标系之间的第一转换关系。
步骤S103C:根据第三位姿以及第四位姿,计算标定坐标系与示踪器坐标系之间的第二转换关系。
其中,示踪器坐标系为:根据末端示踪器建立的坐标系。
具体的,根据第三位姿和第四位姿,可以确定标定示踪器与末端示踪器之间的相对位置,从而根据标定示踪器末端示踪器之间的相对位置,可以确定出标定坐标系与示踪器坐标系之间的第二转换关系。
步骤S103D:根据第一转换关系、第二转换关系、第三转换关系以及探针针尖在标定坐标系下的各个针尖位置,确定障碍物空间在基座坐标系下的位置。
其中,第三转换关系为:示踪器坐标系与末端坐标系之间的转换关系。
在将末端示踪器安装与机械臂末端之后,可以标定末端示踪器与机械臂末端之间的相对位置,也就确定了示踪器坐标系与末端坐标系之间的第三转换关系。
本发明的一个实施例中,在确定障碍物空间在基座坐标系下的位置时,可以将探针针尖在标定坐标系下的针尖位置转换至基座坐标系下,再根据转换后的针尖位置,确定障碍物空间在基座坐标系下的位置。
对探针针尖的针尖位置进行坐标系转换可以通过以下两种实现方式中任一种实现。
第一种实现方式中,可以根据第二转换关系,将探针针尖在标定坐标系下的针尖位置转换至示踪器坐标系下,根据第三转换关系,将探针针尖在示踪器坐标系下的针尖位置转换至末端坐标系下,根据第一转换关系,将探针针尖在末端坐标系下的针尖位置转换至基座坐标系下。
第二种实现方式中,根据第一转换关系、第二转换关系以及第三转换关系,可以确定标定坐标系与基座坐标系之间的第四转换关系,从而根据第四转换关系,可以将探针针尖在标定坐标系下的针尖位置转换至基座坐标系下。
本发明的另一个实施例中,在确定障碍物空间在基座坐标系下的位置时,还可以根据探针针尖在标定坐标系下的针尖位置,确定障碍物空间在标定坐标系下的位置,然后利用第一转换关系、第二转换关系以及第三转换关系,将障碍物空间在标定坐标系下的位置转换至基座坐标系下。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据第一转换关系、第二转换关系、第三转换关系以及探针针尖在标定坐标系下的各个针尖位置,能够准确确定障碍物空间在基座坐标系下的位置,从而根据障碍物空间在基座坐标系下的位置控制机械臂尽心移动,能够提高机械臂的控制准确性。
下面对控制机械臂移动的具体实现方式进行说明。
本发明的一个实施例中,参见图3,提供了第三种机械臂控制方法的流程示意图,本实施例中,上述步骤S104可以通过以下步骤S104A-步骤S104B实现。
步骤S104A:根据障碍物空间所在位置,以预设的目标位姿为机械臂末端的最终位姿规划移动路径。
其中,移动路径针对障碍物空间进行避障。
具体的,在规划机械臂的移动路径时,可以将障碍物空间作为路障、将上述目标位姿作为机械臂末端在路径终点上的最终位姿进行规划。
本发明的一个实施例中,可以通过以下三种实现方式中任一种规划上述移动路径。
第一种实现方式中,可以规划以预设的目标位姿为机械臂末端的最终位姿的多条移动路径,并根据障碍物空间所在位置,在所规划的多条移动路径中选择不经过障碍物空间的移动路径。
根据目标位姿规划移动路径可以通过现有的路径规划技术实现,这里不再详述。
第二种实现方式中,在根据上述目标位姿规划得到机械臂的移动路径之后,若所规划的移动路径经过障碍物空间,则可以在不经过障碍物空间的前提下重新规划经过障碍物空间的这一段路径。
第三种实现方式中,在进行路径规划时考虑障碍物空间所在位置,以机械臂规避障碍物空间为原则规划机械臂的移动路径。
步骤S104B:控制机械臂按照所规划的移动路径进行移动。
具体的,在规划得到机械臂的移动路径之后,可以通过以下两种实现方式中任一种控制机械臂移动。
第一种实现方式中,可以在上述移动路径上选择多个位置点,并将各个位置点的位置信息发送给机械臂,以使得机械臂依次经过各个位置点,从而实现控制机械臂移动。
第二种实现方式中,可以根据上述移动路径生成速度控制指令,并向机械臂发送所生成的速度控制指令,从而实现控制机械臂移动。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据障碍物空间所在位置规划移动路径,控制机械臂按照所规划的移动路径进行移动,由于上述移动路径是针对障碍物空间进行避障的路径,这样在控制机械臂按照所规划的移动路径进行移动的过程中,能够准确控制机械臂规避障碍物空间。
本发明的另一个实施例中,参见图4,提供了第四种机械臂控制方法的流程示意图,本实施例中,上述步骤S104可以通过以下步骤S104C-步骤S104G实现。
步骤S104C:规划以预设的目标位姿为机械臂末端的最终位姿的移动路径。
本步骤可以通过现有的路径规划技术实现,这里不再详述。
步骤S104D:控制机械臂按照所规划的移动路径进行移动。
本步骤与上述步骤S104B相类似,这里不再赘述。
步骤S104E:在移动过程中,监测机械臂的实时位姿。
具体的,手术机器人在控制机械臂移动的过程中,通常可以实时获得机械臂的当前位姿,因此,在控制机械臂按照上述规划的移动路径进行移动的过程中,同样可以实时获得机械臂的当前位姿,作为机械臂的实时位姿。
另外,还可以在机械臂上安装示踪器,并获得示踪器与机械臂之间的相对位置关系,实时监测示踪器的位姿,根据监测到的示踪器的位姿以及所获得的示踪器与机械臂之间的相对位置关系,计算机械臂的实时位姿。
步骤S104F:根据实时位姿以及障碍物空间所在位置,判断机械臂是否触碰到障碍物空间,若为是,则执行步骤S104G。
具体的,根据机械臂的实时位姿,可以确定机械臂所在位置,这样可以判断机械臂所在位置与障碍物空间所在位置是否重合或者二者距离相差较小,从而判断机械臂是否触碰到障碍物空间。若机械臂所在位置与障碍物空间所在位置重合或者二者距离相差较小,则说明机械臂触碰到障碍物空间,此时,执行步骤S104G。
步骤S104G:根据障碍物空间所在位置,控制机械臂进行避障或停止运动。
具体的,在判断出机械臂触碰到障碍物空间时,可以控制机械臂进行避障或者停止运动,这样能够及时避免机械臂与手术部位触碰,从而保证手术的安全性。
本发明的一个实施例中,可以通过以下两种实现方式中任一种控制机械臂进行避障。
第一种实现方式中,可以根据障碍物空间所在位置以及所规划的移动路径中不经过障碍物空间的路段的位置,控制机械臂绕开障碍物空间,并再次回到上述移动路径,从而控制机械臂继续按照移动路径进行移动,从而实现机械臂避障。
第二种实现方式中,在判断出机械臂触碰到障碍物空间时,可以控制机械臂按照已经过的路径进行反向移动,以达到机械臂避障的目的。
由以上可见,应用本发明实施例提供的方案控制机械臂时,监测机械臂移动过程中的实时位姿,根据实时位姿以及障碍物空间所在位姿,能够准确判断出机械臂是否触碰到障碍物空间,从而能够在判断出发生触碰之后,根据障碍物空间所在位置,准确控制机械臂进行避障。
在机械臂移动的过程中,手术对象的位姿可能发生改变,从而障碍物空间所在位置也会发生改变。
针对上述情况,本发明的一个实施例中,参见图5,提供了第五种机械臂控制方法的流程示意图,本实施例中,上述步骤S104F可以通过以下步骤S104F1-步骤S104F4实现。
步骤S104F1:获得在探针针尖触碰手术部位时手术对象的对象位姿。
具体的,在对手术对象进行手术时,可以部署有用于示出手术对象的位姿的对象示踪器,这样在探针针尖触碰手术部位时,可以获得对象示踪器的位姿,作为手术对象的对象位姿。
步骤S104F2:根据障碍物空间所在位置以及对象位姿,确定障碍物空间在手术对象中的手术位置。
具体的,根据对象位姿,可以确定手术对象所在位置,这样根据障碍物空间所在位置以及手术对象所在位置,可以获得障碍物空间与手术对象之间的相对位置,这样也就获得了障碍物空间在手术对象中的手术位置。
步骤S104F3:实时监测手术对象的位姿,并根据监测得到的位姿以及手术位置,更新障碍物空间所在位置。
具体的,上述障碍物空间在手术对象中的手术位置可以理解为障碍物空间和手术对象之间的相对位置,这样在获得实时监测到的手术对象的位姿后,可以确定手术对象的位姿反映的位置,并根据障碍物空间与手术对象之间的相对位置,确定当前障碍物空间所在的最新位置,从而更新障碍物空间所在位置为该最新位置。
步骤S104F4:根据实时位姿以及更新后的障碍物空间所在位置,判断机械臂是否触碰到障碍物空间,若为是,则执行步骤S104G。
本步骤与上述步骤S104F相类似,这里不再赘述。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据实时监测到的手术对象的位姿、障碍物空间在手术对象中的手术位置这两种信息,更新障碍物空间所在位置,这样在判断机械臂是否触碰到障碍物空间时,能够提高判断的准确性,从而根据较为准确的判断结果控制机械臂,能够提高机械臂控制的准确性。因此,应用本发明实施例提供的机械臂控制方案,能够提高机械臂控制的准确性。
与上述机械臂控制方法相对应,本发明实施例还提供了一种机械臂控制装置。
本发明的一个实施例中,参见图6,提供了第一种机械臂控制装置的结构示意图,所述装置包括:
第一获得模块601,用于获得探针的针尖多次触碰手术对象的手术部位时探针示踪器的第一位姿,其中,所述探针示踪器安装于所述探针上,所述探针针尖每一次触碰的手术部位上的位置不同;
针尖确定模块602,用于根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置;
障碍物确定模块603,用于根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置;
机械臂控制模块604,用于根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据探针上安装的探针示踪器的第一位姿,确定探针针尖的针尖位置,从而根据各个针尖位置确定障碍物空间所在位置。由于上述针尖位置为探针针尖触碰手术对象的手术部位时的位置,因此,上述障碍物空间可以认为是包围上述手术部位的空间,这样根据障碍物空间所在位置以及目标位姿控制机械臂移动,能够使得机械臂准确避开手术部位进行移动。
本发明的一个实施例中,所述机械臂控制模块604,具体用于:
根据所述障碍物空间所在位置,以预设的目标位姿为机械臂末端的最终位姿规划移动路径,其中,所述移动路径针对所述障碍物空间进行避障;
控制所述机械臂按照所规划的移动路径进行移动。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据障碍物空间所在位置规划移动路径,控制机械臂按照所规划的移动路径进行移动,由于上述移动路径是针对障碍物空间进行避障的路径,这样在控制机械臂按照所规划的移动路径进行移动的过程中,能够准确控制机械臂规避障碍物空间。
本发明的一个实施例中,参见图7,提供了第二种机械臂控制装置的结构示意图,本实施例中,所述机械臂控制模块604,包括:
路径规划子模块604A,用于规划以预设的目标位姿为机械臂末端的最终位姿的移动路径;
机械臂控制子模块604B,用于控制所述机械臂按照所规划的移动路径进行移动;
位姿检测子模块604C,用于在移动过程中,监测所述机械臂的实时位姿;
触碰判断子模块604D,用于根据所述实时位姿以及所述障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间,若为是,则触发机械臂避障子模块604E;
所述机械臂避障子模块604E,用于根据所述障碍物空间所在位置,控制所述机械臂进行避障或停止运动。
由以上可见,应用本发明实施例提供的方案控制机械臂时,监测机械臂移动过程中的实时位姿,根据实时位姿以及障碍物空间所在位姿,能够准确判断出机械臂是否触碰到障碍物空间,从而能够在判断出发生触碰之后,根据障碍物空间所在位置,准确控制机械臂进行避障。
本发明的一个实施例中,所述触碰判断子模块604D,具体用于:
获得在所述探针针尖触碰所述手术部位时所述手术对象的对象位姿;
根据所述障碍物空间所在位置以及对象位姿,确定所述障碍物空间在所述手术对象中的手术位置;
实时监测所述手术对象的位姿,并根据监测得到的位姿以及所述手术位置,更新所述障碍物空间所在位置;
根据所述实时位姿以及更新后的障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据实时监测到的手术对象的位姿、障碍物空间在手术对象中的手术位置这两种信息,更新障碍物空间所在位置,这样在判断机械臂是否触碰到障碍物空间时,能够提高判断的准确性,从而根据较为准确的判断结果控制机械臂,能够提高机械臂控制的准确性。因此,应用本发明实施例提供的机械臂控制方案,能够提高机械臂控制的准确性。
本发明的一个实施例中,所述障碍物空间所在位置为所述障碍物空间在基座坐标系下的位置,所述基座坐标系为:根据所述机械臂的基座建立的坐标系。
本方案中,由于机械臂通常按照手术机器人在基座坐标系下生成的控制指令进行移动,上述障碍物空间所在位置为障碍物空间在基座坐标系下的位置,因此,根据障碍物空间在基座坐标系下的位置能够准确生成控制指令,从而能够准确控制机械臂进行移动。因此,应用本发明实施例提供的机械臂控制方案,能够提高控制准确性。
本发明的一个实施例中,参见图8,提供了第三种机械臂控制装置的结构示意图,所述装置还包括:
第二获得模块605,用于获得在所述探针针尖触碰所述手术部位时标定示踪器的第二位姿,其中,所述第一位姿和第二位姿为同一坐标系下的位姿;
所述针尖确定模块602,具体用于:
针对所述探针针尖触碰所述手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及所述探针示踪器与所述探针针尖之间的相对位置关系,确定在该触碰时刻下所述探针针尖在标定坐标系下的针尖位置,其中,所述标定坐标系为:根据所述标定示踪器建立的坐标系;
所述障碍物确定模块603,具体用于:
获得当前机械臂姿态、所述标定示踪器的第三位姿以及末端示踪器的第四位姿,其中,所述末端示踪器安装于所述机械臂的末端,所述第三位姿和第四位姿为同一坐标系下的位姿;
根据所获得的机械臂姿态,确定所述基座坐标系与末端坐标系之间的第一转换关系,其中,所述末端坐标系为:根据所述机械臂的末端建立的坐标系;
根据所述第三位姿以及第四位姿,计算所述标定坐标系与示踪器坐标系之间的第二转换关系,其中,所述示踪器坐标系为:根据所述末端示踪器建立的坐标系;
根据所述第一转换关系、第二转换关系、第三转换关系以及所述探针针尖在所述标定坐标系下的各个针尖位置,确定障碍物空间在所述基座坐标系下的位置,其中,所述第三转换关系为:所述示踪器坐标系与末端坐标系之间的转换关系。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据第一转换关系、第二转换关系、第三转换关系以及探针针尖在标定坐标系下的各个针尖位置,能够准确确定障碍物空间在基座坐标系下的位置,从而根据障碍物空间在基座坐标系下的位置控制机械臂尽心移动,能够提高机械臂的控制准确性。
与上述机械臂控制方法相对应,本发明实施例还提供了一种机械臂控制***。
本发明的一个实施例中,参见图9,提供了一种机械臂控制***的结构示意图,所述***包括:机械臂901、安装有探针示踪器902的探针903、三维导航追踪设备904、上位机905、用于示出手术对象的位姿的对象示踪器906、安装有定位示踪器907的***908;
所述***908安装于所述机械臂901的末端;
所述三维导航追踪设备904,用于获得探针903的针尖多次触碰手术对象的手术部位时所述探针示踪器902的第一位姿以及所述对象示踪器906的第二位姿,并将所述第一位姿、第二位姿发送给所述上位机905,其中,所述探针针尖每一次触碰的手术部位上的位置不同,所述第一位姿和第二位姿为同一坐标系下的位姿;
所述上位机905,用于针对所述探针针尖触碰所述手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及所述探针示踪器902与所述探针针尖之间的相对位置关系,确定在该触碰时刻下所述探针针尖在对象坐标系下的针尖位置,根据所述探针针尖在所述对象坐标系下的各个针尖位置,确定障碍物空间在所述对象坐标系下的位置,其中,所述对象坐标系为:根据所述对象示踪器906建立的坐标系;
所述上位机905,还用于获得当前机械臂姿态、所述对象示踪器906的第五位姿以及定位示踪器907的第六位姿;根据所述机械臂姿态,确定基座坐标系与末端坐标系之间的第一转换关系;根据所述第五位姿以及第六位姿,计算所述对象坐标系与定位坐标系之间的第二转换关系;根据所述第一转换关系、第二转换关系以及第三转换关系,将所述对象坐标系下所述障碍物空间所在位置转换至所述基座坐标系下,其中,所述第五位姿和第六位姿为同一坐标系下的位姿,所述定位坐标系为:根据所述定位示踪器907建立的坐标系,所述末端坐标系为:根据所述机械臂901的末端建立的坐标系,所述基座坐标系为:根据所述机械臂901的基座建立的坐标系,所述第三转换关系为:所述定位坐标系与所述末端坐标系之间的转换关系;
所述上位机905,还用于根据所述基座坐标系下所述障碍物空间所在位置以及预设的目标位姿,控制所述机械臂901移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
本发明的一个实施例中,上述三维导航追踪设备904可以是红外光学导航设备、可见光光学导航设备、磁导航设备、电导航设备中的任一种。
本发明的一个实施例中,上述机械臂可以是4轴、5轴、6轴更串联或并联形态的协作机械臂。
由以上可见,应用本发明实施例提供的方案控制机械臂时,根据探针上安装的探针示踪器的第一位姿,确定探针针尖的针尖位置,从而根据各个针尖位置确定障碍物空间所在位置。由于上述针尖位置为探针针尖触碰手术对象的手术部位时的位置,因此,上述障碍物空间可以认为是包围上述手术部位的空间,这样根据障碍物空间所在位置以及目标位姿控制机械臂移动,能够使得机械臂准确避开手术部位进行移动。
本发明实施例还提供了一种电子设备,如图10所示,包括处理器1001、通信接口1002、存储器1003和通信总线1004,其中,处理器1001,通信接口1002,存储器1003通过通信总线1004完成相互间的通信,
存储器1003,用于存放计算机程序;
处理器1001,用于执行存储器1003上所存放的程序时,实现如下步骤:
获得探针的针尖多次触碰手术对象的手术部位时探针示踪器的第一位姿,其中,所述探针示踪器安装于所述探针上,所述探针针尖每一次触碰的手术部位上的位置不同;
根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置;
根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置;
根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
上述处理器1001执行存储器1003上存放的程序以实现机械臂控制的其他方案,与前述方法实施例中提及的方案相同,这里不再赘述。
上述电子设备提到的通信总线可以是外设部件互连标准(Peripheral ComponentInterconnect,PCI)总线或扩展工业标准结构(Extended Industry StandardArchitecture,EISA)总线等。该通信总线可以分为地址总线、数据总线、控制总线等。为便于表示,图中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
通信接口用于上述电子设备与其他设备之间的通信。
存储器可以包括随机存取存储器(Random Access Memory,RAM),也可以包括非易失性存储器(Non-Volatile Memory,NVM),例如至少一个磁盘存储器。可选的,存储器还可以是至少一个位于远离前述处理器的存储装置。
上述的处理器可以是通用处理器,包括中央处理器(Central Processing Unit,CPU)、网络处理器(Network Processor,NP)等;还可以是数字信号处理器(Digital SignalProcessor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
在本发明提供的又一实施例中,还提供了一种计算机可读存储介质,该计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现上述任一机械臂控制方法的步骤。
在本发明提供的又一实施例中,还提供了一种包含指令的计算机程序产品,当其在计算机上运行时,使得计算机执行上述实施例中任一机械臂控制方法。
在上述实施例中,可以全部或部分地通过软件、硬件、固件或者其任意组合来实现。当使用软件实现时,可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令。在计算机上加载和执行所述计算机程序指令时,全部或部分地产生按照本发明实施例所述的流程或功能。所述计算机可以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向另一个计算机可读存储介质传输,例如,所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(DSL))或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质,(例如,软盘、硬盘、磁带)、光介质(例如,DVD)、或者半导体介质(例如固态硬盘Solid State Disk (SSD))等。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于装置、电子设备、计算机可读存储介质以及计算机程序产品实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
以上所述仅为本发明的较佳实施例,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本发明的保护范围内。
Claims (15)
1.一种机械臂控制方法,其特征在于,所述方法包括:
获得探针的针尖多次触碰手术对象的手术部位时探针示踪器的第一位姿,其中,所述探针示踪器安装于所述探针上,所述探针针尖每一次触碰的手术部位上的位置不同;
根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置;
根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置,其中,所述障碍物空间为以各针尖位置作为端点的多面体空间;
根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
2.根据权利要求1所述的方法,其特征在于,所述根据所述障碍物空间所在位置和预设的目标位姿控制所述机械臂移动,包括:
根据所述障碍物空间所在位置,以预设的目标位姿为机械臂末端的最终位姿规划移动路径,其中,所述移动路径针对所述障碍物空间进行避障;
控制所述机械臂按照所规划的移动路径进行移动。
3.根据权利要求1所述的方法,其特征在于,所述根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,包括:
规划以预设的目标位姿为机械臂末端的最终位姿的移动路径;
控制所述机械臂按照所规划的移动路径进行移动;
在移动过程中,监测所述机械臂的实时位姿;
根据所述实时位姿以及所述障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间;
若为是,则根据所述障碍物空间所在位置,控制所述机械臂进行避障或停止运动。
4.根据权利要求3所述的方法,其特征在于,所述根据所述实时位姿以及所述障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间,包括:
获得在所述探针针尖触碰所述手术部位时所述手术对象的对象位姿;
根据所述障碍物空间所在位置以及对象位姿,确定所述障碍物空间在所述手术对象中的手术位置;
实时监测所述手术对象的位姿,并根据监测得到的位姿以及所述手术位置,更新所述障碍物空间所在位置;
根据所述实时位姿以及更新后的障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间。
5.根据权利要求1-4中任一项所述的方法,其特征在于,所述障碍物空间所在位置为所述障碍物空间在基座坐标系下的位置,所述基座坐标系为:根据所述机械臂的基座建立的坐标系。
6.根据权利要求5所述的方法,其特征在于,所述方法还包括:
获得在所述探针针尖触碰所述手术部位时标定示踪器的第二位姿,其中,所述第一位姿和第二位姿为同一坐标系下的位姿;
所述根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置,包括:
针对所述探针针尖触碰所述手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及所述探针示踪器与所述探针针尖之间的相对位置关系,确定在该触碰时刻下所述探针针尖在标定坐标系下的针尖位置,其中,所述标定坐标系为:根据所述标定示踪器建立的坐标系;
所述根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置,包括:
获得当前机械臂姿态、所述标定示踪器的第三位姿以及末端示踪器的第四位姿,其中,所述末端示踪器安装于所述机械臂的末端,所述第三位姿和第四位姿为同一坐标系下的位姿;
根据所获得的机械臂姿态,确定所述基座坐标系与末端坐标系之间的第一转换关系,其中,所述末端坐标系为:根据所述机械臂的末端建立的坐标系;
根据所述第三位姿以及第四位姿,计算所述标定坐标系与示踪器坐标系之间的第二转换关系,其中,所述示踪器坐标系为:根据所述末端示踪器建立的坐标系;
根据所述第一转换关系、第二转换关系、第三转换关系以及所述探针针尖在所述标定坐标系下的各个针尖位置,确定障碍物空间在所述基座坐标系下的位置,其中,所述第三转换关系为:所述示踪器坐标系与末端坐标系之间的转换关系。
7.一种机械臂控制装置,其特征在于,所述装置包括:
第一获得模块,用于获得探针的针尖多次触碰手术对象的手术部位时探针示踪器的第一位姿,其中,所述探针示踪器安装于所述探针上,所述探针针尖每一次触碰的手术部位上的位置不同;
针尖确定模块,用于根据所述探针示踪器与所述探针针尖之间的相对位置关系以及所获得的各个第一位姿,确定所述探针针尖在每一次触碰所述手术部位时的针尖位置;
障碍物确定模块,用于根据所述探针针尖的各个针尖位置,确定障碍物空间所在位置,其中,所述障碍物空间为以各针尖位置作为端点的多面体空间;
机械臂控制模块,用于根据所述障碍物空间所在位置和预设的目标位姿控制机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
8.根据权利要求7所述的装置,其特征在于,所述机械臂控制模块,具体用于:
根据所述障碍物空间所在位置,以预设的目标位姿为机械臂末端的最终位姿规划移动路径,其中,所述移动路径针对所述障碍物空间进行避障;
控制所述机械臂按照所规划的移动路径进行移动。
9.根据权利要求7所述的装置,其特征在于,所述机械臂控制模块,包括:
路径规划子模块,用于规划以预设的目标位姿为机械臂末端的最终位姿的移动路径;
机械臂控制子模块,用于控制所述机械臂按照所规划的移动路径进行移动;
位姿检测子模块,用于在移动过程中,监测所述机械臂的实时位姿;
触碰判断子模块,用于根据所述实时位姿以及所述障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间,若为是,则触发机械臂避障子模块;
所述机械臂避障子模块,用于根据所述障碍物空间所在位置,控制所述机械臂进行避障或停止运动。
10.根据权利要求9所述的装置,其特征在于,所述触碰判断子模块,具体用于:
获得在所述探针针尖触碰所述手术部位时所述手术对象的对象位姿;
根据所述障碍物空间所在位置以及对象位姿,确定所述障碍物空间在所述手术对象中的手术位置;
实时监测所述手术对象的位姿,并根据监测得到的位姿以及所述手术位置,更新所述障碍物空间所在位置;
根据所述实时位姿以及更新后的障碍物空间所在位置,判断所述机械臂是否触碰到所述障碍物空间。
11.根据权利要求7-10中任一项所述的装置,其特征在于,所述障碍物空间所在位置为所述障碍物空间在基座坐标系下的位置,所述基座坐标系为:根据所述机械臂的基座建立的坐标系。
12.根据权利要求11所述的装置,其特征在于,所述装置还包括:
第二获得模块,用于获得在所述探针针尖触碰所述手术部位时标定示踪器的第二位姿,其中,所述第一位姿和第二位姿为同一坐标系下的位姿;
所述针尖确定模块,具体用于:
针对所述探针针尖触碰所述手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及所述探针示踪器与所述探针针尖之间的相对位置关系,确定在该触碰时刻下所述探针针尖在标定坐标系下的针尖位置,其中,所述标定坐标系为:根据所述标定示踪器建立的坐标系;
所述障碍物确定模块,具体用于:
获得当前机械臂姿态、所述标定示踪器的第三位姿以及末端示踪器的第四位姿,其中,所述末端示踪器安装于所述机械臂的末端,所述第三位姿和第四位姿为同一坐标系下的位姿;
根据所获得的机械臂姿态,确定所述基座坐标系与末端坐标系之间的第一转换关系,其中,所述末端坐标系为:根据所述机械臂的末端建立的坐标系;
根据所述第三位姿以及第四位姿,计算所述标定坐标系与示踪器坐标系之间的第二转换关系,其中,所述示踪器坐标系为:根据所述末端示踪器建立的坐标系;
根据所述第一转换关系、第二转换关系、第三转换关系以及所述探针针尖在所述标定坐标系下的各个针尖位置,确定障碍物空间在所述基座坐标系下的位置,其中,所述第三转换关系为:所述示踪器坐标系与末端坐标系之间的转换关系。
13.一种机械臂控制***,其特征在于,所述***包括:机械臂、安装有探针示踪器的探针、三维导航追踪设备、上位机、用于示出手术对象的位姿的对象示踪器、安装有定位示踪器的***;
所述***安装于所述机械臂的末端;
所述三维导航追踪设备,用于获得探针的针尖多次触碰手术对象的手术部位时所述探针示踪器的第一位姿以及所述对象示踪器的第二位姿,并将所述第一位姿、第二位姿发送给所述上位机,其中,所述探针针尖每一次触碰的手术部位上的位置不同,所述第一位姿和第二位姿为同一坐标系下的位姿;
所述上位机,用于针对所述探针针尖触碰所述手术部位的每一触碰时刻,根据该触碰时刻下的第一位姿、第二位姿以及所述探针示踪器与所述探针针尖之间的相对位置关系,确定在该触碰时刻下所述探针针尖在对象坐标系下的针尖位置,根据所述探针针尖在所述对象坐标系下的各个针尖位置,确定障碍物空间在所述对象坐标系下的位置,其中,所述对象坐标系为:根据所述对象示踪器建立的坐标系,所述障碍物空间为以各针尖位置作为端点的多面体空间;
所述上位机,还用于获得当前机械臂姿态、所述对象示踪器的第五位姿以及定位示踪器的第六位姿;根据所述机械臂姿态,确定基座坐标系与末端坐标系之间的第一转换关系;根据所述第五位姿以及第六位姿,计算所述对象坐标系与定位坐标系之间的第二转换关系;根据所述第一转换关系、第二转换关系以及第三转换关系,将所述对象坐标系下所述障碍物空间所在位置转换至所述基座坐标系下,其中,所述第五位姿和第六位姿为同一坐标系下的位姿,所述定位坐标系为:根据所述定位示踪器建立的坐标系,所述末端坐标系为:根据所述机械臂的末端建立的坐标系,所述基座坐标系为:根据所述机械臂的基座建立的坐标系,所述第三转换关系为:所述定位坐标系与所述末端坐标系之间的转换关系;
所述上位机,还用于根据所述基座坐标系下所述障碍物空间所在位置以及预设的目标位姿,控制所述机械臂移动,以使得所述机械臂末端移动至所述目标位姿指示的位置。
14.一种电子设备,其特征在于,包括处理器、通信接口、存储器和通信总线,其中,处理器,通信接口,存储器通过通信总线完成相互间的通信;
存储器,用于存放计算机程序;
处理器,用于执行存储器上所存放的程序时,实现权利要求1-6任一所述的方法步骤。
15.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现权利要求1-6任一所述的方法步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211147679.8A CN115229806B (zh) | 2022-09-21 | 2022-09-21 | 一种机械臂控制方法、装置、***、设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211147679.8A CN115229806B (zh) | 2022-09-21 | 2022-09-21 | 一种机械臂控制方法、装置、***、设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115229806A CN115229806A (zh) | 2022-10-25 |
CN115229806B true CN115229806B (zh) | 2023-03-03 |
Family
ID=83680476
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211147679.8A Active CN115229806B (zh) | 2022-09-21 | 2022-09-21 | 一种机械臂控制方法、装置、***、设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115229806B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1512134A (zh) * | 2002-12-30 | 2004-07-14 | 北京航空航天大学 | 接触式物***姿测量装置 |
CN105455901A (zh) * | 2015-11-20 | 2016-04-06 | 清华大学 | 针对手术机器人的避障规划方法和避障规划*** |
CN108871216A (zh) * | 2018-07-12 | 2018-11-23 | 湘潭大学 | 一种基于视觉引导的机器人多孔接触式自动测量方法 |
CN110216670A (zh) * | 2019-04-30 | 2019-09-10 | 武汉理工大学 | 一种基于损失场的工业机器人自动避障方法及装置 |
CN111540043A (zh) * | 2020-04-30 | 2020-08-14 | 京东方科技集团股份有限公司 | 骨骼模型表面轮廓生成装置、方法、存储介质及电子设备 |
US10772692B1 (en) * | 2019-04-28 | 2020-09-15 | Tinavi Medical Technologies Co., Ltd. | Probe device, precision detection method, precision detection system, and positioning system |
CN112618024A (zh) * | 2021-01-05 | 2021-04-09 | 上海交通大学医学院附属第九人民医院 | 多臂协同式手术机器人 |
CN114288560A (zh) * | 2021-12-30 | 2022-04-08 | 西安科悦医疗股份有限公司 | 经颅磁刺激导航过程的三维配准方法、***及计算机设备 |
CN114429465A (zh) * | 2022-01-26 | 2022-05-03 | 北京柏惠维康科技有限公司 | 手术导航探针的针尖位置标定方法、装置、设备及可读介质 |
CN115087409A (zh) * | 2020-02-12 | 2022-09-20 | 克瑞肖株式会社 | 验证手术目标匹配的方法、用于该方法的装置和包括该装置的*** |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2854687B1 (en) * | 2012-06-01 | 2022-08-24 | Intuitive Surgical Operations, Inc. | Systems for avoiding collisions between manipulator arms using a null-space |
JP6936282B2 (ja) * | 2018-06-28 | 2021-09-15 | グローバス メディカル インコーポレイティッド | ロボットアームの衝突を回避するための手術用ロボットの制御 |
CN108983001A (zh) * | 2018-07-27 | 2018-12-11 | 昆山国显光电有限公司 | 曲面屏触控性能测试控制方法、装置及测试*** |
CN112807086A (zh) * | 2021-02-05 | 2021-05-18 | 新博医疗技术有限公司 | 一种基于模板的手术导航装置及方法 |
CN113157260B (zh) * | 2021-04-28 | 2022-11-22 | 西安电子科技大学 | 一种面向cmm的零件质量检测程序自动生成方法 |
CN113855286B (zh) * | 2021-09-24 | 2023-01-10 | 四川锋准机器人科技有限公司 | 一种种植牙机器人导航***及方法 |
CN114012724B (zh) * | 2021-11-02 | 2024-04-05 | 上海发那科机器人有限公司 | 一种基于探针的工业机器人坐标系自动标定方法 |
CN114767265A (zh) * | 2022-03-14 | 2022-07-22 | 珠海横乐医学科技有限公司 | 手术路径规划方法、***、电子设备和存储介质 |
-
2022
- 2022-09-21 CN CN202211147679.8A patent/CN115229806B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1512134A (zh) * | 2002-12-30 | 2004-07-14 | 北京航空航天大学 | 接触式物***姿测量装置 |
CN105455901A (zh) * | 2015-11-20 | 2016-04-06 | 清华大学 | 针对手术机器人的避障规划方法和避障规划*** |
CN108871216A (zh) * | 2018-07-12 | 2018-11-23 | 湘潭大学 | 一种基于视觉引导的机器人多孔接触式自动测量方法 |
US10772692B1 (en) * | 2019-04-28 | 2020-09-15 | Tinavi Medical Technologies Co., Ltd. | Probe device, precision detection method, precision detection system, and positioning system |
CN110216670A (zh) * | 2019-04-30 | 2019-09-10 | 武汉理工大学 | 一种基于损失场的工业机器人自动避障方法及装置 |
CN115087409A (zh) * | 2020-02-12 | 2022-09-20 | 克瑞肖株式会社 | 验证手术目标匹配的方法、用于该方法的装置和包括该装置的*** |
CN111540043A (zh) * | 2020-04-30 | 2020-08-14 | 京东方科技集团股份有限公司 | 骨骼模型表面轮廓生成装置、方法、存储介质及电子设备 |
CN112618024A (zh) * | 2021-01-05 | 2021-04-09 | 上海交通大学医学院附属第九人民医院 | 多臂协同式手术机器人 |
CN114288560A (zh) * | 2021-12-30 | 2022-04-08 | 西安科悦医疗股份有限公司 | 经颅磁刺激导航过程的三维配准方法、***及计算机设备 |
CN114429465A (zh) * | 2022-01-26 | 2022-05-03 | 北京柏惠维康科技有限公司 | 手术导航探针的针尖位置标定方法、装置、设备及可读介质 |
Also Published As
Publication number | Publication date |
---|---|
CN115229806A (zh) | 2022-10-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9452533B2 (en) | Robot modeling and positioning | |
CN109531577B (zh) | 机械臂标定方法、装置、***、介质、控制器及机械臂 | |
KR101692602B1 (ko) | 클라우드 지식공유 기반 로봇 제어 시스템 및 제어방법 | |
US11609547B2 (en) | Gestural control of an industrial robot | |
US11370120B2 (en) | Method and system for teaching a robot in reaching a given target in robot manufacturing | |
CN113662665A (zh) | 膝关节置换手术机器人***的精度检测方法和装置 | |
CN110977980A (zh) | 基于光学定位仪的机械臂实时手眼标定方法及*** | |
US10456913B2 (en) | Method and apparatus for controlling a robot movement of a robot on the basis of a second trajectory | |
CN115229806B (zh) | 一种机械臂控制方法、装置、***、设备及存储介质 | |
US11518024B2 (en) | Extensible underconstrained robotic motion planning | |
US20200209876A1 (en) | Positioning method and apparatus with the same | |
CN113848893A (zh) | 机器人导航方法、装置、设备及存储介质 | |
US12036684B2 (en) | User interface and related flow for controlling a robotic arm | |
CN115227407B (zh) | 一种手术机器人控制方法、装置、***、设备及存储介质 | |
CN112223289A (zh) | 一种路径偏差小的机械手实时运动方法、计算机可读存储介质及智能机械手*** | |
US20060122804A1 (en) | Method and system for simulative measurement demo | |
CN114147723A (zh) | 一种自动放样机器人***及其运行方法 | |
CN117084788A (zh) | 机械臂目标姿态的确定方法、装置及存储介质 | |
CN114209433A (zh) | 一种手术机器人导航定位方法及装置 | |
CN116149327B (zh) | 一种实时跟踪的前瞻路径规划***、方法及装置 | |
CN112836004A (zh) | 机器人定位地图的创建方法、***、计算机设备及存储介质 | |
KR20170116310A (ko) | 작업 교시 시스템 및 방법 | |
US11511419B2 (en) | Task planning for measurement variances | |
CN115741641A (zh) | 基于激光测距装置的机器人示教方法及装置 | |
US20220388171A1 (en) | Robotic workspace introspection via force feedback |
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 |