CN113855286A - 一种种植牙机器人导航***及方法 - Google Patents
一种种植牙机器人导航***及方法 Download PDFInfo
- Publication number
- CN113855286A CN113855286A CN202111122251.3A CN202111122251A CN113855286A CN 113855286 A CN113855286 A CN 113855286A CN 202111122251 A CN202111122251 A CN 202111122251A CN 113855286 A CN113855286 A CN 113855286A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- tool
- tracer
- patient
- 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
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61C—DENTISTRY; APPARATUS OR METHODS FOR ORAL OR DENTAL HYGIENE
- A61C8/00—Means to be fixed to the jaw-bone for consolidating natural teeth or for fixing dental prostheses thereon; Dental implants; Implanting tools
-
- 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/20—Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61C—DENTISTRY; APPARATUS OR METHODS FOR ORAL OR DENTAL HYGIENE
- A61C8/00—Means to be fixed to the jaw-bone for consolidating natural teeth or for fixing dental prostheses thereon; Dental implants; Implanting tools
- A61C8/0089—Implanting tools or instruments
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Veterinary Medicine (AREA)
- Public Health (AREA)
- General Health & Medical Sciences (AREA)
- Surgery (AREA)
- Engineering & Computer Science (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Dentistry (AREA)
- Epidemiology (AREA)
- Heart & Thoracic Surgery (AREA)
- Medical Informatics (AREA)
- Molecular Biology (AREA)
- Biomedical Technology (AREA)
- Robotics (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Dental Tools And Instruments Or Auxiliary Dental Instruments (AREA)
Abstract
本发明提供一种种植牙机器人导航***及方法,***包括:控制器、机械臂、手术刀具、光学定位仪、工具示踪器、患者示踪器和刀具标定器;所述手术刀具和所述工具示踪器固定安装在所述机械臂的末端;所述患者示踪器固定在患者的非种植牙牙齿上。优点为:机器人导航***利用术前CT扫描影像规划种植牙手术路径进行导航,并在导航过程中,对种植牙手术路径进行实时修正,另外,利用光学定位仪跟踪手术刀具的位置和姿态,从而引导机械臂运动,带动手术刀具到达种植牙路径,可实现手术刀具位置和方向的精确定位,具有定位准确、工作稳定的优点,可保证手术的精度,有效降低对医生操作的要求,并降低医生的工作强度。
Description
技术领域
本发明属于手术机器人导航定位技术领域,具体涉及一种种植牙机器人导航***及方法。
背景技术
传统的种植牙手术方法为:手术开始前,需要透视扫描植牙的情况,从而制定手术方案;然后,手术过程中,医生手持手术刀,凭借经验进行手术。此种种植牙手术方法具有以下问题:医生手持手术刀进行手术,操作精度和稳定性水平较低,无法保证手术的精度。
发明内容
针对现有技术存在的缺陷,本发明提供一种种植牙机器人导航***及方法,可有效解决上述问题。
本发明采用的技术方案如下:
本发明提供一种种植牙机器人导航***,包括:控制器、机械臂、手术刀具、光学定位仪、工具示踪器、患者示踪器和刀具标定器;所述手术刀具和所述工具示踪器固定安装在所述机械臂的末端;所述患者示踪器固定在患者的非种植牙牙齿上;
其中:所述刀具标定器包括4个光学定位球和一个标定孔;所述刀具标定器的标定孔套在所述手术刀具的末端后,手术刀具末端顶点与标定孔顶端中心点重合,手术刀具轴线方向与标定孔轴线方向重合。
优选的,所述机械臂是6自由度协作机械臂,设于机械臂基座上面;所述机械臂基座形成机械臂基座坐标系{B},机械臂的末端机械接口称为TCP,形成机械臂TCP坐标系{E}。
优选的,所述工具示踪器包括刚性支架,所述刚性支架上固定安装有4个光学定位球。
优选的,所述患者示踪器包括不易在CT影像中成像的刚性支架,所述患者示踪器的刚性支架的一端固定在患者的非种植牙牙齿上,另一端装有9个钛珠和4个光学定位球。
本发明还提供一种种植牙机器人导航***的方法,包括以下步骤:
步骤S1,预先标定得到工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE:
步骤S1.1,控制机械臂TCP随机运动n个位姿,得到以下n个方程:
OTB=OTT1·TTE·E1TB
OTB=OTT2·TTE·E2TB
...
OTB=OTTn·TTE·EnTB
其中:
OTB:代表光学定位仪坐标系{O}到机械臂基座坐标系{B}的转换矩阵,由于机械臂TCP运动过程中,机械臂基座与光学定位仪均固定不动,所以OTB始终不变,为已知固定值;
OTTi,i=1,2,...,n:代表机械臂TCP随机运动到第i个位姿时,光学定位仪坐标系{O}到工具示踪器坐标系{T}的转换矩阵,通过以下方法获得:当机械臂TCP随机运动到第i个位姿时,此时,通过光学定位仪,测量得到工具示踪器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的工具示踪器上每个光学定位球在工具示踪器坐标系{T}下的三维位置坐标,得到转换矩阵OTTi;
TTE:代表工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE,在机械臂TCP运动过程中,TTE固定不变,为待求值;
EiTB,i=1,2,...,n:代表机械臂TCP随机运动到第i个位姿时,机械臂TCP坐标系{E}到机械臂基座坐标系{B}的转换矩阵,为已知值;
步骤S1.2,对n个方程形成的方程组,采用最小二乘方法求解,得到工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE;
步骤S2.1,将刀具标定器套在手术刀具的末端,使得手术刀具末端顶点与刀具标定器的标定孔顶端中心点重合,使手术刀具轴线方向与刀具标定器的标定孔轴线方向重合;
步骤S2.2,通过光学定位仪,获得工具示踪器坐标系{T}到光学定位仪坐标系{O}的转换矩阵TTO,以及刀具标定器坐标系{K}到光学定位仪坐标系{O}的转换矩阵KTO;
具体方法为:通过光学定位仪,测量得到工具示踪器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的工具示踪器上每个光学定位球在工具示踪器坐标系{T}下的三维位置坐标,得到转换矩阵TTO;
通过光学定位仪,测量得到刀具标定器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的刀具标定器上每个光学定位球在刀具标定器坐标系{K}下的三维位置坐标,得到转换矩阵KTO;
步骤S2.3,采用下式,得到刀具标定器坐标系{K}到工具示踪器坐标系{T}的转换矩阵KTT:
KTT=KTO·(TTO)-1
根据下式,将刀具标定器的标定孔顶端中心点在刀具标定器坐标系{K}中的三维位置坐标PK,转换到工具示踪器坐标系{T}中,得到标定孔顶端中心点在工具示踪器坐标系{T}中的三维位置坐标PT:
其中:
I为3×3的单位矩阵;
步骤S2.5,由于标定孔顶端中心点在工具示踪器坐标系{T}中的三维位置坐标PT,等于手术刀具末端顶点Q在工具示踪器坐标系{T}的三维位置坐标QT;标定孔轴线方向在工具示踪器坐标系{T}中的方向向量等于手术刀具轴线方向在工具示踪器坐标系{T}的方向向量因此标记得到手术刀具与工具示踪器之间相对位姿关系;
步骤S3,获得CT扫描机坐标系{C}到光学定位仪坐标系{O}的转换矩阵CTO:
步骤S3.1,CT扫描机对患者示踪器进行扫描成像,使患者示踪器的钛珠成像在CT影像中;对CT影像进行分析,得到钛珠在CT扫描机坐标系{C}的三维位置坐标;
步骤S3.2,通过光学定位仪,测量得到患者示踪器的上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;
步骤S3.3,又由于患者示踪器的钛珠在患者示踪器坐标系{S}的三维位置坐标,以及患者示踪器的每个光学定位球在患者示踪器坐标系{S}的三维位置坐标均为已知固定值,因此,结合钛珠在CT扫描机坐标系{C}的三维位置坐标,以及患者示踪器的上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标,得到CT扫描机坐标系{C}到光学定位仪坐标系{O}的转换矩阵CTO;
采用下式,将CT扫描机坐标系{C}下的种植牙路径的进入点AC和路径方向转换到光学定位仪坐标系{O}下,得到光学定位仪坐标系{O}下的种植牙路径的进入点AO和路径方向该光学定位仪坐标系{O}下的种植牙路径的进入点AO和路径方向同时为手术刀具目标位姿;
其中:
I为3×3的单位矩阵;
步骤5,在导航过程中,采用以下方法,通过光学定位仪,实时测量得到手术刀具实时位姿;其中,所述手术刀具实时位姿包括手术刀具末端顶点Q在光学定位仪坐标系{O}下的三维位置坐标QO,以及手术刀具轴线方向在光学定位仪坐标系{O}下的方向向量
通过比较手术刀具实时位姿与手术刀具目标位姿,得到手术刀具在光学定位仪坐标系{O}下的位姿偏差;根据手术刀具在光学定位仪坐标系{O}下的位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动,使手术刀具实时位姿不断逼近手术刀具目标位姿。
优选的,步骤5中,根据手术刀具位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动,具体为:
步骤5.2,获取光学定位仪坐标系{O}到刀具标定器坐标系{K}的转换矩阵OTK;其中,刀具标定器坐标系{K}与刀具坐标系完全相同;因此得到光学定位仪坐标系{O}到刀具坐标系{F}的转换矩阵OTF;
根据光学定位仪坐标系{O}到刀具坐标系{F}的转换矩阵OTF,将手术刀具在光学定位仪坐标系{O}下的位姿偏差,转换为手术刀具在刀具坐标系{F}下的位姿偏差;
步骤5.3,根据步骤S2预先标定得到的手术刀具与工具示踪器之间相对位姿关系,将手术刀具在刀具坐标系{F}下的位姿偏差,转换为手术刀具在工具示踪器坐标系{T}下的位姿偏差;
步骤5.4,根据步骤S1预先标定得到的工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE,将手术刀具在工具示踪器坐标系{T}下的位姿偏差,转换为手术刀具在机械臂TCP坐标系{E}下的位姿偏差;
步骤5.5,根据手术刀具在机械臂TCP坐标系{E}下的位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动。
优选的,还包括:
优选的,步骤6具体为:
步骤6.1,通过光学定位仪,实时测量得到患者示踪器上每个光学定位球在光学定位仪坐标系{O}下的实时位姿;
步骤6.2,根据光学定位仪坐标系{O}到患者示踪器坐标系{S}的转换矩阵,将患者示踪器上每个光学定位球在光学定位仪坐标系{O}下的实时位姿,转换为患者示踪器上每个光学定位球在患者示踪器坐标系{S}下的实时位姿;
步骤6.3,根据患者示踪器坐标系{S}到CT扫描机坐标系{C}的转换矩阵,将患者示踪器上每个光学定位球在患者示踪器坐标系{S}下的实时位姿,转换为患者示踪器上每个光学定位球在CT扫描机坐标系{C}下的实时位姿;
步骤6.4,由于患者病患牙齿与患者示踪器的相对位姿关系固定不变,因此,将患者示踪器上每个光学定位球在CT扫描机坐标系{C}下的实时位姿,转换为患者病患牙齿在CT扫描机坐标系{C}下的实时位姿;
患者病患牙齿在CT扫描机坐标系{C}下的实时位姿,即为种植牙路径的进入点当前值和路径方向当前值;比较种植牙路径的进入点当前值和路径方向当前值,与步骤4规划得到在CT扫描机坐标系{C}下的种植牙路径的进入点AC和路径方向如果一致,则表明手术过程中患者头部位置没有发生变化,不需要更新手术刀具目标位姿;否则,采用患者病患牙齿在CT扫描机坐标系{C}下的实时位姿,更新手术刀具目标位姿。
本发明提供的一种种植牙机器人导航***及方法具有以下优点:
本发明提供的一种种植牙机器人导航***及方法,机器人导航***利用术前CT扫描影像规划种植牙手术路径进行导航,并在导航过程中,对种植牙手术路径进行实时修正,另外,利用光学定位仪跟踪手术刀具的位置和姿态,从而引导机械臂运动,带动手术刀具到达种植牙路径,可实现手术刀具位置和方向的精确定位,具有定位准确、工作稳定的优点,可保证手术的精度,有效降低对医生操作的要求,并降低医生的工作强度。
附图说明
图1为本发明提供的种植牙机器人导航***的结构图;
图2为工具示踪器示意图;
图3为患者示踪器示意图;
图4为刀具标定器示意图。
其中:
1代表工具示踪器;2代表手术刀具;3代表机械臂;4代表患者示踪器;5代表光学定位仪;6代表刀具标定器;
4-1代表患者示踪器上的光学定位球;
4-2代表患者示踪器上的钛珠;
6-1代表刀具标定器上的光学定位球;
6-2代表刀具标定器上的标定孔。
具体实施方式
为了使本发明所解决的技术问题、技术方案及有益效果更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
本发明提供一种种植牙机器人导航***及方法,机器人导航***利用术前CT扫描影像规划种植牙手术路径进行导航,并在导航过程中,对种植牙手术路径进行实时修正,另外,利用光学定位仪跟踪手术刀具的位置和姿态,从而引导机械臂运动,带动手术刀具到达种植牙路径,可实现手术刀具位置和方向的精确定位,具有定位准确、工作稳定的优点,可保证手术的精度,有效降低对医生操作的要求,并降低医生的工作强度。
参考图1,本发明提供一种种植牙机器人导航***,包括:控制器、机械臂、手术刀具、光学定位仪、工具示踪器、患者示踪器和刀具标定器;所述手术刀具和所述工具示踪器固定安装在所述机械臂的末端;所述患者示踪器固定在患者的非种植牙牙齿上;
参考图4,所述刀具标定器包括4个光学定位球和一个标定孔;所述刀具标定器的标定孔套在所述手术刀具的末端后,手术刀具末端顶点与标定孔顶端中心点重合,手术刀具轴线方向与标定孔轴线方向重合。光学定位球在刀具标定器坐标系{K}下的坐标、标定孔顶端中心点在刀具标定器坐标系{K}下的坐标PK和标定孔轴线方向在刀具标定器坐标系{K}下的方向向量事先经过标定。
所述机械臂是6自由度协作机械臂,设于机械臂基座上面;所述机械臂基座形成机械臂基座坐标系{B},机械臂的末端机械接口称为TCP,形成机械臂TCP坐标系{E}。通过控制器可实时读取机械臂TCP坐标系{E}与机械臂基座坐标系{B}之间的转换关系,也即机械臂TCP的位姿。其中,在机械臂运动过程中,机械臂基座坐标系{B}固定不变,机械臂TCP坐标系{E}随机械臂运动而变化。
参考图2,所述工具示踪器包括刚性支架,所述刚性支架上固定安装有4个光学定位球。4个光学定位球在工具示踪器坐标系{T}下的坐标事先经过标定。在机械臂运动过程中,工具示踪器坐标系{T}随机械臂运动而变化。
参考图3,所述患者示踪器包括不易在CT影像中成像的刚性支架,所述患者示踪器的刚性支架的一端固定在患者的非种植牙牙齿上,另一端装有9个钛珠和4个光学定位球。
在一实施例中,患者示踪器上的钛珠可在CT影像中成像,且根据钛珠可建立患者示踪器坐标系{S},4个光学定位球在患者示踪器坐标系{S}下的坐标事先经过标定;通过CT扫描机对钛珠的测量和光学定位仪对光学定位球的测量,可通过坐标系转换计算,得到CT扫描机坐标系{C}与光学定位仪坐标系{O}之间的转换矩阵CTO。
在一实施例中,所述光学定位仪通过测量可获得光学定位球在光学定位仪坐标系{O}下的坐标,则光学定位仪通过对工具示踪器、患者示踪器和刀具标定器上光学定位球的测量,再经过坐标系转换计算,可获得工具示踪器坐标系{T}与光学定位仪坐标系{O}之间的转换矩阵、患者示踪器坐标系{S}与光学定位仪坐标系{O}之间的转换矩阵,以及刀具标定器坐标系{K}与光学定位仪坐标系{O}之间的转换矩阵。
本发明还提供一种种植牙机器人导航***的方法,包括以下步骤:
步骤S1,预先标定得到工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE,即机械臂TCP与工具示踪器之间的相对位姿关系。
步骤S1.1,控制机械臂TCP随机运动n个位姿,例如,10个位姿,得到以下n个方程:
OTB=OTT1·TTE·E1TB
OTB=OTT2·TTE·E2TB
...
OTB=OTTn·TTE·EnTB
其中:
OTB:代表光学定位仪坐标系{O}到机械臂基座坐标系{B}的转换矩阵,由于机械臂TCP运动过程中,机械臂基座与光学定位仪均固定不动,所以OTB始终不变,为已知固定值;
OTTi,i=1,2,...,n:代表机械臂TCP随机运动到第i个位姿时,光学定位仪坐标系{O}到工具示踪器坐标系{T}的转换矩阵,通过以下方法获得:当机械臂TCP随机运动到第i个位姿时,此时,通过光学定位仪,测量得到工具示踪器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的工具示踪器上每个光学定位球在工具示踪器坐标系{T}下的三维位置坐标,得到转换矩阵OTTi;
TTE:代表工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE,在机械臂TCP运动过程中,TTE固定不变,为待求值;
EiTB,i=1,2,...,n:代表机械臂TCP随机运动到第i个位姿时,机械臂TCP坐标系{E}到机械臂基座坐标系{B}的转换矩阵,为已知值,可由控制器读取得到;
步骤S1.2,对n个方程形成的方程组,采用最小二乘方法求解,得到工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE;
步骤S2.1,将刀具标定器套在手术刀具的末端,使得手术刀具末端顶点与刀具标定器的标定孔顶端中心点重合,使手术刀具轴线方向与刀具标定器的标定孔轴线方向重合;
步骤S2.2,通过光学定位仪,获得工具示踪器坐标系{T}到光学定位仪坐标系{O}的转换矩阵TTO,以及刀具标定器坐标系{K}到光学定位仪坐标系{O}的转换矩阵KTO;
具体方法为:通过光学定位仪,测量得到工具示踪器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的工具示踪器上每个光学定位球在工具示踪器坐标系{T}下的三维位置坐标,得到转换矩阵TTO;
通过光学定位仪,测量得到刀具标定器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的刀具标定器上每个光学定位球在刀具标定器坐标系{K}下的三维位置坐标,得到转换矩阵KTO;
步骤S2.3,采用下式,得到刀具标定器坐标系{K}到工具示踪器坐标系{T}的转换矩阵KTT:
KTT=KTO·(TTO)-1
根据下式,将刀具标定器的标定孔顶端中心点在刀具标定器坐标系{K}中的三维位置坐标PK,转换到工具示踪器坐标系{T}中,得到标定孔顶端中心点在工具示踪器坐标系{T}中的三维位置坐标PT:
其中:
I为3×3的单位矩阵;
步骤S2.5,由于标定孔顶端中心点在工具示踪器坐标系{T}中的三维位置坐标PT,等于手术刀具末端顶点Q在工具示踪器坐标系{T}的三维位置坐标QT;标定孔轴线方向在工具示踪器坐标系{T}中的方向向量等于手术刀具轴线方向在工具示踪器坐标系{T}的方向向量因此标记得到手术刀具与工具示踪器之间相对位姿关系;
步骤S3,获得CT扫描机坐标系{C}到光学定位仪坐标系{O}的转换矩阵CTO:
步骤S3.1,CT扫描机对患者示踪器进行扫描成像,使患者示踪器的钛珠成像在CT影像中;对CT影像进行分析,得到钛珠在CT扫描机坐标系{C}的三维位置坐标;
步骤S3.2,通过光学定位仪,测量得到患者示踪器的上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;
步骤S3.3,又由于患者示踪器的钛珠在患者示踪器坐标系{S}的三维位置坐标,以及患者示踪器的每个光学定位球在患者示踪器坐标系{S}的三维位置坐标均为已知固定值,因此,结合钛珠在CT扫描机坐标系{C}的三维位置坐标,以及患者示踪器的上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标,得到CT扫描机坐标系{C}到光学定位仪坐标系{O}的转换矩阵CTO;
采用下式,将CT扫描机坐标系{C}下的种植牙路径的进入点AC和路径方向转换到光学定位仪坐标系{O}下,得到光学定位仪坐标系{O}下的种植牙路径的进入点AO和路径方向该光学定位仪坐标系{O}下的种植牙路径的进入点AO和路径方向同时为手术刀具目标位姿;
其中:
I为3×3的单位矩阵;
步骤5,在导航过程中,采用以下方法,通过光学定位仪,实时测量得到手术刀具实时位姿;其中,所述手术刀具实时位姿包括手术刀具末端顶点Q在光学定位仪坐标系{O}下的三维位置坐标QO,以及手术刀具轴线方向在光学定位仪坐标系{O}下的方向向量
通过比较手术刀具实时位姿与手术刀具目标位姿,得到手术刀具在光学定位仪坐标系{O}下的位姿偏差;根据手术刀具在光学定位仪坐标系{O}下的位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动,使手术刀具实时位姿不断逼近手术刀具目标位姿。
作为一种具体实施例,本步骤中,根据手术刀具位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动,具体为:
步骤5.2,获取光学定位仪坐标系{O}到刀具标定器坐标系{K}的转换矩阵OTK;其中,刀具标定器坐标系{K}与刀具坐标系完全相同;因此得到光学定位仪坐标系{O}到刀具坐标系{F}的转换矩阵OTF;
根据光学定位仪坐标系{O}到刀具坐标系{F}的转换矩阵OTF,将手术刀具在光学定位仪坐标系{O}下的位姿偏差,转换为手术刀具在刀具坐标系{F}下的位姿偏差;
步骤5.3,根据步骤S2预先标定得到的手术刀具与工具示踪器之间相对位姿关系,将手术刀具在刀具坐标系{F}下的位姿偏差,转换为手术刀具在工具示踪器坐标系{T}下的位姿偏差;
步骤5.4,根据步骤S1预先标定得到的工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE,将手术刀具在工具示踪器坐标系{T}下的位姿偏差,转换为手术刀具在机械臂TCP坐标系{E}下的位姿偏差;
步骤5.5,根据手术刀具在机械臂TCP坐标系{E}下的位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动。
另外,还包括:
8、根据权利要求7所述的种植牙机器人导航***的方法,其特征在于,步骤6具体为:
步骤6.1,通过光学定位仪,实时测量得到患者示踪器上每个光学定位球在光学定位仪坐标系{O}下的实时位姿;
步骤6.2,根据光学定位仪坐标系{O}到患者示踪器坐标系{S}的转换矩阵,将患者示踪器上每个光学定位球在光学定位仪坐标系{O}下的实时位姿,转换为患者示踪器上每个光学定位球在患者示踪器坐标系{S}下的实时位姿;
步骤6.3,根据患者示踪器坐标系{S}到CT扫描机坐标系{C}的转换矩阵,将患者示踪器上每个光学定位球在患者示踪器坐标系{S}下的实时位姿,转换为患者示踪器上每个光学定位球在CT扫描机坐标系{C}下的实时位姿;
步骤6.4,由于患者病患牙齿与患者示踪器的相对位姿关系固定不变,因此,将患者示踪器上每个光学定位球在CT扫描机坐标系{C}下的实时位姿,转换为患者病患牙齿在CT扫描机坐标系{C}下的实时位姿;
患者病患牙齿在CT扫描机坐标系{C}下的实时位姿,即为种植牙路径的进入点当前值和路径方向当前值;比较种植牙路径的进入点当前值和路径方向当前值,与步骤4规划得到在CT扫描机坐标系{C}下的种植牙路径的进入点AC和路径方向如果一致,则表明手术过程中患者头部位置没有发生变化,不需要更新手术刀具目标位姿;否则,采用患者病患牙齿在CT扫描机坐标系{C}下的实时位姿,更新手术刀具目标位姿。
因此,本发明中,在手术过程中,如果患者头部位置发生变化,可根据患者种植牙齿的实时位姿更新光学定位仪坐标系{O}下的种植牙路径,重新计算刀具目标位姿。
本发明提供一种种植牙机器人导航***及方法,通过坐标系转换将种植牙路径和手术刀具的位姿都转换到光学定位仪坐标系下进行导航,并引导机械臂带动手术刀具运动,可提供高效准确的种植牙手术导航。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视本发明的保护范围。
Claims (8)
1.一种种植牙机器人导航***,其特征在于,包括:控制器、机械臂、手术刀具、光学定位仪、工具示踪器、患者示踪器和刀具标定器;所述手术刀具和所述工具示踪器固定安装在所述机械臂的末端;所述患者示踪器固定在患者的非种植牙牙齿上;
其中:所述刀具标定器包括4个光学定位球和一个标定孔;所述刀具标定器的标定孔套在所述手术刀具的末端后,手术刀具末端顶点与标定孔顶端中心点重合,手术刀具轴线方向与标定孔轴线方向重合。
2.根据权利要求1所述的一种种植牙机器人导航***,其特征在于,所述机械臂是6自由度协作机械臂,设于机械臂基座上面;所述机械臂基座形成机械臂基座坐标系{B},机械臂的末端机械接口称为TCP,形成机械臂TCP坐标系{E}。
3.根据权利要求1所述的一种种植牙机器人导航***,其特征在于,所述工具示踪器包括刚性支架,所述刚性支架上固定安装有4个光学定位球。
4.根据权利要求1所述的一种种植牙机器人导航***,其特征在于,所述患者示踪器包括不易在CT影像中成像的刚性支架,所述患者示踪器的刚性支架的一端固定在患者的非种植牙牙齿上,另一端装有9个钛珠和4个光学定位球。
5.一种权利要求1-4任一项所述的种植牙机器人导航***的方法,其特征在于,包括以下步骤:
步骤S1,预先标定得到工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE:
步骤S1.1,控制机械臂TCP随机运动n个位姿,得到以下n个方程:
OTB=OTT1·TTE·E1TB
OTB=OTT2·TTE·E2TB
...
OTB=OTTn·TTE·EnTB
其中:
OTB:代表光学定位仪坐标系{O}到机械臂基座坐标系{B}的转换矩阵,由于机械臂TCP运动过程中,机械臂基座与光学定位仪均固定不动,所以OTB始终不变,为已知固定值;
OTTi,i=1,2,...,n:代表机械臂TCP随机运动到第i个位姿时,光学定位仪坐标系{O}到工具示踪器坐标系{T}的转换矩阵,通过以下方法获得:当机械臂TCP随机运动到第i个位姿时,此时,通过光学定位仪,测量得到工具示踪器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的工具示踪器上每个光学定位球在工具示踪器坐标系{T}下的三维位置坐标,得到转换矩阵OTTi;
TTE:代表工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE,在机械臂TCP运动过程中,TTE固定不变,为待求值;
EiTB,i=1,2,...,n:代表机械臂TCP随机运动到第i个位姿时,机械臂TCP坐标系{E}到机械臂基座坐标系{B}的转换矩阵,为已知值;
步骤S1.2,对n个方程形成的方程组,采用最小二乘方法求解,得到工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE;
步骤S2.1,将刀具标定器套在手术刀具的末端,使得手术刀具末端顶点与刀具标定器的标定孔顶端中心点重合,使手术刀具轴线方向与刀具标定器的标定孔轴线方向重合;
步骤S2.2,通过光学定位仪,获得工具示踪器坐标系{T}到光学定位仪坐标系{O}的转换矩阵TTO,以及刀具标定器坐标系{K}到光学定位仪坐标系{O}的转换矩阵KTO;
具体方法为:通过光学定位仪,测量得到工具示踪器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的工具示踪器上每个光学定位球在工具示踪器坐标系{T}下的三维位置坐标,得到转换矩阵TTO;
通过光学定位仪,测量得到刀具标定器上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;再结合已知的刀具标定器上每个光学定位球在刀具标定器坐标系{K}下的三维位置坐标,得到转换矩阵KTO;
步骤S2.3,采用下式,得到刀具标定器坐标系{K}到工具示踪器坐标系{T}的转换矩阵KTT:
KTT=KTO·(TTO)-1
根据下式,将刀具标定器的标定孔顶端中心点在刀具标定器坐标系{K}中的三维位置坐标PK,转换到工具示踪器坐标系{T}中,得到标定孔顶端中心点在工具示踪器坐标系{T}中的三维位置坐标PT:
其中:
I为3×3的单位矩阵;
步骤S2.5,由于标定孔顶端中心点在工具示踪器坐标系{T}中的三维位置坐标PT,等于手术刀具末端顶点Q在工具示踪器坐标系{T}的三维位置坐标QT;标定孔轴线方向在工具示踪器坐标系{T}中的方向向量等于手术刀具轴线方向在工具示踪器坐标系{T}的方向向量因此标记得到手术刀具与工具示踪器之间相对位姿关系;
步骤S3,获得CT扫描机坐标系{C}到光学定位仪坐标系{O}的转换矩阵CTO:
步骤S3.1,CT扫描机对患者示踪器进行扫描成像,使患者示踪器的钛珠成像在CT影像中;对CT影像进行分析,得到钛珠在CT扫描机坐标系{C}的三维位置坐标;
步骤S3.2,通过光学定位仪,测量得到患者示踪器的上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标;
步骤S3.3,又由于患者示踪器的钛珠在患者示踪器坐标系{S}的三维位置坐标,以及患者示踪器的每个光学定位球在患者示踪器坐标系{S}的三维位置坐标均为已知固定值,因此,结合钛珠在CT扫描机坐标系{C}的三维位置坐标,以及患者示踪器的上每个光学定位球在光学定位仪坐标系{O}下的三维位置坐标,得到CT扫描机坐标系{C}到光学定位仪坐标系{O}的转换矩阵CTO;
采用下式,将CT扫描机坐标系{C}下的种植牙路径的进入点AC和路径方向转换到光学定位仪坐标系{O}下,得到光学定位仪坐标系{O}下的种植牙路径的进入点AO和路径方向该光学定位仪坐标系{O}下的种植牙路径的进入点AO和路径方向同时为手术刀具目标位姿;
其中:
I为3×3的单位矩阵;
步骤5,在导航过程中,采用以下方法,通过光学定位仪,实时测量得到手术刀具实时位姿;其中,所述手术刀具实时位姿包括手术刀具末端顶点Q在光学定位仪坐标系{O}下的三维位置坐标QO,以及手术刀具轴线方向在光学定位仪坐标系{O}下的方向向量
通过比较手术刀具实时位姿与手术刀具目标位姿,得到手术刀具在光学定位仪坐标系{O}下的位姿偏差;根据手术刀具在光学定位仪坐标系{O}下的位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动,使手术刀具实时位姿不断逼近手术刀具目标位姿。
6.根据权利要求5所述的种植牙机器人导航***的方法,其特征在于,步骤5中,根据手术刀具位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动,具体为:
步骤5.2,获取光学定位仪坐标系{O}到刀具标定器坐标系{K}的转换矩阵OTK;其中,刀具标定器坐标系{K}与刀具坐标系完全相同;因此得到光学定位仪坐标系{O}到刀具坐标系{F}的转换矩阵OTF;
根据光学定位仪坐标系{O}到刀具坐标系{F}的转换矩阵OTF,将手术刀具在光学定位仪坐标系{O}下的位姿偏差,转换为手术刀具在刀具坐标系{F}下的位姿偏差;
步骤5.3,根据步骤S2预先标定得到的手术刀具与工具示踪器之间相对位姿关系,将手术刀具在刀具坐标系{F}下的位姿偏差,转换为手术刀具在工具示踪器坐标系{T}下的位姿偏差;
步骤5.4,根据步骤S1预先标定得到的工具示踪器坐标系{T}到机械臂TCP坐标系{E}的转换矩阵TTE,将手术刀具在工具示踪器坐标系{T}下的位姿偏差,转换为手术刀具在机械臂TCP坐标系{E}下的位姿偏差;
步骤5.5,根据手术刀具在机械臂TCP坐标系{E}下的位姿偏差,生成对机械臂控制指令,控制机械臂带动手术刀具朝向手术刀具目标位姿运动。
8.根据权利要求7所述的种植牙机器人导航***的方法,其特征在于,步骤6具体为:
步骤6.1,通过光学定位仪,实时测量得到患者示踪器上每个光学定位球在光学定位仪坐标系{O}下的实时位姿;
步骤6.2,根据光学定位仪坐标系{O}到患者示踪器坐标系{S}的转换矩阵,将患者示踪器上每个光学定位球在光学定位仪坐标系{O}下的实时位姿,转换为患者示踪器上每个光学定位球在患者示踪器坐标系{S}下的实时位姿;
步骤6.3,根据患者示踪器坐标系{S}到CT扫描机坐标系{C}的转换矩阵,将患者示踪器上每个光学定位球在患者示踪器坐标系{S}下的实时位姿,转换为患者示踪器上每个光学定位球在CT扫描机坐标系{C}下的实时位姿;
步骤6.4,由于患者病患牙齿与患者示踪器的相对位姿关系固定不变,因此,将患者示踪器上每个光学定位球在CT扫描机坐标系{C}下的实时位姿,转换为患者病患牙齿在CT扫描机坐标系{C}下的实时位姿;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111122251.3A CN113855286B (zh) | 2021-09-24 | 2021-09-24 | 一种种植牙机器人导航***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111122251.3A CN113855286B (zh) | 2021-09-24 | 2021-09-24 | 一种种植牙机器人导航***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113855286A true CN113855286A (zh) | 2021-12-31 |
CN113855286B CN113855286B (zh) | 2023-01-10 |
Family
ID=78993874
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111122251.3A Active CN113855286B (zh) | 2021-09-24 | 2021-09-24 | 一种种植牙机器人导航***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113855286B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114454167A (zh) * | 2022-02-11 | 2022-05-10 | 四川锋准机器人科技有限公司 | 一种种植牙机器人末端夹持器几何尺寸的标定方法 |
CN114521962A (zh) * | 2022-04-24 | 2022-05-24 | 杭州柳叶刀机器人有限公司 | 手术机器人轨迹跟踪方法、装置、机器人及存储介质 |
CN114767302A (zh) * | 2022-06-17 | 2022-07-22 | 杭州柳叶刀机器人有限公司 | 口腔机器人的控制方法、装置和电子设备 |
CN115229806A (zh) * | 2022-09-21 | 2022-10-25 | 杭州三坛医疗科技有限公司 | 一种机械臂控制方法、装置、***、设备及存储介质 |
CN115252172A (zh) * | 2022-08-03 | 2022-11-01 | 北京大学口腔医学院 | 一种牙体预备机器人*** |
CN115778602A (zh) * | 2023-02-06 | 2023-03-14 | 极限人工智能有限公司 | 一种车针校验方法、装置、存储介质及设备 |
CN116138905A (zh) * | 2023-03-07 | 2023-05-23 | 山东大学 | 一种机器人辅助正畸托槽粘结方法及粘接*** |
CN116747039A (zh) * | 2023-08-17 | 2023-09-15 | 深圳卡尔文科技有限公司 | 一种种植机器人位姿调整方法、***和存储介质 |
CN116785001A (zh) * | 2023-08-25 | 2023-09-22 | 深圳卡尔文科技有限公司 | 一种种植手术工具标定方法、***和存储介质 |
CN117137626A (zh) * | 2023-10-30 | 2023-12-01 | 北京三博脑科医院有限公司 | 一种神经外科手术机器人的无创注册方法 |
CN117204951A (zh) * | 2023-09-22 | 2023-12-12 | 上海睿触科技有限公司 | 一种基于x射线的手术定位导航设备及其定位实现方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN202146362U (zh) * | 2010-12-30 | 2012-02-22 | 上海交通大学医学院附属第九人民医院 | 一种基于光学导航七自由度颅颌面手术辅助机械臂 |
CN106061427A (zh) * | 2014-02-28 | 2016-10-26 | 索尼公司 | 机器人臂设备、机器人臂控制方法和程序 |
US20180168750A1 (en) * | 2016-12-16 | 2018-06-21 | Mako Surgical Corp. | Techniques for modifying tool operation in a surgical robotic system based on comparing actual and commanded states of the tool relative to a surgical site |
CN108705536A (zh) * | 2018-06-05 | 2018-10-26 | 雅客智慧(北京)科技有限公司 | 一种基于视觉导航的牙科机器人路径规划***及方法 |
CN112790783A (zh) * | 2021-03-05 | 2021-05-14 | 四川锋准机器人科技有限公司 | 匹配ct图像与定位被动式红外反光球位置的工具及方法 |
CN113303840A (zh) * | 2021-05-14 | 2021-08-27 | 北京大学第三医院 | 一种借助内窥镜的手术导航定位*** |
CN113400325A (zh) * | 2021-06-23 | 2021-09-17 | 四川锋准机器人科技有限公司 | 一种种植牙机器人导航定位方法 |
-
2021
- 2021-09-24 CN CN202111122251.3A patent/CN113855286B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN202146362U (zh) * | 2010-12-30 | 2012-02-22 | 上海交通大学医学院附属第九人民医院 | 一种基于光学导航七自由度颅颌面手术辅助机械臂 |
CN106061427A (zh) * | 2014-02-28 | 2016-10-26 | 索尼公司 | 机器人臂设备、机器人臂控制方法和程序 |
US20180168750A1 (en) * | 2016-12-16 | 2018-06-21 | Mako Surgical Corp. | Techniques for modifying tool operation in a surgical robotic system based on comparing actual and commanded states of the tool relative to a surgical site |
CN108705536A (zh) * | 2018-06-05 | 2018-10-26 | 雅客智慧(北京)科技有限公司 | 一种基于视觉导航的牙科机器人路径规划***及方法 |
CN112790783A (zh) * | 2021-03-05 | 2021-05-14 | 四川锋准机器人科技有限公司 | 匹配ct图像与定位被动式红外反光球位置的工具及方法 |
CN113303840A (zh) * | 2021-05-14 | 2021-08-27 | 北京大学第三医院 | 一种借助内窥镜的手术导航定位*** |
CN113400325A (zh) * | 2021-06-23 | 2021-09-17 | 四川锋准机器人科技有限公司 | 一种种植牙机器人导航定位方法 |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114454167B (zh) * | 2022-02-11 | 2024-06-07 | 四川锋准机器人科技有限公司 | 一种种植牙机器人末端夹持器几何尺寸的标定方法 |
CN114454167A (zh) * | 2022-02-11 | 2022-05-10 | 四川锋准机器人科技有限公司 | 一种种植牙机器人末端夹持器几何尺寸的标定方法 |
CN114521962A (zh) * | 2022-04-24 | 2022-05-24 | 杭州柳叶刀机器人有限公司 | 手术机器人轨迹跟踪方法、装置、机器人及存储介质 |
CN114767302A (zh) * | 2022-06-17 | 2022-07-22 | 杭州柳叶刀机器人有限公司 | 口腔机器人的控制方法、装置和电子设备 |
CN114767302B (zh) * | 2022-06-17 | 2022-11-01 | 杭州柳叶刀机器人有限公司 | 口腔机器人的控制方法、装置和电子设备 |
CN115252172A (zh) * | 2022-08-03 | 2022-11-01 | 北京大学口腔医学院 | 一种牙体预备机器人*** |
CN115229806A (zh) * | 2022-09-21 | 2022-10-25 | 杭州三坛医疗科技有限公司 | 一种机械臂控制方法、装置、***、设备及存储介质 |
CN115778602A (zh) * | 2023-02-06 | 2023-03-14 | 极限人工智能有限公司 | 一种车针校验方法、装置、存储介质及设备 |
CN116138905A (zh) * | 2023-03-07 | 2023-05-23 | 山东大学 | 一种机器人辅助正畸托槽粘结方法及粘接*** |
CN116747039A (zh) * | 2023-08-17 | 2023-09-15 | 深圳卡尔文科技有限公司 | 一种种植机器人位姿调整方法、***和存储介质 |
CN116747039B (zh) * | 2023-08-17 | 2023-10-31 | 深圳卡尔文科技有限公司 | 一种种植机器人位姿调整方法、***和存储介质 |
CN116785001B (zh) * | 2023-08-25 | 2023-10-31 | 深圳卡尔文科技有限公司 | 一种种植手术工具标定方法、***和存储介质 |
CN116785001A (zh) * | 2023-08-25 | 2023-09-22 | 深圳卡尔文科技有限公司 | 一种种植手术工具标定方法、***和存储介质 |
CN117204951A (zh) * | 2023-09-22 | 2023-12-12 | 上海睿触科技有限公司 | 一种基于x射线的手术定位导航设备及其定位实现方法 |
CN117204951B (zh) * | 2023-09-22 | 2024-04-30 | 上海睿触科技有限公司 | 一种基于x射线的手术定位导航设备及其定位实现方法 |
CN117137626A (zh) * | 2023-10-30 | 2023-12-01 | 北京三博脑科医院有限公司 | 一种神经外科手术机器人的无创注册方法 |
CN117137626B (zh) * | 2023-10-30 | 2024-04-12 | 北京三博脑科医院有限公司 | 一种神经外科手术机器人的无创注册方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113855286B (zh) | 2023-01-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113855286B (zh) | 一种种植牙机器人导航***及方法 | |
CN113400325B (zh) | 一种种植牙机器人导航定位方法 | |
JP6367905B2 (ja) | 定位手術用の手術ロボットシステム及び定位手術用ロボットの制御方法 | |
EP3254621B1 (en) | 3d image special calibrator, surgical localizing system and method | |
JP6678565B2 (ja) | 定位手術用の手術ロボット及び定位手術用の手術ロボットの制御方法 | |
CN110946653B (zh) | 一种手术导航*** | |
US9221176B2 (en) | Robot system and method for controlling the same | |
CN111345898B (zh) | 激光手术路径引导方法、及其计算机设备和*** | |
CN114711969A (zh) | 一种手术机器人***及其使用方法 | |
CN112603538A (zh) | 骨科导航定位***及方法 | |
CN113180828A (zh) | 基于旋量理论的手术机器人约束运动控制方法 | |
KR102601195B1 (ko) | 치과 로봇 및 구강 내비게이션 방법 | |
JP2010188439A (ja) | パラメータ算出方法及びパラメータ算出装置 | |
CN113855287B (zh) | 一种带评估种植精度的口腔种植手术机器人及控制方法 | |
CN112641512A (zh) | 一种应用于手术机器人前规划的空间配准方法 | |
CN115153925A (zh) | 一种口腔种植牙手术的钻头自动定位装置及方法 | |
Šuligoj et al. | Medical applicability of a low-cost industrial robot arm guided with an optical tracking system | |
CN115363762A (zh) | 手术机器人的摆位方法、装置及计算机设备 | |
CN116459010A (zh) | 一种口腔种植牙手术的随动装置及方法 | |
Tauscher et al. | High-accuracy drilling with an image guided light weight robot: autonomous versus intuitive feed control | |
CN116269812A (zh) | 主从操作的穿刺***和规划方法 | |
CN215778615U (zh) | 基于自定义标尺的一体化手术机器人术中配准*** | |
CN214857401U (zh) | 一体化***结构装置 | |
Yan et al. | The Dental Implant Robot System Based on Binocular Vision | |
CN117838311B (zh) | 基于光学定位的靶点消融呼吸门控*** |
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 |