CN118806387A - 基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置 - Google Patents

基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置 Download PDF

Info

Publication number
CN118806387A
CN118806387A CN202310461040.5A CN202310461040A CN118806387A CN 118806387 A CN118806387 A CN 118806387A CN 202310461040 A CN202310461040 A CN 202310461040A CN 118806387 A CN118806387 A CN 118806387A
Authority
CN
China
Prior art keywords
module
imu
inertial navigation
installation device
module installation
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
Application number
CN202310461040.5A
Other languages
English (en)
Inventor
王琳
王烨
李光林
杜世伟
张一栏
庄云集
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen Institute of Advanced Technology of CAS
Original Assignee
Shenzhen Institute of Advanced Technology of CAS
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shenzhen Institute of Advanced Technology of CAS filed Critical Shenzhen Institute of Advanced Technology of CAS
Priority to CN202310461040.5A priority Critical patent/CN118806387A/zh
Publication of CN118806387A publication Critical patent/CN118806387A/zh
Pending legal-status Critical Current

Links

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B17/00Surgical instruments, devices or methods
    • A61B17/34Trocars; Puncturing needles
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B17/00Surgical instruments, devices or methods
    • A61B17/34Trocars; Puncturing needles
    • A61B17/3403Needle locating or guiding means
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/10Computer-aided planning, simulation or modelling of surgical operations
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/20Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B90/00Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
    • A61B90/50Supports for surgical instruments, e.g. articulated arms
    • GPHYSICS
    • G16INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
    • G16HHEALTHCARE INFORMATICS, i.e. INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR THE HANDLING OR PROCESSING OF MEDICAL OR HEALTHCARE DATA
    • G16H40/00ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices
    • G16H40/60ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices for the operation of medical equipment or devices
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/10Computer-aided planning, simulation or modelling of surgical operations
    • A61B2034/107Visualisation of planned trajectories or target regions
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/10Computer-aided planning, simulation or modelling of surgical operations
    • A61B2034/108Computer aided selection or customisation of medical implants or cutting guides

Landscapes

  • Health & Medical Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Biomedical Technology (AREA)
  • Public Health (AREA)
  • General Health & Medical Sciences (AREA)
  • Medical Informatics (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Molecular Biology (AREA)
  • Animal Behavior & Ethology (AREA)
  • Veterinary Medicine (AREA)
  • Pathology (AREA)
  • Robotics (AREA)
  • Primary Health Care (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Epidemiology (AREA)
  • General Business, Economics & Management (AREA)
  • Business, Economics & Management (AREA)
  • Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)

Abstract

本发明涉及一种基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及瞄准器,包括:设计模块安装装置,将三个IMU模块安装在模块安装装置上,三个IMU模块绕模块安装装置中心位置中心对称且各相差60度;设计辅具,将模块安装装置可拆卸地连接在辅具上,模块安装装置在辅具的辅助下具有3个转动自由度;基于惯性导航技术,使用模块安装装置实时获取穿刺针的方向角度,结合术前规划的穿刺路径的方向角度,实现术中精准导航。本发明通过将多个惯性传感模块与一种个性化定制的机械结构集成使用,旨在解决含有惯性传感模块的穿刺导引装置在三维空间中由人手操控移动行进时容易产生方向角度偏移失准的问题。

Description

基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置
技术领域
本发明涉及颅内血肿微创清除术辅助机器人领域,具体而言,涉及一种基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置。
背景技术
世界卫生组织在2020年底报道指出,脑卒中(Stroke,又叫中风)成为近年来仅次于心脏病的全球第二大致死病因,2019年统计有超过600万人死于该病,占全球总死亡人数的11%。它是一种急性脑血管疾病,主要分为缺血性和出血性脑卒中(CerebralHemorrhage,又叫脑出血或脑溢血),其中后者死亡率较高。而颅内血肿(ICH,IntracranialHematoma)的形成不仅限于脑出血,也可能由外伤所致。因此,针对颅内血肿此类高危疾病,在神经内科保守药物治疗未见成效的情况下,必须及时进行颅内血肿清除手术,例如微创置管引流术等。但如果缺少神经外科导航系统的有效辅助,则会给患者带来极大的手术风险与病痛折磨。这就更加凸显了神经外科导航系统的重要作用。
对于开颅式颅内血肿清除方法,患者不仅要承受巨大痛苦,而且手术极易诱发感染,手术失败率高,即使手术成功也容易引起一些术后并发症,影响治愈效果。随着最近几十年医学成像技术的蓬勃发展,微创手术时代开启。很多颅内血肿患者可以接受微创置管引流术的治疗,该方法要求对颅内血肿进行精确定位。常见的颅内血肿定位方法包括徒手解剖标志定位、有框架和无框架的立体定向导航(机械式、光学或电磁等)、智能手持设备陀螺仪定位、智能手持设备增强现实定位、头戴式混合现实定位等。方法很多但万变不离其宗,无论传统的徒手解剖标志定位法,还是先进的导航设备辅助定位法,都必须先在术前规划好穿刺路径。医生根据CT或MRI的医学影像信息构造出的颅内三维“地图”并结合解剖学知识,制定一条最佳穿刺路径,然后在术中使穿刺导引装置(穿刺针)尽可能按照规划路径行进,最终命中病灶靶点。
徒手解剖标志定位法不依赖任何导航辅助设备,仅需在患者剃光的头部遵循解剖学知识进行标志描绘,而后纯粹凭借主刀医生的个人经验实施穿刺手术,这就导致该方法的稳定性、传承性和普及性都很差。有框架的立体定向导航需要将患者头部硬性固定,也就是说,需要在患者头部打颅骨固定钉,而且只能对患者进行半麻醉处理。因此,该硬性固定过程会使患者非常煎熬,尤其对于一些儿童患者更加难以完成手术。虽然在手术最核心的颅内血肿定位问题上,徒手解剖标志定位法目前仍能提供最精准定位,但考虑到手术操作时间、硬性固定头部、框架可能遮挡穿刺路径等诸多弊端,该方法已趋淘汰。
相较之下,无框架的立体定向导航在一定程度上可以解决上述问题,同时保持了毫米级的定位精度,但是导航系统造价十分昂贵,一台设备售价高达数百万到上千万元,属于较稀缺医疗资源,目前仍不能惠及全民。本质上,光学和电磁导航系统都是利用电磁波定位原理,在三维空间中建立特定坐标系,标定患者头部与手术操作空间的位置关系,实现穿刺导航。二者的区别在于光学导航系统追踪导引装置(穿刺针)尾部的运动轨迹,而电磁导航系统能够追踪穿刺针尖端的运动轨迹;另外,前者仍需硬性固定头部、存在一定光学遮挡、标定操作繁琐耗时,而后者无需硬性固定头部、操作时间较短,但存在金属干扰问题。
智能手持设备陀螺仪定位、智能手持设备增强现实定位、头戴式混合现实定位等方法本质上都是利用三维空间中物体之间的方向角度关系,即在规划穿刺路径时,基于CT或MRI的医学影像信息,获取所规划穿刺路径分别与矢状面、冠状面、横断面构成的三个夹角,而后再通过各自不同的技术手段重建穿刺轨迹(穿刺针运动方向)与患者头部以及颅内血肿的方向角度关系,实现穿刺导航。由于此类方法在最核心的定位精度方面还有待提高,因此目前市面上没有形成具备竞争力的成熟产品,也并非医院主流的颅内血肿定位方法。但是,以智能手持设备陀螺仪定位为例,仅需一部智能手机就能够完成如此复杂的穿刺手术。该方法的便携灵活、易于使用、无需硬性固定头部、低成本等特点使其具备更多发展潜力,有望造福我国乃至世界广大的颅内血肿患者。
实际上,智能手持设备陀螺仪定位是利用了惯性导航原理,即惯性测量单元(IMU,InertialMeasurementUnit)通常包含加速度计、陀螺仪、磁强计,分别可测量IMU自身在三维空间中X、Y、Z轴的加速度矢量、角速度矢量、磁场强度矢量。当旋转IMU时,陀螺仪测得IMU自身的旋转角速度,通过结合时间变量计算积分,可以获取IMU由初始姿态到最终姿态的在三个坐标轴上的方向角度变化值(Roll横滚角、Pitch俯仰角、Yaw偏航角)。然而,这样单独使用陀螺仪计算角度过于简单粗暴,会产生较大的积分误差,且随时间推移,误差累计增大。因此,往往需要结合加速度计和磁强计,利用Kalman滤波、互补滤波等算法不断修正误差,从而计算出相对精准的方向角度。随着传感器硬件工艺的改良与发展,目前业内广泛使用的微机电系统(MEMS,Micro-Electro-Mechanical System)IMU芯片具有微型化、低成本、低功耗的特点,一般商用IMU模块的角度误差可以控制在0.1°以内,即使受到强磁干扰也依然精准。然而,手动操控IMU模块在空间中沿特定轨迹行进时,总会有难以维持在固定方向角度的问题,而且积分误差随时间推移不断累积导致偏航角度容易失准。关于如何利用IMU方向角度对颅内血肿进行实时定位的具体方法描述,可以在已授权的专利《颅内穿刺方法、颅内穿刺装置、颅内穿刺系统及存储介质》(申请号:CN202110729676.4)和已授权的专利《Intracranial puncture method,intracranial puncture apparatus,intracranialpuncture system and storage medium》(申请号:LU500668)中详细查看,此处不再赘述。
首先,针对颅内血肿清除的开颅手术方法会使患者承受巨大痛苦,且手术极易诱发感染,手术失败率高,即使手术成功也容易引起一些术后并发症,影响治愈效果。本发明利用惯性导航原理,实时精准定位颅内血肿,辅助神经外科医生实现微创手术治疗,即颅内血肿穿刺置管引流术。
其他可用于颅内血肿穿刺置管引流术的颅内血肿定位导航方法、辅助系统包括:徒手解剖标志定位、有框架和无框架的立体定向导航(机械式、光学或电磁等)、智能手持设备陀螺仪定位、智能手持设备增强现实定位、头戴式混合现实定位等。
徒手解剖标志定位法需要在患者剃光的头部遵循解剖学知识进行标志描绘,而后纯粹凭借主刀医生的个人经验实施穿刺手术,因此,该方法的稳定性、传承性和普及性都很差。本发明基于惯性导航技术,实现对颅内血肿的实时、精准定位,操作简单、易用,具有良好的稳定性,容易推广普及。
有框架的立体定向导航需要将患者头部“硬性固定”,也就是说,需要在患者头部打颅骨固定钉,而且只能对患者进行半麻醉处理。因此,该硬性固定的过程会使患者非常煎熬,尤其对于一些儿童患者更加难以完成手术。本发明避免硬性固定头部,术中头部可移动,有效缓解患者的手术痛苦且使医生能够更舒适地完成手术操作。
无框架的立体定向导航系统(光学或电磁)造价十分昂贵,一台设备售价高达数百万到上千万元,属于较稀缺医疗资源,目前仍不能惠及全民。光学导航系统仍需硬性固定头部、存在一定光学遮挡、标定操作繁琐耗时,而电磁导航系统存在金属干扰问题。本发明兼具高精度定位与低成本的特点,有望覆盖医疗水平欠发达地区,造福颅内血肿患者。
智能手持设备陀螺仪定位、智能手持设备增强现实定位、头戴式混合现实定位方法都存在一定程度上的定位精度不准问题,误差往往都处于厘米级别,因此,适用穿刺手术人群严重受限(如特定位置、特定尺寸的血肿)。本发明通过将多个IMU模块与一种个性化定制的机械结构集成,确保穿刺精度达到毫米级别,以更高几率命中病灶靶点从而提高手术效果(即血肿引流效率),并且有望适用于更广泛的颅内血肿患者。
发明内容
本发明实施例提供了一种基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置,以至少解决现有颅内穿刺偏航角度易失准的技术问题。
根据本发明的一实施例,提供了一种基于惯性导航技术的颅内穿刺轨迹定向瞄准方法,包括以下步骤:
S101:设计模块安装装置,将三个IMU模块安装在模块安装装置上,三个IMU模块绕模块安装装置中心位置中心对称且各相差60度;
S102:设计辅具,将模块安装装置可拆卸地连接在辅具上,模块安装装置在辅具的辅助下具有3个转动自由度;
S103:基于惯性导航技术,使用模块安装装置实时获取穿刺针的方向角度,结合术前规划的穿刺路径的方向角度,实现术中精准导航。
进一步地,模块安装装置设计为:3个IMU模块分别安装于形状为等边三角形的三条边的侧面,每个IMU模块之间的横滚角Roll、绕IMU自身X轴的角度相差60°。
进一步地,模块安装装置在三维空间中总是做刚体运动。
进一步地,术前规划的穿刺路径的方向角度包括:分别计算IMU1的方向角度(α111)与IMU3的方向角度(α333),以及IMU2的方向角度(α222)与IMU3的方向角度(α333),针对每个IMU模块得到2组方向角度数据。
进一步地,使用IMU模块的加速度数据进行纯数学计算进行精准的方向角度控制。
进一步地,由于IMU模块在运动中会偶然输出0值加速度,通过求取2组方向角度的平均值减少峰值误差。
进一步地,辅具包括:支撑底座;可伸缩的垂直支撑杆,安装在支撑底座上;可锁止的球铰链,分布于水平伸缩杆的两端,一球铰链连接在垂直支撑杆和水平伸缩杆之间;水平伸缩杆,其长度满足手术操作空间范围;刚性连接结构,位于水平伸缩杆末端球铰链处,连接模块安装装置。
根据本发明的另一实施例,提供了一种基于惯性导航技术的颅内穿刺轨迹定向瞄准装置,包括:
模块安装装置,将三个IMU模块安装在模块安装装置上,三个IMU模块绕模块安装装置中心位置中心对称且各相差60度;
辅具,将模块安装装置可拆卸地连接在辅具上,模块安装装置在辅具的辅助下具有3个转动自由度。
进一步地,模块安装装置为:3个IMU模块分别安装于形状为等边三角形的三条边的侧面,每个IMU模块之间的横滚角Roll、绕IMU自身X轴的角度相差60°。
进一步地,辅具包括:支撑底座;可伸缩的垂直支撑杆,安装在支撑底座上;可锁止的球铰链,分布于水平伸缩杆的两端,一球铰链连接在垂直支撑杆和水平伸缩杆之间;水平伸缩杆,其长度满足手术操作空间范围;刚性连接结构,位于水平伸缩杆末端球铰链处,连接模块安装装置。
一种存储介质,存储介质存储有能够实现上述任意一项基于惯性导航技术的颅内穿刺轨迹定向瞄准方法的程序文件。
一种处理器,处理器用于运行程序,其中,程序运行时执行上述任意一项的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法。
本发明实施例中的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及瞄准器,通过将多个惯性传感模块与一种个性化定制的机械结构集成使用,旨在解决含有惯性传感模块的穿刺导引装置(穿刺针)在三维空间中由人手操控移动行进时容易产生方向角度偏移失准的问题。本发明能够优化偏航角度易失准的问题,保证穿刺针严格按照所规划的穿刺路径行进,提高惯性导航的穿刺精准度。
附图说明
此处所说明的附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明中三角环形装置示意图;
图2为本发明中穿刺手术辅具示意图;
图3为本发明实验操作图。
具体实施方式
为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。
需要说明的是,本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
实施例1
市面上现有的神经外科导航系统操作繁琐、价格高昂,不易推广到医疗水平欠发达地区,本发明为此设计了一种基于惯性导航技术的颅内穿刺轨迹定向瞄准器,通过将多个惯性传感模块与一种个性化定制的机械结构集成使用,旨在解决含有惯性传感模块的穿刺导引装置(穿刺针)在三维空间中由人手操控移动行进时容易产生方向角度偏移失准的问题。本发明能够优化偏航角度易失准的问题,保证穿刺针严格按照所规划的穿刺路径行进,提高惯性导航的穿刺精准度。另外,本发明不仅能够对颅内血肿进行实时、精准定位,辅助神经外科医生施展颅内血肿微创清除术;而且具有便携灵活、易于使用、无需硬性固定头部、低成本等特点,力争实现为我国广大乡镇地区的脑出血患者提供科学精准和高性价比的医疗服务。
本发明将多个IMU模块与一种个性化定制的机械结构集成使用,保留便携灵活、易于使用、无需硬性固定头部、低成本等特点,同时又能够确保穿刺时导引装置严格按照所规划的穿刺路径进行穿刺,属于一种创新方案。
本发明技术方案主要包括两部分内容:(1)一种基于惯性导航技术的多传感器融合方法;(2)一种面向颅内血肿穿刺引流术的个性化定制机械结构设计。本发明将这两部分内容结合,进行系统集成开发,利用IMU模块与个性化定制的机械结构,实现对颅内血肿穿刺轨迹的定向瞄准。
本发明的技术方案详细阐述如下:
(一)本发明技术方案的第一部分内容是基于惯性导航技术,设计一种多传感器融合方法,以改善IMU模块在计算偏航角度时随时间推移产生的积分误差问题。为避免使用积分计算角度,首先设计一种三角环形装置,如图1所示,3个IMU模块分别固定于形状为等边三角形的三条边(三个侧面),使每个IMU模块之间的横滚角Roll(绕IMU自身X轴的角度)相差60°。
每个IMU模块用i表示,位姿变化用ω表示,横滚角Roll用α表示,俯仰角Pitch用β表示,偏航角Yaw用γ表示,则对于其自身坐标系Oi:Xi-Yi-Zi可以用数学公式描述如下:
每个IMU模块测量的线性加速度值可表述为:
其中g为重力加速度(9.81m/s2)。鉴于各组件都被机械地固定在一起,每个IMU模块产生的全局线性加速度a0是相同的,其自身加速度到全局加速度的转换应该也是相同的,也就是说,该装置在三维空间中总是做刚体运动。因此,
a00R1a1 (3)
a00R2a2 (4)
a00R3a3 (5)
其中0R10R20R3是唯一的三维旋转群SO(3)映射,分别将IMU1、IMU2、IMU3的自身加速度投影到全局加速度。由公式(3)~(5)可得,
0R1a10R2a20R3a3 (6)
根据旋转矩阵性质,任何给定的旋转矩阵R必然是正交的,因此,
RTR=RRT=I3 (7)
其中I3是三阶单位矩阵。因此,根据上述旋转矩阵运算法则,公式(6)可以被扩展为:
a11R0 0R2a21R2a2 (9)
a11R0 0R3a31R3a3 (11)
a22R0 0R3a32R3a3 (13)
其中公式(9)和(10)是描述IMU1与IMU2的关系,公式(11)和(12)是描述IMU1与IMU3的关系,公式(13)和(14)是描述IMU2与IMU3的关系。三对关系的后续计算方法相同,虽然使用2个IMU模块就可以实现无积分方法计算偏航角,但额外增加1个IMU,衍生出额外的2组计算公式,有助于增强本发明的算法稳定性。由于计算方法相同,下面将只针对IMU1与IMU2的关系展开详细的计算方法描述,其余2组关系不再赘述。
鉴于2个IMU的相对方向角度不变,也就是说,1R22R1不会随着三角环形装置的移动而变化,因此,可以通过标定实验得出1R2的唯一解,表示如下:
其中rij应满足正交归一化条件:
因此,求解1R2就成了一个解决带约束条件的非线性最小二乘法优化问题,如下所示:
其中nc表示标定实验产生的样本数量。公式(17)是相对于1R22R1进行的对称式构建,以确保公平优化2个IMU模块的计算误差。下一步按照Levenberg-Marquardt等优化算法对实验所得加速度数据进行处理计算,即可获得方位矩阵1R2
根据公式(6)和(10),可得:
0R1a1-0R2a2=0
0R1a1-0R2 2R1a1=0
(0R1-0R2 2R1)a1=0 (18)
由于a1不总为0,因此:
0R10R2 2R1 (19)
任何给定的旋转矩阵,都可以分解为三个围绕全局坐标系有序且连续的横滚角-俯仰角-偏航角的旋转,如下所示:
其中1R2为已知量,其余变量如下:
横滚角α和俯仰角β都可以使用反三角函数计算,如下所示:
至此,未知变量仅剩偏航角γ1和γ2
然后,在公式(20)的等式两边分别从左乘使之变为:
通过扩展公式(26)可以得到9个包含γ1和γ2的非线性方程,再利用Maple等数学软件可进一步推导得出下列闭式表达式:
其中Λ(Y2)是正交矩阵的乘法运算,因此,应满足下列正交归一化条件:
另外,根据公式(23)与(27)可得:
因此,Λ33=1或者Λ33=-1,分别表示顺时针或者逆时针旋转。
根据公式(28)~(34)可以推出:
最后得到2个关于γ1和γ2的独立非线性方程:
受制于下列约束条件:
该方程的求解属于具有非线性约束的最小化问题,可采用顺序二次规划(SQP)算法进行求解,最终得到偏航角γ1和γ2
同理,根据公式(11)、(12)以及公式(13)、(14),可用于分别计算IMU1的方向角度(α1,β1,γ1)与IMU3的方向角度(α3,β3,γ3),以及IMU2的方向角度(α2,β2,γ2)与IMU3的方向角度(α3,β3,γ3),于是针对每个IMU模块都得到了2组方向角度数据。由于IMU模块在运动中可能会偶然输出0值加速度,导致计算过程中产生峰值误差,通过求取2组方向角度的平均值可以在一定程度上减少峰值误差。综上所述,仅使用IMU模块的加速度数据进行纯数学计算即可实现精准的方向角度,此即为本发明方案的第一部分内容,利用多传感器融合方法实现无积分偏航角计算。
(二)基于上述多传感器融合算法,三角环形装置可用于实时获取穿刺针的方向角度,结合术前规划的穿刺路径的方向角度,即可实现术中精准导航。然而,若医生手拿穿刺导引装置进行穿刺,需要根据动态的方向角度信息不断调整穿刺轨迹,势必会产生额外的人工误差。因此,本发明方案的第二部分内容是设计一种个性化定制机械结构,作为穿刺手术辅具,用于固定三角环形装置,该辅具示意图如图2所示。
该辅具包括:支撑底座1,带有5个可拆卸式真空吸盘,确保辅具在使用过程中静止,不使用时方便移动;垂直支撑杆2,可伸缩,高度可变;可锁止球铰链3,分布于水平伸缩杆4的两端,使得其所连接杆件具有空间3个转动自由度,方便调节相应角度,并且调节完成后固定可锁止球铰链3,防止晃动;水平伸缩杆4,其长度满足手术操作空间范围,即,以患者头部为圆心直径约1米左右;刚性连接结构5,位于水平伸缩杆4末端球铰链处,用于连接并固定三角环形装置。
与现有技术相比,本发明的优点为:
本发明提出的多传感器融合方法,有效减少IMU模块计算偏航角的积分漂移误差,同时结合一种个性化定制结构的穿刺手术辅具,用于辅助颅内血肿穿刺术,实现穿刺轨迹的实时精准导航。相对于现有神经外科导航技术的最大优势是灵活便捷、操作简单易用、低成本、无需硬性固定头部,并维持高精准度。
本发明已经过实验验证,图3是实验中使用IMU模块获取方向角度,模拟穿刺手术。在IMU模块的标定实验中,测得IMU模块的横滚角、俯仰角、偏航角最大误差为1.2°、最小误差为0.01°,平均绝对误差(MAE)为0.52°(横滚角MAE为0.11°,俯仰角MAE为0.79°,偏航角MAE为0.66°)。3个方向角度的MAE都低于1°,穿刺精度理论上可以达到毫米级。
实施例2
一种存储介质,存储介质存储有能够实现上述任意一项基于惯性导航技术的颅内穿刺轨迹定向瞄准方法的程序文件。
实施例3
一种处理器,处理器用于运行程序,其中,程序运行时执行上述任意一项的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法。
上述本发明实施例序号仅仅为了描述,不代表实施例的优劣。
在本发明的上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见其他实施例的相关描述。
在本申请所提供的几个实施例中,应该理解到,所揭露的技术内容,可通过其它的方式实现。其中,以上所描述的系统实施例仅仅是示意性的,例如单元的划分,可以为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,单元或模块的间接耦合或通信连接,可以是电性或其它的形式。
作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可为个人计算机、服务器或者网络设备等)执行本发明各个实施例方法的全部或部分步骤。而前述的存储介质包括:U盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、移动硬盘、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。

Claims (10)

1.一种基于惯性导航技术的颅内穿刺轨迹定向瞄准方法,其特征在于,包括以下步骤:
S101:设计模块安装装置,将三个IMU模块安装在模块安装装置上,三个IMU模块绕模块安装装置中心位置中心对称且各相差60度;
S102:设计辅具,将模块安装装置可拆卸地连接在辅具上,模块安装装置在辅具的辅助下具有3个转动自由度;
S103:基于惯性导航技术,使用模块安装装置实时获取穿刺针的方向角度,结合术前规划的穿刺路径的方向角度,实现术中精准导航。
2.根据权利要求1所述的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法,其特征在于,模块安装装置设计为:3个IMU模块分别安装于形状为等边三角形的三条边的侧面,每个IMU模块之间的横滚角Roll、绕IMU自身X轴的角度相差60°。
3.根据权利要求1所述的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法,其特征在于,模块安装装置在三维空间中总是做刚体运动。
4.根据权利要求1所述的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法,其特征在于,术前规划的穿刺路径的方向角度包括:分别计算IMU1的方向角度(α111)与IMU3的方向角度(α333),以及IMU2的方向角度(α222)与IMU3的方向角度(α333),针对每个IMU模块得到2组方向角度数据。
5.根据权利要求1所述的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法,其特征在于,使用IMU模块的加速度数据进行纯数学计算进行精准的方向角度控制。
6.根据权利要求1所述的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法,其特征在于,由于IMU模块在运动中会偶然输出0值加速度,通过求取2组方向角度的平均值减少峰值误差。
7.根据权利要求1所述的基于惯性导航技术的颅内穿刺轨迹定向瞄准方法,其特征在于,辅具包括:支撑底座;可伸缩的垂直支撑杆,安装在支撑底座上;可锁止的球铰链,分布于水平伸缩杆的两端,一球铰链连接在垂直支撑杆和水平伸缩杆之间;水平伸缩杆,其长度满足手术操作空间范围;刚性连接结构,位于水平伸缩杆末端球铰链处,连接模块安装装置。
8.一种基于惯性导航技术的颅内穿刺轨迹定向瞄准器,其特征在于,包括:
模块安装装置,将三个IMU模块安装在模块安装装置上,三个IMU模块绕模块安装装置中心位置中心对称且各相差60度;
辅具,将模块安装装置可拆卸地连接在辅具上,模块安装装置在辅具的辅助下具有3个转动自由度。
9.根据权利要求8所述的基于惯性导航技术的颅内穿刺轨迹定向瞄准器,其特征在于,模块安装装置为:3个IMU模块分别安装于形状为等边三角形的三条边的侧面,每个IMU模块之间的横滚角Roll、绕IMU自身X轴的角度相差60°。
10.根据权利要求8所述的基于惯性导航技术的颅内穿刺轨迹定向瞄准器,其特征在于,辅具包括:支撑底座;可伸缩的垂直支撑杆,安装在支撑底座上;可锁止的球铰链,分布于水平伸缩杆的两端,一球铰链连接在垂直支撑杆和水平伸缩杆之间;水平伸缩杆,其长度满足手术操作空间范围;刚性连接结构,位于水平伸缩杆末端球铰链处,连接模块安装装置。
CN202310461040.5A 2023-04-20 2023-04-20 基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置 Pending CN118806387A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310461040.5A CN118806387A (zh) 2023-04-20 2023-04-20 基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310461040.5A CN118806387A (zh) 2023-04-20 2023-04-20 基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置

Publications (1)

Publication Number Publication Date
CN118806387A true CN118806387A (zh) 2024-10-22

Family

ID=93066565

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310461040.5A Pending CN118806387A (zh) 2023-04-20 2023-04-20 基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置

Country Status (1)

Country Link
CN (1) CN118806387A (zh)

Similar Documents

Publication Publication Date Title
CN113520543B (zh) 颅内穿刺方法、颅内穿刺装置、颅内穿刺系统及存储介质
US20200188037A1 (en) Navigating A Surgical Instrument
CN103356284B (zh) 手术导航方法和系统
US20250000589A1 (en) System, devices and method for surgical navigation including active tracking and drift elimination
CN107182200B (zh) 微创手术导航系统
CN103479431B (zh) 非介入式微创手术导航系统
EP3375400A3 (en) Robotic navigation of robotic surgical systems
Pillai et al. Application accuracy of computed tomography-based, image-guided navigation of temporal bone
WO2015188393A1 (zh) 人体器官运动监测方法、手术导航系统和计算机可读介质
CN107432766A (zh) 一种精准微创手术导航系统
WO2023065495A1 (zh) 一种机械臂穿刺的颅内血肿穿刺引流手术系统
CN118285917B (zh) 一种手术导航系统及提升导航精度的方法
Chen et al. A review of surgery navigation system based on ultrasound guidance
CN112515763A (zh) 目标物的定位显示方法、系统、装置和电子设备
CN116831728A (zh) 靶心平面显示方法、装置、电子设备及存储介质
CN118806387A (zh) 基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置
WO2024216575A1 (zh) 基于惯性导航技术的颅内穿刺轨迹定向瞄准方法及装置
WO2023024903A1 (zh) 一种精确定位导航目标点的方法
CN116019554B (zh) 一种脊柱外科导航中空间配准加速方法及系统
CN116250921B (zh) 二维图像下手术通道位置的三维评估方法及装置
CN115607287B (zh) 股骨头中心实时计算方法、装置、手术机器人和存储介质
CN118946327A (zh) 用于追踪可移动传感器在患者身体内的实时位置的系统
CN214180575U (zh) 一种骨科手术机器人专用追踪定位固定装置
Hua et al. 3D motion planning for flexible needle insertion based on rapidly-exploring random trees with environment-adaptive sampling and central angle control
Arle 29 Development of a Classic: The Todd-Wells Apparatus, the

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