A passive surgical robot navigation and positioning system
Through the passive surgical robot navigation and positioning system, the combination of optical tracker and robotic arm is used to solve the problems of surgical positioning accuracy and operation complexity in the prior art, and high-precision and minimally invasive surgical operations are achieved, which is suitable for a variety of surgeries. Scenarios have promoted the development of surgical robot technology.
Patent Information
- Application Number
- CN202210526122.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-05-16
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2042-05-16
AI Technical Summary
The existing surgical robot navigation and positioning systems have shortcomings in terms of accuracy and operational complexity, which is difficult to meet the needs of modern medicine for minimally invasive and precise surgery.
A passive surgical robot navigation and positioning system was designed, integrating optical tracker, robotic arm and main control system. Through real-time tracking of optical marking points and precise positioning of robotic arms, combined with medical image processing and planning navigation functions, the high surgical tools are achieved. Accurate positioning and attitude control.
It achieves high accuracy of surgical positioning and simplicity of operation, reduces surgical trauma, improves surgical quality, and is suitable for various surgeries such as orthopedics and neurosurgery, promoting the development of minimally invasive surgery.
Smart Images

Figure CN114795496B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of medical robots, and in particular to a passive surgical robot navigation and positioning system. Background Art
[0002] In the past two decades, as medicine, robotics, computer graphics, intelligent control and other disciplines have become increasingly mature, they have gradually merged to form robot-assisted surgery technology. Its many advantages meet the needs of the development of contemporary medicine. Relying on the fast, accurate and easy-to-repeat characteristics of image processing technology and robotics technology, it has made up for the various defects of traditional surgical methods. Scientific and technological workers at home and abroad have integrated robots and vision technology into traditional medical operations. Medical robots have been widely used in neurosurgery, abdominal surgery, thoracic surgery, orthopedic surgery, vascular intervention, craniofacial surgery and other operations.
[0003] Compared with traditional surgery, robot-assisted surgery has the advantages of minimally invasive, clear vision, flexible operation, and precise positioning. It can enable surgical tools to reach the planned position, assist doctors to complete various difficult operations safely and reliably, reduce radiation damage, reduce surgical trauma, shorten operation time, improve surgical quality, and protect the health of doctors and patients.
[0004] At present, for different indications, the functional requirements for robots are different, and the robot software and hardware designs are different. From the perspective of surgical robot technology path, it is generally divided into master-slave surgical robots and positioning surgical robots. Positioning surgical robots that provide doctors with navigation and positioning tools are widely used in minimally invasive diagnosis and treatment of thoracic, abdominal and pelvic punctures, orthopedic surgery, and neurosurgery. Although the current robotic surgical system has made some progress, it is still in a long-term development process. In the future, surgical robots will develop in multiple directions such as smaller, safer, more economical, and smarter.
[0005] The present invention proposes a passive surgical robot navigation and positioning system, which integrates medical image processing, planning and navigation and other functions, has a compact structure, low cost, simple operation and high surgical positioning accuracy. Summary of the invention
[0006] A passive surgical robot navigation and positioning system comprises an optical tracker, a robotic arm, and a main control system.
[0007] The optical tracker is used to track the optical landmarks of the patient's diseased part, robotic arm, etc. in real time during surgery to obtain the locations of the landmarks.
[0008] The robotic arm includes a mechanical body, a controller and a navigation and positioning component, which can manually and accurately locate the position and posture of the end navigation tool.
[0009] The main control system includes a computer control center, a display device, and input and output equipment.
[0010] The optical tracker and the robotic arm are connected to the main control system, which is the main operating device used to process the spatial coordinate conversion between captured images and real-time images, and perform medical image acquisition and processing, planning, registration navigation and postoperative data analysis.
[0011] A robotic arm has four joints in total. The first three joints consisting of a base, a waist seat, an upper arm and a lower arm are rotary joints with encoders installed at the joints. The last joint consisting of a lower arm and a navigation and positioning component is a ball joint.
[0012] There are mechanical interfaces at both ends of the rotary joint, which are connected to the two rods through the connection module. When the electromagnetic clutch is disconnected, the two rods rotate coaxially around the axis of the rotary joint according to the external force applied to the rotary joint, and the encoder detects the rotation angle of the rotary joint.
[0013] Another type of robotic arm has two ball joints.
[0014] When the electromagnetic clutch of the ball joint is disconnected, the connecting rod can rotate in any direction around the center of the ball joint according to the external force.
[0015] All joints of the two types of robotic arms are passive joints, and are equipped with mechanical limit devices and electromagnetic clutches. Optical marking points are installed on the robotic arm bodies.
[0016] Mechanical limit devices are used to limit the range of motion of each joint.
[0017] When the electromagnetic clutch is closed, each joint is locked, and the position and posture of the navigation and positioning component are fixed relative to the base of the robotic arm.
[0018] The optical marking points on the robot body are used to calibrate the structural parameters of the robot body.
[0019] At least three optical marking points that are not in a straight line are installed on the navigation and positioning component. The relative position and posture between the navigation tool at the end of the robotic arm and the optical marking points on the navigation and positioning component are known. There is an electromagnetic clutch switch on the navigation and positioning component for the doctor to operate during surgery.
[0020] The navigation and positioning component is equipped with a guide frame connected to the end of the robotic arm. The slide frame can slide along the guide frame. Two V-shaped sliders and a spring form a clamping device that can clamp the surgical instrument. The clamping device can slide up and down along the slide frame to adjust the position. After the adjustment, it is fixed with a fastening screw to ensure that the implant axis is consistent with the working axis of the surgical instrument during surgery.
[0021] The guide frame is provided with a scale, and the slide rail frame is provided with optical marking points. The depth of the implant into the human body is estimated according to the distance between the optical marking points at the beginning and the end of the operation.
[0022] The robotic arm and optical tracker can be installed on the operating table or on a bedside device. The robotic arm, optical tracker, and main control system can be installed separately or integrated into one device.
[0023] The intraoperative optical tracker can track the optical marker points on the navigation and positioning components in real time. If the optical marker points deviate from the planned target, the system will issue an alarm.
[0024] Calibrate the structural parameters of a robotic arm and establish the kinematic model of the robotic arm. Optical markers can be installed on the upper arm and the lower arm. During the calibration process, the optical tracker and the robotic arm base are fixed.
[0025] Rotate the first joint and keep the other joints fixed, take at least two series of optical marker points, fit each series of position points to generate a circle, take the lines connecting the centers of each circle to establish coordinate axes Z1 and X2, rotate the second joint and keep the other joints fixed, take at least two series of optical marker points, fit each series of position points to generate a circle, take the lines connecting the centers of each circle to establish coordinate axes Y1 and Z2, and the intersections with coordinate axes Z1 and X2 are the origins O1 and O2, and coordinate axes X1 and Y2 are established according to the right-hand rule of the spatial rectangular coordinate system. Thus, two coordinate systems O1X1Y1Z1 and O2X2Y2Z2 are established.
[0026] When the robot arm is at zero position, the coordinate system O1X1Y1Z1 is offset by l1 in the opposite direction of the coordinate axis Z1 to establish the base coordinate system O0X0Y0Z0.
[0027] Rotate the third joint while keeping the other joints stationary, take at least two series of position points of optical marker points, fit each series of position points to generate a circle, take the line connecting the centers of each circle to establish the coordinate axis Z3, and make a perpendicular from the origin O2 to the coordinate axis Z3 to determine the position of the origin O3. The distance between O2O3 is the connecting rod length l2. The coordinate axis X3 is in a straight line with the origins O2 and O3 at zero position. Establish the coordinate axis Y3 according to the right-hand rule of the spatial rectangular coordinate system, and now establish the coordinate system O3X3Y3Z3.
[0028] Rotate the fourth joint while keeping the other joints unchanged, take a series of position points of optical markers on at least one navigation and positioning component, fit each series of position points to generate a sphere, determine the center of the sphere as the origin O4, the distance O3O4 is the connecting rod length l3, and the coordinate system O3X3Y3Z3 is offset by l3 along the coordinate axis X3 to establish the coordinate system O4X4Y4Z4.
[0029] Hold the probe with optical markers, and place the needle tip near the implant entry point of the surgical instrument to generate a series of optical marker position points. Fit the cylinder and plane to generate the cylinder axis as the coordinate axis Z5, and the intersection of the cylinder and the plane as the origin O5 (p x5 ,p y5 ,p z5 ), coordinate axis Y5 is perpendicular to the plane determined by coordinate axis X4 and coordinate axis Z5, and coordinate axis X5 is established according to the right-hand rule of the spatial rectangular coordinate system, thus establishing the coordinate system O5X5Y5Z5.
[0030] Assuming that the rotation angles of the first, second, and third joints are θ1, θ2, and θ3, establish the homogeneous transformation matrix of each link:
[0031]
[0032]
[0033] [n x4 ,n y4 ,n z4 ]、[o x4 ,o y4 ,o z4 ]、[a x4 ,a y4 ,a z4 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O4X4Y4Z4 relative to the three principal axes of the coordinate system O3X3Y3Z3.
[0034] [n x5 ,n y5 ,n z5 ]、[o x5 ,o y5 ,o z5 ]、[a x5 ,a y5 ,a z5 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O5X5Y5Z5 relative to the three principal axes of the coordinate system O4X4Y4Z4.
[0035] Calibrate the structural parameters of another robotic arm and establish the kinematic model of the robotic arm. Optical markers can be installed on the intermediate rod. During the calibration process, the optical tracker and the robotic arm base are fixed.
[0036] Rotate the first ball joint while keeping the other ball joints stationary, take at least one series of optical marker points, fit each series of points to generate a sphere, determine the center of the sphere as the origin O7, rotate around the three coordinate axes of the spatial rectangular coordinate system, take at least one series of optical marker points, fit each series of points to generate a circle, take the lines connecting the centers of the circles to establish coordinate axes X7, Y7, and Z7, thus establishing the coordinate system O7X7Y7Z7. When the robot arm is at zero position, the base coordinate system O6X6Y6Z6 coincides with the coordinate system O7X7Y7Z7.
[0037] Rotate the second ball joint while keeping the other ball joint unchanged, take a series of optical marker points on at least one navigation and positioning component, fit each series of position points to generate a sphere, determine the center of the sphere as the origin O8, the distance O7O8 is the connecting rod length l4, rotate around the three coordinate axes of the spatial rectangular coordinate system, take at least one series of optical marker points, fit each series of position points to generate a circle, take the lines connecting the centers of each circle to establish coordinate axes X8, Y8, and Z8, and thus establish the coordinate system O8X8Y8Z8.
[0038] Hold the probe with optical markers, and touch the needle tip near the implant entry point of the surgical instrument to generate a series of optical marker position points, fit the generated cylinder and plane, the axis of the cylinder is the coordinate axis Z9, and the intersection of the cylinder and the plane is the origin O9 (p x9 ,p y9 ,p z9 ), coordinate axis Y9 is perpendicular to the plane defined by coordinate axis X8 and coordinate axis Z9, and coordinate axis X9 is established according to the right-hand rule of the spatial rectangular coordinate system, thus establishing the coordinate system O9X9Y9Z9.
[0039] Establish the homogeneous transformation matrix of each link:
[0040]
[0041] [n x7 ,n y7 ,n z7 ]、[o x7 ,o y7 ,o z7 ]、[a x7 ,a y7 ,a z7 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O7X7Y7Z7 relative to the three principal axes of the coordinate system O6X6Y6Z6.
[0042] [n x8 ,n y8 ,n z8 ]、[o x8 ,o y8 ,o z8 ]、[ax8 ,a y8 ,a z8 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O8X8Y8Z8 relative to the three principal axes of the coordinate system O7X7Y7Z7.
[0043] [n x9 ,n y9 ,n z9 ]、[o x9 ,o y9 ,o z9 ]、[a x9 ,a y9 ,a z9 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O9X9Y9Z9 relative to the three principal axes of the coordinate system O8X8Y8Z8.
[0044] Offline computational simulation is performed before surgery.
[0045] According to the surgical planning target in the optical tracker coordinate system and the position of the optical markers on the robot navigation and positioning components, the posture transformation relationship between the two is determined. In the virtual simulation environment, the inverse solution is obtained according to the robot kinematics model to obtain the rotation angle of each joint of the robot, and the robot moves to the planned target position. The simulation system displays the posture deviation between the real robot navigation and positioning components and the planned target in real time.
[0046] During the operation, the robotic arm is manually positioned according to the simulation results.
[0047] For a four-joint robotic arm, manually rotate the first, second, and third rotation joints in sequence to make the encoder rotation angle consistent with the rotation angle of the simulation system, lock the three joints, manually rotate the fourth ball joint in three directions to make the navigation positioning component consistent with the surgical planning target of the simulation system, and lock the fourth joint.
[0048] For another two-joint robotic arm, manually rotate the first ball joint in three directions to make the rotation angles of the ball joint in three directions consistent with the rotation angles of the simulation system, lock the first joint, manually rotate the second ball joint in three directions to make the navigation and positioning components consistent with the surgical planning targets of the simulation system, and lock the second joint.
[0049] The present invention provides a passive surgical robot navigation and positioning system, which integrates medical image acquisition and processing, planning, registration navigation and postoperative data analysis, is simple to operate, and is intelligent and minimally invasive. It can be applied to different parts, such as orthopedics, neurosurgery, oral treatment, puncture biopsy, injection and other surgeries, to assist doctors in navigation and positioning operations. It is of great significance for optimizing surgical goals, improving surgical positioning accuracy, reducing surgical trauma, and improving surgical quality. With the further development and combination of multiple disciplines such as clinical, robotic systems, and medical imaging in the future, surgical robot systems will surely become the development trend of minimally invasive surgery. BRIEF DESCRIPTION OF THE DRAWINGS
[0050] Figure 1 It is the operation flow chart of the navigation and positioning system
[0051] Figure 2 It is the composition diagram of the navigation and positioning system
[0052] Figure 3 It is robot arm A
[0053] Figure 4 It is robot arm B
[0054] Figure 5 It is an electric bone drill
[0055] Figure 6 It is the navigation and positioning component of the robotic arm
[0056] Figure 7 It is a probe
[0057] Figure 8 It is the coordinate system of the robot arm A link
[0058] Fig. 9 It is the coordinate system of the robot arm B link
[0059] 1- Main control system
[0060] 2-Binocular Eye Tracker
[0061] 3-Robotic Arm
[0062] 4-Tracer
[0063] 5-Guide frame
[0064] 6-Reflective ball
[0065] 7-Slide rail rack
[0066] 8- Fastening screws
[0067] 9-Guide tube
[0068] 10-K-wire
[0069] 11-Electromagnetic switch
[0070] 12-end reflective ball bracket
[0071] 13-Ball joint
[0072] 14-Forearm reflective ball bracket
[0073] 15-Forearm rotation joint
[0074] 16-Big arm reflective ball bracket
[0075] 17- Upper arm rotation joint
[0076] 18-Waist seat rotation joint
[0077] 19-Fixed base
[0078] 20-First ball joint
[0079] 21- Second ball joint
[0080] 22-Back end of bone drill
[0081] 23-Bone drill front end
[0082] 24-Scale
[0083] 25-Upper slider
[0084] 26-Spring
[0085] 27-Lower slider DETAILED DESCRIPTION
[0086] The present invention is further described in detail below in conjunction with embodiments and drawings, but the implementation manner of the present invention is not limited thereto.
[0087] like Figure 1-Figure 9 As shown, this embodiment provides a passive surgical robot navigation and positioning system, such as Figure 2 , which includes a main control system 1, a binocular optical tracker 2, a robotic arm 3, and a tracer 4. The binocular optical tracker 2 and the robotic arm 3 are connected to the main control system 1. The main control system 1 is the main operating device, which is used to process the spatial coordinate conversion between medical images and real-time images, perform medical image acquisition processing, planning, registration navigation and postoperative data analysis, and assist doctors in completing surgical navigation positioning with the help of the robotic arm 3, so as to complete accurate, safe and fast minimally invasive surgery.
[0088] like Figure 3 The navigation and positioning component is provided with a guide frame 5 connected to the end of the robot arm, and the slide rail frame 7 can slide along the guide frame 5. Two V-shaped sliders 25, 27 and a spring 26 form a clamping device that can clamp the electric bone drill. Figure 6The clamping device can slide up and down along the slide rail frame 7 to adjust the position, and after the adjustment is completed, it is fixed with a fastening screw 8 to ensure that the axis of the electric bone drill and the Kirschner wire 10 are consistent during surgery.
[0089] The guide frame 5 is provided with a scale 24, and the slide rail frame 7 is provided with a reflective ball 6. The depth of the Kirschner wire 10 inserted into the human body can be estimated according to the distance of the reflective ball 6 at the beginning and the end of the operation.
[0090] like Figure 3 , Figure 8 , calibrate the structural parameters of the robot A, and establish the kinematic model of the robot A. The upper arm and the lower arm are equipped with reflective ball brackets 16 and 14. During the calibration process, the binocular optical tracker 2 is fixed and the base 19 of the robot A is fixed.
[0091] Rotate the first joint 18 and keep the other joints fixed, take three reflective ball series position points, fit each series position points to generate a circle, take the line connecting the centers of each circle to establish coordinate axes Z1 and X2, rotate the second joint 17 and keep the other joints fixed, take three reflective ball series position points, fit each series position points to generate a circle, take the line connecting the centers of each circle to establish coordinate axes Y1 and Z2, and the intersection with coordinate axes Z1 and X2 is the origin O1 and O2, and coordinate axes X1 and Y2 are established according to the right-hand rule of the spatial rectangular coordinate system. So far, two coordinate systems O1X1Y1Z1 and O2X2Y2Z2 are established.
[0092] When the robot A is at zero position, the coordinate system O1X1Y1Z1 is offset by l1 in the opposite direction of the coordinate axis Z1 to establish the base coordinate system O0X0Y0Z0.
[0093] Rotate the third joint 15 while keeping the other joints unchanged, take three series of position points of the reflective balls, fit each series of position points to generate a circle, take the line connecting the centers of each circle to establish the coordinate axis Z3, make a perpendicular from the origin O2 to the coordinate axis Z3 to determine the position of the origin O3, the distance between O2O3 is the connecting rod length l2, the coordinate axis X3 is in a straight line with the origins O2 and O3 at zero position, establish the coordinate axis Y3 according to the right-hand rule of the spatial rectangular coordinate system, and now the coordinate system O3X3Y3Z3 is established.
[0094] Rotate the fourth joint 13 while keeping the other joints unchanged, take the four reflective ball series position points on the reflective ball bracket 12 of the navigation and positioning component, fit each series of position points to generate a sphere, determine the center position of the sphere as the origin O4, the distance O3O4 is the connecting rod length l3, and the coordinate system O3X3Y3Z3 is offset by l3 along the coordinate axis X3 to generate the coordinate system O4X4Y4Z4.
[0095] Hold a probe with four reflective balls, such as Figure 7 , the needle tip touches the guide tube 9 near the needle entry point, generates a series of reflective ball position points, and generates a cylinder and a plane by fitting. The axis of the cylinder is the coordinate axis Z5, and the intersection of the cylinder and the plane is the origin O5 (px5 ,p y5 ,p z5 ), coordinate axis Y5 is perpendicular to the plane determined by coordinate axis X4 and coordinate axis Z5, and coordinate axis X5 is established according to the right-hand rule of the spatial rectangular coordinate system, thus establishing the coordinate system O5X5Y5Z5.
[0096] Assuming that the rotation angles of the first, second, and third joints are θ1, θ2, and θ3, establish the homogeneous transformation matrix of each link:
[0097]
[0098]
[0099] [n x4 ,n y4 ,n z4 ]、[o x4 ,o y4 ,o z4 ]、[a x4 ,a y4 ,a z4 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O4X4Y4Z4 relative to the three principal axes of the coordinate system O3X3Y3Z3.
[0100] [n x5 ,n y5 ,n z5 ]、[o x5 ,o y5 ,o z5 ]、[a x5 ,a y5 ,a z5 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O5X5Y5Z5 relative to the three principal axes of the coordinate system O4X4Y4Z4.
[0101] like Figure 4 , Fig. 9 , calibrate the structural parameters of another robot arm B and establish the kinematic model of the robot arm B. Three reflective balls are installed on the middle rod. During the calibration process, the binocular optical tracker 2 and the base of the robot arm B are fixed.
[0102] Rotate the first ball joint 20 while keeping the other ball joint 21 still, take three reflective ball series position points, fit each series position points to generate a sphere, determine the center of the sphere as the origin O7, rotate around the three coordinate axes of the spatial rectangular coordinate system, take three reflective ball series position points, fit each series position points to generate a circle, take the lines connecting the centers of the circles to establish coordinate axes X7, Y7, and Z7 respectively, and thus establish the coordinate system O7X7Y7Z7. When the robot arm B is at zero position, the base coordinate system O6X6Y6Z6 coincides with the coordinate system O7X7Y7Z7.
[0103] Rotate the second ball joint 21 while keeping the other ball joint 20 unchanged. Take the four reflective ball series position points on the navigation and positioning component, fit each series of position points to generate a sphere, determine the center of the sphere as the origin O8, the distance O7O8 is the connecting rod length l4, rotate around the three coordinate axes of the spatial rectangular coordinate system, take three reflective ball series position points, fit each series of position points to generate a circle, take the lines connecting the centers of each circle to establish coordinate axes X8, Y8, and Z8, and thus establish the coordinate system O8X8Y8Z8.
[0104] Hold a probe with four reflective balls, such as Figure 7 , the needle tip touches the guide tube 9 near the needle entry point, generates a series of reflective ball position points, and generates a cylinder and a plane by fitting. The axis of the cylinder is the coordinate axis Z9, and the intersection of the cylinder and the plane is the origin O9 (p x9 ,p y9 ,p z9 ), coordinate axis Y9 is perpendicular to the plane defined by coordinate axis X8 and coordinate axis Z9, and coordinate axis X9 is established according to the right-hand rule of the spatial rectangular coordinate system, thus establishing the coordinate system O9X9Y9Z9.
[0105] Establish the homogeneous transformation matrix of each link:
[0106]
[0107] [n x7 ,n y7 ,n z7 ]、[o x7 ,o y7 ,o z7 ]、[a x7 ,a y7 ,a z7 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O7X7Y7Z7 relative to the three principal axes of the coordinate system O6X6Y6Z6.
[0108] [n x8 ,n y8 ,n z8 ]、[o x8 ,o y8 ,o z8 ]、[a x8 ,a y8 ,a z8 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O8X8Y8Z8 relative to the three principal axes of the coordinate system O7X7Y7Z7.
[0109] [n x9 ,n y9 ,n z9 ]、[o x9,o y9 ,o z9 ]、[a x9 ,a y9 ,a z9 ] respectively represent the projection components of the three principal axis unit vectors of the coordinate system O9X9Y9Z9 relative to the three principal axes of the coordinate system O8X8Y8Z8.
[0110] Taking fracture reduction surgery as an example, the following operations are performed:
[0111] a) Take photos with medical imaging equipment, transmit the photographic information to the main control system 1, perform medical image processing, and the doctor plans the operation, including the entry and exit points of the bone screws.
[0112] b) Fixing the tracer 4 on the affected bone of the patient, and using the binocular optical tracker 2 to record the spatial position information of the tracer 4 .
[0113] c) Use the control software to register the image information, convert the medical image information into spatial coordinates, send the planning target and the reflective ball position of the navigation and positioning component to the main control system 1, perform inverse kinematics of the robot arm on the planning target, and obtain the rotation angle of each joint of the robot arm. If there are multiple inverse solutions, manually select one of the inverse solutions, and send the selected inverse solution to the virtual robot arm, and the robot arm simulates movement to the planning target.
[0114] d) The doctor presses the switch 11 on the robot arm to disconnect the electromagnetic clutch, and adjusts the overall arm shape of the robot arm 3 to the planned surgical target posture according to the simulation results and the encoder display value.
[0115] For a four-joint robot arm A, Figure 3 , manually rotate the first rotary joint 18, the second rotary joint 17, and the third rotary joint 15 in sequence to make the encoder rotation angle consistent with the rotation angle of the simulation system, lock the three joints 18, 17, and 15, manually rotate the fourth ball joint 13 in three directions to make the navigation positioning component consistent with the surgical planning target of the simulation system, and lock the fourth joint 13.
[0116] For another two-joint robot arm B, such as Figure 4 , manually rotate the first ball joint 20 in three directions to make the rotation angles of the ball joint 20 in three directions consistent with the rotation angles of the simulation system, lock the first joint 20, manually rotate the second ball joint 21 in three directions to make the navigation positioning component consistent with the surgical planning target of the simulation system, and lock the second joint 21.
[0117] If the patient moves unexpectedly during the operation, the robot arm 3 is adjusted again to the updated planning target.
[0118] e) The doctor installs the bone drill, such as Figure 5, clamp the front end 23 or the rear end 22 of the bone drill, insert the Kirschner wire 10 into the guide cylinder 9, clamp the Kirschner wire 10 with the bone drill, place the Kirschner wire 10 at the planned starting position, note the positions of the reflective ball 6 and the scale 24, and insert the Kirschner wire 10 according to the planned depth.
[0119] f) The doctor disassembles the bone drill, removes the robotic arm 3, and inserts the bone screw.
[0120] The above embodiments are only used to further illustrate the present invention, but cannot be understood as limiting the scope of protection of the present invention. It should be pointed out that ordinary technicians in this field can modify, replace and modify the above embodiments according to the design concept of the present invention, which all belong to the protection scope of the present invention.
Claims
1. A passive surgical robot navigation and positioning system, It is characterized in that The components include optical tracker, robotic arm, and main control system; An optical tracker, which is used to track the optical markers of the patient's diseased part and the robotic arm in real time during surgery to obtain the positions of the markers; A mechanical arm, comprising a mechanical body, a controller and a navigation and positioning component, capable of manually and accurately positioning the position and posture of a terminal navigation tool; A main control system, which includes a computer control center, a display device, and input and output equipment; The optical tracker and the robotic arm are connected to the main control system, which is the main operating device for processing the spatial coordinate conversion between the captured image and the real-time image, and performing medical image acquisition processing, planning, registration navigation and postoperative data analysis; The mechanical body of the robotic arm includes a base, a waist seat, an upper arm, and a lower arm; there are two types of robotic arms, one type of robotic arm A has four joints, the base, waist seat, upper arm, and lower arm constitute the first three joints, and the lower arm and the navigation and positioning component constitute the last joint; the first three joints are rotary joints, and the last joint is a ball joint; there are mechanical interfaces at both ends of the rotary joint, and two rods are respectively connected through a connection module. When the electromagnetic clutch is disconnected, the two rods rotate coaxially around the axis of the rotary joint according to the external force applied to the rotary joint, and the encoder detects the rotation angle of the rotary joint; Another type of robot arm B has two joints; The two joints are ball joints. When the electromagnetic clutch is disconnected, the rod rotates in any direction around the center of the ball joint according to the external force. All joints of the two types of mechanical arms are passive joints, and are equipped with mechanical limit devices and electromagnetic clutches. Optical marking points are installed on the mechanical bodies of the mechanical arms. The mechanical limit device is used to limit the range of motion of each joint; When the electromagnetic clutch is closed, each joint is locked, and the position and posture of the navigation and positioning component are fixed relative to the mechanical arm base; The optical marking points on the mechanical body of the robotic arm are used to calibrate the structural parameters of the mechanical body of the robotic arm; Calibrate the structural parameters of the mechanical body of the robot A, establish the kinematic model of the robot A, install optical markers on the upper arm and the lower arm, and during the calibration process, the optical tracker is fixed and the base of the robot A is fixed; Rotate the first joint and keep the other joints unchanged. Take at least two series of optical marker points, fit each series of points to generate a circle, and take the line connecting the centers of each circle to establish the coordinate axis Z. 1 , X 2 , rotate the second joint and keep the other joints unchanged, take at least two optical marker points, fit each series of points to generate a circle, take the line connecting the centers of each circle to establish the coordinate axis Y 1 , Z 2 , and the coordinate axis Z 1 , X 2 The intersection point is the origin O 1 , O 2 , according to the right-hand rule of the spatial rectangular coordinate system, the coordinate axis X is established 1 , Y 2 , so far two coordinate systems O are established 1 X 1 Y 1 Z 1 , O 2 X 2 Y 2 Z 2 ; When the robot arm A is at zero position, the coordinate system O 1 X 1 Y 1 Z 1 Along the coordinate axis Z 1 Reverse bias 1 , establish the base coordinate system O 0 X 0 Y 0 Z 0 ; Rotate the third joint and keep the other joints unchanged. Take at least two optical marker points in series, fit each series of points to generate a circle, and take the line connecting the centers of each circle to establish the coordinate axis Z. 3 , from the origin O 2 Towards the coordinate axis Z 3 Draw a perpendicular to determine the origin O 3 Location, O 2 O 3 The distance is the connecting rod length l 2 , coordinate axis X 3 With the origin O at zero position 2 , O 3 On a straight line, the coordinate axis Y is established according to the right-hand rule of the spatial rectangular coordinate system. 3 , so far the coordinate system O is established 3 X 3 Y 3 Z 3 ; Rotate the fourth joint and keep the other joints unchanged, take a series of optical marker points on at least one of the navigation and positioning components, fit each series of position points to generate a sphere, and determine the center position of the sphere as the origin O 4 Location, O 3 O 4 The distance is the connecting rod length l 3 , the coordinate system O 3 X 3 Y 3 Z 3 Along the coordinate axis X 3 Bias 3 Establish coordinate system O 4 X 4 Y 4 Z 4 ; Hold the probe with optical markers, and place the needle tip near the surgical instrument implant entry point to generate a series of optical marker position points. Fit the generated cylinder and plane, with the cylinder axis as the coordinate axis Z. 5 , the intersection of the cylinder and the plane is the origin O 5 (p x5 ,p y5 ,p z5 ), coordinate axis Y 5 Perpendicular to the coordinate axis X 4 and the coordinate axis Z 5 Determine the plane and establish the coordinate axis X according to the right-hand rule of the spatial rectangular coordinate system 5 , so far the coordinate system O is established 5 X 5 Y 5 Z 5 ; Assume that the rotation angles of the first, second, and third joints are θ 1 ,θ 2 ,θ 3 , establish the homogeneous transformation matrix of each connecting rod: [n x4 ,n y4 ,n z4 ]、[o x4 ,o y4 ,o z4 ]、[a x4 ,a y4 ,a z4 ] represent the coordinate system O 4 X 4 Y 4 Z 4 The three principal axis unit vectors are relative to the coordinate system O 3 X 3 Y 3 Z 3 The projected components of the three principal axes of ; [n x5 ,n y5 ,n z5 ]、[o x5 ,o y5 ,o z5 ]、[a x5 ,a y5 ,a z5 ] represent the coordinate system O 5 X 5 Y 5 Z 5 The three principal axis unit vectors are relative to the coordinate system O 4 X 4 Y 4 Z 4 The projected components of the three principal axes of ; Calibrate the structural parameters of the mechanical body of the other mechanical arm B and establish the kinematic model of the mechanical arm B; install optical marking points on the intermediate rod, and during the calibration process, the optical tracker is fixed and the base of the mechanical arm B is fixed; Rotate the first ball joint and keep the other ball joint unchanged, take at least one optical mark point series position point, fit each series position point to generate a sphere, and determine the center position of the sphere as the origin O 7 Position, rotate around the three coordinate axes of the spatial rectangular coordinate system, take at least one optical mark point series position point, fit each series of position points to generate a circle, take the line connecting the centers of each circle to establish the coordinate axis X 7 , Y 7 , Z 7 , so far the coordinate system O is established 7 X 7 Y 7 Z 7 , when the robot arm B is at zero position, the base coordinate system O 6 X 6 Y 6 Z 6 With the coordinate system O 7 X 7 Y 7 Z 7 coincide; Rotate the second ball joint and keep the other ball joint unchanged, take a series of optical marker points on at least one navigation and positioning component, fit each series of position points to generate a sphere, and determine the center position of the sphere as the origin O 8 Location, O 7 O 8 The distance is the connecting rod length l 4 , respectively rotate around the three coordinate axes of the spatial rectangular coordinate system, take at least one optical mark point series position point, fit each series position point to generate a circle, take the line connecting the centers of each circle to establish the coordinate axis X 8 , Y 8 , Z 8 , so far the coordinate system O is established 8 X 8 Y 8 Z 8 ; Hold the probe with optical markers, and place the needle tip near the surgical instrument implant entry point to generate a series of optical marker position points. Fit the generated cylinder and plane, with the cylinder axis as the coordinate axis Z. 9 , the intersection of the cylinder and the plane is the origin O 9 (p x9 ,p y9 ,p z9 ), coordinate axis Y 9 Perpendicular to the coordinate axis X 8 and the coordinate axis Z 9 Determine the plane and establish the coordinate axis X according to the right-hand rule of the spatial rectangular coordinate system 9 , so far the coordinate system O is established 9 X 9 Y 9 Z 9 ; Establish the homogeneous transformation matrix of each link: [n x7 ,n y7 ,n z7 ]、[o x7 ,o y7 ,o z7 ]、[a x7 ,a y7 ,a z7 ] represent the coordinate system O 7 X 7 Y 7 Z 7 The three principal axis unit vectors are relative to the coordinate system O 6 X 6 Y 6 Z 6 The projected components of the three principal axes of ; [n x8 ,n y8 ,n z8 ]、[o x8 ,o y8 ,o z8 ]、[a x8 ,a y8 ,a z8 ] represent the coordinate system O 8 X 8 Y 8 Z 8 The three principal axis unit vectors are relative to the coordinate system O 7 X 7 Y 7 Z 7 The projected components of the three principal axes of ; [n x9 ,n y9 ,n z9 ]、[o x9 ,o y9 ,o z9 ]、[a x9 ,a y9 ,a z9 ] represent the coordinate system O 9 X 9 Y 9 Z 9 The three principal axis unit vectors are relative to the coordinate system O 8 X 8 Y 8 Z 8 The projected components of the three principal axes of ; Offline computational simulation is performed before surgery; According to the surgical planning target in the optical tracker coordinate system and the position of the optical marker point on the navigation and positioning component of the robot arm, the posture transformation relationship between the two is determined. In a virtual simulation environment, the inverse solution is obtained according to the kinematic model of the robot arm to obtain the rotation angle of each joint of the robot arm. The robot arm moves to the planned target position, and the simulation system displays the posture deviation between the real navigation and positioning component of the robot arm and the planned target in real time. During the operation, the robot arm is manually positioned according to the simulation results; For a four-joint robot A, manually rotate the first, second, and third rotation joints in sequence to make the rotation angle detected by the encoder consistent with the corresponding robot A joint rotation angle acquired by the simulation system, lock the three joints, manually rotate the fourth ball joint in three directions to make the navigation positioning component consistent with the surgical planning target of the simulation system, and lock the fourth joint; For another two-joint robotic arm B, manually rotate the first ball joint in three directions to make the rotation angles of the ball joint in three directions consistent with the corresponding robotic arm joint rotation angles obtained by the simulation system, lock the first joint, manually rotate the second ball joint in three directions to make the navigation and positioning component consistent with the surgical planning target of the simulation system, and lock the second joint.
2. A passive surgical robot navigation and positioning system according to claim 1, It is characterized in that At least three optical marking points which are not in a straight line are installed on the navigation positioning component. The relative position and posture between the navigation tool at the end of the robotic arm and the optical marking points on the navigation positioning component are known. The navigation positioning component is provided with an electromagnetic clutch switch for the doctor to hold and operate during surgery.
3. A passive surgical robot navigation and positioning system according to claim 1, It is characterized in that The navigation and positioning component is equipped with a guide frame connected to the end of the mechanical arm, the slide rail frame can slide along the guide frame, two V-shaped sliders and a spring form a clamping device, which can clamp the surgical instrument, and the clamping device can slide up and down along the slide rail frame to adjust the position, and is fixed with a fastening screw after adjustment to ensure that the implant axis is consistent with the working axis of the surgical instrument during surgery; The guide frame is provided with a scale, and the slide rail frame is provided with optical marking points. The depth of the implant into the human body is estimated according to the distance between the optical marking points at the beginning and the end of the operation.
4. A passive surgical robot navigation and positioning system according to claim 1, It is characterized in that The robotic arm and the optical tracker are installed on an operating table or a bedside device. The robotic arm, the optical tracker, and the main control system are installed separately or integrated into one device.
5. The passive surgical robot navigation and positioning system according to claim 1, It is characterized in that During the operation, the optical tracker can track the optical marker points on the navigation and positioning component in real time. If the optical marker points deviate from the planned target, the system will issue a warning.
