CN1985773A - 基于光学跟踪闭环控制脑外科机器人***及实现方法 - Google Patents
基于光学跟踪闭环控制脑外科机器人***及实现方法 Download PDFInfo
- Publication number
- CN1985773A CN1985773A CNA200510122586XA CN200510122586A CN1985773A CN 1985773 A CN1985773 A CN 1985773A CN A200510122586X A CNA200510122586X A CN A200510122586XA CN 200510122586 A CN200510122586 A CN 200510122586A CN 1985773 A CN1985773 A CN 1985773A
- Authority
- CN
- China
- Prior art keywords
- robot
- freedom
- degrees
- computer
- pose
- 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.)
- Granted
Links
- 230000003287 optical effect Effects 0.000 title claims abstract description 82
- 238000000034 method Methods 0.000 title claims abstract description 41
- 239000003550 marker Substances 0.000 claims abstract description 44
- 238000005259 measurement Methods 0.000 claims description 81
- 238000013507 mapping Methods 0.000 claims description 40
- 238000001356 surgical procedure Methods 0.000 claims description 40
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims description 27
- 230000033001 locomotion Effects 0.000 claims description 26
- 230000009466 transformation Effects 0.000 claims description 26
- 238000006243 chemical reaction Methods 0.000 claims description 19
- 238000010998 test method Methods 0.000 claims description 17
- 230000007246 mechanism Effects 0.000 claims description 13
- 238000013461 design Methods 0.000 claims description 11
- 230000037361 pathway Effects 0.000 claims description 11
- 238000005516 engineering process Methods 0.000 claims description 10
- 238000000465 moulding Methods 0.000 claims description 9
- 210000004556 brain Anatomy 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 7
- 238000012937 correction Methods 0.000 claims description 7
- 210000000707 wrist Anatomy 0.000 claims description 6
- 238000004891 communication Methods 0.000 claims description 4
- 239000000284 extract Substances 0.000 claims description 4
- 230000008676 import Effects 0.000 claims description 4
- 230000001105 regulatory effect Effects 0.000 claims description 3
- 238000000926 separation method Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 abstract description 10
- 230000002490 cerebral effect Effects 0.000 abstract description 5
- 230000008901 benefit Effects 0.000 abstract description 2
- 201000010099 disease Diseases 0.000 abstract 2
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 abstract 2
- 239000011159 matrix material Substances 0.000 description 13
- 238000004519 manufacturing process Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 229920000535 Tan II Polymers 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000005489 elastic deformation Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 239000007943 implant Substances 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 239000007769 metal material Substances 0.000 description 1
- 238000002324 minimally invasive surgery Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000004899 motility Effects 0.000 description 1
- 239000008188 pellet Substances 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 230000001915 proofreading effect Effects 0.000 description 1
- 230000002787 reinforcement Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000002672 stereotactic surgery Methods 0.000 description 1
- GUVRBAGPIYLISA-UHFFFAOYSA-N tantalum atom Chemical compound [Ta] GUVRBAGPIYLISA-UHFFFAOYSA-N 0.000 description 1
- 230000033912 thigmotaxis Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
Abstract
一种基于光学跟踪闭环控制脑外科机器人***,是进行接收医学影像信息、测定并确定病灶位置、辅助进行手术规划、进行手术导引的脑外科机器人;由计算机、五自由度机器人、光学跟踪设备和被动标识器构成一个闭环的机器人位姿测量与实时反馈控制***,被动标识器安装在五自由度机器人末端;五自由度机器人包括机械臂和机械臂控制器;辅助手术规划与导引软件包括数字影像输入与预处理模块、病灶提取与三维重构模块、手术规划模块、以及手术实施模块;其优点是:提高机器人***的轨迹跟踪和定位精度,解决限制外科手术机器人推广使用的绝对精度问题,降低机器人设计和制造成本;简化注册标定过程,减轻医生工作量和出错概率,减轻病人的痛苦。
Description
技术领域
本发明属于机器人技术领域,特别涉及一种基于光学跟踪闭环控制脑外科机器人***及实现方法,具体地说是指一种可以辅助医生进行精细脑外科微创手术的高精度机器人***及其实现方法。
背景技术
脑外科微创手术机器人是一种可以辅助医生施行无框架立体定向手术的机器人***,一般都包括有能够辅助进行手术规划与导引的计算机、以及执行立体定向辅助手术操作的机器人。其中,辅助进行手术规划与导引的计算机,安装配套的辅助手术规划与导引软件,主要完成病人脑部医学影像信息的处理和三维重构,辅助医生进行虚拟手术规划,并在手术过程中向机器人控制器发出运动指令以控制机器人运动。该软件通常包括数字影像输入与预处理、病灶提取与三维重构、手术规划、以及手术实施等功能模块。数字影像输入与预处理模块的作用是接收外部输入的病人脑部的医学影像数据,并转换成计算机可以显示的格式,在此基础上对图像进行预处理,包括图像的强化、去燥、直方统计等;病灶提取与三维重构模块的作用是让医生以交互的方式在图像上对病灶进行分割,并提取头颅轮廓,从而生成病灶和头颅的三维医学模型;在手术规划模块中,医生可以进行靶点与标记点的标识工作,并可以在虚拟现实环境中进行手术路径规划;在手术实施模块中,可以按照预先规划好的手术路径,适时向机器人控制器发出运动指令以控制机器人运动,同时虚拟现实功能可以为手术提供实时的监控。
***所采用的机器人由机械臂和控制器组成,一般具有5个关节自由度,每个关节都有驱动机构,用于驱动关节运动,能够保证手术器械以任意姿态到达手术空间中的任意一点。机器人控制器能够接受计算机发出的运动指令,实时控制机器人的各个关节运动到达指定位置。
现有脑外科机器人存在的最大问题是定位精度不能满足精细脑外科手术的高精确性要求。外科机器人不仅要求重复精度高,对器械运动的绝对精度要求更严格,因为在虚拟的三维医学模型空间进行的手术规划,最终要由机器人的运动实现。由于机构和控制误差的因素,期望的位置命令和机器人实际达到的位置之间不可避免地存在误差。这种误差通常可能达到几个毫米到一个厘米左右,远远超过微创伤外科手术的精度要求,必须设法加以克服。在工业应用中,机器人的绝对定位误差可以通过各种方式的标定来克服,但外科机器人作为一种手术设备,其应用情况差别很大,一般没有严格固定的安置位置。显然,对每一例手术都要求进行严格、繁琐的现场标定是不适合的,况且一些非几何误差因素如机构弹性形变、关节间隙和柔性等的影响,也难以依靠标定解决。目前,许多工作都是从机械上考虑提高精度的方法,依靠高精密度的机构加工、装配以及高精度的控制和补偿来保证***精度,很难达到理想效果,而且大大增加了机器人的设计和制造成本。现有的脑外科机器人从全局上是开环的,即从计算机给出位置命令到引导机器人运动和定位的过程,缺少机器人末端位姿的反馈和校正,各种误差因素无法得到全局的闭环校正,绝对位姿精度很难保证。
另外,从已经公开的报道(例如中国专利公开号CN1243690A),确定病灶相对机器人操作空间的位置的所谓标测定位方法过于复杂,需要用到立体定位框架、标测钉、或双层模板、六关节数字化机械臂、力控制人机交互技术等,既费时又费力,也给病人带来痛苦和压力;也有运用视觉测量技术进行注册的方法(例如中国专利公开号CN1554315A),但是精度和环境适应性还需要提高,较难实用。
发明内容
本发明的目的是提供一种基于光学跟踪闭环控制脑外科机器人***及实现方法,可以克服现有技术的缺点。它是将光学跟踪设备与脑外科机器人结合,利用光学跟踪设备实时跟踪机器人末端器械的当前位置和姿态,在光学测量空间进行实时的位姿闭环控制,使得脑外科机器人末端能够精确地按照预先规划的理想手术路径进行运动和定位,实现能够满足精细脑外科手术要求的高精度脑外科机器人***。同时,借助于光学跟踪技术,大大简化标测三维医学模型空间与机器人基座坐标空间的映射变换的过程和方法。使用本发明能够使脑外科机器人达到高精度、低成本,而且省时、便捷、实用、易操作。
本发明提出的基于光学跟踪闭环控制脑外科机器人***包括:
五自由度机器人、计算机(选用型号PC P42.0GHz/256M)、光学跟踪设备(选用型号NDI公司POLARIS光学跟踪设备)、光学注册工具(选用型号NDI公司POLARIS标配被动工具)、被动标识器(选用型号NDI公司POLARIS标配球形被动标识器)、医学标志器(医学上使用的一种用钽金属材料制成的、对射电高度不透明的小球形标志点,与生物体兼容,可长期植入人体)、塑形枕和手术床等设备组成的硬件部分;辅助手术规划与导引软件部分,即进行接收医学影像信息、测定并确定病灶的位置、辅助进行手术规划、并进行手术导引的脑外科机器人;其特征是:
所说的计算机、五自由度机器人、光学跟踪设备、和被动标识器构成一个闭环的机器人位姿测量与实时反馈控制***,被动标识器安装在五自由度机器人的末端,始终被光学跟踪设备跟踪;所说的五自由度机器人包括五自由度机械臂和机械臂控制器;所说的辅助手术规划与导引软件包括数字影像输入与预处理模块、病灶提取与三维重构模块、手术规划模块、以及手术实施模块。
使用本发明进行手术阶段的具体操作步骤是:
一.在进行手术前准备时:在病人头颅上粘贴四个医学标志器,对脑部进行医学影像扫描,并将扫描所得医学影像信息输入计算机,运用辅助手术规划与导引软件确定病灶,重构病灶和头颅的三维医学模型,进行手术靶点与医学标志影像位置的标识,并规划手术路径。
二.在进行注册标定时:让病人躺在手术床上,头部使用塑形枕与手术床相对固定,一方面用光学注册工具测定病人头颅上的四个医学标志器的坐标,测量值由光学跟踪设备给出,并送入计算机,由计算机计算三维医学模型空间与光学测量空间之间的映射变换;另一方面用本发明设计的标测方法,由五自由度机器人、光学跟踪设备、被动标识器、和计算机配合,自动测定五自由度机器人基座坐标空间与光学测量空间之间的映射变换。
三.在进行手术实施时:首先,由计算机将在三维医学模型空间预先规划的手术路径变换到光学测量空间,并计算出在当前路径点五自由度机器人末端需要达到的理想位姿;然后,由计算机根据当前路径点的理想位姿,进行由光学测量空间到五自由度机器人基座坐标空间的坐标变换,并通过求解五自由度机器人逆运动学,得到五自由度机器人各个关节的理想位置;然后,由计算机向五自由度机器人输入各个关节的理想位置,控制五自由度机器人运动;同时,由光学跟踪设备和安装在五自由度机器人末端的被动标识器配合,实时测定五自由度机器人的末端位姿并送入计算机,用本发明设计的控制方法对五自由度机器人的末端位姿进行实时控制,实现精确的轨迹跟踪和定位;最后,五自由度机器人锁定,医生在五自由度机器人的辅助下进行手术操作。
五自由度机械臂由手臂和手腕组成,具有五个关节,采取两个滑动关节和三个转动关节的PPRRR构型;手臂部分具有三个关节,分别为I、II和III关节,第I关节采用滑动关节,运动方向垂直于水平面;第II关节采用滑动关节,与第I关节成“T”形垂直;第III关节采用转动关节,轴线与第I关节运动方向平行;手腕部分具有两个关节,分别为IV和V关节,第IV关节采用转动关节,轴线与第III关节轴线平行;第V关节采用转动关节,轴线与第IV关节轴线垂直;在机械臂的第V关节安装末端器械,安装轴线与第IV关节轴线平行。每个关节都有独立的驱动机构,由步进电机、减速器组成,滑动关节的驱动机构还包括有滚珠丝杆。
机械臂控制器由可编程逻辑控制器PLC和步进电机驱动器组成,采用三个PLC和五个步进电机驱动器组合,对应控制五自由度机械臂的五个关节,机械臂控制器通过RS232C串口通信组件与外部计算机进行通信,可接受外部计算机输入的关节位置命令,控制机械臂运动到达指定位置。
NDI公司的POLARIS光学跟踪设备,是目前医疗行业中广泛应用的一种空间测量定位仪器。被动式的POLARIS设备包括一个能发射并接收红外照明光的位置传感器,配套提供若干被动标识器或安装有被动标识器的被动工具;POLARIS设备通过测量工具上被动标识器的空间位置,就可以实时地确定工具的位置和方向,3D均方误差范围通常在0.35mm范围内;POLARIS设备与计算机之间通过RS-232/RS-422通讯,连续跟踪的数据更新频率达到60HZ。
闭环的机器人位姿测量和实时反馈控制***的方法是:由光学跟踪设备测定五自由度机器人的末端位姿,由计算机根据测量得到的位姿和期望五自由度机器人达到的位姿计算控制量,控制五自由度机器人进一步运动以修正偏差。
光学跟踪设备通过跟踪安装在五自由度机器人末端的被动标识器来测量五自由度机器人的末端位姿。
被动标识器安装在五自由度机器人的末端,数量至少为3个。
被动标识器在五自由度机器人末端安装的几何位置关系满足:任意两个被动标识器之间的距离不能小于50mm,任意两条由被动标识器连线构成的线段之间的最小空间间隔不能小于5mm,任意两条线段不平行,而且任意两条线段之间的夹角不能低于0.5度。
基于光学跟踪闭环控制的脑外科机器人***的实现方法,其特征在于,借助于光学跟踪技术进行位姿测量,包括:三维医学模型空间与光学测量空间映射变换的简便标测方法、五自由度机器人基座坐标空间与光学测量空间映射变换的自动标测方法及五自由度机器人末端位姿的闭环控制方法。
所述三种方法涉及五个坐标系,如图2:在三维医学模型空间中建立一个三维医学模型坐标系{V};在真实的病人头颅上建立一个患者坐标系{P};在光学测量空间中建立一个光学测量坐标系{M};在五自由度机器人的基座上建立一个机器人基座坐标系{R};在五自由度机器人的末端建立一个末端工具坐标系{T};整个***以光学测量坐标系{M}为基准参考系;其中,患者坐标系是基于粘贴在病人头颅上的四个医学标志器所在的点来描述的,该坐标系在四个医学标志器中选取任意一个标志器所在的点M0作为坐标系原点,同时以M0与其他三个标志器所在的点M1、M2、M3的连线作为三个坐标轴向。
下面给出所述三种方法的详细步骤和数学描述。
一.三维医学模型空间与光学测量空间的映射变换
借助于光学跟踪技术进行位姿测量,三维医学模型空间与光学测量空间映射变换的简便标测方法是:由医生在病人头部粘贴四个医学标志器,这四个标志器不在同一平面,且任意三个标志器不在同一条直线上;对病人头部进行CT或MRI医学影像扫描,所得扫描影像输入计算机;让病人躺在手术床上,头部使用塑形枕与手术床相对固定,用光学注册工具测定病人头部的四个医学标志器在光学测量空间的坐标,测量值由光学跟踪设备输入计算机;由计算机计算三维医学模型空间与光学测量空间的映射变换。
该映射变换由两组坐标转换组成,即从三维医学模型坐标系{V}到患者坐标系{P}的转换、和从患者坐标系{P}到光学测量坐标系{M}的转换,两组转换都是基于在病人头颅上粘贴的四个医学标志器来确定。
显然,根据患者坐标系{P}的定义,四个标志器在{P}中的坐标分别为:M0(0,0,0),M1(1,0,0),M2(0,1,0),M3(0,0,1)。
另外,由于四个医学标志器在医学扫描影像中是可以识别的,它们在三维医学模型坐标系{V}中的坐标也可以获得,假设记为:M′0(xv0,yv0,zv0),M′1(xv1,yv1,zv1),M′2(xv2,yv2,zv2),M′3(xv3,yv3,zv3)。
由于病人脑部的三维医学模型是通过病人的脑部扫描数据重构的,因此可以认为三维医学模型坐标系{V}与患者坐标系{P}的映射是刚性变换(包括平移、旋转和拉伸),可以用一个齐次变换矩阵VTP完成两个坐标系中的位置映射。由{P}向{V}的齐次变换矩阵为:
同理,可以确定患者坐标系{P}向光学测量坐标系{M}的转换矩阵MTP。四个医学标志器在光学测量坐标系{M}中的位置,可以通过用光学注册工具分别点到四个医学标志器来获得,设为:M0(xm0,ym0,zm0),M1(xm1,ym1,zm1),M2(xm2,ym2,zm2),M3(xm3,ym3,zm3)。则由{P}向{M}的齐次变换矩阵为:
最后,由三维虚拟模型坐标系{V}到光学测量坐标系{M}的齐次变换为MTV即为:
MTV=MTP PTV=MTP(VTP)-1 (3)
二.五自由度机器人基座坐标空间与光学测量空间的映射变换
借助于光学跟踪技术进行位姿测量,五自由度机器人基座坐标空间与光学测量空间映射变换的自动标测方法是:首先,选定五自由度机器人工作空间内的四个点,这四个点同时应该处于光学跟踪设备的测量范围内,并且四个点不共面,任意三个点不共线;由计算机按照预设的程序,向五自由度机器人发出到达上述四个点的关节位置命令,控制五自由度机器人末端依次运动到上述四个点,计算机记录下上述四个点在五自由度机器人基座坐标空间中的坐标;同时,由光学跟踪设备和安装在五自由度机器人末端的被动标识器配合,依次测定五自由度机器人运动到上述四个点时其末端在光学测量空间中的坐标,并送入计算机;最后,由计算机根据上述四个点在五自由度机器人基座坐标空间和光学测量空间的坐标值,计算出五自由度机器人基座坐标空间与光学测量空间的映射变换,从而完成自动标测。
假设所述四个点在机器人基座坐标系{R}中的坐标为RPi(ri,si,ti),(i=1,2,3,4),同时,所述四个点在光学测量坐标系中的坐标为MPi(ui,vi,wi),(i=1,2,3,4),则由机器人基座坐标系{R}到光学测量坐标系{M}的齐次变换矩阵为:
三.五自由度机器人末端位姿的闭环控制方法
借助于光学跟踪技术进行位姿测量,五自由度机器人末端位姿的闭环控制方法是:以光学测量空间为基准参考空间,首先,由计算机将在三维医学模型空间预先规划的手术路径变换到光学测量空间,并计算出在当前路径点五自由度机器人末端需要达到的理想位姿;然后,由计算机根据当前路径点的理想位姿,进行由光学测量空间到五自由度机器人基座坐标空间的坐标变换,并通过求解五自由度机器人逆运动学,得到五自由度机器人各个关节的理想位置;然后,由计算机向五自由度机器人输入各个关节的理想位置,控制五自由度机器人运动;同时,由光学跟踪设备和安装在五自由度机器人末端的被动标识器配合,实时测定五自由度机器人末端的位姿,并送入计算机;然后,由计算机将实时测定的位姿信息与预先规划的当前路径点的理想位姿进行比较,得到两者的位姿偏差;最后,由计算机根据位姿偏差按照预先确定的控制规律计算校正控制量,修正当前路径点的理想位姿,并开始新一轮的运动控制,从而实现精确的轨迹跟踪和定位。
由计算机根据位姿偏差计算校正控制量时所采用的控制规律是:位置控制采用比例-积分-微分调节;姿态控制采用比例调节。
五自由度机器人的末端位姿是在光学测量空间中进行闭环控制。
如图5,设末端工具坐标系{T}在光学测量坐标系{M}中的位姿用X=[PTφT]T表示。其中P=[xyz]T表示{T}的位置;φ=[αβγ]T表示{T}的姿态,由一组Z-Y-X欧拉角组成,
记Xd=[Pd Tφd T]T表示理想位姿,Pd=[xdydzd]T,φd=[αdβdγd]T;Xr=[Pr Tφr T]T表示实际测量得到的位姿,Pr=[xryrzr]T,φr=[αrβrγr]T;ΔX=[ΔPTΔφT]T表示Xd和Xr的偏差,ΔP=[ΔxΔyΔz]T,Δφ=[ΔαΔβΔγ]T,
位置偏差可以直接计算,即:
ΔP=Pd-Pr (5)
姿态偏差的计算涉及旋转变换,用Rd表示{T}相对于{M}的理想旋转变换矩阵;Rr表示根据测量值得到的实际变换矩阵;ΔR表示由Rr向Rd的变换,则:
记:
又有:
(9)
由(6)、(7)、(8)、(9)式联合可以解得姿态偏差Δφ=[ΔαΔβΔγ]T,其中:
a.当sinΔβ≠0时,
Δα=Atan2(r23/sinΔβ,r13/sinΔβ),
Δγ=Atan2(r32/sinΔβ,-r31/sinΔβ) (10)
b.当sinΔβ=0时,若Δβ=0.0,则:
Δα=0.0,
Δγ=Atan2(-r12,r11) (11)
若Δβ=180.0°,则:
Δα=0.0,
Δγ=Atan2(r12,-r11) (12)
下面分别讨论位置校正和姿态校正问题,采用离散形式列写公式,括号中的下标k表示控制循环的第k步。
位置校正采用比例-积分-微分(PID)控制,校正控制量记为UP=[uxuyuz]T,则:
其中T是***的采样控制周期,比如按POLARIS设定的最高测量数据更新率60HZ,T可取为16.7ms;KPP是由三个比例控制系数组成的对角矩阵;KPI是由三个积分控制系数组成的对角矩阵;KPD是由三个微分控制系数组成的对角矩阵。将上式改写成增量形式:
记
则进一步将算法写成计算机实现的形式:
初值可取F(k-1)=0,ΔP(k-1)=0,算法的每一步都要计算ΔP(k)、UP(k)、F(k),其中F(k)用于下一步计算UP(k)。
姿态校正采用比例(P)控制,校正控制量记为Uφ=[Uαuβuγ]T,对应的旋转矩阵为
则:
Uφ(k)=KφPΔφ(k) (16)
其中KφP是由三个比例控制系数组成的对角矩阵,
由(6)、(17)、(19)式联合求解
其过程可参照上述由(6)、(7)、(8)、(9)式联合求解Δφ=[ΔαΔβΔγ]T,不再赘述。
本发明具有的优点是:通过对机器人末端位姿进行实时的闭环控制,使影响机器人运动和定位的主要误差因素,如机器人本体的机构和控制误差,以及手术过程中的各种测量和计算误差等因素都能得到校正,从而确效地保证了手术机器人***全局的运动和定位精度,解决了现有外科手术机器人存在的轨迹跟踪和定位精度不能满足临床精细手术运用要求的问题。另一方面,采用了全局的位姿控制以后,对机器人本体的机构设计、制造及控制精度的要求等都可以放宽,从而降低机器人本体的设计和制造成本,并有条件更多地关注机器人的手术灵活性和可操作性,设计出人机更加协调的手术机器人机构***。本发明提出的方法同样适合于某些对绝对精度要求严格的工业机器人应用领域。
本发明还可以自动标定机器人基座坐标空间与光学测量空间的映射变换,免去了繁琐的机器人基座坐标系的人工标定过程,而且通过在病人头部粘贴医学标志器、采用光学注册工具测定医学标志器的坐标,就可以很简捷地获得由三维医学模型空间与光学测量空间的映射变换。
总之,本发明一方面可以明显提高机器人***的轨迹跟踪和定位精度,不仅解决了限制外科手术机器人推广使用的关键性的绝对精度问题,而且有利于降低机器人本体的设计和制造成本;另一方面大大简化了注册标定过程,不仅减轻了医生的工作量、心理负担和出现差错的概率,而且减轻了病人的痛苦和压力。
附图说明
图1是本发明的结构示意图。
图2是本发明的工作原理框图和所涉及坐标系定义的示意图。
图3是本发明的三维医学模型空间与光学测量空间映射变换的标测方法的流程框图。
图4是本发明的五自由度机器人基座坐标空间与光学测量空间映射变换的自动标测方法的流程框图。
图5是本发明的五自由度机器人末端位姿的闭环控制方法的流程和原理框图。
图6是本发明的五自由度机器人机械臂结构示意图。
具体实施方式
参照附图对本发明作详细说明:
如图所示,设备组成和图中个标号的含义是,它是由计算机1、五自由度机器人2、光学跟踪设备3、光学注册工具4、被动标识器5、医学标志器6、塑形枕7、手术床8硬件部分,和辅助手术规划与导引软件9部分组成的,以及五自由度机械臂11和机械臂控制器10。
由所说的计算机1、五自由度机器人2、光学跟踪设备3、和被动标识器5构成一个闭环的机器人位姿测量与实时反馈控制***,被动标识器5安装在五自由度机器人2的末端,始终被光学跟踪设备3跟踪;所说的五自由度机器人2包括五自由度机械臂11和机械臂控制器10;所说的辅助手术规划与导引软件9包括数字影像输入与预处理模块、病灶提取与三维重构模块、手术规划模块、以及手术实施模块。被动标识器5的数量至少为3个。
具体操作步骤是:
一.在进行手术前准备时:在病人头颅上粘贴四个医学标志器6,对脑部进行医学影像扫描,并将扫描所得医学影像信息输入计算机1,运用辅助手术规划与导引软件9确定病灶,重构病灶和头颅的三维医学模型,进行手术靶点与医学标志影像位置的标识,并规划手术路径;
二.在进行注册标定时:让病人躺在手术床8上,头部使用塑形枕7与手术床8相对固定,一方面用光学注册工具4测定病人头颅上的四个医学标志器6的坐标,测量值由光学跟踪设备3给出,并送入计算机1,由计算机1计算三维医学模型空间与光学测量空间之间的映射变换;另一方面用本发明设计的标测方法,由五自由度机器人2、光学跟踪设备3和计算机1配合,自动测定五自由度机器人基座坐标空间与光学测量空间之间的映射变换;
三.在进行手术实施时:首先,由计算机1将在三维医学模型空间预先规划的手术路径变换到光学测量空间,并计算出在当前路径点五自由度机器人末端需要达到的理想位姿;然后,由计算机1根据当前路径点的理想位姿,进行由光学测量空间到五自由度机器人基座坐标空间的坐标变换,并通过求解五自由度机器人逆运动学,得到五自由度机器人2各个关节的理想位置;然后,由计算机1向五自由度机器人2输入各个关节的理想位置,控制五自由度机器人2运动;同时,由光学跟踪设备3和安装在五自由度机器人末端的被动标识器5配合,实时测定五自由度机器人的末端位姿并送入计算机1,用本发明设计的控制方法对五自由度机器人的末端位姿进行实时控制,实现精确的轨迹跟踪和定位;最后,五自由度机器人2锁定,医生在五自由度机器人2的辅助下进行手术操作。
五自由度机械臂由手臂和手腕组成,具有五个关节,采取两个滑动关节和三个转动关节的PPRRR构型;手臂部分具有三个关节,分别为I、II和III关节,第I关节11-1采用滑动关节,运动方向垂直于水平面;第II关节11-2采用滑动关节,与第I关节成“T”形垂直;第III关节11-3采用转动关节,轴线与第I关节运动方向平行;手腕部分具有两个关节,分别为IV和V关节,第IV关节11-4采用转动关节,轴线与第III关节轴线平行;第V关节11-5采用转动关节,轴线与第IV关节轴线垂直;在机械臂的第V关节安装末端器械,安装轴线与第IV关节轴线平行。每个关节都有独立的驱动机构,由步进电机、减速器组成,滑动关节的驱动机构还包括有滚珠丝杆。
机械臂控制器10包括编程逻辑控制器PLC和步进电机驱动器,采用三个PLC和五个步进电机驱动器组合,对应控制五自由度机械臂11的五个关节,机械臂控制器10通过RS232C串口通信组件与计算机1进行通信,接受计算机1输入的关节位置命令,控制五自由度机械臂11运动到达指定位置。
闭环的机器人位姿测量与实时反馈控制***的方法是:由光学跟踪设备3通过跟踪安装在五自由度机器人末端的被动标识器5来测定五自由度机器人2的末端位姿,由计算机1根据测量得到的位姿和期望五自由度机器人2达到的位姿计算控制量,控制五自由度机器人2进一步运动以修正偏差;光学跟踪设备3与计算机1之间通过RS232/RS422串口进行通信;五自由度机器人2与计算机1之间通过RS232C串口进行通信。
所述的脑外科机器人***,被动标识器5在五自由度机器人2末端安装的几何位置关系满足:任意两个被动标识器5之间的距离不能小于50mm,任意两条由被动标识器5连线构成的线段之间的最小空间间隔不能小于5mm,任意两条线段不平行,而且任意两条线段之间的夹角不能低于0.5度。
基于光学跟踪闭环控制的脑外科机器人***的实现方法,借助于光学跟踪技术进行位姿测量,包括:三维医学模型空间与光学测量空间映射变换的简便标测方法、五自由度机器人基座坐标空间与光学测量空间映射变换的自动标测方法、五自由度机器人末端位姿的闭环控制方法。
三维医学模型空间与光学测量空间映射变换的简便标测方法是:
a.由医生在病人头部粘贴四个医学标志器6,要求这四个标志器不在同一平面,且任意三个标志器不在同一条直线上;
b.对病人头部进行CT或MRI医学影像扫描,所得扫描影像输入计算机1;
c.确定四个医学标志器的扫描成像点在三维医学模型空间的坐标;
d.让病人躺在手术床8上,头部使用塑形枕7与手术床8相对固定,用光学注册工具4测定病人头部的四个医学标志器6在光学测量空间的坐标,测量值由光学跟踪设备3输入计算机1;
e.由计算机1计算三维医学模型空间与光学测量空间的映射变换。
五自由度机器人基座坐标空间与光学测量空间映射变换的自动标测方法是:
a.预先选定五自由度机器人2工作空间内的四个点,要求这四个点应该处于光学跟踪设备3的测量范围内,并且四个点不共面,任意三个点不共线;
b.由计算机1向五自由度机器人2发出到达上述四个点的关节位置命令,控制五自由度机器人2依次运动到上述四个点;
c.由计算机1记录下上述四个点在五自由度机器人基座坐标空间中的坐标;同时,由光学跟踪设备3和安装在五自由度机器人末端的被动标识器5配合,依次测定五自由度机器人2运动到上述四个点时其末端在光学测量空间中的坐标,并送入计算机1;
d.由计算机1根据上述四个点在五自由度机器人基座坐标空间和光学测量空间的坐标值,计算出五自由度机器人2基座坐标空间与光学测量空间的映射变换,从而完成自动标测。
五自由度机器人末端位姿的闭环控制方法是:
a.由计算机1将在三维医学模型空间预先规划的手术路径变换到光学测量空间,并计算1出在当前路径点五自由度机器人末端需要达到的理想位姿;
b.由计算机1根据当前路径点的理想位姿,进行由光学测量空间到五自由度机器人基座坐标空间的坐标变换,并通过求解五自由度机器人逆运动学,得到五自由度机器人各个关节的理想位置;
c.由计算机1向五自由度机器人2输入各个关节的理想位置,控制五自由度机器人2运动;
d.由光学跟踪设备3和安装在五自由度机器人末端的被动标识器5配合,实时测定五自由度机器人末端的位姿,并送入计算机1;
e.由计算机1将实时测定的位姿信息与预先规划的当前路径点的理想位姿进行比较,得到两者的位姿偏差;
f.由计算机1根据位姿偏差按照预先确定的控制规律,位置控制采用比例-积分-微分调节;姿态控制采用比例调节,计算校正控制量,修正当前路径点的理想位姿,并开始新一轮的运动控制,从而实现精确的轨迹跟踪和定位。
Claims (10)
1、一种基于光学跟踪闭环控制脑外科机器人***,包括计算机(1)、五自由度机器人(2)、光学跟踪设备(3)、光学注册工具(4)、被动标识器(5)、医学标志器(6)、塑形枕(7)、和手术床(8)等设备组成的硬件部分,和辅助手术规划与导引软件(9)部分,是进行接收医学影像信息、测定并确定病灶的位置、辅助进行手术规划、并进行手术导引的脑外科机器人;其特征是,由所说的计算机(1)、五自由度机器人(2)、光学跟踪设备(3)、和被动标识器(5)构成一个闭环的机器人位姿测量与实时反馈控制***,被动标识器(5)安装在五自由度机器人(2)的末端,始终被光学跟踪设备(3)跟踪;所说的五自由度机器人(2)包括五自由度机械臂(11)和机械臂控制器(10);所说的辅助手术规划与导引软件(9)包括数字影像输入与预处理模块、病灶提取与三维重构模块、手术规划模块、以及手术实施模块;
使用本发明进行手术阶段的具体操作步骤是:
一.在进行手术前准备时:在病人头颅上粘贴四个医学标志器(6),对脑部进行医学影像扫描,并将扫描所得医学影像信息输入计算机(1),运用辅助手术规划与导引软件(9)确定病灶,重构病灶和头颅的三维医学模型,进行手术靶点与医学标志影像位置的标识,并规划手术路径;
二.在进行注册标定时:让病人躺在手术床(8)上,头部使用塑形枕(7)与手术床(8)相对固定,一方面用光学注册工具(4)测定病人头颅上的四个医学标志器(6)的坐标,测量值由光学跟踪设备(3)给出,并送入计算机(1),由计算机(1)计算三维医学模型空间与光学测量空间之间的映射变换;另一方面用本发明设计的标测方法,由五自由度机器人(2)、光学跟踪设备(3)和计算机(1)配合,自动测定五自由度机器人基座坐标空间与光学测量空间之间的映射变换;
三.在进行手术实施时:首先,由计算机(1)将在三维医学模型空间预先规划的手术路径变换到光学测量空间,并计算出在当前路径点五自由度机器人末端需要达到的理想位姿;然后,由计算机(1)根据当前路径点的理想位姿,进行由光学测量空间到五自由度机器人基座坐标空间的坐标变换,并通过求解五自由度机器人逆运动学,得到五自由度机器人(2)各个关节的理想位置;然后,由计算机(1)向五自由度机器人(2)输入各个关节的理想位置,控制五自由度机器人(2)运动;同时,由光学跟踪设备(3)和安装在五自由度机器人末端的被动标识器(5)配合,实时测定五自由度机器人的末端位姿并送入计算机(1),用本发明设计的控制方法对五自由度机器人的末端位姿进行实时控制,实现精确的轨迹跟踪和定位;最后,五自由度机器人(2)锁定,医生在五自由度机器人(2)的辅助下进行手术操作。
2.根据权利要求1所述的脑外科机器人***,其特征是,五自由度机械臂(11)由手臂和手腕组成,具有五个关节,采取两个滑动关节和三个转动关节的PPRRR构型;手臂部分具有三个关节,分别为I、II和III关节,第I关节11-1采用滑动关节,运动方向垂直于水平面;第II关节11-2采用滑动关节,与第I关节成“T”形垂直;第III关节11-3采用转动关节,轴线与第I关节运动方向平行;手腕部分具有两个关节,分别为IV和V关节,第IV关节11-4采用转动关节,轴线与第III关节轴线平行;第V关节11-5采用转动关节,轴线与第IV关节轴线垂直;在机械臂的第V关节安装末端器械,安装轴线与第IV关节轴线平行;每个关节都有独立的驱动机构,由步进电机、减速器组成,滑动关节的驱动机构还包括有滚珠丝杆。
3.根据权利要求1所述的脑外科机器人***,其特征是,机械臂控制器(10)包括编程逻辑控制器(PLC)和步进电机驱动器,采用三个PLC和五个步进电机驱动器组合,对应控制五自由度机械臂(11)的五个关节,机械臂控制器(10)通过RS232C串口通信组件与计算机(1)进行通信,接受计算机(1)输入的关节位置命令,控制五自由度机械臂(11)运动到达指定位置。
4.根据权利要求1所述的脑外科机器人***,其特征是,闭环的机器人位姿测量与实时反馈控制***的方法是:由光学跟踪设备(3)通过跟踪安装在五自由度机器人木端的被动标识器(5)来测定五自由度机器人(2)的末端位姿,由计算机(1)根据测量得到的位姿和期望五自由度机器人(2)达到的位姿计算控制量,控制五自由度机器人(2)进一步运动以修正偏差;光学跟踪设备(3)与计算机(1)之间通过RS232/RS422串口进行通信;五自由度机器人(2)与计算机(1)之间通过RS232C串口进行通信。
5.根据权利要求1所述的脑外科机器人***,其特征是,被动标识器(5)的数量至少为3个。
6.根据权利要求1所述的脑外科机器人***,其特征是,被动标识器(5)在五自由度机器人(2)末端安装的几何位置关系满足:任意两个被动标识器(5)之间的距离不能小于50mm,任意两条由被动标识器(5)连线构成的线段之间的最小空间间隔不能小于5mm,任意两条线段不平行,而且任意两条线段之间的夹角不能低于0.5度。
7.一种基于光学跟踪闭环控制的脑外科机器人***的实现方法,其特征在于,借助于光学跟踪技术进行位姿测量,包括:三维医学模型空间与光学测量空间映射变换的简便标测方法、五自由度机器人基座坐标空间与光学测量空间映射变换的自动标测方法、五自由度机器人末端位姿的闭环控制方法。
8.根据权利要求7所说的实现方法,其特征是,三维医学模型空间与光学测量空间映射变换的简便标测方法是:
a.由医生在病人头部粘贴四个医学标志器(6),要求这四个标志器不在同一平面,且任意三个标志器不在同一条直线上;
b.对病人头部进行CT或MRI医学影像扫描,所得扫描影像输入计算机(1);
c.确定四个医学标志器的扫描成像点在三维医学模型空间的坐标;
d.让病人躺在手术床(8)上,头部使用塑形枕(7)与手术床(8)相对固定,用光学注册工具(4)测定病人头部的四个医学标志器(6)在光学测量空间的坐标,测量值由光学跟踪设备(3)输入计算机(1);
e.由计算机(1)计算三维医学模型空间与光学测量空间的映射变换。
9.根据权利要求7所说的方法,其特征是,五自由度机器人基座坐标空间与光学测量空间映射变换的自动标测方法是:
a.预先选定五自由度机器人(2)工作空间内的四个点,要求这四个点应该处于光学跟踪设备(3)的测量范围内,并且四个点不共面,任意三个点不共线;
b.由计算机(1)向五自由度机器人(2)发出到达上述四个点的关节位置命令,控制五自由度机器人(2)依次运动到上述四个点;
c.由计算机(1)记录下上述四个点在五自由度机器人基座坐标空间中的坐标;同时,由光学跟踪设备(3)和安装在五自由度机器人末端的被动标识器(5)配合,依次测定五自由度机器人(2)运动到上述四个点时其末端在光学测量空间中的坐标,并送入计算机(1);
d.由计算机(1)根据上述四个点在五自由度机器人基座坐标空间和光学测量空间的坐标值,计算出五自由度机器人(2)基座坐标空间与光学测量空间的映射变换,从而完成自动标测。
10.根据权利要求7所说的实现方法,其特征是,五自由度机器人术端位姿的闭环控制方法是:
a.由计算机(1)将在三维医学模型空间预先规划的手术路径变换到光学测量空间,并计算(1)出在当前路径点五自由度机器人末端需要达到的理想位姿;
b.由计算机(1)根据当前路径点的理想位姿,进行由光学测量空间到五自由度机器人基座坐标空间的坐标变换,并通过求解五自由度机器人逆运动学,得到五自由度机器人各个关节的理想位置;
c.由计算机(1)向五自由度机器人(2)输入各个关节的理想位置,控制五自由度机器人(2)运动:
d.由光学跟踪设备(3)和安装在五自由度机器人末端的被动标识器(5)配合,实时测定五自由度机器人末端的位姿,并送入计算机(1);
e.由计算机(1)将实时测定的位姿信息与预先规划的当前路径点的理想位姿进行比较,得到两者的位姿偏差;
f.由计算机(1)根据位姿偏差按照预先确定的控制规律,位置控制采用比例-积分-微分调节;姿态控制采用比例调节,计算校正控制量,修正当前路径点的理想位姿,并开始新一轮的运动控制,从而实现精确的轨迹跟踪和定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB200510122586XA CN100464720C (zh) | 2005-12-22 | 2005-12-22 | 基于光学跟踪闭环控制的脑外科机器人***及实现方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB200510122586XA CN100464720C (zh) | 2005-12-22 | 2005-12-22 | 基于光学跟踪闭环控制的脑外科机器人***及实现方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1985773A true CN1985773A (zh) | 2007-06-27 |
CN100464720C CN100464720C (zh) | 2009-03-04 |
Family
ID=38182807
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB200510122586XA Expired - Fee Related CN100464720C (zh) | 2005-12-22 | 2005-12-22 | 基于光学跟踪闭环控制的脑外科机器人***及实现方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100464720C (zh) |
Cited By (60)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101842755A (zh) * | 2007-08-28 | 2010-09-22 | 萨里大学 | 逆运动学 |
CN101999938A (zh) * | 2010-10-15 | 2011-04-06 | 上海交通大学 | 用于骨科手术辅助机器人的手动操纵装置 |
WO2011069469A1 (en) * | 2009-12-11 | 2011-06-16 | Hospital Authority | Stereoscopic visualization system for surgery |
CN102198660A (zh) * | 2011-05-04 | 2011-09-28 | 上海海事大学 | 基于脑-机接口的机械手臂控制***及动作命令控制方案 |
CN102448398A (zh) * | 2009-06-01 | 2012-05-09 | 皇家飞利浦电子股份有限公司 | 基于距离的位置跟踪方法和*** |
CN101870104B (zh) * | 2009-04-25 | 2012-09-19 | 鸿富锦精密工业(深圳)有限公司 | 机械手臂反向运动方法 |
CN102848389A (zh) * | 2012-08-22 | 2013-01-02 | 浙江大学 | 基于视觉运动捕捉的机械臂标定及跟踪***实现方法 |
CN102922521A (zh) * | 2012-08-07 | 2013-02-13 | 中国科学技术大学 | 一种基于立体视觉伺服的机械臂***及其实时校准方法 |
CN103402453A (zh) * | 2011-03-03 | 2013-11-20 | 皇家飞利浦有限公司 | 用于导航***的自动初始化和配准的***和方法 |
CN101711127B (zh) * | 2007-04-19 | 2013-12-11 | 玛口外科股份有限公司 | 使用捕获的关节运动信息的植入规划 |
CN101612062B (zh) * | 2008-06-26 | 2014-03-26 | 北京石油化工学院 | 实现超声影像导航定位方法的传感式的六关节机械臂 |
CN103759635A (zh) * | 2013-12-25 | 2014-04-30 | 合肥工业大学 | 一种精度与机器人无关的扫描测量机器人检测方法 |
CN103895023A (zh) * | 2014-04-04 | 2014-07-02 | 中国民航大学 | 一种基于编码方位装置的机械臂末端跟踪测量***及方法 |
CN104083217A (zh) * | 2014-07-03 | 2014-10-08 | 北京天智航医疗科技股份有限公司 | 一种手术定位装置和方法以及机器人手术*** |
CN104287833A (zh) * | 2010-10-21 | 2015-01-21 | 伊顿株式会社 | 手术机器人的移动控制/补偿方法及其装置 |
CN105025835A (zh) * | 2013-03-13 | 2015-11-04 | 史赛克公司 | 用于在外科程序的准备中布置手术室中的对象的*** |
CN105318838A (zh) * | 2015-11-26 | 2016-02-10 | 华科精准(北京)医疗科技有限公司 | 激光测距仪和机械臂末端关系的单平面标定方法及其*** |
CN105598970A (zh) * | 2016-02-01 | 2016-05-25 | 北京航空航天大学 | 全闭环机器人***及其控制方法 |
CN105773629A (zh) * | 2015-01-14 | 2016-07-20 | 库卡罗伯特有限公司 | 用于使多轴操纵器与输入设备对准的方法 |
CN105852979A (zh) * | 2016-03-23 | 2016-08-17 | 北京柏惠维康科技有限公司 | 医学图像空间的定位装置及方法 |
CN105997260A (zh) * | 2016-07-28 | 2016-10-12 | 北京柏惠维康科技有限公司 | 自动升降装置及其控制方法及手术医疗*** |
CN106462992A (zh) * | 2014-03-19 | 2017-02-22 | 株式会社乐博特思 | 用于对机器人运动进行编辑及再生的装置、方法及计算机可读记录介质 |
CN106420054A (zh) * | 2016-10-19 | 2017-02-22 | 胡磊 | 一种融合术前3d规划信息的前交叉韧带止点定位和韧带隧道定位装置 |
CN106737683A (zh) * | 2017-01-11 | 2017-05-31 | 吉林省凯迪科技有限公司 | 校正工业机器人离线编程在现场中的误差的方法 |
CN106863332A (zh) * | 2017-04-27 | 2017-06-20 | 广东工业大学 | 一种机器人视觉定位方法及*** |
CN106914893A (zh) * | 2015-12-01 | 2017-07-04 | 西门子保健有限责任公司 | 用于运行医学机器人设备的方法以及医学机器人设备 |
CN106999250A (zh) * | 2014-12-17 | 2017-08-01 | 库卡罗伯特有限公司 | 用于机器人辅助的医疗处理的*** |
CN107174343A (zh) * | 2017-06-26 | 2017-09-19 | 南京普爱医疗设备股份有限公司 | 基于红外光学定位***的三维骨科手术导航空间配准方法 |
CN107405161A (zh) * | 2015-02-25 | 2017-11-28 | 奥林巴斯株式会社 | 机械手 |
CN107690317A (zh) * | 2015-06-04 | 2018-02-13 | 克瑞肖株式会社 | 手术路径设定装置、包括该手术路径设定装置的手术机器人***以及用于手术机器人的手术路径设定方法 |
CN107898499A (zh) * | 2017-12-06 | 2018-04-13 | 上海波城医疗科技有限公司 | 骨科三维区域定位***及方法 |
CN107997822A (zh) * | 2017-12-06 | 2018-05-08 | 上海波城医疗科技有限公司 | 微创手术定位*** |
CN108042172A (zh) * | 2017-12-06 | 2018-05-18 | 上海波城医疗科技有限公司 | 骨科手术单孔道定位*** |
CN108042218A (zh) * | 2017-12-05 | 2018-05-18 | 北京军秀咨询有限公司 | 一种神经外科手术病人头部标记自动视觉定位装置及方法 |
CN108042202A (zh) * | 2017-12-06 | 2018-05-18 | 上海波城医疗科技有限公司 | 手术机械臂定位*** |
CN108042173A (zh) * | 2017-12-06 | 2018-05-18 | 上海波城医疗科技有限公司 | 钻孔通道定位*** |
CN108201470A (zh) * | 2016-12-16 | 2018-06-26 | 上海铂联医疗科技有限公司 | 一种自主式种植牙机器人***及其设备和方法 |
CN108938090A (zh) * | 2018-08-20 | 2018-12-07 | 真健康(北京)医疗科技有限公司 | 一种精准定位的肿瘤手术机器人***及其目标定位方法 |
CN109431603A (zh) * | 2018-10-09 | 2019-03-08 | 北京术锐技术有限公司 | 用于内窥镜治疗术式的柔性机器人手术***及其使用方法 |
CN109431604A (zh) * | 2018-10-09 | 2019-03-08 | 北京术锐技术有限公司 | 一种用于单孔微创术式的柔性手术机器人及其使用方法 |
CN109591007A (zh) * | 2017-09-30 | 2019-04-09 | 北京柏惠维康科技有限公司 | 一种机器人空间注册方法和装置 |
CN109864806A (zh) * | 2018-12-19 | 2019-06-11 | 江苏集萃智能制造技术研究所有限公司 | 基于双目视觉的动态补偿功能的穿刺机器人导航*** |
CN109909646A (zh) * | 2019-02-02 | 2019-06-21 | 宁波吉利汽车研究开发有限公司 | 机器人焊枪工作点的修正方法、装置及电子设备 |
CN109938842A (zh) * | 2019-04-18 | 2019-06-28 | 王小丽 | 面部外科手术定位导航方法及装置 |
CN110051436A (zh) * | 2018-01-18 | 2019-07-26 | 上海舍成医疗器械有限公司 | 自动化协同工作组件及其在手术器械中的应用 |
CN110464465A (zh) * | 2019-08-14 | 2019-11-19 | 重庆文理学院 | 一种全膝关节置换手术辅助机器人 |
CN110584778A (zh) * | 2018-06-12 | 2019-12-20 | 上海舍成医疗器械有限公司 | 调整物体姿态的方法及其装置和在自动化设备中的应用 |
CN111113430A (zh) * | 2019-12-31 | 2020-05-08 | 深圳市优必选科技股份有限公司 | 一种机器人及其末端控制方法和装置 |
CN111134702A (zh) * | 2019-12-17 | 2020-05-12 | 南京佗道医疗科技有限公司 | 一种c臂机自动控制***及方法 |
CN111213098A (zh) * | 2017-08-17 | 2020-05-29 | 快砖知识产权私人有限公司 | 用于交互***的通信*** |
CN111249007A (zh) * | 2018-11-30 | 2020-06-09 | 微创(上海)医疗机器人有限公司 | 医疗机器人及其用于夹持医疗器械的机械臂 |
CN111728696A (zh) * | 2020-06-12 | 2020-10-02 | 天津理工大学 | 一种开颅手术机器人***及其开颅手术方法 |
WO2020228087A1 (zh) * | 2019-05-15 | 2020-11-19 | 北京天智航医疗科技股份有限公司 | 示踪设备和定位*** |
CN113297997A (zh) * | 2021-05-31 | 2021-08-24 | 合肥工业大学 | 非接触式生理检测机器人的6自由度人脸追踪方法和装置 |
CN113580141A (zh) * | 2021-08-18 | 2021-11-02 | 南京佗道医疗科技有限公司 | 一种6轴机械臂位姿求解方法 |
CN113693725A (zh) * | 2021-10-22 | 2021-11-26 | 杭州维纳安可医疗科技有限责任公司 | 进针路径规划方法、装置、设备及存储介质 |
CN113995512A (zh) * | 2021-02-07 | 2022-02-01 | 武汉光脉科技有限公司 | 一种全自动跟踪微创激光消融手术机器人***及其治疗方法 |
CN114010961A (zh) * | 2021-02-07 | 2022-02-08 | 武汉光脉科技有限公司 | 一种全自动跟踪激光疼痛治疗机器人***及其治疗方法 |
CN114391958A (zh) * | 2022-02-15 | 2022-04-26 | 南京佗道医疗科技有限公司 | 一种机械臂有效工作空间计算方法及其控制方法 |
CN116077190A (zh) * | 2023-02-27 | 2023-05-09 | 上海华易镜升数字科技有限公司 | 一种提高手术机器人***精度的*** |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6167295A (en) * | 1991-01-28 | 2000-12-26 | Radionics, Inc. | Optical and computer graphic stereotactic localizer |
US6052611A (en) * | 1997-11-28 | 2000-04-18 | Picker International, Inc. | Frameless stereotactic tomographic scanner for image guided interventional procedures |
EP1531749A2 (en) * | 2002-08-13 | 2005-05-25 | Microbotics Corporation | Microsurgical robot system |
CN1286438C (zh) * | 2003-12-26 | 2006-11-29 | 北京航空航天大学 | 医疗机器人视觉注册方法 |
CN100496429C (zh) * | 2005-02-06 | 2009-06-10 | 天津市华志计算机应用有限公司 | 外科手术导航***基于光学定位的机器人手术定位方法 |
-
2005
- 2005-12-22 CN CNB200510122586XA patent/CN100464720C/zh not_active Expired - Fee Related
Cited By (87)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101711127B (zh) * | 2007-04-19 | 2013-12-11 | 玛口外科股份有限公司 | 使用捕获的关节运动信息的植入规划 |
CN101842755A (zh) * | 2007-08-28 | 2010-09-22 | 萨里大学 | 逆运动学 |
CN101842755B (zh) * | 2007-08-28 | 2014-12-10 | 萨里大学 | 逆运动学 |
US8965582B2 (en) | 2007-08-28 | 2015-02-24 | The University Of Surrey | Inverse kinematics |
CN101612062B (zh) * | 2008-06-26 | 2014-03-26 | 北京石油化工学院 | 实现超声影像导航定位方法的传感式的六关节机械臂 |
CN101870104B (zh) * | 2009-04-25 | 2012-09-19 | 鸿富锦精密工业(深圳)有限公司 | 机械手臂反向运动方法 |
CN102448398A (zh) * | 2009-06-01 | 2012-05-09 | 皇家飞利浦电子股份有限公司 | 基于距离的位置跟踪方法和*** |
WO2011069469A1 (en) * | 2009-12-11 | 2011-06-16 | Hospital Authority | Stereoscopic visualization system for surgery |
CN101999938A (zh) * | 2010-10-15 | 2011-04-06 | 上海交通大学 | 用于骨科手术辅助机器人的手动操纵装置 |
CN104287833A (zh) * | 2010-10-21 | 2015-01-21 | 伊顿株式会社 | 手术机器人的移动控制/补偿方法及其装置 |
CN104287833B (zh) * | 2010-10-21 | 2017-04-12 | 伊顿株式会社 | 手术机器人的移动控制/补偿方法及其装置 |
CN103402453A (zh) * | 2011-03-03 | 2013-11-20 | 皇家飞利浦有限公司 | 用于导航***的自动初始化和配准的***和方法 |
US10290076B2 (en) | 2011-03-03 | 2019-05-14 | The United States Of America, As Represented By The Secretary, Department Of Health And Human Services | System and method for automated initialization and registration of navigation system |
CN102198660A (zh) * | 2011-05-04 | 2011-09-28 | 上海海事大学 | 基于脑-机接口的机械手臂控制***及动作命令控制方案 |
CN102922521B (zh) * | 2012-08-07 | 2015-09-09 | 中国科学技术大学 | 一种基于立体视觉伺服的机械臂***及其实时校准方法 |
CN102922521A (zh) * | 2012-08-07 | 2013-02-13 | 中国科学技术大学 | 一种基于立体视觉伺服的机械臂***及其实时校准方法 |
CN102848389A (zh) * | 2012-08-22 | 2013-01-02 | 浙江大学 | 基于视觉运动捕捉的机械臂标定及跟踪***实现方法 |
CN102848389B (zh) * | 2012-08-22 | 2015-06-17 | 浙江大学 | 基于视觉运动捕捉的机械臂标定及跟踪***实现方法 |
US10410746B2 (en) | 2013-03-13 | 2019-09-10 | Stryker Corporation | System and method for arranging objects in an operating room in preparation for surgical procedures |
CN105025835A (zh) * | 2013-03-13 | 2015-11-04 | 史赛克公司 | 用于在外科程序的准备中布置手术室中的对象的*** |
US11183297B2 (en) | 2013-03-13 | 2021-11-23 | Stryker Corporation | System and method for arranging objects in an operating room in preparation for surgical procedures |
CN105025835B (zh) * | 2013-03-13 | 2018-03-02 | 史赛克公司 | 用于在外科程序的准备中布置手术室中的对象的*** |
CN103759635A (zh) * | 2013-12-25 | 2014-04-30 | 合肥工业大学 | 一种精度与机器人无关的扫描测量机器人检测方法 |
CN103759635B (zh) * | 2013-12-25 | 2016-10-26 | 合肥工业大学 | 一种精度与机器人无关的扫描测量机器人检测方法 |
CN106462992B (zh) * | 2014-03-19 | 2019-12-10 | 株式会社乐博特思 | 用于对机器人运动进行编辑及再生的装置、方法及记录介质 |
CN106462992A (zh) * | 2014-03-19 | 2017-02-22 | 株式会社乐博特思 | 用于对机器人运动进行编辑及再生的装置、方法及计算机可读记录介质 |
CN103895023A (zh) * | 2014-04-04 | 2014-07-02 | 中国民航大学 | 一种基于编码方位装置的机械臂末端跟踪测量***及方法 |
CN103895023B (zh) * | 2014-04-04 | 2015-08-19 | 中国民航大学 | 一种基于编码方位装置的机械臂末端跟踪测量***的跟踪测量方法 |
CN104083217A (zh) * | 2014-07-03 | 2014-10-08 | 北京天智航医疗科技股份有限公司 | 一种手术定位装置和方法以及机器人手术*** |
CN106999250A (zh) * | 2014-12-17 | 2017-08-01 | 库卡罗伯特有限公司 | 用于机器人辅助的医疗处理的*** |
CN105773629A (zh) * | 2015-01-14 | 2016-07-20 | 库卡罗伯特有限公司 | 用于使多轴操纵器与输入设备对准的方法 |
CN107405161B (zh) * | 2015-02-25 | 2020-05-26 | 奥林巴斯株式会社 | 机械手 |
CN107405161A (zh) * | 2015-02-25 | 2017-11-28 | 奥林巴斯株式会社 | 机械手 |
CN107690317A (zh) * | 2015-06-04 | 2018-02-13 | 克瑞肖株式会社 | 手术路径设定装置、包括该手术路径设定装置的手术机器人***以及用于手术机器人的手术路径设定方法 |
CN107690317B (zh) * | 2015-06-04 | 2020-07-10 | 克瑞肖株式会社 | 手术路径设定装置、包括该手术路径设定装置的手术机器人*** |
CN105318838B (zh) * | 2015-11-26 | 2017-09-26 | 华科精准(北京)医疗科技有限公司 | 激光测距仪和机械臂末端关系的单平面标定方法 |
CN105318838A (zh) * | 2015-11-26 | 2016-02-10 | 华科精准(北京)医疗科技有限公司 | 激光测距仪和机械臂末端关系的单平面标定方法及其*** |
CN106914893A (zh) * | 2015-12-01 | 2017-07-04 | 西门子保健有限责任公司 | 用于运行医学机器人设备的方法以及医学机器人设备 |
CN106914893B (zh) * | 2015-12-01 | 2019-12-10 | 西门子保健有限责任公司 | 用于运行医学机器人设备的方法以及医学机器人设备 |
CN105598970A (zh) * | 2016-02-01 | 2016-05-25 | 北京航空航天大学 | 全闭环机器人***及其控制方法 |
CN105852979A (zh) * | 2016-03-23 | 2016-08-17 | 北京柏惠维康科技有限公司 | 医学图像空间的定位装置及方法 |
CN105997260A (zh) * | 2016-07-28 | 2016-10-12 | 北京柏惠维康科技有限公司 | 自动升降装置及其控制方法及手术医疗*** |
CN106420054A (zh) * | 2016-10-19 | 2017-02-22 | 胡磊 | 一种融合术前3d规划信息的前交叉韧带止点定位和韧带隧道定位装置 |
CN108201470A (zh) * | 2016-12-16 | 2018-06-26 | 上海铂联医疗科技有限公司 | 一种自主式种植牙机器人***及其设备和方法 |
CN106737683A (zh) * | 2017-01-11 | 2017-05-31 | 吉林省凯迪科技有限公司 | 校正工业机器人离线编程在现场中的误差的方法 |
CN106863332A (zh) * | 2017-04-27 | 2017-06-20 | 广东工业大学 | 一种机器人视觉定位方法及*** |
CN107174343A (zh) * | 2017-06-26 | 2017-09-19 | 南京普爱医疗设备股份有限公司 | 基于红外光学定位***的三维骨科手术导航空间配准方法 |
CN111213098A (zh) * | 2017-08-17 | 2020-05-29 | 快砖知识产权私人有限公司 | 用于交互***的通信*** |
CN111213098B (zh) * | 2017-08-17 | 2024-03-15 | 快砖知识产权私人有限公司 | 用于交互***的通信*** |
CN109591007B (zh) * | 2017-09-30 | 2022-02-22 | 北京柏惠维康科技有限公司 | 一种机器人空间注册方法和装置 |
CN109591007A (zh) * | 2017-09-30 | 2019-04-09 | 北京柏惠维康科技有限公司 | 一种机器人空间注册方法和装置 |
CN108042218A (zh) * | 2017-12-05 | 2018-05-18 | 北京军秀咨询有限公司 | 一种神经外科手术病人头部标记自动视觉定位装置及方法 |
CN108042172A (zh) * | 2017-12-06 | 2018-05-18 | 上海波城医疗科技有限公司 | 骨科手术单孔道定位*** |
CN107997822A (zh) * | 2017-12-06 | 2018-05-08 | 上海波城医疗科技有限公司 | 微创手术定位*** |
CN108042173A (zh) * | 2017-12-06 | 2018-05-18 | 上海波城医疗科技有限公司 | 钻孔通道定位*** |
CN108042202A (zh) * | 2017-12-06 | 2018-05-18 | 上海波城医疗科技有限公司 | 手术机械臂定位*** |
CN108042202B (zh) * | 2017-12-06 | 2019-10-25 | 上海波城医疗科技有限公司 | 手术机械臂定位*** |
CN107898499A (zh) * | 2017-12-06 | 2018-04-13 | 上海波城医疗科技有限公司 | 骨科三维区域定位***及方法 |
CN110051436B (zh) * | 2018-01-18 | 2020-04-17 | 上海舍成医疗器械有限公司 | 自动化协同工作组件及其在手术器械中的应用 |
CN110051436A (zh) * | 2018-01-18 | 2019-07-26 | 上海舍成医疗器械有限公司 | 自动化协同工作组件及其在手术器械中的应用 |
CN110584778A (zh) * | 2018-06-12 | 2019-12-20 | 上海舍成医疗器械有限公司 | 调整物体姿态的方法及其装置和在自动化设备中的应用 |
CN108938090A (zh) * | 2018-08-20 | 2018-12-07 | 真健康(北京)医疗科技有限公司 | 一种精准定位的肿瘤手术机器人***及其目标定位方法 |
CN109431604A (zh) * | 2018-10-09 | 2019-03-08 | 北京术锐技术有限公司 | 一种用于单孔微创术式的柔性手术机器人及其使用方法 |
CN109431603A (zh) * | 2018-10-09 | 2019-03-08 | 北京术锐技术有限公司 | 用于内窥镜治疗术式的柔性机器人手术***及其使用方法 |
CN111249007A (zh) * | 2018-11-30 | 2020-06-09 | 微创(上海)医疗机器人有限公司 | 医疗机器人及其用于夹持医疗器械的机械臂 |
CN111249007B (zh) * | 2018-11-30 | 2021-09-07 | 上海微创医疗机器人(集团)股份有限公司 | 医疗机器人及其用于夹持医疗器械的机械臂 |
CN109864806A (zh) * | 2018-12-19 | 2019-06-11 | 江苏集萃智能制造技术研究所有限公司 | 基于双目视觉的动态补偿功能的穿刺机器人导航*** |
CN109909646A (zh) * | 2019-02-02 | 2019-06-21 | 宁波吉利汽车研究开发有限公司 | 机器人焊枪工作点的修正方法、装置及电子设备 |
CN109938842A (zh) * | 2019-04-18 | 2019-06-28 | 王小丽 | 面部外科手术定位导航方法及装置 |
WO2020228087A1 (zh) * | 2019-05-15 | 2020-11-19 | 北京天智航医疗科技股份有限公司 | 示踪设备和定位*** |
CN110464465A (zh) * | 2019-08-14 | 2019-11-19 | 重庆文理学院 | 一种全膝关节置换手术辅助机器人 |
CN111134702A (zh) * | 2019-12-17 | 2020-05-12 | 南京佗道医疗科技有限公司 | 一种c臂机自动控制***及方法 |
CN111134702B (zh) * | 2019-12-17 | 2024-04-12 | 佗道医疗科技有限公司 | 一种c臂机自动控制***及方法 |
CN111113430A (zh) * | 2019-12-31 | 2020-05-08 | 深圳市优必选科技股份有限公司 | 一种机器人及其末端控制方法和装置 |
CN111113430B (zh) * | 2019-12-31 | 2021-07-27 | 深圳市优必选科技股份有限公司 | 一种机器人及其末端控制方法和装置 |
US11644840B2 (en) | 2019-12-31 | 2023-05-09 | Ubtech Robotics Corp Ltd | Method for controlling a robot and its end-portions and device thereof |
CN111728696A (zh) * | 2020-06-12 | 2020-10-02 | 天津理工大学 | 一种开颅手术机器人***及其开颅手术方法 |
CN113995512A (zh) * | 2021-02-07 | 2022-02-01 | 武汉光脉科技有限公司 | 一种全自动跟踪微创激光消融手术机器人***及其治疗方法 |
CN114010961A (zh) * | 2021-02-07 | 2022-02-08 | 武汉光脉科技有限公司 | 一种全自动跟踪激光疼痛治疗机器人***及其治疗方法 |
CN113297997A (zh) * | 2021-05-31 | 2021-08-24 | 合肥工业大学 | 非接触式生理检测机器人的6自由度人脸追踪方法和装置 |
CN113580141A (zh) * | 2021-08-18 | 2021-11-02 | 南京佗道医疗科技有限公司 | 一种6轴机械臂位姿求解方法 |
CN113693725A (zh) * | 2021-10-22 | 2021-11-26 | 杭州维纳安可医疗科技有限责任公司 | 进针路径规划方法、装置、设备及存储介质 |
CN113693725B (zh) * | 2021-10-22 | 2022-02-22 | 杭州维纳安可医疗科技有限责任公司 | 进针路径规划方法、装置、设备及存储介质 |
CN114391958A (zh) * | 2022-02-15 | 2022-04-26 | 南京佗道医疗科技有限公司 | 一种机械臂有效工作空间计算方法及其控制方法 |
CN114391958B (zh) * | 2022-02-15 | 2024-06-07 | 佗道医疗科技有限公司 | 一种机械臂有效工作空间计算方法及其控制方法 |
CN116077190B (zh) * | 2023-02-27 | 2023-08-08 | 上海华易镜升数字科技有限公司 | 一种提高手术机器人***精度的*** |
CN116077190A (zh) * | 2023-02-27 | 2023-05-09 | 上海华易镜升数字科技有限公司 | 一种提高手术机器人***精度的*** |
Also Published As
Publication number | Publication date |
---|---|
CN100464720C (zh) | 2009-03-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100464720C (zh) | 基于光学跟踪闭环控制的脑外科机器人***及实现方法 | |
CN101980838B (zh) | 用于引导外科辅助仪器的手术辅助*** | |
Zargarbashi et al. | Single setup estimation of a five-axis machine tool eight link errors by programmed end point constraint and on the fly measurement with Capball sensor | |
KR101200961B1 (ko) | 평행 운동학적 기계, 평행 운동학적 기계의 교정 방법, 및교정 프로그램 제품 | |
CN108789404A (zh) | 一种基于视觉的串联机器人运动学参数标定方法 | |
ES2457791T3 (es) | Procedimiento para determinar errores geométricos en una máquina herramienta o máquina de medición | |
CN103759635B (zh) | 一种精度与机器人无关的扫描测量机器人检测方法 | |
US20050273202A1 (en) | Method and device for improving the positioning accuracy of a manipulator | |
CN104408299B (zh) | 基于距离识别冗余运动学参数的机器人位置误差补偿方法 | |
CN105444672B (zh) | 激光测距仪和机械臂末端关系的正交平面标定方法及*** | |
Chen et al. | A ballbar test for measurement and identification the comprehensive error of tilt table | |
CN105318838B (zh) | 激光测距仪和机械臂末端关系的单平面标定方法 | |
Wang et al. | Identification of strut and assembly errors of a 3-PRS serial–parallel machine tool | |
CN110916799A (zh) | 基于5g网络的穿刺机器人导航*** | |
CN201858965U (zh) | 一种放射、放疗设备等中心点的检测装置 | |
CN109176487A (zh) | 一种联动关节段标定方法、***、设备、存储介质 | |
CN113974835B (zh) | 一种基于远心不动点约束的手术机器人运动控制方法 | |
CN105808882A (zh) | 仿爬行类四足步行机器人运动参数的标定方法与装置 | |
CN110279470A (zh) | 动态调节装置、动态调节***及其使用方法 | |
CN107186701B (zh) | 一种三自由度并联机构的示教机械臂参数标定装置及方法 | |
JPH11142139A (ja) | 3次元自動計測装置用計測誤差補正方法 | |
CN102538675B (zh) | 一种利用附加光源的光学检测*** | |
Nadeau et al. | A multi-plane approach for ultrasound visual servoing: application to a registration task | |
Tamadon et al. | Semiautonomous robotic manipulator for minimally invasive aortic valve replacement | |
CN114067646A (zh) | 一种穿刺手术机器人可视化仿真示教*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20090304 Termination date: 20141222 |
|
EXPY | Termination of patent right or utility model |