CN113331948B - Interventional operation robot system, calibration device and calibration method - Google Patents
Interventional operation robot system, calibration device and calibration method Download PDFInfo
- Publication number
- CN113331948B CN113331948B CN202110595080.XA CN202110595080A CN113331948B CN 113331948 B CN113331948 B CN 113331948B CN 202110595080 A CN202110595080 A CN 202110595080A CN 113331948 B CN113331948 B CN 113331948B
- Authority
- CN
- China
- Prior art keywords
- calibration
- mechanical arm
- tool
- optical
- tail end
- 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
- 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
- A61B90/00—Instruments, 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/36—Image-producing devices or illumination devices not otherwise provided for
- A61B90/37—Surgical systems with images on a monitor during operation
-
- 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/2055—Optical tracking systems
-
- 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/2059—Mechanical position encoders
-
- 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/2065—Tracking using image or pattern recognition
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B90/00—Instruments, 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/36—Image-producing devices or illumination devices not otherwise provided for
- A61B90/37—Surgical systems with images on a monitor during operation
- A61B2090/376—Surgical systems with images on a monitor during operation using X-rays, e.g. fluoroscopy
- A61B2090/3762—Surgical systems with images on a monitor during operation using X-rays, e.g. fluoroscopy using computed tomography systems [CT]
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Engineering & Computer Science (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Medical Informatics (AREA)
- Public Health (AREA)
- Heart & Thoracic Surgery (AREA)
- Veterinary Medicine (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Biomedical Technology (AREA)
- Robotics (AREA)
- Gynecology & Obstetrics (AREA)
- Radiology & Medical Imaging (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Pathology (AREA)
- Apparatus For Radiation Diagnosis (AREA)
Abstract
The invention relates to the technical field of medical instruments, and aims to provide an interventional operation robot system, a calibration device and a calibration method. The calibration device comprises an optical locator, a calibration tool, an optical tool and a calibration plate; the main body of the calibration tool is in a rod shape, one end of the main body is provided with a flange plate for connecting to the tail end of the mechanical arm, and the tail end of the rod-shaped main body is in a hemisphere or sphere shape; the number of the optical tools is at least three, and the optical tools are rigid bodies with reflective balls; and a plurality of vertical supporting columns are distributed on the surface of the calibration plate, and spherical grooves matched with the tail ends of the calibration tools in shape are formed in the top ends of the supporting columns. The interventional operation robot system can convert an image coordinate system and a mechanical arm coordinate system at any position by using the calibration method of the invention, thereby reducing errors caused by the movement of the position of the mechanical arm.
Description
Technical Field
The invention belongs to the technical field of medical instruments, and particularly relates to an interventional operation robot system, a calibration device and a calibration method.
Background
The percutaneous interventional operation refers to the process of accurately placing surgical instruments (such as a puncture needle, a biopsy needle, an ablation needle and the like) into organs in a patient body for tissue extraction or treatment under the guidance of medical images (B-ultrasound, MRI, CT and the like), has the characteristics of small wound, few complications and quick postoperative recovery, and is a great revolution of the traditional open type operation. The traditional interventional operation mainly depends on the experience and skill of doctors, so that the treatment effect is different, and the problems of inaccurate positioning and difficult path planning in the puncture process also exist.
The interventional operation robot can establish the puncture interventional operation on the basis of more science, controllability and predictability by using technical means such as three-dimensional path planning, real-time target point tracking and the like. The interventional operation robot can not only improve the accuracy of operation, but also reduce the dependence on doctor experience and reduce the labor intensity of doctors. The key to the implementation of the interventional robot system is as follows: the process of establishing the conversion relation is called the calibration process of the interventional operation robot, and a certain tool is needed in the calibration process.
The calibration of the existing interventional operation robot generally installs an optical tool on the body surface of a patient, obtains the physical space position information of the optical tool by using an optical position finder, and realizes the unification of an image space and a physical space by solving a transformation matrix between a mark point corresponding to the image space and a physical space coordinate obtained by the optical position finder. However, the calibration method has high requirements on the installation position of the optical tool, shielding cannot exist, and calibration needs to be performed again if the position of the mechanical arm changes after calibration is completed.
Disclosure of Invention
The invention aims to solve the technical problem of overcoming the defects in the prior art and provides an interventional surgical robot system, a calibration device and a calibration method.
In order to solve the technical problem, the solution of the invention is as follows:
the calibration device for the interventional operation robot comprises an optical positioning instrument, a calibration tool, an optical tool and a calibration plate; the main body of the calibration tool is in a rod shape, one end of the main body is provided with a flange plate for connecting to the tail end of the mechanical arm, and the tail end of the rod-shaped main body is in a hemispherical body or a spherical body; at least three optical tools are rigid bodies with reflective balls; and a plurality of vertical supporting columns are distributed on the surface of the calibration plate, and spherical grooves matched with the tail ends of the calibration tools in shape are formed in the top ends of the supporting columns.
As a preferred scheme, the rigid body of the optical tool is in a cross shape, and the reflective ball is fixed on the rigid body; the rigid body is provided with a screw hole for passing through a screw to be installed.
As a preferred scheme, the calibration plate is made of acrylic materials, and handles are arranged on two sides of the calibration plate.
Preferably, the number of the pillars on the surface of the calibration plate is at least 4, and the heights of the pillars are different; and the number of the ceramic balls which are the same as that of the pillars and are opaque to X-rays are also arranged, and the diameter of the ceramic balls is matched with the grooves at the top ends of the pillars.
Preferably, the flange plate is provided with a positioning pin.
The invention also provides an interventional operation robot system with a calibration function, which comprises a navigation main control computer, scanning equipment (CT) and a mechanical arm with a steering joint, wherein the navigation main control computer is respectively connected with the scanning equipment and a driving motor of the mechanical arm in a wired or wireless mode; the system further comprises the calibration device of claim 1; the optical locator and the mechanical arm are arranged on the same base; the two optical tools are arranged at different positions on a ceiling right above a CT (computed tomography) bed in an operating room and are used for assisting in confirming the displacement condition of the optical position finder; the other optical tool is arranged on the rod-shaped main body of the calibration tool and is used for assisting in confirming the displacement condition of the mechanical arm.
The invention further provides a calibration method of the interventional operation robot, which comprises the following steps:
(1) Acquiring an offset vector of a ball center at the tail end of a calibration tool in an optical position indicator coordinate system;
(2) Acquiring the offset of the center of the tail end of the calibration tool in the coordinates of the mechanical arm;
(3) Registering coordinate systems of the optical locator and the mechanical arm by using results obtained in the steps (1) and (2) to obtain a transformation matrix Mnu between the two coordinate systems;
(4) Registering the CT scanning image and the mechanical arm coordinate system to obtain a transformation matrix Miu between the CT scanning image and the mechanical arm coordinate system;
(5) And (5) converting the coordinates of the target point in the CT scanning image into the coordinates of the mechanical arm based on the registration results of different coordinate systems in the steps (3) and (4), thereby completing the calibration of the interventional operation robot.
In the present invention, the step (1) specifically includes:
(1.1) mounting an optical tool on a rod-shaped main body of a calibration tool, and fixing the calibration tool at the tail end of a mechanical arm through a flange plate; the calibration Tool with the same length replaces the actual surgical instrument to be used, so that the optical Tool is positioned at the Tool Center Point (TCP) of the mechanical arm, and the calibration operation is carried out on the basis of the position;
(1.2) taking the sphere center of a hemisphere or a sphere at the tail end of the calibration tool as a center, and operating the mechanical arm to rotate the calibration tool to perform conical motion at an angle smaller than 60 degrees; meanwhile, the offset vectors of the spherical center at the tail end of the calibration tool and the optical tool are obtained by using the matched system software of the optical locator.
In the present invention, the step (2) specifically includes:
and aligning the center of the ball at the tail end of the calibration tool to the same point in the space in 4 different postures by utilizing the tool center point calibration function of the mechanical arm demonstrator to obtain the offset vector of the tool center point of the mechanical arm and the center of the ball at the tail end of the calibration tool.
In the present invention, the step (3) specifically includes:
(3.1) adjusting the mechanical arm to enable the mechanical arm to present K different poses, and ensuring that an optical tool on the calibration tool always faces the optical position finder;
(3.2) obtaining K pairs of different coordinate data { N1, U1}, { N2, U2}. The end spherical center of the calibration tool in coordinate systems of the mechanical arm and the optical position finder respectively according to results obtained in the steps (1) and (2), wherein K is less than or equal to 4 and less than or equal to 10;
and (3.3) constructing a matrix by using K pairs of coordinate data { N1, U1}, { N2, U2}. }. { NK, UK }, and decomposing the matrix by Singular Value Decomposition (SVD) to obtain a transformation matrix Mnu between the mechanical arm and the optical position finder coordinate system.
In the present invention, the step (4) specifically includes:
(4.1) placing the calibration plate on the CT bed plate to be fixed, and placing X-ray opaque ceramic balls in the grooves at the top ends of all the support columns as target points; performing CT scanning on the calibration plate to obtain an image, wherein all target points are ensured to be included in the image in the scanning process;
(4.2) opening the CT scanning image of the calibration plate, and identifying the spherical center coordinate I1 in the image; under the demonstrator mode of the mechanical arm, putting the hemispheroid or the sphere at the tail end of the calibration tool into the groove of each strut in sequence; recording a coordinate U1 of the mechanical arm, and sequentially performing the operations on all pillars In the CT scanning image to obtain n sets of image coordinates and mechanical arm coordinates, { I1, U1}, { I2, U2}, and. N is more than or equal to 4 and less than or equal to 10;
and (4.3) constructing a matrix by using the n pairs of coordinate data { I1, U1}, { I2, U2}, (9.3) obtained In the step (4.2), and performing SVD (space vector decomposition) on the matrix to obtain a transformation matrix Miu between the image and the mechanical arm coordinate system.
Preferably, in the step (4.1), the scanning is performed again after the position of the calibration plate is adjusted; repeating this operation to obtain at least 3 phase CT scan images, optionally one of the phase images is used in the operation of step (4.2).
Preferably, the step (5) specifically comprises:
(5.1) under the condition that the mechanical arm trolley does not move, converting the coordinate img0 of the target point in the CT scanning image into the mechanical arm coordinate: u0= Miu img0;
(5.2) under the condition that the mechanical arm trolley moves, converting the coordinate img0 of the target point in the CT scanning image into a mechanical arm coordinate u1 in the following mode:
(5.2.1) calculating displacement data Tn of the optical locator according to the positioning data of the two optical tools which are arranged at different positions on the ceiling right above the CT bed of the operating room;
(5.2.2) because the optical position finder and the mechanical arm are fixed on the same trolley, the relative positions of the optical position finder and the mechanical arm are fixed; calculating the displacement of the mechanical arm according to the displacement of the optical locator: tu = Mnu -1 *Tn*Mnu,Mnu -1 An inverse matrix to matrix Mnu;
(5.2.3) converting the coordinates of the target point in the CT scanning image into mechanical arm coordinates: u1= Tu Miu img0.
Compared with the prior art, the invention has the beneficial effects that:
after the interventional operation robot system uses the calibration method, the image coordinate system and the mechanical arm coordinate system can be converted at any position, and errors caused by the movement of the position of the mechanical arm are reduced.
Drawings
Fig. 1 is a schematic view of an interventional surgical robotic system of the present invention.
The reference numbers in the figures are: a mechanical arm 1; an optical tool 2; a calibration tool 3; a calibration plate 4; an optical tool 6; an optical tool 7; an optical position finder 8; struts 5-1 to 5-7; 5-8 of grooves.
Detailed Description
The present invention will be further described with reference to the following examples.
As shown in fig. 1, the calibration device for the interventional operation robot comprises an optical locator 8, a calibration tool 3, optical tools 2, 6 and 7 and a calibration plate 4; the main body of the calibration tool 3 is in a rod shape, one end of the calibration tool is provided with a flange plate for connecting to the tail end of the mechanical arm, the flange plate is provided with a positioning pin, and the tail end of the rod-shaped main body is in a hemispheroid or a sphere shape; the rigid bodies of the optical tools 2, 6 and 7 are in a cross shape, and the reflective balls are fixed on the rigid bodies; the rigid body is provided with a screw hole for passing through a screw to be installed. The calibration plate 4 is made of acrylic material, and handles are arranged on two sides of the calibration plate; 7 vertical pillars 5-1 to 5-7 are arranged on the surface of the calibration plate 4, the heights of the pillars are different, and the tops of the pillars are provided with spherical grooves 5-8 matched with the shapes of the tail ends of the calibration tools 3. And the number of the ceramic balls which are not transparent to X-rays and are the same as that of the pillars are also arranged, and the diameter of the ceramic balls is matched with the grooves 5-8 at the top ends of the pillars. In this embodiment, the optical locating instrument and the optical tool may be manufactured and sold as a kit by Northern Digital inc. And when the offset vectors of the spherical center at the tail end of the calibration tool and the optical tool are obtained, the calibration can be realized through the Pivot function of Track software matched with the NDI optical position finder system.
The interventional operation robot system with the calibration function comprises a navigation main control computer (not shown in the figure), scanning equipment (not shown in the figure), a mechanical arm with a steering joint and the calibration device. The navigation main control computer is respectively connected with the scanning device (CT) and the driving motor of the mechanical arm 1 in a wired or wireless mode. And the CT sends the scanned image to a navigation main control computer, and the navigation main control computer sends the planned plan to the mechanical arm for execution. Wherein, the optical position finder 8 and the mechanical arm 1 are arranged on the same base; wherein, the two optical tools 6 and 7 are arranged at different positions on the ceiling right above the CT bed of the operating room and are used for assisting to confirm the displacement condition of the optical positioner; another optical tool 2 is mounted on the rod-like body of the calibration tool 3 for assisting in confirming the displacement of the robot arm 1.
The calibration method of the interventional operation robot system comprises the following steps:
step 1: and calculating an offset vector n _ tip _ vec of the center of the sphere at the tail end of the calibration tool 3 in a coordinate system of the optical locator 8.
The optical tool 2 is arranged on a rod-shaped main body of a calibration tool 3, and then the calibration tool 3 is fixed at the tail end of the mechanical arm 1 through a flange plate; the invention replaces the actual surgical instrument to be used with the calibration Tool 3 with the same length, so that the optical Tool 2 is positioned at the Tool Center Point (TCP) of the mechanical arm 1, and the calibration operation is carried out based on the position;
and taking the spherical center at the tail end of the calibration tool 3 as a center, rotating the calibration tool 3 by operating the mechanical arm 1 to perform conical motion with an angle less than 60 degrees, and obtaining an offset vector n _ tip _ vec of the spherical center and the optical tool 2 by utilizing a Pivot function of Track software provided by an optical locator 8 system. To eliminate the error, 10 repetitions were performed, averaging the orientation amounts n _ tip _ vec.
And 2, step: and calculating the offset u _ tcp _ vec of the center of the sphere at the tail end of the calibration tool 3 under the coordinate of the mechanical arm.
And (3) aligning the sphere center at the tail end of the calibration tool 3 to the same point in the space by using the calibration function of the demonstrator TCP of the mechanical arm and 4 different postures, and calculating to obtain a sphere center offset vector u _ TCP _ vec at the tail end of the mechanical arm TCP and the calibration tool 3. To eliminate the error, 10 repetitions were performed, and the average of the orientation amounts u _ tcp _ vec was calculated.
And step 3: registering the optical locator 8 and the mechanical arm coordinate system to obtain a transformation matrix between the mechanical arm 1 and the optical locator 8 coordinate system: mnu.
Step 3.1: the optical tool 2 is fixed on the calibration tool 3, and the calibration tool 3 is fixed at the position of the mechanical arm TCP.
Step 3.2: and moving the mechanical arm 1 to 10 different poses, enabling the optical tool 2 on the calibration tool 3 to face the optical position finder 8 all the time, and obtaining 10 pairs of different coordinates { N1, U1}, { N2, U2}. The { N10, U10} of the center of the sphere at the tail end of the calibration tool 3 under the coordinate systems of the mechanical arm 1 and the optical position finder 8 respectively by using the N _ tip _ vec and the U _ tcp _ vec obtained in the step 1,2.
Step 3.3: a matrix is constructed for the coordinates by using { N1, U1}, { N2, U2}. { N10, U10}10, and Singular Value Decomposition (SVD) is performed for the matrix to obtain a transformation matrix between the coordinate systems of the robot arm 1 and the optical position finder 8: mnu.
And 4, step 4: carrying out registration on the CT scanning image and the mechanical arm 1 coordinate system to obtain a transformation matrix between the image and the mechanical arm coordinate system: miu.
Step 4.1: ceramic balls are placed in the grooves at the tops of 7 stand columns on the calibration plate 4, and CT scanning is respectively carried out on 3 different positions of the calibration plate 4 on a CT bed plate to obtain 3-stage images. It is ensured that all ceramic balls are included in the image during the scanning.
Step 4.2: and fixing the calibration tool 3 at the position of the mechanical arm TCP.
Step 4.3: opening a first-stage calibration plate image at will, identifying a center coordinate I1 in the image, placing a ball at the tail end of a calibration tool 3 in a groove of a corresponding upright column by using a demonstrator mode of a mechanical arm 1, recording a coordinate U1 of the mechanical arm, and sequentially performing the operations on all struts in a CT scanning image to obtain 7 groups of image coordinates and mechanical arm coordinates, { I1, U1}, { I2, U2}, { I7, U7}, }
Step 4.4: and (3) constructing a matrix for the coordinates by using the { I1, U1}, { I2, U2},. The { I7, U7}7, and carrying out SVD (singular value decomposition) on the matrix to obtain a transformation matrix between the image and the mechanical arm coordinate system: miu.
And 5: and converting the coordinates of the positioning image into the coordinates of the mechanical arm.
Under the condition that the mechanical arm trolley does not move, calculating image coordinates to mechanical arm coordinates: u0= Miu img0.
Under the condition that the mechanical arm trolley moves, the image coordinate is converted into a mechanical arm coordinate u1 according to the following steps:
step 5.1.1: the displacement of the optical position finder 8 is calculated from its positioning data by means of two fixed position optical tools 6, 7: tn.
Step 5.1.2: optical positioning appearance 8 and arm 1 are installed on same base, and both relative positions are fixed, and the displacement of arm 1 is calculated by optical positioning appearance 8's displacement: tu = Mnu -1 *Tn*Mnu。
Step 5.1.3: and (3) calculating image coordinates to mechanical arm coordinates: u1= Tu Miu img0.
The above embodiments are only used for illustrating the present invention, and the structure, connection mode, manufacturing process, etc. of each component may be changed, and all equivalent changes and modifications performed on the basis of the technical solution of the present invention should not be excluded from the scope of protection of the present invention.
Claims (11)
1. An interventional operation robot system with a calibration function comprises a navigation main control computer, scanning equipment and a mechanical arm with a steering joint, wherein the navigation main control computer is respectively connected with the scanning equipment and a driving motor of the mechanical arm in a wired or wireless mode; the system is characterized by also comprising the following calibration devices:
the calibration device comprises an optical locator, a calibration tool, an optical tool and a calibration plate; the main body of the calibration tool is in a rod shape, one end of the main body is provided with a flange plate for connecting to the tail end of the mechanical arm, and the tail end of the rod-shaped main body is in a hemisphere or sphere shape; the optical tools are at least three rigid bodies with reflecting balls; a plurality of vertical supporting columns are distributed on the surface of the calibration plate, and spherical grooves matched with the tail end of the calibration tool in shape are formed in the top ends of the supporting columns;
the optical locator and the mechanical arm are arranged on the same base; the two optical tools are arranged at different positions on a ceiling right above a CT (computed tomography) bed in an operating room and are used for assisting in confirming the displacement condition of the optical position finder; the other optical tool is arranged on the rod-shaped main body of the calibration tool and is used for assisting in confirming the displacement condition of the mechanical arm.
2. The interventional surgical robotic system of claim 1, wherein the rigid body of the optical tool is cross-shaped with a reflective sphere fixed to the rigid body; the rigid body is also provided with a screw hole for passing through a screw to be installed.
3. The interventional surgical robotic system of claim 1, wherein the calibration plate is acrylic material with handles on both sides.
4. The interventional surgical robotic system of claim 1, wherein the calibration plate surface has at least 4 struts of varying heights; and the number of the ceramic balls which are the same as that of the pillars and are opaque to X-rays are also arranged, and the diameter of the ceramic balls is matched with the grooves at the top ends of the pillars.
5. The interventional surgical robotic system of claim 1, wherein the flange carries locating pins.
6. A calibration method of an interventional operation robot is characterized in that the calibration method is realized based on the following interventional operation robot system:
the interventional operation robot system comprises a navigation main control computer, scanning equipment and a mechanical arm with a steering joint, wherein the navigation main control computer is respectively connected with the scanning equipment and a driving motor of the mechanical arm in a wired or wireless mode;
the system also comprises the following calibration devices: the calibration device comprises an optical locator, a calibration tool, an optical tool and a calibration plate; the main body of the calibration tool is in a rod shape, one end of the main body is provided with a flange plate for connecting to the tail end of the mechanical arm, and the tail end of the rod-shaped main body is in a hemisphere or sphere shape; at least three optical tools are rigid bodies with reflective balls; a plurality of vertical supporting columns are distributed on the surface of the calibration plate, and spherical grooves matched with the tail end of the calibration tool in shape are formed in the top ends of the supporting columns;
the optical locator and the mechanical arm are arranged on the same base; the two optical tools are arranged at different positions on a ceiling right above a CT (computed tomography) bed in an operating room and are used for assisting in confirming the displacement condition of the optical position finder; the other optical tool is arranged on the rod-shaped main body of the calibration tool and used for assisting in confirming the displacement condition of the mechanical arm;
the calibration method of the interventional operation robot specifically comprises the following steps:
(1) Acquiring an offset vector of a ball center at the tail end of a calibration tool in an optical position indicator coordinate system;
(2) Acquiring the offset of the center of the tail end of the calibration tool in the coordinates of the mechanical arm;
(3) Registering coordinate systems of the optical locator and the mechanical arm by using results obtained in the steps (1) and (2) to obtain a transformation matrix Mnu between the two coordinate systems;
(4) Registering the CT scanning image and the mechanical arm coordinate system to obtain a transformation matrix Miu between the CT scanning image and the mechanical arm coordinate system;
(5) Converting the coordinates of the target point in the CT scanning image into the coordinates of the mechanical arm based on the registration results of different coordinate systems in the steps (3) and (4), thereby completing the calibration of the interventional operation robot;
the step (5) specifically comprises:
(5.1) under the condition that the mechanical arm trolley does not move, converting the coordinate img0 of the target point in the CT scanning image into the mechanical arm coordinate: u0= Miu img0;
(5.2) under the condition that the mechanical arm trolley moves, converting the coordinate img0 of the target point in the CT scanning image into a mechanical arm coordinate u1 according to the following modes:
(5.2.1) calculating displacement data Tn of the optical locator according to the positioning data of the two optical tools which are arranged at different positions on the ceiling right above the CT bed of the operating room;
(5.2.2) because the optical locator and the mechanical arm are fixed on the same trolley, the relative positions of the optical locator and the mechanical arm are fixed; calculating the displacement of the mechanical arm according to the displacement of the optical locator: tu = Mnu -1 *Tn*Mnu,Mnu -1 An inverse matrix to matrix Mnu;
(5.2.3) converting the coordinates of the target point in the CT scanning image into mechanical arm coordinates: u1= Tu Miu img0.
7. The method according to claim 6, wherein the step (1) specifically comprises:
(1.1) mounting an optical tool on a rod-shaped main body of a calibration tool, and fixing the calibration tool at the tail end of a mechanical arm through a flange plate; the calibration tool with the same length replaces the surgical instrument to be actually used, so that the optical tool is positioned at the tool center point of the mechanical arm, and the calibration operation is carried out on the basis of the tool center point;
(1.2) taking the sphere center of a hemisphere or a sphere at the tail end of the calibration tool as a center, and operating the mechanical arm to rotate the calibration tool to perform conical motion at an angle smaller than 60 degrees; meanwhile, the offset vectors of the spherical center at the tail end of the calibration tool and the optical tool are obtained by using the matched system software of the optical locator.
8. The method according to claim 6, wherein the step (2) comprises in particular:
and aligning the center of the ball at the tail end of the calibration tool to the same point in the space in 4 different postures by utilizing the tool center point calibration function of the mechanical arm demonstrator to obtain the offset vector of the tool center point of the mechanical arm and the center of the ball at the tail end of the calibration tool.
9. The method according to claim 6, wherein the step (3) comprises in particular:
(3.1) adjusting the mechanical arm to present K different poses, and ensuring that the optical tool on the calibration tool always faces the optical position finder;
(3.2) obtaining K pairs of different coordinate data { N1, U1}, { N2, U2}. The end spherical center of the calibration tool in coordinate systems of the mechanical arm and the optical position finder respectively according to results obtained in the steps (1) and (2), wherein K is equal to or less than 10;
and (3.3) constructing a matrix by using K pair coordinate data { N1, U1}, { N2, U2}. { NK, UK }, and performing singular value decomposition on the matrix to obtain a transformation matrix Mnu between the mechanical arm and the optical position finder coordinate system.
10. The method according to claim 6, characterized in that said step (4) comprises in particular:
(4.1) placing the calibration plate on the CT bed plate to be fixed, and placing X-ray opaque ceramic balls in the grooves at the top ends of all the support columns as target points; performing CT scanning on the calibration plate to obtain an image, wherein all target points are ensured to be included in the image in the scanning process;
(4.2) opening the CT scanning image of the calibration plate, and identifying the spherical center coordinate I1 in the image; under the demonstrator mode of the mechanical arm, putting the hemispheroid or the sphere at the tail end of the calibration tool into the groove of each strut in sequence; recording a coordinate U1 of the mechanical arm, and sequentially performing the operations on all struts In the CT scanning image to obtain n groups of image coordinates and mechanical arm coordinates, { I1, U1}, { I2, U2}, { In, un }, wherein n is not less than 4 and not more than 10;
and (4.3) constructing a matrix by using the n sets of coordinate data { I1, U1}, { I2, U2}, { In, un } obtained In the step (4.2), and performing SVD (space vector decomposition) on the matrix to obtain a transformation matrix Miu between the image and the mechanical arm coordinate system.
11. The method according to claim 10, characterized in that in step (4.1), the scanning is performed again after adjusting the position of the calibration plate; repeating this operation to obtain at least 3 phase CT scan images, optionally with one phase image being used for the operation of step (4.2).
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110595080.XA CN113331948B (en) | 2021-05-28 | 2021-05-28 | Interventional operation robot system, calibration device and calibration method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110595080.XA CN113331948B (en) | 2021-05-28 | 2021-05-28 | Interventional operation robot system, calibration device and calibration method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113331948A CN113331948A (en) | 2021-09-03 |
CN113331948B true CN113331948B (en) | 2022-12-09 |
Family
ID=77472118
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110595080.XA Active CN113331948B (en) | 2021-05-28 | 2021-05-28 | Interventional operation robot system, calibration device and calibration method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113331948B (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015142798A1 (en) * | 2014-03-17 | 2015-09-24 | Intuitive Surgical Operations, Inc. | Methods and devices for tele-surgical table registration |
CN114027980B (en) * | 2021-10-30 | 2023-07-21 | 浙江德尚韵兴医疗科技有限公司 | Interventional operation robot system and calibration and error compensation method thereof |
WO2023144602A1 (en) * | 2022-01-25 | 2023-08-03 | Lem Surgical Ag | Intraoperative robotic calibration and sizing of surgical tools |
CN114767270B (en) * | 2022-04-26 | 2023-05-12 | 广州柏视医疗科技有限公司 | Navigation display system for pulmonary surgery puncture |
CN116612306B (en) * | 2023-07-17 | 2023-09-26 | 山东顺发重工有限公司 | Computer vision-based intelligent flange plate alignment method and system |
CN117838311B (en) * | 2024-03-07 | 2024-05-31 | 杭州海沛仪器有限公司 | Target spot ablation respiratory gating system based on optical positioning |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10383765B2 (en) * | 2012-04-24 | 2019-08-20 | Auris Health, Inc. | Apparatus and method for a global coordinate system for use in robotic surgery |
CN103860268B (en) * | 2012-12-13 | 2017-10-03 | 中国科学院深圳先进技术研究院 | A kind of mark point method for registering, device and surgical navigation systems |
CN105232155B (en) * | 2015-09-08 | 2018-11-09 | 微创(上海)医疗机器人有限公司 | Operating robot adjusts system |
CN108030551B (en) * | 2017-12-06 | 2020-02-18 | 上海波城医疗科技有限公司 | System and method for correcting stroke of surgical mechanical arm |
CN107970060A (en) * | 2018-01-11 | 2018-05-01 | 上海联影医疗科技有限公司 | Surgical robot system and its control method |
CN110559077B (en) * | 2018-06-05 | 2021-08-17 | 武汉联影智融医疗科技有限公司 | Coordinate system registration method, robot control method, device, equipment and medium |
CN110355754B (en) * | 2018-12-15 | 2023-09-22 | 深圳铭杰医疗科技有限公司 | Robot hand-eye system, control method, device and storage medium |
CN110355755B (en) * | 2018-12-15 | 2023-05-16 | 深圳铭杰医疗科技有限公司 | Robot hand-eye system calibration method, device, equipment and storage medium |
CN114711969B (en) * | 2019-01-21 | 2023-10-31 | 华科精准(北京)医疗科技有限公司 | Surgical robot system and application method thereof |
CN111437011B (en) * | 2020-03-30 | 2021-04-13 | 中国科学院深圳先进技术研究院 | Puncture surgery robot system |
CN111823233B (en) * | 2020-06-30 | 2022-11-29 | 浙江德尚韵兴医疗科技有限公司 | Mechanical arm hand-eye calibration system and method based on high-precision three-dimensional optical positioning |
CN112006777B (en) * | 2020-07-31 | 2022-03-29 | 清华大学 | Nailing surgical robot system based on surface tracking and control method |
-
2021
- 2021-05-28 CN CN202110595080.XA patent/CN113331948B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN113331948A (en) | 2021-09-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113331948B (en) | Interventional operation robot system, calibration device and calibration method | |
CN114027980B (en) | Interventional operation robot system and calibration and error compensation method thereof | |
CN111110351B (en) | Assembly and method for detecting accuracy of joint replacement surgical robotic system | |
CN113288429A (en) | Space registration and real-time navigation method of breast minimally invasive interventional operation robot | |
CN113940755A (en) | Surgical operation planning and navigation method integrating operation and image | |
CN112618017B (en) | Navigation operation system, computer readable storage medium and electronic device | |
CN112754616B (en) | Ultrasonic positioning puncture system and storage medium | |
WO2022141153A1 (en) | Ultrasonic positioning puncture system and storage medium | |
CN101301220A (en) | Positioning apparatus of robot puncturing hole in endoscope operation and locating method | |
CN110916799A (en) | Puncture robot navigation system based on 5G network | |
CN112190328A (en) | Holographic perspective positioning system and positioning method | |
WO2022199296A1 (en) | Error elimination method and apparatus for surgical navigation robot, and electronic device | |
CN113843792A (en) | Hand-eye calibration method of surgical robot | |
CN114159160B (en) | Surgical navigation method, device, electronic equipment and storage medium | |
CN110279470A (en) | Dynamic regulation device, dynamic adjusting system and its application method | |
CN114587593B (en) | Surgical navigation positioning system and use method thereof | |
CN109091234A (en) | Minimally Invasive Surgery puncture needle robot system | |
CN117084791A (en) | Puncture azimuth resolving method and puncture operation executing system | |
CN117084790A (en) | Puncture azimuth control method and device, computer equipment and storage medium | |
CN209301315U (en) | Minimally Invasive Surgery puncture needle robot system | |
Tseng et al. | Development of a robotic navigation system for neurosurgery | |
CN114886561A (en) | Robot operation path planning device and planning method thereof | |
CN112370290B (en) | Reduction and fixation integrated operation system for limb fracture | |
CN110141318B (en) | Neurosurgery minimal access surgery frameless locater | |
CN201384570Y (en) | Carbon fiber solid developing self-adapting stereo guide headstock |
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 |