CN108324373B - 一种基于电磁定位系统的穿刺手术机器人精确定位实现方法 - Google Patents
一种基于电磁定位系统的穿刺手术机器人精确定位实现方法 Download PDFInfo
- Publication number
- CN108324373B CN108324373B CN201810222617.6A CN201810222617A CN108324373B CN 108324373 B CN108324373 B CN 108324373B CN 201810222617 A CN201810222617 A CN 201810222617A CN 108324373 B CN108324373 B CN 108324373B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- robot
- calculating
- sensor
- transformation matrix
- 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
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/34—Trocars; Puncturing needles
- A61B17/3403—Needle locating or guiding means
-
- 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
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/70—Manipulators specially adapted for use in surgery
-
- 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
- A61B2034/2046—Tracking techniques
- A61B2034/2051—Electromagnetic tracking systems
Landscapes
- Health & Medical Sciences (AREA)
- Surgery (AREA)
- Life Sciences & Earth Sciences (AREA)
- Engineering & Computer Science (AREA)
- Medical Informatics (AREA)
- Biomedical Technology (AREA)
- Heart & Thoracic Surgery (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Robotics (AREA)
- Pathology (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于电磁定位系统的穿刺手术机器人精确定位实现方法,可应用于穿刺手术机器人,属于机器人控制领域。该方法包括以下步骤:(1)通过磁场导航装置获得电磁发生器坐标系和传感器坐标系间的变换矩阵;(2)通过机器人运动学模型计算机器人坐标系与传感器坐标系之间的变换矩阵;(3)计算电磁发生器坐标系和穿刺手术机器人坐标系间的变换矩阵;(4)对机器人工作空间进行分割和采样,获得采样点的误差信息;(5)应用空间插值方法对目标点进行误差补偿。采用此方法,可以减小手术机器人的定位误差,实现精确定位。具有精度高、成本低、计算简单等优点。
Description
技术领域
本发明涉及一种基于磁场导航装置的机器人精确定位的实现方法,特别涉及一种应用空间插值方法对机器人进行定位误差补偿的实现技术,可应用于穿刺手术机器人,属于机器人控制领域。
背景技术
在复杂的手术环境中,穿刺手术机器人系统的精确空间定位是一个关键问题。磁定位器作为一种新式传感器,可以实现非接触式测量,并且不受遮挡影响,特别适合在手术室等人员密集的复杂环境下应用。它价格相对较低,使用方便,被广泛采用。但其应用于手术机器人领域时,定位精度较低,不能满足高精度手术的要求。
文献“刘少丽,杨向东,吴聊,等.基于磁定位器的微创手术机器人空间定位方法研究[J].机械设计与制造,2011(12):1-3.”提出了一种微创手术机器人空间定位方法,该方法利用了传统的奇异值分解的方法实现磁定位发射器空间和机器人空间的配准,但此方法存在以下两点不足:计算复杂、定位精度不够高。
申请号为201310451794.9,公开了一种用于工业机器人的基于模糊神经网络的标定误差补偿方法,但该方法需要使用激光跟踪仪测量机器人位姿,无法应用于手术环境中,且需要的采样点较多,计算量大。
发明内容
本发明的目的是为了克服现有的手术机器人末端精确定位的技术缺陷,能够在保证机器人定位精度满足要求的同时尽量降低运算量、成本也不会太高,采用了电磁定位系统完成空间配准,提出了一种基于空间插值方法的机器人定位误差补偿模型,实现机器人的精确定位,满足实际手术的需要。
本发明的目的是通过以下技术方案实现的。
本发明的一种基于电磁定位系统的机器人精确定位实现方法,其实现平台是由磁场导航装置和机械臂组成的穿刺手术机器人系统,磁场导航装置通过采集贴在人体上的传感器位置信息和手术针末端的传感器位置信息,完成系统的配准和导航功能。
一种基于电磁定位系统的穿刺手术机器人精确定位实现方法,该方法包括1、计算机器人坐标系与传感器坐标系之间的变换矩阵的步骤;进一步的,包括通过手术针末端传感器的信息建立一个和手术针末端坐标系重合的传感器坐标系,计算机器人坐标系与传感器坐标系之间的变换矩阵;根据机器人的运动学方程计算机器人坐标系与传感器坐标系之间的变换矩阵。
3、包括对机器人工作空间进行分割和采样,获得采样点的误差信息的步骤;是将机器人工作空间分割成若干个边长相等的立方体,对每个立方体的顶点进行采样,根据机器人运动学方程计算出各顶点在机器人坐标系下的位置矢量,再通过电磁发生器采集到的传感器数据计算出在磁场坐标系下的位置矢量。
4、包括计算每个采样点的位置误差矢量的步骤;位置误差矢量ΔMPi计算如下:
MPi'=RRPi+P
ΔMPi=MPi'-MPi。
求得位置误差矢量后,对目标点的给定位置坐标进行修正,用修正后的坐标驱动机器人到达目标点。
6、进一步的,还包括通过磁场导航装置获得电磁发生器坐标系和传感器坐标系间的变换矩阵的步骤。
本发明的积极效果:本发明提出了一种基于电磁定位系统的机器人精确定位实现方法,该方法属于机器人定位领域,可应用于穿刺手术机器人定位,极大地减小了配准误差,提高了机器人的定位精度,同时具有运算量小、计算速度快、实现成本低的特点,可以满足手术机器人的实际需求。
附图说明
图1为穿刺手术机器人定位及误差补偿流程示意图;
图2为手术机器人坐标变换矩阵示意图;
具体实施方式
为了更清楚地说明本发明的目的、技术方案与优点,以下结合附图及实施例,对本发明进行进一步的详细说明。
实施例:
参见附图1,本发明方法包括以下步骤:通过磁定位器获得磁场与传感器间变换矩阵;计算机器人末端的运动学方程;计算电磁发生器与机器人间的变换矩阵;对机器人工作空间进行分割和采样,计算采样点误差;对目标点进行误差补偿。
同时参见附图2,所述方法的具体步骤如下:
(4)将机器人工作空间分割成若干个边长相等的立方体,对每个立方体的顶点进行采样。将操作臂依次运动到各顶点K1-K8,根据机器人运动学方程计算出K1-K8在机器人坐标系下的位置矢量RPi,再通过电磁发生器采集到的传感器数据计算出在磁场坐标系下的位置矢量MPi。
(5)计算每个采样点的位置误差矢量ΔMPi。
MPi'=RRPi+P
ΔMPi=MPi'-MPi
(6)对于目标点K,确定其位于工作空间的某一立方体内,根据K点与其立方体的采样点的距离di,计算各个采样点对K点的误差补偿权值。
(7)计算K点的位置误差矢量。
(8)求得位置误差矢量后,对K点的给定位置坐标进行修正,用修正后的坐标驱动机器人到达目标点。
需要说明的是,本发明的实施例仅仅用于对本发明技术方案进行说明,并非仅仅限于实施例的描述。本发明涉及到的是应用空间插值方法对机器人进行定位误差补偿的实现技术,属于机器人控制领域,实现机器人的机械臂端部的精确定位,可应用于各种广泛的领域中。本发明中提到了穿刺手术机器人手术针末端的定位,仅仅是通过实例对本发明的构思及技术方案进行说明,并非属于针对疾病的诊断及治疗方法。
Claims (4)
1.一种基于电磁定位系统的穿刺手术机器人精确定位装置,其特征是:包括穿刺手术机器人系统、磁场发生器、手术针末端传感器,所述的穿刺手术机器人系统由磁场导航装置和机械臂组成,其中磁场导航装置用于采集贴在人体上的传感器位置信息和手术针末端的传感器位置信息,完成系统的配准和导航功能,装置的定位实现方法如下:
包括计算机器人坐标系与传感器坐标系之间的变换矩阵的步骤;
包括计算电磁发生器坐标系和穿刺手术机器人坐标系间的变换矩阵的步骤;
包括对机器人工作空间进行分割和采样,获得采样点的误差信息的步骤;
包括计算每个采样点的位置误差矢量的步骤;
包括应用空间插值方法对目标点进行误差补偿的步骤;
穿刺手术机器人坐标系与传感器坐标系之间的变换矩阵的步骤中,包括通过手术针末端传感器的信息建立一个和手术针末端坐标系重合的传感器坐标系,计算穿刺手术机器人坐标系与传感器坐标系之间的变换矩阵;根据机器人的运动学方程计算机器人坐标系与传感器坐标系之间的变换矩阵;
对机器人工作空间进行分割和采样,获得采样点的误差信息的步骤中,是将机器人工作空间分割成若干个边长相等的立方体,对每个立方体的顶点进行采样,根据机器人运动学方程计算出各顶点在机器人坐标系下的位置矢量,再通过电磁发生器采集到的传感器数据计算出在磁场坐标系下的位置矢量。
4.根据权利要求1所述的基于电磁定位系统的穿刺手术机器人精确定位装置,其特征是:磁场导航装置获得电磁发生器坐标系和传感器坐标系间的变换矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810222617.6A CN108324373B (zh) | 2018-03-19 | 2018-03-19 | 一种基于电磁定位系统的穿刺手术机器人精确定位实现方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810222617.6A CN108324373B (zh) | 2018-03-19 | 2018-03-19 | 一种基于电磁定位系统的穿刺手术机器人精确定位实现方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108324373A CN108324373A (zh) | 2018-07-27 |
CN108324373B true CN108324373B (zh) | 2020-11-27 |
Family
ID=62930921
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810222617.6A Active CN108324373B (zh) | 2018-03-19 | 2018-03-19 | 一种基于电磁定位系统的穿刺手术机器人精确定位实现方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108324373B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109623813B (zh) * | 2018-12-10 | 2021-09-10 | 国电南瑞科技股份有限公司 | 配电线路带电作业机器人作业末端的磁场定位及路径规划方法 |
CN109620408B (zh) * | 2018-12-10 | 2020-06-19 | 华南理工大学 | 一种基于电磁定位的增强现实手术导航系统标定方法 |
CN109806003B (zh) * | 2019-01-30 | 2021-08-06 | 杭州键嘉机器人有限公司 | 执行杆、采用该执行杆的手术机器人及机器人定位方法 |
CN109974584B (zh) * | 2019-04-12 | 2020-03-20 | 山东大学 | 一种辅助激光截骨手术机器人的标定系统及标定方法 |
CN110448359B (zh) * | 2019-08-02 | 2021-05-14 | 中国人民解放军总医院 | 提高经颈静脉肝内门体分流术成功率的手术导航设备及其应用 |
CN112605995B (zh) * | 2020-12-15 | 2022-04-22 | 山东威高医疗科技有限公司 | 一种基于磁场发射器的机械臂运动标定方法 |
CN113367795A (zh) * | 2021-05-31 | 2021-09-10 | 浙江大学 | 一种具有磁定位功能的输尿管软镜及输尿管镜位姿估测系统 |
CN114159163B (zh) * | 2021-12-13 | 2022-09-16 | 南开大学 | 面向软镜的磁导航系统 |
CN114305686B (zh) * | 2021-12-20 | 2024-07-16 | 杭州堃博生物科技有限公司 | 基于磁传感器的定位处理方法、装置、设备与介质 |
CN115245387B (zh) * | 2022-09-22 | 2022-12-20 | 深圳市爱博医疗机器人有限公司 | 细长型医疗器械递送系统、递送方法、设备及介质 |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1650813A (zh) * | 2005-02-06 | 2005-08-10 | 天津市华志计算机应用有限公司 | 外科手术导航系统基于光学定位的机器人手术定位方法 |
CN101803952A (zh) * | 2010-03-05 | 2010-08-18 | 南开大学 | Ct图像导航脊柱微创手术机器人运动控制系统 |
WO2013075500A1 (zh) * | 2011-11-27 | 2013-05-30 | Zhang Chunlin | 随动式脊柱自定位导航手术机器手及其定位方法 |
WO2014155257A1 (en) * | 2013-03-28 | 2014-10-02 | Koninklijke Philips N.V. | Localization of robotic remote center of motion point using custom trocar |
CN104248471A (zh) * | 2013-06-27 | 2014-12-31 | 中国科学院沈阳自动化研究所 | 一种机器人辅助斜尖柔性针穿刺系统及方法 |
CN104516268A (zh) * | 2013-09-28 | 2015-04-15 | 沈阳新松机器人自动化股份有限公司 | 一种基于模糊神经网络的机器人标定误差补偿方法 |
CN104684502A (zh) * | 2012-09-26 | 2015-06-03 | 史赛克公司 | 包括光学传感器和非光学传感器的导航系统 |
CN104827480A (zh) * | 2014-02-11 | 2015-08-12 | 泰科电子(上海)有限公司 | 机器人系统的自动标定方法 |
WO2016033090A1 (en) * | 2014-08-25 | 2016-03-03 | Covidien Lp | System and method for planning, monitoring, and confirming treatment |
CN106063726A (zh) * | 2016-05-24 | 2016-11-02 | 中国科学院苏州生物医学工程技术研究所 | 实时穿刺导航系统及其导航方法 |
CN106132323A (zh) * | 2014-03-24 | 2016-11-16 | 皇家飞利浦有限公司 | 用于电磁跟踪系统的质量保证和数据协调 |
WO2017074977A1 (en) * | 2015-10-30 | 2017-05-04 | Acclarent, Inc. | System and method for navigation of surgical instruments |
CN107205786A (zh) * | 2015-02-25 | 2017-09-26 | 马科外科公司 | 用于在外科手术过程中减少跟踪中断的导航系统和方法 |
EP3289995A1 (en) * | 2016-08-29 | 2018-03-07 | Covidien LP | Systems, methods, and computer-readable media of providing distance, orientation feedback and motion compensation while navigating 3d |
-
2018
- 2018-03-19 CN CN201810222617.6A patent/CN108324373B/zh active Active
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1650813A (zh) * | 2005-02-06 | 2005-08-10 | 天津市华志计算机应用有限公司 | 外科手术导航系统基于光学定位的机器人手术定位方法 |
CN101803952A (zh) * | 2010-03-05 | 2010-08-18 | 南开大学 | Ct图像导航脊柱微创手术机器人运动控制系统 |
WO2013075500A1 (zh) * | 2011-11-27 | 2013-05-30 | Zhang Chunlin | 随动式脊柱自定位导航手术机器手及其定位方法 |
CN104684502A (zh) * | 2012-09-26 | 2015-06-03 | 史赛克公司 | 包括光学传感器和非光学传感器的导航系统 |
WO2014155257A1 (en) * | 2013-03-28 | 2014-10-02 | Koninklijke Philips N.V. | Localization of robotic remote center of motion point using custom trocar |
CN104248471A (zh) * | 2013-06-27 | 2014-12-31 | 中国科学院沈阳自动化研究所 | 一种机器人辅助斜尖柔性针穿刺系统及方法 |
CN104516268A (zh) * | 2013-09-28 | 2015-04-15 | 沈阳新松机器人自动化股份有限公司 | 一种基于模糊神经网络的机器人标定误差补偿方法 |
CN104827480A (zh) * | 2014-02-11 | 2015-08-12 | 泰科电子(上海)有限公司 | 机器人系统的自动标定方法 |
CN106132323A (zh) * | 2014-03-24 | 2016-11-16 | 皇家飞利浦有限公司 | 用于电磁跟踪系统的质量保证和数据协调 |
WO2016033090A1 (en) * | 2014-08-25 | 2016-03-03 | Covidien Lp | System and method for planning, monitoring, and confirming treatment |
CN107205786A (zh) * | 2015-02-25 | 2017-09-26 | 马科外科公司 | 用于在外科手术过程中减少跟踪中断的导航系统和方法 |
WO2017074977A1 (en) * | 2015-10-30 | 2017-05-04 | Acclarent, Inc. | System and method for navigation of surgical instruments |
CN106063726A (zh) * | 2016-05-24 | 2016-11-02 | 中国科学院苏州生物医学工程技术研究所 | 实时穿刺导航系统及其导航方法 |
EP3289995A1 (en) * | 2016-08-29 | 2018-03-07 | Covidien LP | Systems, methods, and computer-readable media of providing distance, orientation feedback and motion compensation while navigating 3d |
Non-Patent Citations (5)
Title |
---|
《基于磁定位器的微创手术机器人空间定位方法研究》;刘少丽,杨向东,吴聊,陈恳;《机械设计与制造》;20111231(第12期);全文 * |
《微创手术机器人定位系统的实用设计》;向茜,王世庆,李兴红,李建;《计算机仿真》;20160831;第33卷(第8期);全文 * |
《脊柱微创手术机器人运动控制系统的设计》;宋银灏,安刚,张建勋,张娜,袁丰华;《计算机工程与应用》;20100511;第46卷(第14期);全文 * |
《腹腔镜微创外科手术机器人控制系统研究》;鞠浩;《中国博士学位论文全文数据库(电子期刊)》;20100730;全文 * |
Dispersion compensation for an ultrathin metal film using LCD-CCD system;Dai Yu,Zhang Jian-Xu;《Chin.Phys.B》;20121015;第21卷(第10期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN108324373A (zh) | 2018-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108324373B (zh) | 一种基于电磁定位系统的穿刺手术机器人精确定位实现方法 | |
CN109822574B (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
CN109794963B (zh) | 一种面向曲面构件的机器人快速定位方法 | |
CN113160334B (zh) | 一种基于手眼相机的双机器人系统标定方法 | |
CN111618859A (zh) | 一种对于静止或低速工况下机械臂高精度力反馈的方法 | |
Li et al. | Efficient industrial robot calibration via a novel unscented Kalman filter-incorporated variable step-size Levenberg–Marquardt algorithm | |
CN103878770A (zh) | 基于速度估计的空间机器人视觉时延误差补偿方法 | |
CN113733088B (zh) | 一种基于双目视觉的机械臂运动学自标定方法 | |
CN111216138A (zh) | 机器人标定方法、机器人标定系统及可读存储介质 | |
Zhang et al. | A simultaneous optimization method of calibration and measurement for a typical hand–eye positioning system | |
CN114454174B (zh) | 机械臂动作捕捉方法、介质、电子设备及系统 | |
CN113843792B (zh) | 一种手术机器人的手眼标定方法 | |
CN111489399A (zh) | 一种视觉跟踪组件安装参数标定装置和方法 | |
CN113211445A (zh) | 一种机器人参数标定方法、装置、设备及存储介质 | |
CN113799127B (zh) | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 | |
CN114711968A (zh) | 一种基于手术机器人系统的无标定靶区定位跟踪方法 | |
CN110900608B (zh) | 基于最优测量构型选择的机器人运动学标定方法 | |
CN116942314A (zh) | 光学定位和机械定位混合的定位方法及系统 | |
CN115493616B (zh) | 一种激光跟踪姿态角现场精度的评定方法 | |
CN113822934B (zh) | 基于逆投影的多特征融合视觉定位方法 | |
Yan et al. | An uncalibrated and accurate robotic puncture method under respiratory motion | |
CN115609586A (zh) | 一种基于抓取位姿约束的机器人高精度装配方法 | |
Wang et al. | Fast and Accurate 3D Eye-to-hand calibration for large-scale scene based on HALCON | |
CN112545652A (zh) | 一种微创手术机器人柔性丝传动手术器械高精度控制方法 | |
Li et al. | An automatic high-precision calibration method of legs and feet for quadruped robots using machine vision and artificial neural networks |
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 |