CN108056819A - 一种用于医疗机器人的手术跟踪定位导航方法 - Google Patents
一种用于医疗机器人的手术跟踪定位导航方法 Download PDFInfo
- Publication number
- CN108056819A CN108056819A CN201611096776.3A CN201611096776A CN108056819A CN 108056819 A CN108056819 A CN 108056819A CN 201611096776 A CN201611096776 A CN 201611096776A CN 108056819 A CN108056819 A CN 108056819A
- Authority
- CN
- China
- Prior art keywords
- platform
- coordinate
- surgical instrument
- navigation
- point
- 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.)
- Pending
Links
- 230000004807 localization Effects 0.000 title claims abstract description 14
- 239000003550 marker Substances 0.000 claims abstract description 27
- 239000011324 bead Substances 0.000 claims abstract description 11
- 238000001356 surgical procedure Methods 0.000 claims abstract description 5
- 238000013507 mapping Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000003993 interaction Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000010276 construction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
本发明的目的是提出一种用于医疗机器人的手术跟踪定位导航方法,用于远程医疗系统中的遥控操作。本发明包括如下步骤:A:将手术对象固定在导航固定平台中,并将手术模型对象与空间配准平台固定;所述导航固定平台、空间配准平台设有位置对应的配准小球,以用于坐标配准;B:将手术器械简化为针轴,通过手术器械的针轴、针点对手术器械定位之后,利用视觉定位平台捕获并计算出手术器械在空间配准平台上的marker坐标系的坐标;C:将手术器械的针轴和针点转换到导航固定平台的三维坐标系下,通过双线程的方式,将手术器械坐标采集工作和机器人操作臂的实时跟踪工作同时运行,从而达到最终的手术跟踪定位导航的作用。
Description
技术领域
本发明属于远程医疗技术领域,具体涉及到一种用于医疗机器人的手术跟踪定位导航方法。
背景技术
在远程医疗系统中,医疗机器人的应用给医生提供了极大的方便。医疗机器人提供遥操作医疗设备的功能,位于偏远地区的医疗机器人通过网络端口接入网络,位于医疗水平发达地区的医生可以通过遥操作模块控制医疗机器人,而不需要亲自到现场去操作,这极大的方便了偏远地区病人的就医,减少了就医成本。
为了实现最终的手术空间导航定位,需要将真实手术空间中的手术器械相对于手术对象的位置和姿态转换到虚拟手术空间中,并且能够在虚拟的手术空间实时的显示和跟踪手术器械相对于手术模型的CT数据的位置,这就必须找出一种合适的用于医疗机器人的手术跟踪定位导航方法。
发明内容
本发明的目的是提出一种用于医疗机器人的手术跟踪定位导航方法,用于远程医疗系统中的遥控操作。
本发明的用于医疗机器人的手术跟踪定位导航方法包括如下步骤:
A:将手术对象固定在导航固定平台中,并将手术模型对象与空间配准平台固定;所述导航固定平台、空间配准平台设有位置对应的配准小球,以用于坐标配准;
B:将手术器械简化为针轴,通过手术器械的针轴、针点对手术器械定位之后,利用视觉定位平台捕获并计算出手术器械在空间配准平台上的marker坐标系的坐标;
C:将手术器械的针轴和针点转换到导航固定平台的三维坐标系下,通过双线程的方式,将手术器械坐标采集工作和机器人操作臂的实时跟踪工作同时运行,从而达到最终的手术跟踪定位导航的作用。
具体来说,B步骤中:根据手术器械的标定算法求针点和针轴,即两点point_base和point_up,其坐标为相对于手术器械本身的坐标系,手术器械本身的坐标系相对于视觉平台的转换矩阵为M1;
所述针点坐标point_base和针轴坐标point_up如下:point_base=(bx,by,bz)T,point_up=(ux,uy,uz)T,
计算手术器械上的针轴和针点坐标相对于视觉平台的坐标:
point_base_vision=M1*point_base
point_up_vision=M1*point_up
所述C步骤中:利用视觉定位平台实时地对空间配准平台上的marker坐标系进行定位跟踪,获得空间配准平台的marker坐标系相对于视觉平台的位姿矩阵M2,另外,空间配准平台的marker坐标系与导航固定平台中的配准小球对应的坐标系之间有平移的变换为T,为了将point_base_vision和point_up_vision映射到真实的配准平台marker坐标系下,进行如下的变换方式:
再将空间配准平台的marker坐标系下的针点和针轴坐标转换到导航固定平台的配准小球的坐标系下,变换方式如下:
其中为导航固定平台的配准小球坐标系和空间配准平台的marker坐标系之间的平移矩阵;
将空间配准平台的marker坐标系下的手术器械的针点和针轴映射到导航固定平台的三维空间中,采用的配准算法为func(aim_point,P_Xct,P_Yct,P_Zct),则:
得到如下的计算公式:
最后利用人机交互功能,在虚拟三维手术环境中,实现实时的显示point_base_ct和point_up_ct两点,并且连线,完成跟踪导航显示的功能。
本发明通过位置对应的配准小球,构建了可以互相转化的空间配准平台的marker坐标系及导航固定平台的坐标系,从而将空间配准平台坐标系中的手术器械的坐标、动作转化为导航固定平台的坐标系中的机器人操作臂的坐标、动作,实现了跟踪导航显示的功能。
具体实施方式
下面通过对实施实例的描述,对本发明的具体实施方式如所涉及的各构件的形状、构造、各部分之间的相互位置及连接关系、各部分的作用及工作原理等作进一步的详细说明。
实施例1:
本实施例的用于医疗机器人的手术跟踪定位导航方法包括如下步骤:
A:将手术对象固定在导航固定平台中,并将手术模型对象与空间配准平台固定;所述导航固定平台、空间配准平台设有位置对应的配准小球,以用于坐标配准;
B:将手术器械简化为针轴,通过手术器械的针轴、针点对手术器械定位之后,利用视觉定位平台捕获手术器械在空间配准平台上的marker坐标系的坐标,通过计算将手术器械的针轴和针点位置转换到marker坐标系下;
C:将手术器械的针轴和针点转换到导航固定平台的三维坐标系下,通过双线程的方式,将手术器械坐标采集工作和机器人操作臂的实时跟踪工作同时运行,从而达到最终的手术跟踪定位导航的作用。
具体来说,B步骤中:根据手术器械的标定算法求针点和针轴,即两点point_base和point_up,其坐标为相对于手术器械本身的坐标系,手术器械本身的坐标系相对于视觉平台的转换矩阵为M1;
所述针点坐标point_base和针轴坐标point_up如下:point_base=(bx,by,bz)T,point_up=(ux,uy,uz)T,
计算手术器械上的针轴和针点坐标相对于视觉平台的坐标:
point_base_vision=M1*point_base
point_up_vision=M1*point_up
所述C步骤中:利用视觉定位平台实时地对空间配准平台上的marker坐标系进行定位跟踪,获得空间配准平台的marker坐标系相对于视觉平台的位姿矩阵M2,另外,空间配准平台的marker坐标系与导航固定平台中的配准小球对应的坐标系之间有平移的变换为T,为了将point_base_vision和point_up_vision映射到真实的配准平台marker坐标系下,进行如下的变换方式:
再将空间配准平台的marker坐标系下的针点和针轴坐标转换到导航固定平台的配准小球的坐标系下,变换方式如下:
其中为导航固定平台的配准小球坐标系和空间配准平台的marker坐标系之间的平移矩阵;
将空间配准平台的marker坐标系下的手术器械的针点和针轴映射到导航固定平台的三维空间中,采用的配准算法为func(aim_point,P_Xct,P_Yct,P_Zct),则:
得到如下的计算公式:
最后利用人机交互功能,在虚拟三维手术环境中,实现实时的显示point_base_ct和point_up_ct两点,并且连线,完成跟踪导航显示的功能。
Claims (2)
1.一种用于医疗机器人的手术跟踪定位导航方法,其特征在于包括如下步骤:
A:将手术对象固定在导航固定平台中,并将手术模型对象与空间配准平台固定;所述导航固定平台、空间配准平台设有位置对应的配准小球,以用于坐标配准;
B:将手术器械简化为针轴,通过手术器械的针轴、针点对手术器械定位之后,利用视觉定位平台捕获并计算出手术器械在空间配准平台上的marker坐标系的坐标;
C:将手术器械的针轴和针点转换到导航固定平台的三维坐标系下,通过双线程的方式,将手术器械坐标采集工作和机器人操作臂的实时跟踪工作同时运行,从而达到最终的手术跟踪定位导航的作用。
2.根据权利要求1所述的用于医疗机器人的手术跟踪定位导航方法,其特征在于B步骤中:根据手术器械的标定算法求针点和针轴,即两点point_base和point_up,其坐标为相对于手术器械本身的坐标系,手术器械本身的坐标系相对于视觉平台的转换矩阵为M1;
所述针点坐标point_base和针轴坐标point_up如下:
,
计算手术器械上的针轴和针点坐标相对于视觉平台的坐标:
所述C步骤中:利用视觉定位平台实时地对空间配准平台上的marker坐标系进行定位跟踪,获得空间配准平台的marker坐标系相对于视觉平台的位姿矩阵M2,另外,空间配准平台的marker坐标系与导航固定平台中的配准小球对应的坐标系之间有平移的变换为T,为了将point_base_vision和point_up_vision映射到真实的配准平台marker坐标系下,进行如下的变换方式:
;
;
再将空间配准平台的marker坐标系下的针点和针轴坐标转换到导航固定平台的配准小球的坐标系下,变换方式如下:
;
其中为导航固定平台的配准小球坐标系和空间配准平台的marker坐标系之间的平移矩阵;
将空间配准平台的marker坐标系下的手术器械的针点和针轴映射到导航固定平台的三维空间中,采用的配准算法为,则:
;
得到如下的计算公式:
;
最后利用人机交互功能,在虚拟三维手术环境中,实现实时的显示point_base_ct和point_up_ct两点,并且连线,完成跟踪导航显示的功能。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611096776.3A CN108056819A (zh) | 2016-12-02 | 2016-12-02 | 一种用于医疗机器人的手术跟踪定位导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611096776.3A CN108056819A (zh) | 2016-12-02 | 2016-12-02 | 一种用于医疗机器人的手术跟踪定位导航方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108056819A true CN108056819A (zh) | 2018-05-22 |
Family
ID=62136716
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611096776.3A Pending CN108056819A (zh) | 2016-12-02 | 2016-12-02 | 一种用于医疗机器人的手术跟踪定位导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108056819A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109124769A (zh) * | 2018-09-10 | 2019-01-04 | 上海电气集团股份有限公司 | 手术机器人的坐标系标定、控制的方法及系统 |
CN109692050A (zh) * | 2018-12-26 | 2019-04-30 | 雅客智慧(北京)科技有限公司 | 一种牙科种植导航手术的标定、追踪方法和装置 |
CN109938842A (zh) * | 2019-04-18 | 2019-06-28 | 王小丽 | 面部外科手术定位导航方法及装置 |
CN110123452A (zh) * | 2019-05-08 | 2019-08-16 | 上海电气集团股份有限公司 | 机器人的导航方法及系统 |
CN110215284A (zh) * | 2019-06-06 | 2019-09-10 | 上海木木聚枞机器人科技有限公司 | 一种可视化系统和方法 |
CN110561413A (zh) * | 2018-06-05 | 2019-12-13 | 上海联影医疗科技有限公司 | 坐标系配准工具 |
CN111035452A (zh) * | 2019-12-27 | 2020-04-21 | 苏州微创畅行机器人有限公司 | 定位工具、机械臂系统、手术系统以及注册配准方法 |
-
2016
- 2016-12-02 CN CN201611096776.3A patent/CN108056819A/zh active Pending
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110561413B (zh) * | 2018-06-05 | 2021-05-18 | 上海联影医疗科技股份有限公司 | 坐标系配准工具 |
CN110561413A (zh) * | 2018-06-05 | 2019-12-13 | 上海联影医疗科技有限公司 | 坐标系配准工具 |
CN109124769A (zh) * | 2018-09-10 | 2019-01-04 | 上海电气集团股份有限公司 | 手术机器人的坐标系标定、控制的方法及系统 |
CN109692050A (zh) * | 2018-12-26 | 2019-04-30 | 雅客智慧(北京)科技有限公司 | 一种牙科种植导航手术的标定、追踪方法和装置 |
US12011230B2 (en) | 2018-12-26 | 2024-06-18 | Beijing Yakebot Technology Co., Ltd. | Calibration method and device for dental implant navigation surgery, and tracking method and device for dental implant navigation surgery |
CN109692050B (zh) * | 2018-12-26 | 2020-05-22 | 雅客智慧(北京)科技有限公司 | 一种牙科种植导航手术的标定、追踪方法和装置 |
CN109938842A (zh) * | 2019-04-18 | 2019-06-28 | 王小丽 | 面部外科手术定位导航方法及装置 |
CN109938842B (zh) * | 2019-04-18 | 2021-07-30 | 雅客智慧(北京)科技有限公司 | 面部外科手术定位导航方法及装置 |
CN110123452A (zh) * | 2019-05-08 | 2019-08-16 | 上海电气集团股份有限公司 | 机器人的导航方法及系统 |
CN110215284B (zh) * | 2019-06-06 | 2021-04-02 | 上海木木聚枞机器人科技有限公司 | 一种可视化系统和方法 |
CN110215284A (zh) * | 2019-06-06 | 2019-09-10 | 上海木木聚枞机器人科技有限公司 | 一种可视化系统和方法 |
CN111035452B (zh) * | 2019-12-27 | 2021-07-02 | 苏州微创畅行机器人有限公司 | 定位工具、机械臂系统、手术系统以及注册配准方法 |
CN111035452A (zh) * | 2019-12-27 | 2020-04-21 | 苏州微创畅行机器人有限公司 | 定位工具、机械臂系统、手术系统以及注册配准方法 |
US11981037B2 (en) | 2019-12-27 | 2024-05-14 | Suzhou MicroPort Orthobot Co., Ltd. | Positioning tool, robotic arm system and registration method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108056819A (zh) | 一种用于医疗机器人的手术跟踪定位导航方法 | |
CA3034314C (en) | Methods and systems for registration of virtual space with real space in an augmented reality system | |
US11432879B2 (en) | Method and apparatus for wide area multi-body 6D pose tracking system | |
EP3254621B1 (en) | 3d image special calibrator, surgical localizing system and method | |
CN103211655B (zh) | 一种骨科手术导航系统及导航方法 | |
US20170042625A1 (en) | Robotic interface positioning determination systems and methods | |
WO2022218389A1 (zh) | 超声与x光组合执行操作的方法、装置、系统及计算机可读存储介质 | |
CN110916799A (zh) | 基于5g网络的穿刺机器人导航系统 | |
CN104039259A (zh) | 用于外科手术工具追踪的系统 | |
KR20080027256A (ko) | 최소침습 로봇수술 동안 센서 및/또는 카메라로부터 도출된데이터와의 융합에 의한 3차원 툴 추적을 수행하기 위한방법 및 시스템 | |
CN103519895A (zh) | 一种骨科手术辅助导引方法 | |
CN204655073U (zh) | 一种骨科手术导航系统 | |
EP3212104B1 (en) | Hybrid navigation system for surgical interventions | |
CN204542390U (zh) | 一种基于增强现实的力反馈手术机器人控制系统 | |
CN113208731A (zh) | 基于双目视觉系统的手术穿刺机器人手眼标定方法 | |
Haliburton et al. | A visual odometry base-tracking system for intraoperative C-arm guidance | |
TW201519856A (zh) | 手術定位方法 | |
US20240164844A1 (en) | Bone landmarks extraction by bone surface palpation using ball tip stylus for computer assisted surgery navigation | |
CN114668460A (zh) | 穿刺针空间位姿统一方法及系统 | |
CN114587592A (zh) | 一种手术导航系统及其使用方法 | |
CN109793558A (zh) | 基于双目视觉定位的穿刺手术空间映射方法 | |
Wang et al. | Augmented reality provision in robotically assisted minimally invasive surgery | |
CN117679178B (zh) | 一种创伤骨科微创手术机器人系统 | |
Ho et al. | Supervised control for robot-assisted surgery using augmented reality | |
CN218528879U (zh) | 一种骨科手术机器人示踪装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20180704 Address after: 510000 A20, No. 1601, Part 8, Pearl River West Road, Tianhe District, Guangzhou, Guangdong (No. 1603A), for office use only. Applicant after: Guangzhou Key Technology Co., Ltd. Address before: 510510 room 2405, No. 103 Jingxi Road, Guangzhou, Guangdong Applicant before: Wang Jian |
|
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180522 |