WO2024027857A1 - Method and system for registration of surgical robot coordinate system with ct scanner coordinate system - Google Patents

Method and system for registration of surgical robot coordinate system with ct scanner coordinate system Download PDF

Info

Publication number
WO2024027857A1
WO2024027857A1 PCT/CN2023/125927 CN2023125927W WO2024027857A1 WO 2024027857 A1 WO2024027857 A1 WO 2024027857A1 CN 2023125927 W CN2023125927 W CN 2023125927W WO 2024027857 A1 WO2024027857 A1 WO 2024027857A1
Authority
WO
WIPO (PCT)
Prior art keywords
coordinate system
structured light
machine
calibration
calibration plate
Prior art date
Application number
PCT/CN2023/125927
Other languages
French (fr)
Chinese (zh)
Inventor
甘承军
隋晨光
郭岩中
Original Assignee
苏州派尼迩医疗科技有限公司
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 苏州派尼迩医疗科技有限公司 filed Critical 苏州派尼迩医疗科技有限公司
Priority to CN202380012400.1A priority Critical patent/CN117835933A/en
Publication of WO2024027857A1 publication Critical patent/WO2024027857A1/en

Links

Classifications

    • 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
    • A61B17/00Surgical instruments, devices or methods, e.g. tourniquets
    • 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/30Surgical robots
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/70Manipulators specially adapted for use in surgery
    • 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/36Image-producing devices or illumination devices not otherwise provided for
    • A61B90/361Image-producing devices, e.g. surgical cameras
    • 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/36Image-producing devices or illumination devices not otherwise provided for
    • A61B90/37Surgical systems with images on a monitor during operation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/16Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
    • 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
    • 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
    • A61B2034/2046Tracking techniques
    • A61B2034/2055Optical tracking systems
    • 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
    • A61B2034/2046Tracking techniques
    • A61B2034/2065Tracking using image or pattern recognition
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • A61B2034/305Details of wrist mechanisms at distal ends of robotic arms

Landscapes

  • Health & Medical Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Molecular Biology (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Medical Informatics (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Physics & Mathematics (AREA)
  • Robotics (AREA)
  • Mathematical Physics (AREA)
  • Pathology (AREA)
  • General Physics & Mathematics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computational Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Computing Systems (AREA)
  • Algebra (AREA)
  • Gynecology & Obstetrics (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Radiology & Medical Imaging (AREA)
  • Manipulator (AREA)

Abstract

A method and system for the registration of a surgical robot coordinate system with a CT scanner coordinate system. The system comprises a 3D structured light camera (1) and a calibration plate (2), which are used cooperatively with a surgical robot console, a robotic arm (4), and a CT scanner, wherein a 3D visual system is used for the registration of the CT scanner coordinate system with a robotic arm coordinate system of the surgical robot; and the 3D structured light camera (1) in the 3D visual system moves synchronously with the robotic arm (4) and a puncture device (3) fixedly mounted at the end of the robotic arm (4). In this way, a coordinate registration process in a robot surgical procedure is simplified. The 3D structured light camera (1) and the puncture device (3) are both mounted at the end of the robotic arm (4), so that the surgical robot has a reduced size.

Description

用于配准手术机器人坐标系与CT机坐标系的方法及系统Method and system for registering surgical robot coordinate system and CT machine coordinate system 技术领域Technical field
本发明涉及穿刺机器人领域,具体地说,涉及一种用于配准手术机器人坐标系与CT机坐标系的方法及系统。The present invention relates to the field of puncture robots, and specifically to a method and system for registering the coordinate system of a surgical robot and the coordinate system of a CT machine.
背景技术Background technique
利用机器人进行穿刺手术的过程中,医生会根据医学影像设备(例如CT机)对患者进行诊断并制定手术方案,再由手术机器人依据医生给出的手术方案执行穿刺手术。只有将手术机器人的坐标系与医学影像设备的坐标系配准统一后,手术机器人才能按照医生制定的手术方案完成手术动作。In the process of using a robot to perform puncture surgery, the doctor will diagnose the patient and formulate a surgical plan based on medical imaging equipment (such as a CT machine), and then the surgical robot will perform the puncture surgery based on the surgical plan given by the doctor. Only after the coordinate system of the surgical robot is aligned with the coordinate system of the medical imaging equipment can the surgical robot complete the surgical action according to the surgical plan formulated by the doctor.
目前手术机器人大多是采用红外双目相机,对固定在机械臂上的标志组件和固定在人体上的标志组件进行拍摄,再结合固定在人体上标志组件的CT影像,通过图形识别算法和空间几何算法来确定机械臂与CT机的坐标配准。这种技术与方法需要在患者身上和机械臂上均固定安装标志组件,并且在机械臂之外视野合适的位置安放一台大型红外双目相机,整个系统设备复杂,操作不方便,医务人员需要长时间的培训后才能完成操作。尤其是在患者身上固定标志组件,需要病人的有效配合才能完成,限制了手术机器人的广泛推广与应用。At present, most surgical robots use infrared binocular cameras to take pictures of the sign components fixed on the robotic arm and the sign components fixed on the human body. Then, combined with the CT images of the sign components fixed on the human body, through the pattern recognition algorithm and spatial geometry, Algorithm to determine the coordinate registration of the robotic arm and CT machine. This technology and method requires the fixed installation of marker components on both the patient and the robotic arm, and a large infrared binocular camera placed outside the robotic arm at a suitable position with a view. The entire system is complex and inconvenient to operate, requiring medical staff to The operation can only be completed after a long training period. In particular, fixing the landmark component on the patient requires the patient's effective cooperation, which limits the widespread promotion and application of surgical robots.
发明内容Contents of the invention
本发明的目的在于提供一种用于配准手术机器人坐标系与CT机坐标系的方法,属于一种全新的配准方法,本发明只需在机械臂末端固定安装一个高精度、小尺寸的3D结构光相机,再配合本发明依据3D结构光相机专门设计的标定板,将标定板放置在CT机上即可以完成机械臂坐标与CT机坐标的配准,无需在机械臂及患者身上固定相应的标志件,也无需另行配设大型的红外双目相机,使得手术机器人设备简单化,使用与操作更加简便,可以被广泛推广与应用,适用于各种级别的医疗单位。The purpose of the present invention is to provide a method for registering the coordinate system of a surgical robot and the coordinate system of a CT machine. It is a completely new registration method. The present invention only requires a high-precision, small-sized robot to be fixedly installed at the end of the robotic arm. The 3D structured light camera, combined with the calibration plate specially designed according to the 3D structured light camera of the present invention, can complete the registration of the robot arm coordinates and the CT machine coordinates by placing the calibration plate on the CT machine, without the need to fix the corresponding coordinates on the robot arm and the patient. It also eliminates the need for additional large-scale infrared binocular cameras, making the surgical robot equipment simpler and easier to use and operate. It can be widely promoted and applied and is suitable for medical units of all levels.
本发明中用于配准手术机器人坐标系与CT机坐标系的方法,使用3D视觉系统将CT机坐标系与手术机器人中机械臂坐标系进行配准,所述3D视觉系统中的3D结构光相机随所述机械臂及所述机械臂末端固定安装的穿刺装置一起作同步移动。The method for registering the coordinate system of the surgical robot and the coordinate system of the CT machine in the present invention uses a 3D vision system to register the coordinate system of the CT machine and the coordinate system of the mechanical arm in the surgical robot. The 3D structured light in the 3D vision system The camera moves synchronously with the robotic arm and the puncture device fixedly installed at the end of the robotic arm.
优选地,所述3D视觉系统包括有安装在所述机械臂末端、与所述穿刺装置固定成一个整体的3D结构光相机、能直接放置在所述CT机上且位于所述3D结构光相机拍摄范围内的标定板。Preferably, the 3D vision system includes a 3D structured light camera installed at the end of the robotic arm and fixed as a whole with the puncture device. It can be directly placed on the CT machine and is located where the 3D structured light camera takes pictures. Calibration board within range.
优选地,用于配准上CT机坐标系与机械臂坐标系,其特征在于,按以下步骤执行:Preferably, it is used to register the CT machine coordinate system and the robot arm coordinate system, which is characterized in that the following steps are performed:
1)将固定有3D结构光相机的机械臂移动至CT机旁的手术区域内;1) Move the robotic arm fixed with the 3D structured light camera to the surgical area next to the CT machine;
2)将所述标定板放置在所述CT机上,且位于所述3D结构光相机能拍摄到的范围内;2) Place the calibration plate on the CT machine and within the range that can be photographed by the 3D structured light camera;
3)启动配准程序,所述机械臂携带所述3D结构光相机依序移动到多个位姿,移动至每个位姿后均开启所述3D结构相机投射多组结构光并采集结构光投射到的所述标定板中标定结构的照片,通过计算机软件记录下每个位姿的机械臂变换参数和所述标定板中标定结构的照片,运用手眼标定算法,获取所述标定板坐标系与机械臂坐标系的转换关系,为第三转换矩阵;3) Start the registration process. The robotic arm carries the 3D structured light camera and moves to multiple poses in sequence. After moving to each pose, the 3D structured light camera is turned on to project multiple sets of structured light and collect the structured light. Project the photos of the calibration structure in the calibration plate, record the transformation parameters of the robot arm in each posture and the photos of the calibration structure in the calibration plate through computer software, and use the hand-eye calibration algorithm to obtain the coordinate system of the calibration plate. The transformation relationship with the robot arm coordinate system is the third transformation matrix;
4)所述机械臂收回到初始位置,所述标定板继续放在所述CT机上保持不动,启动CT机对所述标定板进行扫描;获取所述标定板上四个球状标定件的CT影像数据,结合四个球状标定件的球心针对所述标定板的坐标矩阵,获得CT坐标系与所述标定板坐标系之间的转换关系,为第四转换矩阵;4) The robotic arm is retracted to the initial position, the calibration plate continues to be placed on the CT machine and remains motionless, and the CT machine is started to scan the calibration plate; CT scans of the four spherical calibration parts on the calibration plate are obtained. The image data is combined with the coordinate matrix of the spherical center of the four spherical calibration parts against the calibration plate to obtain the conversion relationship between the CT coordinate system and the calibration plate coordinate system, which is the fourth conversion matrix;
5)依据所述标定板坐标系与机械臂坐标系之间的第三转换矩阵、所述CT机坐标系与所述标定板坐标系之间的第四转换矩阵,获取所述CT机坐标系与机械臂坐标系之间的转换关系,为第五转换矩阵,完成所述CT机坐标系与机械臂坐标系的坐标配准。5) Obtain the CT machine coordinate system based on the third transformation matrix between the calibration plate coordinate system and the robot arm coordinate system and the fourth transformation matrix between the CT machine coordinate system and the calibration plate coordinate system. The conversion relationship with the robot arm coordinate system is the fifth transformation matrix, which completes the coordinate registration between the CT machine coordinate system and the robot arm coordinate system.
优选地,所述步骤3)中,按以下步骤执行:Preferably, in step 3), the following steps are performed:
3.1)启动配准程序,所述机械臂携带所述3D结构光相机依序移动至n个预先设定的不同位姿,移动至每个位姿后分别获取每个位姿下所述标定板坐标系与所述相机坐标系之间的转换关系,为第一转换矩阵WBC;机械臂末端中心点与所述机械臂坐标系之间的转换关系,为第二转换矩阵WAT3.1) Start the registration procedure. The robotic arm carries the 3D structured light camera and moves to n different preset poses in sequence. After moving to each pose, the calibration plate in each pose is acquired. The conversion relationship between the coordinate system and the camera coordinate system is the first conversion matrix W BC ; the conversion relationship between the end center point of the robotic arm and the robotic arm coordinate system is the second conversion matrix W AT ;
3.2)选取其中两个位姿(i,j)对应的第一转换矩阵WBC和第二转换矩阵WAT,根据以下等式(1)获取所述相机坐标系与机械臂末端中心点坐标系的转换矩阵WCT (ij)
WAT (i)WCT (ij)WBC (i)=WAT (j)WCT (ij)WBC (j)           (1)
3.2) Select the first transformation matrix W BC and the second transformation matrix W AT corresponding to two of the poses (i, j), and obtain the camera coordinate system and the robot end center point coordinate system according to the following equation (1) The transformation matrix W CT (ij) ;
W AT (i) W CT (ij) W BC (i) = W AT (j) W CT (ij) W BC (j) (1)
3.3)依据以下等式(2)获取针对该两个位姿(i,j)的标定板坐标系与机械臂坐标系的转换矩阵WAB (ij)
WAB (ij)=WAT (i)WCT (ij)WBC (i)=WAT (j)WCT (ij)WBC (j)    (2)
3.3) Obtain the transformation matrix W AB (ij) of the calibration plate coordinate system and the robot arm coordinate system for the two poses (i, j) according to the following equation (2) ;
W AB (ij) = W AT (i) W CT (ij) W BC (i) = W AT (j) W CT (ij) W BC (j) (2)
3.4)重复步骤3.2)、3.3),从n个位姿中选取两个不同位姿的第一转换矩阵WBC和第二转换矩阵WAT,组合后能够获得n*(n-1)/2个所述转换矩阵WAB (ij);针对n*(n-1)/2个所述转换矩阵WAB (ij)中对应的相同变量求取平均值,将所有相同变量的平均值组合成标定板坐标系与机械臂坐标系的转换关系,称第三转换矩阵 3.4) Repeat steps 3.2) and 3.3) to select the first transformation matrix W BC and the second transformation matrix W AT of two different postures from n postures. After combination, n*(n-1)/2 can be obtained the conversion matrices W AB (ij) ; calculate the average value for the same variables corresponding to the n*(n-1)/2 conversion matrices W AB (ij) , and combine the average values of all the same variables into The conversion relationship between the calibration plate coordinate system and the robot arm coordinate system is called the third conversion matrix
优选地,所述步骤3.1)中,所述机械臂移动至每个位姿后均执行以下步骤:Preferably, in step 3.1), the following steps are performed after the robotic arm moves to each posture:
3.1.1)所述3D结构光相机向所述标定板投射结构光,采集结构光投射到的所述标定板中标志结构的照片,由计算机软件记录下机械臂的位姿变换参数和结构光投射到的所述标定板中标志结构的照片,通过手眼标定算法获取针对该位姿的所述标定板坐标系与所述3D结构光相机中心点坐标系之间的转换关系,为第一转换矩阵WBC3.1.1) The 3D structured light camera projects structured light to the calibration plate, collects photos of the mark structure in the calibration plate projected by the structured light, and records the posture transformation parameters of the robotic arm and the structured light by computer software The photo of the landmark structure in the calibration plate is projected onto the camera, and the conversion relationship between the coordinate system of the calibration plate and the center point coordinate system of the 3D structured light camera for this pose is obtained through the hand-eye calibration algorithm, which is the first conversion. matrix W BC ;
3.1.2)依据每一个位姿下机械臂位姿变换参数,获取机械臂末端中心点在机械臂坐标系下的位姿表示,即该位姿的机械臂末端中心点坐标系与机械臂坐标系之间的转换关系,为第二转换矩阵WAT3.1.2) Based on the pose transformation parameters of the robot arm in each pose, obtain the pose representation of the center point of the robot arm in the robot arm coordinate system, that is, the coordinate system of the center point of the robot arm end and the coordinates of the robot arm in this pose The conversion relationship between systems is the second conversion matrix W AT .
优选地,步骤3)中所述3D结构光相机随所述机械臂移动的位姿数量为4-25个。Preferably, the number of poses that the 3D structured light camera moves with the robotic arm in step 3) is 4-25.
优选地,步骤3.1.1)中所述3D结构光相机投射波长为490nm的蓝紫LED光,呈13-24幅条纹光栅至所述标定板。Preferably, the 3D structured light camera in step 3.1.1) projects blue-violet LED light with a wavelength of 490 nm to the calibration plate in the form of a 13-24 stripe grating.
优选地,所述标定板包括有基板,四个球状标定件,用于固定连接所述基板和所述球状标定件的柱状连接件,用于锁固所述柱状连接件和所述基板的锁固件,每根所述柱状连接件的高度呈等差分列分布,所有柱状连接件均固定设置在所述基板的同一侧表面,所述基板位于所述柱状连接件设置的侧面表面设置有棋盘格。Preferably, the calibration plate includes a base plate, four spherical calibration members, a cylindrical connector for fixedly connecting the base plate and the spherical calibration member, and a lock for locking the cylindrical connector and the base plate. Firmware, the height of each columnar connector is distributed in equal rows, all columnar connectors are fixedly arranged on the same side surface of the base plate, and the substrate is provided with a checkerboard pattern on the side surface where the columnar connectors are provided. .
优选地,所述柱状连接件包括有与所述球状标定件连接的第一连接部,与所述基板连接的第二连接部,所述第一连接部设置有供所述球状标定件沉入的圆柱状凹槽,所述凹槽的深度大于所述球状标定件的半径,所述凹槽的内径小于等于所述球状标定件的直径。Preferably, the cylindrical connector includes a first connection portion connected to the spherical calibration member and a second connection portion connected to the base plate, and the first connection portion is provided with a hole for the spherical calibration member to sink into. A cylindrical groove, the depth of the groove is greater than the radius of the spherical calibration piece, and the inner diameter of the groove is less than or equal to the diameter of the spherical calibration piece.
本发明中用于配准手术机器人坐标系与CT机坐标系的系统,与手术机器人控制台、机械臂、CT机配合使用的3D结构光相机和标定板,所述3D结构光相机与所述机械臂末端安装的穿刺装置固定安装一起,与所述穿刺装置一起随所述机械臂的移动而移动。In the present invention, there is a system for registering the coordinate system of the surgical robot and the coordinate system of the CT machine, a 3D structured light camera and a calibration plate used in conjunction with the surgical robot console, robotic arm, and CT machine. The 3D structured light camera and the The puncture device installed at the end of the robotic arm is fixedly installed together, and moves together with the puncture device as the robotic arm moves.
使用本发明系统进行配准时,只需要把装有3D结构光相机的手术机器人及机械臂推至CT机旁,将标定板放在CT机床能被3D结构光相机拍摄到的范围内,启动程序后即可自动完成坐标配准,操作简便,易学易用。从而大大简化了手术机器人的操作难度,大大减少医务人员学习培训的时间。When using the system of the present invention for registration, you only need to push the surgical robot and robotic arm equipped with a 3D structured light camera to the side of the CT machine, place the calibration plate within the range of the CT machine tool that can be photographed by the 3D structured light camera, and start the program. Then the coordinate registration can be automatically completed, which is simple to operate, easy to learn and use. This greatly simplifies the operation difficulty of the surgical robot and greatly reduces the learning and training time of medical staff.
本发明将3D结构光相机应用于手术机器人后可以快速、准确的实现手术机器人坐标系与CT机坐标系的配准,配准精度可以达到1mm以内,为手术机器人进行穿刺手术提供了准确的定位和识别,确保手术的精准度。After the 3D structured light camera is applied to a surgical robot, the present invention can quickly and accurately realize the registration of the coordinate system of the surgical robot and the coordinate system of the CT machine. The registration accuracy can reach within 1 mm, providing accurate positioning for the surgical robot to perform puncture surgery. and identification to ensure the accuracy of surgery.
另,本发明通过3D结构光相机的使用,大大简化了机器人手术过程中的坐标配准流程,与患者无关,使用人员操作简单,大量缩短了医务人员的学习和培训时间。并且3D结构光相机与穿刺装置一起安装在机械臂末端,使手术机器人的设备体积缩小,大大减少了CT手术室的设备占用空间,常规CT检查室就可以充分使用,使得机器人手术可以在更多的医院开展。In addition, the present invention greatly simplifies the coordinate registration process during robot surgery through the use of 3D structured light cameras. It has nothing to do with the patient, is simple to operate, and greatly shortens the learning and training time of medical staff. In addition, the 3D structured light camera and the puncture device are installed at the end of the robotic arm, which reduces the size of the surgical robot's equipment and greatly reduces the space occupied by the equipment in the CT operating room. The conventional CT examination room can be fully used, allowing robotic surgery to be used in more of hospitals.
附图说明Description of the drawings
图1是本发明中用于配准手术机器人坐标系与CT机坐标系的方法的流程图。Fig. 1 is a flow chart of the method for registering the coordinate system of the surgical robot and the coordinate system of the CT machine in the present invention.
图2是本发明中用于配准手术机器人坐标系与CT机坐标系的系统的结构示意图。Figure 2 is a schematic structural diagram of a system for registering the surgical robot coordinate system and the CT machine coordinate system in the present invention.
图3是本发明中3D结构光相机与穿刺装置组合安装后的结构示意图。Figure 3 is a schematic structural diagram of the 3D structured light camera and the puncture device in the present invention after they are combined and installed.
图4是本发明中标定板的立体结构示意图。Figure 4 is a schematic three-dimensional structural diagram of the calibration plate in the present invention.
图5是本发明中标定板基板内棋盘格的结构示意图。Fig. 5 is a schematic structural diagram of the checkerboard structure in the calibration plate substrate of the present invention.
图6是本发明中四根柱状连接件的剖视结构示意图。Figure 6 is a schematic cross-sectional structural view of four columnar connectors in the present invention.
图7是本发明中系统的工作状态结构示意图。Figure 7 is a schematic structural diagram of the working state of the system in the present invention.
图8是本发明中配准的工作原理图一。Figure 8 is a diagram 1 of the working principle of registration in the present invention.
图9是本发明中配准的工作原理图二。Figure 9 is the second working principle diagram of registration in the present invention.
实施方式Implementation
为使本发明的目的、技术方案和优点更加清楚明了,下面结合具体实施方式并参照附图,对本发明进一步详细说明。应该理解,这些描述只是示例性的,而并非要限制本发明的范围。In order to make the purpose, technical solutions and advantages of the present invention more clear, the present invention will be further described in detail below with reference to the specific embodiments and the accompanying drawings. It should be understood that these descriptions are exemplary only and are not intended to limit the scope of the invention.
如图1、图2、图3、图8和图9所示,本发明中用于配准手术机器人坐标系与CT机坐标系的方法是使用3D视觉系统将CT机坐标系与手术机器人中机械臂坐标系进行配准,其中3D视觉系统中的3D结构光相机随机械臂4及机械臂末端安装的穿刺装置3一起作同步移动。As shown in Figures 1, 2, 3, 8 and 9, the method for registering the coordinate system of the surgical robot and the coordinate system of the CT machine in the present invention is to use a 3D vision system to register the coordinate system of the CT machine and the coordinate system of the surgical robot. The robot arm coordinate system is registered, and the 3D structured light camera in the 3D vision system moves synchronously with the robot arm 4 and the puncture device 3 installed at the end of the robot arm.
用于配准手术机器人坐标系与CT机坐标系的3D视觉系统包括有软件部分和硬件部分,其中软件部分与手术机器人的控制系统结合,具体的结合及软件程序作为本领域的技术人员在本发明方法的详细说明后可以实现。硬件部分包括有安装在手术机器人机械臂4末端穿刺装置3上的3D结构光相机1、可以平稳放置在CT机上的标定板2。其中3D结构光相机1与穿刺装置3经由安装架32固定安装在一起,均安装在机械臂4的末端,与穿刺装置3一起随机械臂4的移动而作同步移动。关于3D结构光相机1、穿刺装置3的固定安装以及固定安装架32的具体结构,对于本领域的技术人员来说是容易实现的,在此不再详细说明。The 3D vision system used to register the coordinate system of the surgical robot and the coordinate system of the CT machine includes a software part and a hardware part. The software part is combined with the control system of the surgical robot. The specific combination and software program will be determined by those skilled in the art. This can be achieved after a detailed description of the inventive method. The hardware part includes a 3D structured light camera 1 installed on the puncture device 3 at the end of the surgical robot's robotic arm 4, and a calibration plate 2 that can be placed stably on the CT machine. The 3D structured light camera 1 and the puncture device 3 are fixedly installed together through the mounting bracket 32. They are both installed at the end of the robotic arm 4 and move synchronously with the movement of the robotic arm 4 together with the puncture device 3. The specific structures of the fixed installation of the 3D structured light camera 1 and the puncture device 3 and the fixed mounting bracket 32 are easy to implement for those skilled in the art, and will not be described in detail here.
如图3所示,本发明中的3D结构光相机1可以拆分成两部分,包括有结构光源30和DDP相机31,分别安装在穿刺装置3的两侧边,使穿刺装置3中穿刺针5位于结构光源30和DDP相机31之间,并且结构光源30、DDP相机31固定安装完成后,结构光源30的光源覆盖范围和相机31的拍摄范围恰好呈重叠的方式位于穿刺装置3的下方,可以更好的找准穿刺位置。本发明中的3D结构光相机1也可以如图7和图9所示,作为一个整体直接固定安装在机械臂4的末端,与穿刺装置3平行(或并列)设置。As shown in Figure 3, the 3D structured light camera 1 in the present invention can be split into two parts, including a structured light source 30 and a DDP camera 31, which are respectively installed on both sides of the puncture device 3, so that the puncture needle in the puncture device 3 can 5 is located between the structured light source 30 and the DDP camera 31, and after the structured light source 30 and the DDP camera 31 are fixedly installed, the light source coverage range of the structured light source 30 and the shooting range of the camera 31 overlap exactly and are located below the puncture device 3. Can better identify the puncture location. The 3D structured light camera 1 in the present invention can also be directly fixed and installed on the end of the robotic arm 4 as a whole, as shown in FIGS. 7 and 9 , and is arranged parallel (or side by side) with the puncture device 3 .
如图4所示,标定板2包括有基板20,四个球状标定件22,用于固定连接基板20和球状标定件22的四根柱状连接件21,用于锁固柱状连接件21和基板20的四个锁固件23。As shown in Figure 4, the calibration plate 2 includes a base plate 20, four spherical calibration members 22, four columnar connectors 21 used to fixedly connect the base plate 20 and the spherical calibration members 22, and used to lock the columnar connectors 21 and the base plate. 20 of the four fasteners 23.
其中基板20选用长为160mm、宽为140mm、厚为5mm的方形陶瓷基板,在陶瓷基板的四个直角位置处各设有一个穿孔25,在陶瓷基板20其中一个侧表面、且位于四个穿孔25的正中间设置均布有标志结构24。标志结构24为绘制或印刷在陶瓷基板20表面的几何图形,如图5所示,本发明优选黑、 白正方形交替排列组合,形成棋盘格图案,黑、白正方形的边长为8mm。The substrate 20 is a square ceramic substrate with a length of 160 mm, a width of 140 mm, and a thickness of 5 mm. Each of the four right-angled positions of the ceramic substrate is provided with a through hole 25. One of the side surfaces of the ceramic substrate 20 is located at four through holes. Logo structures 24 are evenly distributed in the middle of 25 . The logo structure 24 is a geometric figure drawn or printed on the surface of the ceramic substrate 20, as shown in Figure 5. In the present invention, it is preferably black, The white squares are alternately arranged and combined to form a checkerboard pattern. The side length of the black and white squares is 8mm.
柱状连接件21优选聚甲醛热塑性结晶聚合物(POM,polyformaldehyde)材料一体成形,在每根柱状连接件21的上方分别固定一个球状标定件22,该球状标定件22选择需要在CT机内可以清晰成像而又不会产生伪影的材料,优先选用直径为20mm的AL2O3陶瓷球。The columnar connectors 21 are preferably made of polyformaldehyde thermoplastic crystalline polymer (POM, polyformaldehyde) material. A spherical calibration member 22 is fixed above each columnar connector 21. The spherical calibration member 22 must be clearly visible in the CT machine. For materials that can image without producing artifacts, AL 2 O 3 ceramic balls with a diameter of 20 mm are preferred.
柱状连接件21与球状标定件22选择使用的材料,球状标定件22的密度大于柱状连接件21的密度1.5-4倍,可以准确、清晰的从CT图像上识别开,同时不会在CT影像中产生伪影。The materials used for the cylindrical connector 21 and the spherical calibration member 22 are selected. The density of the spherical calibration member 22 is 1.5-4 times greater than the density of the cylindrical connector 21. It can be accurately and clearly identified from the CT image, and at the same time, it will not appear in the CT image. artifacts are produced.
如图6所示,柱状连接件21包括有与球状标定件22连接的第一连接部26,与基板20连接的第二连接部27,以及用于连接第一连接部26和第二连接部27的连接柱28。第一连接部26、第二连接部27、连接柱28由聚甲醛热塑性结晶聚合物材料一体成形。四根柱状连接件21的高度均不相同,每根柱状连接件21的第一连接部26、第二连接部27的结构、形状均相同,尺寸也完全相同。用于连接第一连接部26、第二连接部27的连接柱28的高度不同,四根连接柱28呈等差数列排列,优选0mm、20mm、40mm、60mm。As shown in FIG. 6 , the cylindrical connector 21 includes a first connection portion 26 connected to the spherical calibration member 22 , a second connection portion 27 connected to the base plate 20 , and a second connection portion for connecting the first connection portion 26 and the second connection portion. 27 to connecting column 28. The first connecting part 26, the second connecting part 27, and the connecting column 28 are integrally formed of polyoxymethylene thermoplastic crystalline polymer material. The heights of the four columnar connectors 21 are all different, and the first connecting portion 26 and the second connecting portion 27 of each columnar connector 21 have the same structure and shape, and the same size. The connecting posts 28 used to connect the first connecting part 26 and the second connecting part 27 have different heights, and the four connecting posts 28 are arranged in an arithmetic sequence, preferably 0 mm, 20 mm, 40 mm, and 60 mm.
第一连接部26的内部设置有供球状标定件22沉入的圆柱状凹槽29,该凹槽29的深度大于球状标定件22的半径,但小于球状标定件22的直径的2/3,本实施例中凹槽29的深度优选21mm,直径优选19.9-20mm,借助于聚甲醛热塑性结晶聚合物材料的特性,使球状标定件22沉入凹槽29时有一点卡紧状态,需要使用一点力量才可以进入到凹槽29内部,从而可以使球状标定件22的球心完全处于凹槽29的正中心位置,并且球状标定件22进入凹槽29后不会发生转动等任何移动,使球状标定件22的球心始终处于凹槽29的正中心位置。为了能使球状标定件22能顺利地进入到凹槽29内,在凹槽29的内底部设有一个通气孔19。The first connecting part 26 is provided with a cylindrical groove 29 inside for the spherical calibration member 22 to sink into. The depth of the groove 29 is greater than the radius of the spherical calibration member 22 but less than 2/3 of the diameter of the spherical calibration member 22. In this embodiment, the depth of the groove 29 is preferably 21 mm, and the diameter is preferably 19.9-20 mm. With the help of the characteristics of the polyoxymethylene thermoplastic crystalline polymer material, the spherical calibration member 22 has a somewhat clamped state when sinking into the groove 29, and it needs to be used a little. Only when the force can enter the groove 29 can the center of the spherical calibration member 22 be completely in the center of the groove 29, and the spherical calibration member 22 will not rotate or move after entering the groove 29, making the spherical calibration member 22 completely in the center of the groove 29. The center of the ball of the calibration member 22 is always at the center of the groove 29 . In order to enable the spherical calibration member 22 to enter the groove 29 smoothly, a ventilation hole 19 is provided at the inner bottom of the groove 29 .
优选地,四个锁固件23采用硬橡胶支撑柱,能够保证标定板2放置在CT机上时稳定不滑动。 Preferably, the four locking members 23 use hard rubber support columns to ensure that the calibration plate 2 is stable and does not slide when placed on the CT machine.
本发明标定板2中棋盘格、柱状连接件21与球状标定件22的尺寸以及其在标定板2中的位置都是精确控制的,可以确保球状标定件22在CT机内可以清晰成像而又不会产生伪影,同时保证球状标定件22可以稳定固定在标定板中,使得球状标定件22中心点在标定板坐标系中的坐标精确。The size of the checkerboard grid, the columnar connector 21 and the spherical calibration member 22 in the calibration plate 2 of the present invention and their positions in the calibration plate 2 are precisely controlled, which can ensure that the spherical calibration member 22 can be clearly imaged in the CT machine and Artifacts will not be generated, and the spherical calibration member 22 can be stably fixed in the calibration plate, so that the coordinates of the center point of the spherical calibration member 22 in the calibration plate coordinate system are accurate.
如图1、图7、图8和图9所示,本发明中用于配准手术机器人坐标系与CT机坐标系的方法用于配准上CT机坐标系与机械臂坐标系,按以下步骤执行:As shown in Figure 1, Figure 7, Figure 8 and Figure 9, the method for registering the coordinate system of the surgical robot and the coordinate system of the CT machine in the present invention is used to register the coordinate system of the CT machine and the coordinate system of the robot arm, as follows Steps to perform:
1)将固定有3D结构光相机1的机械臂4移动至CT机6旁预定的手术区域内固定,在此步骤内,可以预先启动机械臂4并将机械臂4移动至预定位置。1) Move the robotic arm 4 fixed with the 3D structured light camera 1 to a predetermined surgical area next to the CT machine 6 and fix it. In this step, the robotic arm 4 can be started in advance and moved to a predetermined position.
2)将标定板2放置在CT机6的CT床上,并放置于3D结构光相机1能拍摄到的范围内。2) Place the calibration plate 2 on the CT bed of the CT machine 6 and within the range that the 3D structured light camera 1 can capture.
3)启动配准程序,机械臂4携带3D结构光相机1同步移动到预先设定(手术机器人程序内设定)好的第一位姿,执行以下步骤:3) Start the registration process, and the robotic arm 4 carries the 3D structured light camera 1 and moves synchronously to the preset first posture (set in the surgical robot program), and performs the following steps:
3.1)开启3D结构光相机1中的结构光源30,向标定板2投射波长为490nm的蓝紫LED光,并呈20幅条纹光栅在标定板2的标志结构24上,通过蓝紫LED光折射到DDP相机31,转换光栅条纹的格雷编码为实时数据,通过软件进行半精度匹配算法,再经过补丁算法形成点云图像,计算标定板2标志结构24中棋盘格的内容距离(棋盘角点到角点的距离),然后根据标定板2中标志结构24的真实值,进行偏差修正计算,得到第一位姿下标定板坐标系与相机坐标系的转换关系WBC1 3.1) Turn on the structured light source 30 in the 3D structured light camera 1, project blue-violet LED light with a wavelength of 490nm to the calibration plate 2, and form a 20-stripe grating on the logo structure 24 of the calibration plate 2, refracted by the blue-violet LED light to the DDP camera 31, convert the Gray code of the grating stripes into real-time data, perform a half-precision matching algorithm through the software, and then form a point cloud image through the patch algorithm, and calculate the content distance of the checkerboard in the mark structure 24 of the calibration plate 2 (checkerboard corner point to distance from the corner point), and then perform a deviation correction calculation based on the true value of the mark structure 24 in the calibration plate 2 to obtain the conversion relationship W BC1 between the calibration plate coordinate system and the camera coordinate system in the first attitude,
称标定板坐标系与相机坐标系的转换关系为第一转换矩阵WBCThe transformation relationship between the calibration plate coordinate system and the camera coordinate system is called the first transformation matrix W BC .
此步骤中涉及的具体算法为手眼标定算法,属于公知技术,具体原理及算法不再详细描述。 The specific algorithm involved in this step is a hand-eye calibration algorithm, which is a well-known technology, and the specific principles and algorithms will not be described in detail.
此步骤中蓝紫LED光的投射波长可以在450nm-550nm之间,并且根据不同的波长可以呈13-24幅条纹光栅在标定板2上,本实施例优选490nm的波长,并呈20幅条纹光栅在标定板2上,便于计算机软件的快速计算。In this step, the projection wavelength of the blue-violet LED light can be between 450nm and 550nm, and according to different wavelengths, it can have 13-24 stripes. The grating is placed on the calibration plate 2. In this embodiment, the wavelength of 490nm is preferred, and there are 20 stripes. The grating is on the calibration plate 2, which facilitates rapid calculation by computer software.
3.2)依据每一个位姿下机械臂位姿变换参数(坐标x、y、z和角度θx、θy、θz),获取第一位姿机械臂末端中心点在机械臂坐标系下的位姿表示,即该第一位姿的机械臂末端中心点坐标系与机械臂坐标系之间的转换关系,为第二转换矩阵WAT13.2) Based on the pose transformation parameters of the robot arm in each pose (coordinates x, y, z and angles θ x , θ y , θ z ), obtain the center point of the end of the robot arm in the robot arm coordinate system in the first posture The pose representation, that is, the transformation relationship between the coordinate system of the end center point of the robot arm and the coordinate system of the robot arm in the first posture, is the second transformation matrix W AT1 .
具体是通过转换矩阵的旋转矩阵和平移矩阵,再变换成4×4齐次变换矩阵WAT
Specifically, the rotation matrix and translation matrix of the transformation matrix are transformed into a 4×4 homogeneous transformation matrix W AT :
4)启动机械臂4移动至第二位姿,重复上述步骤3),分别获取第二位姿下标定板坐标系与相机坐标系的第一转换矩阵WBC2,机械臂4末端中心点与机械臂坐标系的第二转换矩阵WAT24) Start the robotic arm 4 to move to the second posture, repeat the above step 3), and obtain the first transformation matrix W BC2 of the calibration plate coordinate system and the camera coordinate system in the second posture, and the center point of the end of the robotic arm 4 and the mechanical The second transformation matrix W AT2 of the arm coordinate system;
如此反复,依序移动机械臂4至10个预定设定的不同位姿,分别获取每个位姿下的第一转换矩阵WBCi,为WBC1,WBC2,WBC3,…….WBC10;第二转换矩阵WATi,为:WAT1,WAT2,WAT3,…….WAT10Repeat this, move the robotic arm 4 to 10 different predetermined postures in sequence, and obtain the first transformation matrix W BCi in each posture, which is W BC1 , W BC2 , W BC3 , ....W BC10 ;The second conversion matrix W ATi is: W AT1 , W AT2 , W AT3 ,…….W AT10 .
5)获取相机坐标系与机械臂末端中心点坐标系之间的转换矩阵WCT5) Obtain the transformation matrix W CT between the camera coordinate system and the coordinate system of the center point of the end of the robot arm.
具体是:从步骤4)的10位姿中选取任意两个位姿(i,j)的第一转换矩阵WBCi,WBCj和第二转换矩阵WATi,WATj,根据以下等式(1)可以获得相机坐标系与机械臂末端中心点坐标系之间的转换关系,即转换矩阵WCT (ij)
WAT (i)WCT (ij)WBC (i)=WAT (j)WCT (ij)WBC (j)    (1)
Specifically: select the first transformation matrix W BCi , W BCj and the second transformation matrix W ATi , W ATj of any two poses (i, j) from the 10 poses in step 4), according to the following equation (1 ) can obtain the transformation relationship between the camera coordinate system and the coordinate system of the center point at the end of the manipulator, that is, the transformation matrix W CT (ij) .
W AT (i) W CT (ij) W BC (i) = W AT (j) W CT (ij) W BC (j) (1)
6)获取标定板坐标系与机械臂坐标系之间的转换矩阵WAB (ij)6) Obtain the transformation matrix W AB (ij) between the calibration plate coordinate system and the robot arm coordinate system.
依据以下等式(2)获取针对该两个位姿(i,j)的标定板坐标系与机械臂坐标系之间转换关系,即转换矩阵为WAB (ij)
WAB (ij)=WAT (i)WCT (ij)WBC (i)=WAT (j)WCT (ij)WBC (j)     (2)
According to the following equation (2), the transformation relationship between the calibration plate coordinate system and the robot arm coordinate system for the two poses (i, j) is obtained, that is, the transformation matrix is W AB (ij) .
W AB (ij) = W AT (i) W CT (ij) W BC (i) = W AT (j) W CT (ij) W BC (j) (2)
7)重复步骤5)、6),从10个位姿中选取两个不同位姿的第一转换矩阵WBC和第二转换矩阵WAT,两两组合后能够获得10*9/2=45个转换矩阵WAB (ij)。针对45个转换矩阵WAB (ij)中对应的相同变量求取平均值,将所有相同变量的平均值组合成标定板坐标系与机械臂坐标系的转换关系,称第三转换矩阵 7) Repeat steps 5) and 6) to select the first transformation matrix W BC and the second transformation matrix W AT of two different postures from the 10 postures. After combining the two, 10*9/2=45 can be obtained. transformation matrix W AB (ij) . Calculate the average value for the same variables corresponding to the 45 transformation matrices W AB (ij) , and combine the average values of all the same variables into the transformation relationship between the calibration plate coordinate system and the robot arm coordinate system, which is called the third transformation matrix
需要说明的是,本实施例中预设10个位姿,是结合了标定板2的结构尺寸和3D结构光相机1的特征参数,选定能够保证测量精度和转换矩阵计算精度的最佳位姿数量,位姿数量可以是4-20个之间,根据了标定板2的结构尺寸和3D结构光相机1的特征参数而定。It should be noted that the 10 preset poses in this embodiment are based on the structural size of the calibration plate 2 and the characteristic parameters of the 3D structured light camera 1, and the best position that can ensure the measurement accuracy and conversion matrix calculation accuracy is selected. The number of poses can be between 4 and 20, depending on the structural size of the calibration plate 2 and the characteristic parameters of the 3D structured light camera 1.
相同变量是指转换矩阵内每个相同位置的具体变量,如uABx,uABy,uABz等。The same variables refer to specific variables at each same position in the transformation matrix, such as u ABx , u ABy , u ABz , etc.
8)控制机械臂4收回,标定板2在CT机6上保持不动,启动CT机6对标定板2进行密扫。8) Control the robotic arm 4 to retract, keep the calibration plate 2 stationary on the CT machine 6, and start the CT machine 6 to closely scan the calibration plate 2.
得到标定板2上四个球状标定件22的CT影响数据,该影响数据中包含了图像中所有像素的CT值和三维CT坐标,通过以CT值为依据的图像识别算法和球心算法,计算出四个球状标定件22在CT坐标系下的球心坐标,用坐标矩阵B表示,结合四个球状标定件22球心在标定板2的坐标矩阵可以得到如下等式关系:
The CT influence data of the four spherical calibration parts 22 on the calibration plate 2 are obtained. The influence data includes the CT values and three-dimensional CT coordinates of all pixels in the image. Through the image recognition algorithm and the sphere center algorithm based on the CT values, the calculation Find the spherical center coordinates of the four spherical calibration parts 22 in the CT coordinate system, represented by the coordinate matrix B, Combining the coordinate matrix of the four spherical calibration parts 22 with the center of the sphere on the calibration plate 2 The following equation relationship can be obtained:
坐标矩阵B已经得到,可以对上面等式求解,从而计算获得CT坐标系到标定板坐标系的转换关系,称第四转换矩阵 The coordinate matrix B has been obtained. The above equation can be solved to calculate the transformation relationship from the CT coordinate system to the calibration plate coordinate system, which is called the fourth transformation matrix.
9)在得出标定板坐标系与机械臂坐标系的第三转换矩阵WAB、CT坐标系到标定板坐标系的第四转换矩阵WBD后,就可以按以下计算公式(3)获取CT机坐标系与机械臂坐标系之间的转换关系,称第五转换矩阵WAD
9) After obtaining the third transformation matrix W AB from the calibration plate coordinate system and the robot arm coordinate system, and the fourth transformation matrix W BD from the CT coordinate system to the calibration plate coordinate system, the CT can be obtained according to the following calculation formula (3) The transformation relationship between the machine coordinate system and the robot arm coordinate system is called the fifth transformation matrix W AD .
得出CT坐标系与机械臂坐标系的第五转换矩阵WAD后,就完成了CT机坐标系与机械臂坐标系的坐标配准,从而也就完成了CT机坐标系与手术机器人坐标系的坐标配准。After obtaining the fifth transformation matrix W AD between the CT coordinate system and the robot arm coordinate system, the coordinate registration of the CT machine coordinate system and the robot arm coordinate system is completed, thus completing the CT machine coordinate system and the surgical robot coordinate system. coordinate registration.
综上所述,本发明是将一台3D结构光相机固定在机械臂的末端,采用手在眼上的标定方法,无需采用另行设置的双目相机,可以有效减小CT室中各种背景光源对测量的影响,并且可以达到很高的测量精度。理论测量精度可以达到0.001mm,在实例的场景条件下,可以达到0.1mm的精度。 To sum up, the present invention fixes a 3D structured light camera at the end of the robotic arm and adopts a hand-on-eye calibration method. There is no need to use a separate binocular camera, which can effectively reduce various backgrounds in the CT room. The influence of light source on measurement can achieve high measurement accuracy. The theoretical measurement accuracy can reach 0.001mm, and under the scene conditions of the example, the accuracy can reach 0.1mm.

Claims (10)

  1. 一种用于配准手术机器人坐标系与CT机坐标系的方法,其特征在于,使用3D视觉系统将CT机坐标系与手术机器人中机械臂坐标系进行配准,所述3D视觉系统中的3D结构光相机随所述机械臂及所述机械臂末端固定安装的穿刺装置一起作同步移动。A method for registering the coordinate system of a surgical robot and the coordinate system of a CT machine, characterized in that a 3D vision system is used to register the coordinate system of the CT machine and the coordinate system of the mechanical arm in the surgical robot, and the 3D vision system The 3D structured light camera moves synchronously with the robotic arm and the puncture device fixedly installed at the end of the robotic arm.
  2. 根据权利要求1所述的用于配准手术机器人坐标系与CT机坐标系的方法,其特征在于,所述3D视觉系统包括有安装在所述机械臂末端、与所述穿刺装置固定成一个整体的3D结构光相机、能直接放置在所述CT机上且位于所述3D结构光相机拍摄范围内的标定板。The method for registering the surgical robot coordinate system and the CT machine coordinate system according to claim 1, wherein the 3D vision system includes a device installed at the end of the robotic arm and fixed to the puncture device. The overall 3D structured light camera and the calibration plate can be placed directly on the CT machine and located within the shooting range of the 3D structured light camera.
  3. 根据权利要求2所述的用于配准手术机器人坐标系与CT机坐标系的方法,用于配准上CT机坐标系与机械臂坐标系,其特征在于,按以下步骤执行:The method for registering the coordinate system of the surgical robot and the coordinate system of the CT machine according to claim 2, which is used to register the coordinate system of the CT machine and the coordinate system of the robotic arm, is characterized in that it is performed according to the following steps:
    1)将固定有3D结构光相机的机械臂移动至CT机旁的手术区域内;1) Move the robotic arm fixed with the 3D structured light camera to the surgical area next to the CT machine;
    2)将所述标定板放置在所述CT机上,且位于所述3D结构光相机能拍摄到的范围内;2) Place the calibration plate on the CT machine and within the range that can be photographed by the 3D structured light camera;
    3)启动配准程序,所述机械臂携带所述3D结构光相机依序移动到多个位姿,移动至每个位姿后均开启所述3D结构相机投射多组结构光并采集结构光投射到的所述标定板中标定结构的照片,通过计算机软件记录下每个位姿的机械臂变换参数和所述标定板中标定结构的照片,运用手眼标定算法,获取所述标定板坐标系与机械臂坐标系的转换关系,为第三转换矩阵;3) Start the registration process. The robotic arm carries the 3D structured light camera and moves to multiple poses in sequence. After moving to each pose, the 3D structured light camera is turned on to project multiple sets of structured light and collect the structured light. Project the photos of the calibration structure in the calibration plate, record the transformation parameters of the robot arm in each posture and the photos of the calibration structure in the calibration plate through computer software, and use the hand-eye calibration algorithm to obtain the coordinate system of the calibration plate. The transformation relationship with the robot arm coordinate system is the third transformation matrix;
    4)所述机械臂收回到初始位置,所述标定板继续放在所述CT机上保持不动,启动CT机对所述标定板进行扫描;获取所述标定板上四个球状标定件的CT影像数据,结合四个球状标定件的球心针对所述标定板的坐标矩阵,获得CT坐标系与所述标定板坐标系之间的转换关系,为第四转换矩阵;4) The robotic arm is retracted to the initial position, the calibration plate continues to be placed on the CT machine and remains motionless, and the CT machine is started to scan the calibration plate; CT scans of the four spherical calibration parts on the calibration plate are obtained. The image data is combined with the coordinate matrix of the spherical center of the four spherical calibration parts against the calibration plate to obtain the conversion relationship between the CT coordinate system and the calibration plate coordinate system, which is the fourth conversion matrix;
    5)依据所述标定板坐标系与机械臂坐标系之间的第三转换矩阵、所述CT机坐标系与所述标定板坐标系之间的第四转换矩阵,获取所述CT机坐标系与机械臂坐标系之间的转换关系,为第五转换矩阵,完成所述CT机坐标系与机械臂坐标系的坐标配准。5) Obtain the CT machine coordinate system based on the third transformation matrix between the calibration plate coordinate system and the robot arm coordinate system and the fourth transformation matrix between the CT machine coordinate system and the calibration plate coordinate system. The conversion relationship with the robot arm coordinate system is the fifth transformation matrix, which completes the coordinate registration between the CT machine coordinate system and the robot arm coordinate system.
  4. 根据权利要求3所述的用于配准手术机器人坐标系与CT机坐标系的方法,其特征在于,所述步骤3)中,按以下步骤执行:The method for registering the surgical robot coordinate system and the CT machine coordinate system according to claim 3, characterized in that in step 3), the following steps are performed:
    3.1)启动配准程序,所述机械臂携带所述3D结构光相机依序移动至n个预先设定的不同位姿,移动至每个位姿后分别获取每个位姿下所述标定板坐标系与所述相机坐标系之间的转换关系,为第一转换矩阵WBC;机械臂末端中心点与所述机械臂坐标系之间的转换关系,为第二转换矩阵WAT3.1) Start the registration procedure. The robotic arm carries the 3D structured light camera and moves to n different preset poses in sequence. After moving to each pose, the calibration plate in each pose is acquired. The conversion relationship between the coordinate system and the camera coordinate system is the first conversion matrix W BC ; the conversion relationship between the end center point of the robotic arm and the robotic arm coordinate system is the second conversion matrix W AT ;
    3.2)选取其中两个位姿(i,j)对应的第一转换矩阵WBC和第二转换矩阵WAT,根据以下等式(1)获取所述相机坐标系与机械臂末端中心点坐标系的转换矩阵WCT (ij)
    WAT (i)WCT (ij)WBC (i)=WAT (j)WCT (ij)WBC (j)     (1)
    3.2) Select the first transformation matrix W BC and the second transformation matrix W AT corresponding to two of the poses (i, j), and obtain the camera coordinate system and the robot end center point coordinate system according to the following equation (1) The transformation matrix W CT (ij) ;
    W AT (i) W CT (ij) W BC (i) = W AT (j) W CT (ij) W BC (j) (1)
    3.3)依据以下等式(2)获取针对该两个位姿(i,j)的标定板坐标系与机械臂坐标系的两个转换矩阵WAB (ij)
    WAB (ij)=WAT (i)WCT (ij)WBC (i)=WAT (j)WCT (ij)WBC (j)    (2)
    3.3) Obtain the two transformation matrices W AB (ij ) of the calibration plate coordinate system and the robot arm coordinate system for the two poses (i, j) according to the following equation (2);
    W AB (ij) = W AT (i) W CT (ij) W BC (i) = W AT (j) W CT (ij) W BC (j) (2)
    3.4)重复步骤3.2)、3.3),从2n个位姿中选取两个不同位姿的第一转换矩阵WBC和第二转换矩阵WAT,组合后能够获得n*(n-1)/2个所述转换矩阵WAB (ij);针对n*(n-1)/2个所述转换矩阵WAB (ij)中对应的相同变量求取平均值,将所有相同变量的平均值组合成标定板坐标系与机械臂坐标系的转换关系,称第三转换矩阵 3.4) Repeat steps 3.2) and 3.3) to select the first transformation matrix W BC and the second transformation matrix W AT of two different postures from 2n postures. After combination, n*(n-1)/2 can be obtained the conversion matrices W AB (ij) ; calculate the average value for the same variables corresponding to the n*(n-1)/2 conversion matrices W AB (ij) , and combine the average values of all the same variables into The conversion relationship between the calibration plate coordinate system and the robot arm coordinate system is called the third conversion matrix
  5. 根据权利要求4所述的用于配准手术机器人坐标系与CT机坐标系的方法,其特征在于,所述步骤3.1)中,所述机械臂移动至每个位姿后均执行以下步骤: The method for registering the surgical robot coordinate system and the CT machine coordinate system according to claim 4, characterized in that in step 3.1), the following steps are performed after the robotic arm moves to each posture:
    3.1.1)所述3D结构光相机向所述标定板投射结构光,采集结构光投射到的所述标定板中标志结构的照片,由计算机软件记录下机械臂的位姿变换参数和结构光投射到的所述标定板中标志结构的照片,通过手眼标定算法获取针对该位姿的所述标定板坐标系与所述3D结构光相机中心点坐标系之间的转换关系,为第一转换矩阵WBC3.1.1) The 3D structured light camera projects structured light to the calibration plate, collects photos of the mark structure in the calibration plate projected by the structured light, and records the posture transformation parameters of the robotic arm and the structured light by computer software The photo of the landmark structure in the calibration plate is projected onto the camera, and the conversion relationship between the coordinate system of the calibration plate and the center point coordinate system of the 3D structured light camera for this pose is obtained through the hand-eye calibration algorithm, which is the first conversion. matrix W BC ;
    3.1.2)依据每一个位姿下机械臂位姿变换参数,获取机械臂末端中心点在机械臂坐标系下的位姿表示,即该位姿的机械臂末端中心点坐标系与机械臂坐标系之间的转换关系,为第二转换矩阵WAT3.1.2) Based on the pose transformation parameters of the robot arm in each pose, obtain the pose representation of the center point of the robot arm in the robot arm coordinate system, that is, the coordinate system of the center point of the robot arm end and the coordinates of the robot arm in this pose The conversion relationship between systems is the second conversion matrix W AT .
  6. 根据权利要求4所述的用于配准手术机器人坐标系与CT机坐标系的方法,其特征在于,步骤3)中所述3D结构光相机随所述机械臂移动的位姿数量为4-20之间的偶数。The method for registering the coordinate system of the surgical robot and the coordinate system of the CT machine according to claim 4, characterized in that in step 3), the number of postures that the 3D structured light camera moves with the robotic arm is 4- An even number between 20.
  7. 根据权利要求5所述的用于配准手术机器人坐标系与CT机坐标系的方法,其特征在于,步骤3.1.1)中所述3D结构光相机投射波长为490nm的蓝紫LED光,呈13-24幅条纹光栅至所述标定板。The method for registering the surgical robot coordinate system and the CT machine coordinate system according to claim 5, characterized in that the 3D structured light camera in step 3.1.1) projects blue-violet LED light with a wavelength of 490 nm. 13-24 fringe gratings to the calibration plate.
  8. 根据权利要求3-7任意一项所述的用于配准手术机器人坐标系与CT机坐标系的方法,其特征在于,所述标定板包括有基板,四个球状标定件,用于固定连接所述基板和所述球状标定件的柱状连接件,用于锁固所述柱状连接件和所述基板的锁固件,每根所述柱状连接件的高度呈等差分列分布,所有柱状连接件均固定设置在所述基板的同一侧表面,所述基板位于所述柱状连接件设置的侧面表面设置有棋盘格。The method for registering the surgical robot coordinate system and the CT machine coordinate system according to any one of claims 3 to 7, characterized in that the calibration plate includes a base plate and four spherical calibration parts for fixed connection. The columnar connector between the base plate and the spherical calibration piece is used to lock the columnar connector and the base plate. The height of each columnar connector is distributed in equal rows, and all columnar connectors are They are all fixedly arranged on the same side surface of the base plate, and the base plate is provided with a checkerboard pattern on the side surface where the columnar connector is provided.
  9. 根据权利要求8所述的用于配准手术机器人坐标系与CT机坐标系的方法,其特征在于,所述柱状连接件包括有与所述球状标定件连接的第一连接部,与所述基板连接的第二连接部,所述第一连接部设置有供所述球状标定件沉入的圆柱状凹槽,所述凹槽的深度大于所述球状标定件的半径,所述凹槽的内径小于等于所述球状标定件的直径。The method for registering the coordinate system of the surgical robot and the coordinate system of the CT machine according to claim 8, characterized in that the cylindrical connector includes a first connection portion connected to the spherical calibration member, and the The second connection part for connecting the substrate, the first connection part is provided with a cylindrical groove for the spherical calibration piece to sink into, the depth of the groove is greater than the radius of the spherical calibration piece, and the groove is The inner diameter is less than or equal to the diameter of the spherical calibration component.
  10. 一种用于上述权利要求1-9中任意一项所述的用于配准手术机器人坐标系与CT机坐标系的方法的系统,与手术机器人控制台、机械臂、CT机配合使用的3D结构光相机和标定板,其特征在于,所述3D结构光相机与所述机械臂末端安装的穿刺装置固定安装一起,与所述穿刺装置一起随所述机械臂的移动而移动。 A system for the method of registering a surgical robot coordinate system and a CT machine coordinate system according to any one of the above claims 1-9, a 3D system used in conjunction with a surgical robot console, a robotic arm, and a CT machine Structured light camera and calibration plate, characterized in that the 3D structured light camera is fixedly installed with the puncture device installed at the end of the robotic arm, and moves together with the puncture device with the movement of the robotic arm.
PCT/CN2023/125927 2023-04-07 2023-10-23 Method and system for registration of surgical robot coordinate system with ct scanner coordinate system WO2024027857A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202380012400.1A CN117835933A (en) 2023-04-07 2023-10-23 Method and system for registering surgical robot coordinate system and CT machine coordinate system

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202310365385.0 2023-04-07
CN202310365385.0A CN116392246A (en) 2023-04-07 2023-04-07 Method and system for registering surgical robot coordinate system and CT machine coordinate system

Publications (1)

Publication Number Publication Date
WO2024027857A1 true WO2024027857A1 (en) 2024-02-08

Family

ID=87008632

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2023/125927 WO2024027857A1 (en) 2023-04-07 2023-10-23 Method and system for registration of surgical robot coordinate system with ct scanner coordinate system

Country Status (2)

Country Link
CN (2) CN116392246A (en)
WO (1) WO2024027857A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116392246A (en) * 2023-04-07 2023-07-07 苏州派尼迩医疗科技有限公司 Method and system for registering surgical robot coordinate system and CT machine coordinate system
CN116563297B (en) * 2023-07-12 2023-10-31 中国科学院自动化研究所 Craniocerebral target positioning method, device and storage medium

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6321137B1 (en) * 1997-09-04 2001-11-20 Dynalog, Inc. Method for calibration of a robot inspection system
CN114643578A (en) * 2020-12-18 2022-06-21 沈阳新松机器人自动化股份有限公司 Calibration device and method for improving robot vision guide precision
CN217162286U (en) * 2021-12-13 2022-08-12 浙江德尚韵兴医疗科技有限公司 Measuring tool for positioning precision of tail end of optical navigation robot based on medical image
CN115553888A (en) * 2022-10-28 2023-01-03 苏州派尼迩医疗科技有限公司 Puncture robot integrating 3D camera and needle inserting device and puncture method
CN116392246A (en) * 2023-04-07 2023-07-07 苏州派尼迩医疗科技有限公司 Method and system for registering surgical robot coordinate system and CT machine coordinate system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6321137B1 (en) * 1997-09-04 2001-11-20 Dynalog, Inc. Method for calibration of a robot inspection system
CN114643578A (en) * 2020-12-18 2022-06-21 沈阳新松机器人自动化股份有限公司 Calibration device and method for improving robot vision guide precision
CN217162286U (en) * 2021-12-13 2022-08-12 浙江德尚韵兴医疗科技有限公司 Measuring tool for positioning precision of tail end of optical navigation robot based on medical image
CN115553888A (en) * 2022-10-28 2023-01-03 苏州派尼迩医疗科技有限公司 Puncture robot integrating 3D camera and needle inserting device and puncture method
CN116392246A (en) * 2023-04-07 2023-07-07 苏州派尼迩医疗科技有限公司 Method and system for registering surgical robot coordinate system and CT machine coordinate system

Also Published As

Publication number Publication date
CN116392246A (en) 2023-07-07
CN117835933A (en) 2024-04-05

Similar Documents

Publication Publication Date Title
WO2024027857A1 (en) Method and system for registration of surgical robot coordinate system with ct scanner coordinate system
CN114041875B (en) Integrated operation positioning navigation system
US9542743B2 (en) Calibration and transformation of a camera system's coordinate system
US6275725B1 (en) Stereotactic optical navigation
CN112451093B (en) Physical space and image space registration method for image-guided robot minimally invasive surgery
CN113347937A (en) Registration of frame of reference
US10832408B2 (en) Patient registration systems, devices, and methods for a medical procedure
CN111973212B (en) Parameter calibration method and parameter calibration device
CN111060006A (en) Viewpoint planning method based on three-dimensional model
US20220054199A1 (en) Robotic surgery systems and surgical guidance methods thereof
CN112229323B (en) Six-degree-of-freedom measurement method of checkerboard cooperative target based on monocular vision of mobile phone and application of six-degree-of-freedom measurement method
Meng et al. An automatic markerless registration method for neurosurgical robotics based on an optical camera
KR101662323B1 (en) Three-axis Motion Tracking Device for Medical Image Device and Method of Correcting Medical Image Using the Same
CN116883471B (en) Line structured light contact-point-free cloud registration method for chest and abdomen percutaneous puncture
WO2022237787A1 (en) Robot positioning and pose adjustment method and system
CN114463482A (en) Calibration model and method of optical tracking three-dimensional scanner and surgical navigation system thereof
CN112132903A (en) Coordinate system calibration method and system for vision system and multi-axis motion system
CN117357217A (en) System calibration method of percutaneous puncture mechanical arm
JP6974030B2 (en) Registration markers, registration marker utilization programs, and how to operate the robot system
US20220047334A1 (en) Systems and methods for magnetic resonance imaging guided robotics
CN115588011B (en) X-ray machine projection model parameter calibration method
CN111833396B (en) Method and system for converting camera coordinate system of blood sampling device into world coordinate system
US20230248467A1 (en) Method of medical navigation
US20210068781A1 (en) Ultrasonic imaging system
CN110051433B (en) Method for keeping track of target and application thereof in image-guided surgery

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 23849561

Country of ref document: EP

Kind code of ref document: A1