WO2023029922A1 - Method and system for limiting movement area of robot - Google Patents

Method and system for limiting movement area of robot Download PDF

Info

Publication number
WO2023029922A1
WO2023029922A1 PCT/CN2022/111535 CN2022111535W WO2023029922A1 WO 2023029922 A1 WO2023029922 A1 WO 2023029922A1 CN 2022111535 W CN2022111535 W CN 2022111535W WO 2023029922 A1 WO2023029922 A1 WO 2023029922A1
Authority
WO
WIPO (PCT)
Prior art keywords
stiffness
virtual spring
stiffness value
freedom
virtual
Prior art date
Application number
PCT/CN2022/111535
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 北京长木谷医疗科技有限公司
Publication of WO2023029922A1 publication Critical patent/WO2023029922A1/en

Links

Images

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/30Surgical robots
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B17/00Surgical instruments, devices or methods, e.g. tourniquets
    • A61B17/14Surgical saws ; Accessories therefor
    • A61B17/15Guides therefor
    • A61B17/154Guides therefor for preparing bone for knee prosthesis
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/10Computer-aided planning, simulation or modelling of surgical operations
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/20Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • 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
    • A61FFILTERS IMPLANTABLE INTO BLOOD VESSELS; PROSTHESES; DEVICES PROVIDING PATENCY TO, OR PREVENTING COLLAPSING OF, TUBULAR STRUCTURES OF THE BODY, e.g. STENTS; ORTHOPAEDIC, NURSING OR CONTRACEPTIVE DEVICES; FOMENTATION; TREATMENT OR PROTECTION OF EYES OR EARS; BANDAGES, DRESSINGS OR ABSORBENT PADS; FIRST-AID KITS
    • A61F2/00Filters implantable into blood vessels; Prostheses, i.e. artificial substitutes or replacements for parts of the body; Appliances for connecting them with the body; Devices providing patency to, or preventing collapsing of, tubular structures of the body, e.g. stents
    • A61F2/02Prostheses implantable into the body
    • A61F2/30Joints
    • A61F2/46Special tools or methods for implanting or extracting artificial joints, accessories, bone grafts or substitutes, or particular adaptations therefor
    • A61F2/4603Special tools or methods for implanting or extracting artificial joints, accessories, bone grafts or substitutes, or particular adaptations therefor for insertion or extraction of endoprosthetic joints or of accessories thereof
    • A61F2/461Special tools or methods for implanting or extracting artificial joints, accessories, bone grafts or substitutes, or particular adaptations therefor for insertion or extraction of endoprosthetic joints or of accessories thereof of knees
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/10Geometric CAD
    • G06F30/17Mechanical parametric or variational design
    • 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/101Computer-aided simulation of surgical operations
    • A61B2034/102Modelling of surgical devices, implants or prosthesis
    • A61B2034/104Modelling the effect of the tool, e.g. the effect of an implanted prosthesis or for predicting the effect of ablation or burring
    • 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/101Computer-aided simulation of surgical operations
    • A61B2034/105Modelling of the patient, e.g. for ligaments or bones
    • 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/20Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis
    • A61B2034/2068Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis using pointers, e.g. pointers having reference marks for determining coordinates of body points
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61FFILTERS IMPLANTABLE INTO BLOOD VESSELS; PROSTHESES; DEVICES PROVIDING PATENCY TO, OR PREVENTING COLLAPSING OF, TUBULAR STRUCTURES OF THE BODY, e.g. STENTS; ORTHOPAEDIC, NURSING OR CONTRACEPTIVE DEVICES; FOMENTATION; TREATMENT OR PROTECTION OF EYES OR EARS; BANDAGES, DRESSINGS OR ABSORBENT PADS; FIRST-AID KITS
    • A61F2/00Filters implantable into blood vessels; Prostheses, i.e. artificial substitutes or replacements for parts of the body; Appliances for connecting them with the body; Devices providing patency to, or preventing collapsing of, tubular structures of the body, e.g. stents
    • A61F2/02Prostheses implantable into the body
    • A61F2/30Joints
    • A61F2/46Special tools or methods for implanting or extracting artificial joints, accessories, bone grafts or substitutes, or particular adaptations therefor
    • A61F2002/4632Special tools or methods for implanting or extracting artificial joints, accessories, bone grafts or substitutes, or particular adaptations therefor using computer-controlled surgery, e.g. robotic surgery
    • A61F2002/4633Special tools or methods for implanting or extracting artificial joints, accessories, bone grafts or substitutes, or particular adaptations therefor using computer-controlled surgery, e.g. robotic surgery for selection of endoprosthetic joints or for pre-operative planning

Definitions

  • the present application relates to the technical field of medical devices, and in particular, relates to a method and system for defining a movement area of a robot.
  • the main purpose of the present application is to provide a method and system for limiting the movement area of a robot, so as to limit the actuator at the end of the mechanical arm within the target area, thereby improving safety.
  • a method for defining the motion area of a robot including:
  • the stiffness-damping model of the virtual spring is established
  • Stiffness values of each of the virtual springs in directions of multiple degrees of freedom are set to limit the movement of the actuator to a pre-planned target area.
  • the direction in which the actuator cuts into the target area is marked as the depth direction
  • the direction within the target area and perpendicular to the depth direction is marked as the lateral direction
  • the direction perpendicular to the target area is marked as vertical direction
  • the stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction
  • the stiffness value of the virtual spring in the transverse direction is smaller than the stiffness value of the virtual spring in the vertical direction
  • the stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the transverse direction are both less than or equal to the first translation preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second Shift the preset stiffness threshold.
  • setting the stiffness values of each of the virtual springs in directions of multiple degrees of freedom includes:
  • the stiffness value of the virtual spring in the rotation direction taking the vertical direction as the axis is smaller than the stiffness value of the virtual spring in the rotation direction taking the depth direction as the axis, and is smaller than the stiffness of the virtual spring in the rotation direction taking the transverse direction as the axis value;
  • the stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis is less than or equal to the first rotation preset stiffness threshold
  • the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis and the stiffness value of the virtual spring in the rotation direction with the transverse axis as the axis are greater than or equal to the second rotation preset stiffness threshold.
  • the first translation preset stiffness threshold is 0N/m-500N/m;
  • the second translation preset stiffness threshold is 4000N/m-5000N/m;
  • the first rotational preset stiffness threshold is 0Nm/rad to 20Nm/rad;
  • the second rotational preset stiffness threshold is 200Nm/rad ⁇ 300Nm/rad.
  • the damping values of the virtual spring in directions of multiple degrees of freedom are set.
  • the target area includes: femoral front end osteotomy plane, femoral anterior oblique osteotomy plane, femoral posterior condyle osteotomy plane, femoral posterior oblique osteotomy plane, femoral distal end osteotomy plane and tibial osteotomy flat.
  • a system for defining the motion area of a robot includes:
  • the model building module is configured to establish a virtual spring stiffness-damping model according to the displacement offset between the initial position and the actual position of the actuator at the end of the mechanical arm of the robot in multiple degrees of freedom directions;
  • the stiffness setting module is configured to set the stiffness values of each of the virtual springs in directions of multiple degrees of freedom, so as to limit the movement of the actuator to a pre-planned target area.
  • the direction in which the actuator cuts into the target area is marked as the depth direction
  • the direction within the target area and perpendicular to the depth direction is marked as the transverse direction
  • the direction perpendicular to the target area is marked as the horizontal direction.
  • the direction is recorded as the vertical direction;
  • the stiffness setting module is further configured to, in the direction of the translation degree of freedom, set the stiffness value of the virtual spring in the depth direction, the stiffness value of the virtual spring in the transverse direction, and the stiffness value of the virtual spring in the vertical direction ;
  • the stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction
  • the stiffness value of the virtual spring in the transverse direction is greater than the stiffness value of the virtual spring in the vertical direction
  • the stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the transverse direction are both less than or equal to the first translation preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second Shift the preset stiffness threshold.
  • the stiffness setting module is further configured to, in the direction of the rotational degree of freedom, set the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis, and set the stiffness value of the virtual spring in the rotation direction with the transverse direction as the axis.
  • the stiffness value of the virtual spring in the rotation direction taking the vertical direction as the axis is smaller than the stiffness value of the virtual spring in the rotation direction taking the depth direction as the axis, and is smaller than the stiffness of the virtual spring in the rotation direction taking the transverse direction as the axis value;
  • the stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis is less than or equal to the first rotation preset stiffness threshold
  • the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis and the stiffness value of the virtual spring in the rotation direction with the transverse axis as the axis are greater than or equal to the second rotation preset stiffness threshold.
  • the stiffness setting module is further configured to set the first translation preset stiffness threshold to 0N/m-500N/m;
  • the second translation preset stiffness threshold is 4000N/m-5000N/m;
  • the first rotational preset stiffness threshold is 0Nm/rad to 20Nm/rad;
  • the second rotational preset stiffness threshold is 200Nm/rad ⁇ 300Nm/rad.
  • system for defining the motion region of the robot further includes a damping setting module configured to set damping values of the virtual spring in directions of multiple degrees of freedom.
  • the present application also proposes an electronic device, including: at least one processor and at least one memory; the memory is used to store one or more program instructions; the processor is used to run one or more Program instructions for performing any of the methods described above.
  • the present application also proposes a computer-readable storage medium, which contains one or more program instructions, and the one or more program instructions are used to execute the method described in any one of the above .
  • a stiffness-damping model of the virtual spring is established;
  • the stiffness value of each virtual spring in the degree direction is used to limit the movement of the actuator to the pre-planned target area.
  • FIG. 1 is a flow chart of a method for defining a robot motion area according to an embodiment of the present application
  • FIG. 2 is a schematic diagram of the principle of a stiffness-damping model of a virtual spring according to an embodiment of the present application
  • Fig. 3 is a schematic diagram of directions of multiple degrees of freedom of an actuator according to an embodiment of the present application.
  • Fig. 4A is a schematic diagram of a comparison before and after osteotomy according to an embodiment of the present application.
  • Fig. 4B is a schematic diagram of a femur in a first direction according to an embodiment of the present application.
  • Fig. 4C is a schematic diagram of a femur in a second direction according to an embodiment of the present application.
  • Fig. 4D is a schematic diagram of the third direction of the femur according to an embodiment of the present application.
  • Fig. 4E is a schematic view of the fourth direction of the femur according to an embodiment of the present application.
  • Fig. 4F is a schematic diagram of the fifth direction of the femur according to an embodiment of the present application.
  • Fig. 4G is a schematic diagram of a tibia according to an embodiment of the present application.
  • FIG. 5 is a schematic structural diagram of a system for defining a robot motion area according to an embodiment of the present application
  • Fig. 6 is a schematic structural diagram of a device for defining a movement area of a robot according to an embodiment of the present application.
  • the terms “installed”, “disposed”, “provided”, “connected”, “connected”, “socketed” are to be interpreted broadly. For example, it may be a fixed connection, a detachable connection, or an integral structure; it may be a mechanical connection or an electrical connection; it may be a direct connection or an indirect connection through an intermediary; internal connectivity.
  • installed disposed, “provided”, “connected”, “connected”, “socketed”
  • it may be a fixed connection, a detachable connection, or an integral structure; it may be a mechanical connection or an electrical connection; it may be a direct connection or an indirect connection through an intermediary; internal connectivity.
  • the method for defining the motion area of a robot in the present application can be applied to the method for defining the osteotomy plane of a robot for knee joint replacement, and can also be applied to the method for defining the motion area of a robot in other fields.
  • Step S102 according to the displacement offsets between the initial position and the actual position of the actuator at the end of the mechanical arm of the robot in directions of multiple degrees of freedom, a stiffness-damping model of the virtual spring is established.
  • the stiffness-damping model of the virtual spring is also called Cartesian Impedance Control Mode (CICM).
  • CICM Cartesian Impedance Control Mode
  • the behavior of the robot is compliance-sensitive and reacts to external influences such as obstacles or process forces. Applying an external force can cause the robot to deviate from the planned orbital path.
  • the model is based on virtual springs and dampers that stretch as the difference between the current measurement and the specified position of the TCP (Tool Center Point).
  • the characteristics of the spring are described by the stiffness value (stiffness), and the characteristics of the damper are described by the damping value (damping). These parameters can be set individually for each translation or rotation dimension.
  • the virtual spring is relaxed. Since the robot's behavior is compliant at this point, external forces or motion commands cause deviations between the robot's position setpoint and actual value. This causes the virtual spring to deflect, producing a force according to Hooke's law.
  • Step S104 setting the stiffness values of each virtual spring in multiple degrees of freedom directions, so as to limit the movement of the actuator to a pre-planned target area.
  • the above-mentioned target area may be a target plane, that is, an osteotomy plane.
  • the target area may include: multiple osteotomy planes at different positions on the femur and tibia.
  • a relatively large stiffness value is set, and the stiffness value is greater than a predetermined threshold, so as to limit the actuator to move in the direction perpendicular to the osteotomy plane. Movement, thereby effectively avoiding the actuator from deviating from the osteotomy plane.
  • the predetermined threshold can be set flexibly.
  • the control robot enters the state of the virtual spring damping model.
  • the entire mechanical arm can be regarded as an approximate virtual spring.
  • the virtual spring obeys Hooke's law.
  • the stiffness in this direction is large, the deflection of the actuator in this direction will be small, so that the actuator can be stably limited to the osteotomy plane.
  • the cutting depth direction of the actuator is marked as the depth direction, represented by a symbol X.
  • the direction in the region where the actuator is located and perpendicular to the cutting direction of the actuator is marked as the transverse direction, represented by the symbol Y.
  • the direction perpendicular to the plane of the actuator is recorded as the vertical direction and is represented by the symbol Z.
  • the degrees of freedom include translation degrees of freedom and rotation degrees of freedom, which are described in two cases below.
  • the stiffness values of the virtual springs in the direction of multiple degrees of freedom in the direction of the translational degree of freedom, set the stiffness of the virtual spring in the depth direction
  • the stiffness value, the stiffness value of the virtual spring in the lateral direction, and the stiffness value of the virtual spring in the vertical direction when setting the stiffness values of the virtual springs in the direction of multiple degrees of freedom, in the direction of the translational degree of freedom, set the stiffness of the virtual spring in the depth direction The stiffness value, the stiffness value of the virtual spring in the lateral direction, and the stiffness value of the virtual spring in the vertical direction.
  • the stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction; the stiffness value of the virtual spring in the transverse direction is greater than the stiffness value of the virtual spring in the vertical direction. Both the stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the lateral direction are less than or equal to the first translation preset stiffness threshold.
  • the value range of the first translation preset stiffness threshold may be 0N/m ⁇ 500N/m. Therefore, the range of the stiffness value of the virtual spring in the depth direction X and the range of the stiffness value of the virtual spring in the transverse direction Y can be limited within the range of 0 N/m to 500 N/m. Of course, it can also be set to other ranges of values according to actual conditions.
  • the principle is that the stiffness should be set relatively small, because according to Hooke's law, when the force is constant, the smaller the stiffness, the greater the spring deformation. Therefore, setting the stiffness in the depth direction as small as possible can help the actuator to move in this direction and cut.
  • the setting stiffness is also relatively small, which also helps the actuator move in this direction for cutting.
  • Both the depth direction and the transverse direction are on the osteotomy plane, and the stiffness values of the actuator in these two directions are set relatively small, which is conducive to the cutting movement of the actuator.
  • the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second translation preset stiffness threshold.
  • the second translation preset stiffness threshold may be 4000N/m ⁇ 5000N/m. It can be seen from the above that the stiffness of the vertical direction Z of the target area is the largest, and the setting range is 4000N/m-5000N/m. Of course, it can also be set flexibly according to the actual situation. The principle is that it should be as large as possible. Because according to Hooke's law, when the force is constant, the greater the stiffness, the smaller the spring deformation.
  • the stiffness values of each of the virtual springs when setting the stiffness values of each of the virtual springs in the directions of multiple degrees of freedom, set the stiffness values of the virtual springs in the rotation direction with the depth direction X as the axis;
  • the stiffness value of the virtual spring in the rotation direction with the vertical direction Z as the axis is the stiffness value of the virtual spring in the rotation direction with the vertical direction Z as the axis.
  • the stiffness value of the virtual spring in the rotation direction of the axis in the vertical direction Z is smaller than the stiffness value of the virtual spring in the rotation direction of the axis in the depth direction X, and is smaller than the stiffness value of the virtual spring in the rotation direction of the axis in the horizontal direction Y .
  • the stiffness value of the virtual spring in the rotation direction with the vertical direction Z as the axis is less than or equal to the first rotation preset stiffness threshold.
  • the preset stiffness threshold of the first rotation is 0Nm/rad to 20Nm/rad, so that the actuator can rotate in the current target area on the Z axis in the vertical direction,
  • the stiffness of the virtual spring in the rotation direction with the depth direction X as the axis and the stiffness of the virtual spring in the rotation direction with the horizontal Y as the axis are greater than or equal to the second preset rotation stiffness threshold.
  • the second rotation preset stiffness threshold is 200Nm/rad to 300Nm/rad, which limits the displacement of the actuator rotating around the X axis in the depth direction and the Y axis in the lateral direction, and prevents the actuator from breaking away from the current target area. Ensure the safety of osteotomy.
  • the preset stiffness value of the virtual spring in the depth direction X and the preset stiffness value of the virtual spring in the lateral direction Y can be 0N/m
  • the preset stiffness value of the virtual spring in the vertical direction Z is 0N/m.
  • the stiffness value be 5000N/m
  • the stiffness value of the virtual spring in the rotation direction with the vertical direction Z as the axis can be 10Nm/rad
  • the stiffness value of the virtual spring in the rotation direction with the depth direction X as the axis and the horizontal direction
  • the stiffness values of the virtual springs in the rotation direction of the axis Y may all be 300 Nm/rad.
  • the defining method further includes: setting damping values of the virtual spring in directions of multiple degrees of freedom.
  • the spring damping determines how much the virtual spring oscillates after being offset from the center position.
  • the damping value may range from 0.1 to 1.0, for example, 0.7.
  • Oscillation coefficient for all degrees of freedom 0.1 to 1.0; default value: 0.7.
  • the degrees of freedom of Cartesian damping control modes are given by the enumeration CartDOF (package com.kuka.roboticsAPI.geometricModel).
  • the values of this enumeration can be used to describe individual degrees of freedom, or a combination of multiple degrees of freedom.
  • CartDOF.TRANSL A combination of translation degrees of freedom in the X, Y, and Z directions;
  • CartDOF.C rotates degrees of freedom around the X axis
  • CartDOF.ROT combination of rotational degrees of freedom for X, Y, and Z axes
  • CartesianImpedanceControlModeimpedanceMode newCartesianImpedanceControlMode()
  • impedanceMode.parametrize (CartDOF.ALL).setDamping(1); For all combinations of all Cartesian degrees of freedom, set the spring damping to 1;
  • motioncontainer lbr. moveAsync(positionHold(impedanceMode, -1, TimeUnit. SECONDS)).
  • the aforementioned target areas when applied in knee joint replacement surgery, include: femoral anterior oblique osteotomy plane, femoral anterior oblique osteotomy plane, femoral posterior condyle osteotomy plane, femoral posterior oblique osteotomy plane, distal femoral End osteotomy plane and tibial osteotomy plane.
  • the area covered by dark gray is not the area to be osteotomized at the front end of the femur, and this area will be the osteotomy plane of the front end of the femur.
  • the dark gray covered area is the femoral anterior oblique osteotomy area, and this area is the femoral anterior oblique osteotomy plane.
  • the dark gray area is the posterior femoral condyle osteotomy area, which is the posterior femoral condyle osteotomy plane after this area is cut off.
  • the dark gray area is the posterior oblique femoral osteotomy plane after osteotomy.
  • the dark gray area is the area of the distal femur to be osteotomized. After this area is cut off, it becomes the osteotomy plane of the distal femur.
  • the light gray area is a schematic diagram of the saw blade.
  • the dark gray area is the tibial plateau area, which is the tibial osteotomy plane after being cut off.
  • the present application also proposes a method for preoperative planning, which specifically includes the following steps:
  • the medical image of the knee joint is obtained, the medical image is segmented and three-dimensionally reconstructed to obtain a three-dimensional bone model of the knee joint;
  • the key parameters of the bone can include key anatomical points of the bone, key axes of the bone, and bone size parameters, and the key anatomical points of the bone can be identified based on a deep learning algorithm, such as a neural network model, And mark the identified key anatomical points of the bone on the three-dimensional bone model.
  • a deep learning algorithm such as a neural network model
  • Bone size can include left and right femur diameter, femur anteroposterior diameter, tibial left and right diameter and tibial anteroposterior diameter.
  • the line connecting the medial and lateral borders of the tibia is determined, and the anteroposterior diameter of the tibia is determined according to the line connecting the anterior and posterior borders of the tibia.
  • the key axis of the bone is determined based on the key anatomical points of the bone, and the key angle of the bone is determined based on the key axis of the bone. However, based on the key axis of the bone and the key angle of the bone, it is helpful to determine the type and model of the three-dimensional bone prosthesis model.
  • the three-dimensional skeletal prosthesis model of the knee joint generally includes a three-dimensional femoral prosthesis model, a three-dimensional tibial prosthesis model, and a spacer model connecting the three-dimensional tibial prosthesis model and the three-dimensional femoral prosthesis model.
  • the three-dimensional skeletal prosthesis model can be a prosthesis model for total knee replacement currently on the market.
  • There are many types of three-dimensional bone prosthesis models and each type of three-dimensional bone prosthesis model has multiple models.
  • the types of three-dimensional femoral prosthesis models include ATTUNE-PS, ATTUNE-CR, SIGMA-PS150, etc.
  • the models of ATTUNE-PS include 1, 2, 3, 3N, 4, 4N, 5, 5N, 6, 6N.
  • the implementation of the system determining the prosthesis model through the interactive interface may include: setting the configuration items of each three-dimensional bone prosthesis model on the interface, for example, it may be a three-dimensional femoral prosthesis model configuration item, a three-dimensional tibial prosthesis model configuration item item and the configuration item of the 3D spacer model, when a certain configuration item is triggered (for example, the selected method triggers the configuration item), it can automatically match the corresponding prosthesis library, and then detect which phantom model in the prosthesis library is activated Trigger, the prosthesis that is triggered signals as a replacement prosthesis.
  • the femoral prosthesis model configuration item when the femoral prosthesis model configuration item is triggered, it can establish an association with the femoral prosthesis library, and then display the types and models of all the prosthesis models in the femoral prosthesis library on the interface, and then detect which type of femoral prosthesis model and which type of femoral prosthesis model under this type is triggered, so that the triggered femoral prosthesis model is selected as the femoral prosthesis model.
  • the femoral prosthesis model can be determined based on the femoral valgus angle, femoral varus angle, femoral external rotation angle, femoral internal rotation angle, left and right femoral diameter, and femoral anteroposterior diameter Whether the 3D femur model has been installed and fitted.
  • tibial varus angle femoral valgus angle
  • left and right tibial diameter tibial anteroposterior diameter
  • the three-dimensional bone model includes a three-dimensional femoral model
  • the three-dimensional bone prosthesis model includes a three-dimensional femoral prosthesis model
  • the key parameters of the bone include key parameters of the femur
  • the key parameters of the femur include the mechanical axis of the femur , femoral condyle line, posterior condyle line, femur left and right diameter and femur anteroposterior diameter
  • the step of adjusting the placement position and placement angle of the three-dimensional skeleton prosthesis model based on the key bone parameters and the type and model of the three-dimensional skeleton prosthesis model includes:
  • the installation position of the femoral prosthesis model satisfies that the femoral prosthesis model can cover the left and right sides of the femur and the front and back of the femur, the installation position is appropriate.
  • the femoral valgus angle and femoral varus angle can be determined according to the relative angle between the central axis of the femoral prosthesis model in the upper and lower direction of the coronal plane and the femoral force line, and according to the transverse axis of the femoral prosthesis model
  • the external rotation angle and internal rotation angle are determined by the relative angle to the condylar line;
  • the femoral flexion angle is determined by the angle between the femoral mechanical axis and the central axis of the femoral prosthesis model in the sagittal front-posterior direction.
  • the installation angle of the three-dimensional femoral prosthesis model is appropriate. For example, when the varus/valgus angle is adjusted to 0°, and the PCA is adjusted to 3°, it can be determined as the correct installation angle of the femoral prosthesis model. Adjust the placement position and placement angle to a suitable position.
  • the three-dimensional bone model also includes a three-dimensional tibial model
  • the three-dimensional femoral prosthesis model also includes a three-dimensional tibial prosthesis model
  • the key bone parameters also include tibial key parameters
  • the tibial key parameters include Tibial mechanical axis, tibial left-right diameter and tibial anterior-posterior diameter
  • the step of adjusting the placement position and placement angle of the three-dimensional skeleton prosthesis model based on the key bone parameters and the type and model of the three-dimensional skeleton prosthesis model includes:
  • the varus angle or valgus angle of the three-dimensional tibial prosthesis is adjusted so that the tibial mechanical axis is perpendicular to the cross-section of the three-dimensional tibial prosthesis.
  • the method further includes:
  • the osteotomy is simulated, and the three-dimensional bone postoperative simulation model is obtained;
  • the extension gap is determined in the state of extension, and the flexion gap is determined in the flexion state;
  • the bone osteotomy thickness is determined according to the bone prosthesis model design principle, and different bone prosthesis models may correspond to different osteotomy thicknesses; the osteotomy thickness, bone prosthesis model Once matched to the bone, the bone's osteotomy plane can be determined.
  • the motion simulation can be performed, and the extension gap and flexion gap can be determined through the extension position simulation map and the flexion position simulation map. Based on the straightening gap and the flexion gap, it is determined whether the three-dimensional bone prosthesis model fits the osteotomized three-dimensional bone model. By simulating the installation effect of the prosthesis, it can be observed from different angles whether the size and position of the prosthesis are appropriate, whether there is collision or misplacement of the prosthesis, and then it is possible to accurately determine whether the prosthesis and the bone fit. The user can determine whether the bone prosthesis model needs to be adjusted through the final simulation image.
  • the prosthesis library can be called again to generate a three-dimensional replacement based on the new bone prosthesis model.
  • Skeletal postoperative simulation model By simulating the expected postoperative effect, the resulting bone prosthesis model can be more closely matched to the patient's knee joint.
  • the gap can be accurately determined, thereby overcoming the reliance on the technique and experience of the surgeon in the related art, and completely relying on the gap balance and the installation of the prosthesis position.
  • the subjective feeling is assessed, which in turn leads to the defect of low surgical precision.
  • the preoperative planning method further includes: determining the three-dimensional coordinates of the center point of the femoral medullary cavity based on the three-dimensional femoral model; creating an intramedullary positioning analog rod by a circular fitting method; using the intramedullary positioning analog rod Determine the opening point of the femur.
  • the intramedullary locating analog rod and the opening point of the femur are visualized on the three-dimensional bone model to guide the doctor to open the pulp.
  • this application also proposes a bone registration method, which specifically includes the following step:
  • the three-dimensional model refers to the bone model of the knee joint.
  • the preoperative planning points are points planned in advance in the three-dimensional model for registration.
  • Intraoperative marker points are the points marked on the bone surface by the doctor during the operation.
  • the three-dimensional model may specifically include a three-dimensional femur model and a three-dimensional tibial model.
  • doctors place pins and trackers on each bone in the patient's knee. Then take the medial approach of the knee joint, cut the skin and subcutaneous tissue, enter the joint to fully expose the tibial plateau, and register and register the bones of the knee joint in turn.
  • the optical navigation and positioning system obtains the spatial position of the preoperative planning points on the bones in the 3D model of the knee joint in the coordinate system of the 3D model, and the intraoperative marker points on each bone of the knee joint in the world.
  • the spatial position in the coordinate system For example, 40 bone positioning points can be collected as intraoperative marker points.
  • the registration process of the 3D model can be divided into two stages: the coarse registration stage and the fine registration stage.
  • the preset 3D space point cloud search method can be used for rough registration.
  • the rough registration of the spatial position of the preoperative planning point in the three-dimensional coordinate system and the spatial position of the intraoperative marker point in the world coordinate system includes:
  • the spatial position of the preoperative planning point in the three-dimensional coordinate system and the spatial position of the intraoperative marker point in the world coordinate system are respectively triangulated to obtain the intraoperative marker
  • the intraoperative marker points corresponding to the practical operation triangle sequence are roughly registered with the corrected preoperative planning points.
  • the preset three-dimensional space point cloud search method is used to respectively analyze the spatial position of the preoperative planning point in the three-dimensional coordinate system and the spatial position of the intraoperative marker point in the world coordinate system Perform triangulation processing to obtain the practical triangle sequence corresponding to the intraoperative marker points and the planning triangle sequence corresponding to the preoperative planning points, including:
  • the first three points of the preoperative planning point are formed into a triangle, and according to the intraoperative marker point in the world coordinate system
  • the spatial position below will form a triangle with the first three points of the intraoperative marker points;
  • the triangular sequence is the same as the triangular composition order of the planned triangular sequence.
  • the pre-operative planning points are corrected according to the planning triangle sequence through the preset three-dimensional space point cloud search method, and the corrected pre-operative planning points obtained include:
  • the spatial position of the preoperative planning point under the three-dimensional model coordinates is corrected to the position corresponding to the second target point according to the planning triangle sequence.
  • the second stage of fine registration is required.
  • no preoperative planning is required.
  • surgical probes and other surface calibration equipment can be used to draw lines on the bone surfaces of the solid knee joint, and the lines drawn on each bone surface can be collected through the line drawing operation. Line point set.
  • the scribing area where the scribing operation needs to be performed is the key bone area on the surface of each bone, that is, the area containing the key bone points.
  • the dashed point set is composed of points on multiple line segments, for example, may include points in three line segments.
  • the points in the set of dashed points are paired in triangles, and a point is selected in each line segment, and every three points form a triangle.
  • the principle of composition is that the perimeter of the triangle is the largest.
  • a sequence of paired triangles is obtained.
  • the sequence of paired triangles includes a plurality of triangles.
  • the position of the tracker on the surgical probe is tracked by the tracking camera in the optical navigation and positioning system, and the probe tracker on the surgical probe acquired by the tracking camera is in the world coordinates during the scribing process.
  • the surgical probe may be used to perform sampling at a frequency S, and the point collection operation may be performed on the line to subdivide the entire line segment into several point sets.
  • the neighborhood space point set of the dashed point set on the 3D model can be determined first, and then the dashed point set can be aligned according to the neighborhood space point set and the spatial position of the dashed point set in the world coordinate system.
  • the spatial position in the three-dimensional model coordinate system is corrected, and then the corrected line point set is registered with the space position of the line point set in the world coordinate system.
  • the fine registration of the spatial position of the line point set in the world coordinate system with the 3D model according to the coarse registration matrix includes:
  • the coarse registration matrix represents the conversion relationship between the world coordinate system and the three-dimensional model coordinate system obtained by the coarse registration.
  • the spatial position of the dashed point set in the world coordinate system can be reflected back to the 3D model coordinate system, so as to obtain the position of the dashed point set in the 3D model coordinate system.
  • the neighborhood space search can be performed on the 3D model according to the position of the dashed point set in the 3D model coordinate system to obtain the first neighborhood space point set.
  • the first neighborhood space point set is a neighborhood space point set corresponding to the dashed line point set in the three-dimensional model coordinate system.
  • the correcting the spatial position of the lined point set in the world coordinate system according to the first neighborhood spatial point set includes:
  • This step specifically includes: screening out a first target point from the point set in the first neighborhood space; correcting the positions of the points in the lined point set to the positions corresponding to the first target point according to the paired triangle sequence.
  • the dashed point set is composed of points on multiple line segments, for example, may include points in three line segments.
  • the points in the set of dashed points are paired in triangles, and a point is selected in each line segment, and every three points form a triangle.
  • the principle of composition is that the perimeter of the triangle is the largest.
  • a sequence of paired triangles is obtained.
  • the sequence of paired triangles includes a plurality of triangles.
  • the first neighborhood space point set includes a large number of points.
  • the paired triangle sequence includes multiple triangles, and each triangle includes three triangle points.
  • the target point corresponding to each triangle point of the current triangle can be screened in the second neighborhood space point set according to the paired triangle sequence to obtain the first A set of target points.
  • the default screening strategy is that the triangle formed by the screened three target points is congruent with the triangle in the paired triangle sequence.
  • the spatial positions of the three triangle points of the current triangle under the coordinates of the three-dimensional model can be respectively corrected to the positions corresponding to the target points in the first target point set, and the correction process can be repeated to achieve A large number of triangles continuously correct the spatial position of the dashed point set in the 3D model coordinates, making the spatial position of the dashed point set reflected in the 3D model coordinate system more accurate.
  • the corrected set of dashed points and the spatial position of the set of dashed points in the world coordinate system are registered through a registration algorithm to obtain a registration result.
  • the registration algorithm may be ICP (Iterative Closest Point, iterative closest point algorithm).
  • the registration result can be the transformation relationship between the final world coordinate system and the three-dimensional coordinates, and the accuracy of the intraoperative operation can be improved through the registration result.
  • the spatial position of the lined point set on each bone of the knee joint of the entity in the world coordinate system is acquired through the line line operation, so that the line point set is placed in the world coordinate system according to the rough registration matrix
  • the spatial position below is precisely registered with the 3D model. Compared with the traditional point-taking registration algorithm, the registration efficiency is greatly improved, and the registration accuracy is also greatly improved.
  • the present application also proposes a method for controlling the mechanical arm of a surgical robot, including the following steps:
  • the offset of the actuator relative to the current target area is determined according to the current spatial position of the actuator and the spatial position of the current target area of the knee joint;
  • the robotic arm is controlled to confine the movement of the actuator within the target area.
  • the surgical robot may be a joint replacement robot (including, but not limited to, a total knee replacement robot and other robots that require osteotomy), and the robot may mainly include a mechanical arm, and (in a detachable manner) an executive arm installed at the end of the robot.
  • the actuator may be an osteotomy saw blade.
  • the main control system of the upper computer can send an osteotomy start signal to the robotic arm, and the robotic arm drives the osteotomy saw at the end to move after receiving the signal.
  • the end of the robotic arm and the actual area to be osteotomized can be pre-set with a tracer.
  • the tracer includes a light-sensitive ball that can emit infrared rays and is tracked in real time by a binocular infrared camera.
  • the position of the light-sensitive ball at the end of the manipulator, the position of the light-sensitive ball on the femoral area, and the position of the light-sensitive ball on the tibial area can determine the current spatial position of the actuator at the end of the manipulator, and the position of each target area.
  • the current spatial position so that the spatial position of the actuator and the spatial position of the current target area can be determined in real time, and the offset of the actuator relative to the current target area can be determined based on the spatial position of the actuator and the spatial position of the current target area.
  • a pre-planned osteotomy sequence is displayed in the three-dimensional model, and the current target area is a target area selected from a plurality of target areas in response to the operator.
  • the position of the actuator determines the position difference between the current spatial position of the target area and the current spatial position of the actuator; determines the displacement of the manipulator according to the position difference; displays in the three-dimensional model the corresponding displacement
  • the instruction adjustment information of the instruction is used to enable the operator to operate the robotic arm according to the instruction adjustment information, so as to adjust the actuator so that its plane is coplanar with the current target area. It can be understood that the plane of the actuator is coplanar with the target area, which means that the actuator is on the outer edge of the current target area, and the plane of the actuator and the current target area are roughly aligned in the same plane.
  • the indication adjustment information corresponding to the displacement amount may include the adjustment path corresponding to the displacement amount enlarged and displayed in the target area, guiding the doctor to hold the mechanical arm and adjust the plane of the actuator to align with the osteotomy plane (the actuator is on the osteotomy plane , the actuator is approximately coplanar with the osteotomy plane).
  • the step of controlling the robotic arm to limit the movement of the actuator within the target area according to the offset includes:
  • the Cartesian damping control mode modeled on the virtual spring and damper is started, and the manipulator is based on the preset stiffness value C of each virtual spring in the aforementioned multiple degrees of freedom directions and in multiple degrees of freedom directions
  • the present application also provides a system for limiting the motion plane of a robot, refer to the schematic structural diagram of a system for limiting the motion plane of a robot shown in Figure 5; the system includes:
  • the model establishment module 61 is configured to establish a virtual spring stiffness-damping model according to the displacement offset between the initial position and the actual position of the actuator at the end of the mechanical arm of the robot in multiple degrees of freedom directions;
  • the stiffness setting module 62 is configured to set stiffness values of each of the virtual springs in directions of multiple degrees of freedom, so as to limit the movement of the actuator to a pre-planned target area.
  • the direction in which the actuator cuts into the target area is marked as the depth direction
  • the direction within the target area and perpendicular to the depth direction is marked as the transverse direction
  • the direction perpendicular to the target area is marked as the horizontal direction.
  • the direction is recorded as the vertical direction;
  • the stiffness setting module 62 is further configured to, in the direction of the translation degree of freedom, set the stiffness value of the virtual spring in the depth direction, the stiffness value of the virtual spring in the transverse direction, and the stiffness value of the virtual spring in the vertical direction;
  • the stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction
  • the stiffness value of the virtual spring in the transverse direction is greater than the stiffness value of the virtual spring in the vertical direction
  • the stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the transverse direction are both less than or equal to the first translation preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second Shift the preset stiffness threshold.
  • the stiffness setting module 62 is further configured to, in the direction of the rotational degree of freedom, set the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis, and set the stiffness value of the virtual spring in the rotation direction with the transverse direction as the axis.
  • the stiffness value of the virtual spring in the rotation direction taking the vertical direction as the axis is smaller than the stiffness value of the virtual spring in the rotation direction taking the depth direction as the axis, and is smaller than the stiffness of the virtual spring in the rotation direction taking the transverse direction as the axis value;
  • the stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis is less than or equal to the first rotation preset stiffness threshold
  • the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis and the stiffness value of the virtual spring in the rotation direction with the transverse axis as the axis are greater than or equal to the second rotation preset stiffness threshold.
  • the stiffness setting module 62 is further configured to set the first translation preset stiffness threshold to 0N/m-500N/m, and the second translation preset stiffness threshold to 4000N/m-5000N/m , the first rotation preset stiffness threshold is 0N/m ⁇ 20N/m, and the second rotation preset stiffness threshold is 200N/m ⁇ 300N/m.
  • a damping setting module 63 is further included, configured to set damping values of the virtual spring in directions of multiple degrees of freedom.
  • the model building module 61 , the stiffness setting module 62 and the damping setting module 63 can all be located in the robotic arm subsystem 12 .
  • the present application also proposes a device for defining a robot motion plane, refer to the schematic structural diagram of a device for defining a robot motion plane shown in FIG. 6 ; the device includes: at least one processor 71 and at least one memory 72; The memory 72 is used to store one or more program instructions; the processor 71 is used to run one or more program instructions to perform any of the steps described above.
  • the present application also proposes a computer-readable storage medium, which contains one or more program instructions, and the one or more program instructions are used to perform the steps described in any one of the above .
  • a general-purpose processor may be a microprocessor, or the processor may be any conventional processor, or the like.
  • the steps of the method disclosed in connection with the embodiments of the present application may be directly implemented by a hardware decoding processor, or implemented by a combination of hardware and software modules in the decoding processor.
  • the software module can be located in a mature storage medium in the field such as random access memory, flash memory, read-only memory, programmable read-only memory or electrically erasable programmable memory, register.
  • the processor reads the information in the storage medium, and completes the steps of the above method in combination with its hardware.
  • a storage medium may be a memory, which may be, for example, volatile memory or nonvolatile memory, or may include both volatile and nonvolatile memory.
  • the non-volatile memory can be read-only memory (Read-Only Memory, referred to as ROM), programmable read-only memory (Programmable ROM, referred to as PROM), erasable programmable read-only memory (Erasable PROM, referred to as EPROM) , Electrically Erasable Programmable Read-Only Memory (Electrically Erasable EPROM, referred to as EEPROM) or flash memory.
  • ROM Read-Only Memory
  • PROM programmable read-only memory
  • EPROM erasable programmable read-only memory
  • EPROM erasable programmable read-only memory
  • EPROM erasable programmable read-only memory
  • EEPROM Electrically Erasable Programmable Read-Only Memory
  • flash memory Electrically Erasable Programmable Read-Only Memory
  • the volatile memory may be Random Access Memory (RAM for short), which acts as an external cache.
  • RAM Random Access Memory
  • many forms of RAM are available, such as Static Random Access Memory (Static RAM, SRAM for short), Dynamic Random Access Memory (Dynamic RAM, DRAM for short), Synchronous Dynamic Random Access Memory (Synchronous DRAM, referred to as SDRAM), double data rate synchronous dynamic random access memory (Double Data Rate SDRAM, referred to as DDRSDRAM), enhanced synchronous dynamic random access memory (Enhanced SDRAM, referred to as ESDRAM), synchronous connection dynamic random access memory (Synchlink DRAM, referred to as SLDRAM) and direct memory bus random access memory (DirectRambus RAM, referred to as DRRAM).
  • Static Random Access Memory Static Random Access Memory
  • Dynamic RAM Dynamic RAM
  • Synchronous Dynamic Random Access Memory Synchronous Dynamic Random Access Memory
  • DDRSDRAM double data rate synchronous dynamic random access memory
  • ESDRAM enhanced synchronous dynamic random access memory
  • the storage medium described in the embodiments of the present application is intended to include but not limited to these and any other suitable types of storage.
  • each module or each step of the above-mentioned application can be realized by a general-purpose computing device, and they can be concentrated on a single computing device, or distributed in a network composed of multiple computing devices
  • they can be implemented with program codes executable by a computing device, so that they can be stored in a storage device and executed by a computing device, or they can be made into individual integrated circuit modules, or they can be integrated into Multiple modules or steps are fabricated into a single integrated circuit module to realize.
  • the present application is not limited to any specific combination of hardware and software.

Landscapes

  • Health & Medical Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Veterinary Medicine (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Public Health (AREA)
  • General Health & Medical Sciences (AREA)
  • Animal Behavior & Ethology (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Medical Informatics (AREA)
  • Molecular Biology (AREA)
  • Physics & Mathematics (AREA)
  • Robotics (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Geometry (AREA)
  • Transplantation (AREA)
  • General Physics & Mathematics (AREA)
  • Physical Education & Sports Medicine (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Theoretical Computer Science (AREA)
  • Mathematical Analysis (AREA)
  • Evolutionary Computation (AREA)
  • Computer Hardware Design (AREA)
  • Computational Mathematics (AREA)
  • General Engineering & Computer Science (AREA)
  • Pure & Applied Mathematics (AREA)
  • Dentistry (AREA)
  • Mathematical Optimization (AREA)
  • Cardiology (AREA)
  • Vascular Medicine (AREA)
  • Prostheses (AREA)

Abstract

Disclosed in the present application are a method and system for limiting a movement area of a robot. The method comprises: establishing a stiffness-damping model of a virtual spring according to a displacement offset between an initial position and an actual position of an actuator at a robot arm tail end of a robot in each of the directions of multiple degrees of freedom; and setting the respective stiffness values of the virtual springs in the directions of the multiple degrees of freedom, so as to limit the movement of the actuator in a pre-planned target area. In the present application, the stiffness in each of the directions of multiple degrees of freedom is set by using a stiffness-damping model of a virtual spring, such that motions in the directions of the multiple degrees of freedom are restrained. When an external force is applied to the multiple degrees of freedom, displacement is very small in the direction of the degree of freedom where the stiffness is large, such that displacement may not even occur. In this way, an actuator can be limited in a target area, thereby preventing a patient from being hurt by the actuator deviating from the target area.

Description

机器人运动区域的限定方法及系统Method and system for limiting motion area of robot
相关申请的交叉引用Cross References to Related Applications
本申请要求于2021年09月03日提交的申请号为202111035714.2,名称为“机器人运动区域的限定方法及系统”的中国专利申请的优先权,其通过引用方式全部并入本文。This application claims the priority of the Chinese patent application with application number 202111035714.2 and titled "Method and System for Limiting Robot Movement Area" filed on September 3, 2021, which is incorporated herein by reference in its entirety.
技术领域technical field
本申请涉及医疗器械技术领域,具体而言,涉及一种机器人运动区域的限定方法及系统。The present application relates to the technical field of medical devices, and in particular, relates to a method and system for defining a movement area of a robot.
背景技术Background technique
现有的手术中,采用机器人进行辅助时,医生手扶持机器人的机械臂进行操作。在操作的过程中,由于操作的疏忽大意,主动或被动的在不该用力的地方可能会用力过猛,使得机械臂末端的锯片超出了预定的操作区域,从而给患者带来不必要的伤害。In the existing operation, when a robot is used for assistance, the doctor's hand supports the mechanical arm of the robot to operate. During the operation, due to the negligence of the operation, active or passive force may be exerted too much where it should not be, so that the saw blade at the end of the mechanical arm exceeds the predetermined operating area, thereby causing unnecessary pain to the patient. harm.
发明内容Contents of the invention
本申请的主要目的在于提供一种机器人运动区域的限定方法及系统,以把机械臂末端的执行器限定在目标区域内,从而提高安全性。The main purpose of the present application is to provide a method and system for limiting the movement area of a robot, so as to limit the actuator at the end of the mechanical arm within the target area, thereby improving safety.
为了实现上述目的,根据本申请的一个方面,提供了一种机器人运动区域的限定方法,包括:In order to achieve the above purpose, according to one aspect of the present application, a method for defining the motion area of a robot is provided, including:
根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型;According to the displacement offset between the initial position and the actual position of the actuator at the end of the robotic arm of the robot in multiple degrees of freedom directions, the stiffness-damping model of the virtual spring is established;
设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。Stiffness values of each of the virtual springs in directions of multiple degrees of freedom are set to limit the movement of the actuator to a pre-planned target area.
在一种实施方式中,所述执行器向所述目标区域切入的方向记为进深方向,所述目标区域内并与进深方向垂直的方向记为横向,与所述目标区域垂直的方向记为垂直方向;In one embodiment, the direction in which the actuator cuts into the target area is marked as the depth direction, the direction within the target area and perpendicular to the depth direction is marked as the lateral direction, and the direction perpendicular to the target area is marked as vertical direction;
设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,包括:Set the stiffness values of each of the virtual springs in directions of multiple degrees of freedom, including:
在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值;In the translation degree of freedom direction, set the stiffness value of the virtual spring in the depth direction, the stiffness value of the virtual spring in the lateral direction, and the stiffness value of the virtual spring in the vertical direction;
所述进深方向上的虚拟弹簧的刚度值等于或小于所述横向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction;
所述横向上的虚拟弹簧的刚度值小于所述垂直方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the transverse direction is smaller than the stiffness value of the virtual spring in the vertical direction;
所述进深方向上的虚拟弹簧的刚度值、所述横向上的虚拟弹簧的刚度值均小于或等于第一平移预设刚度阈值,所述垂直方向上的虚拟弹簧的刚度值大于或等于第二平移预设刚度阈值。The stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the transverse direction are both less than or equal to the first translation preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second Shift the preset stiffness threshold.
在一种实施方式中,设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,包括:In one embodiment, setting the stiffness values of each of the virtual springs in directions of multiple degrees of freedom includes:
在旋转自由度方向上,设定以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值、以所述横向为轴旋转方向上的虚拟弹簧的刚度值和以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值;In the direction of the degree of freedom of rotation, set the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis, the stiffness value of the virtual spring in the rotation direction with the horizontal axis as the axis, and the rotation with the vertical direction as the axis The stiffness value of the virtual spring in the direction;
以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值,并小于以所述横向为轴旋转方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the rotation direction taking the vertical direction as the axis is smaller than the stiffness value of the virtual spring in the rotation direction taking the depth direction as the axis, and is smaller than the stiffness of the virtual spring in the rotation direction taking the transverse direction as the axis value;
以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于或等于第一旋转预设刚度阈值;The stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis is less than or equal to the first rotation preset stiffness threshold;
以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值和以所述横向为轴旋转方向上的虚拟弹簧的刚度值大于或等于第二旋转预设刚度阈值。The stiffness value of the virtual spring in the rotation direction with the depth direction as the axis and the stiffness value of the virtual spring in the rotation direction with the transverse axis as the axis are greater than or equal to the second rotation preset stiffness threshold.
在一种实施方式中,所述第一平移预设刚度阈值为0N/m~500N/m;In one embodiment, the first translation preset stiffness threshold is 0N/m-500N/m;
所述第二平移预设刚度阈值为4000N/m~5000N/m;The second translation preset stiffness threshold is 4000N/m-5000N/m;
所述第一旋转预设刚度阈值为0Nm/rad~20Nm/rad;The first rotational preset stiffness threshold is 0Nm/rad to 20Nm/rad;
所述第二旋转预设刚度阈值为200Nm/rad~300Nm/rad。The second rotational preset stiffness threshold is 200Nm/rad˜300Nm/rad.
在一种实施方式中,设定虚拟弹簧在多个自由度方向上的阻尼值。In one embodiment, the damping values of the virtual spring in directions of multiple degrees of freedom are set.
在一种实施方式中,所述目标区域包括:股骨前端截骨平面、股骨前斜截骨平面、股骨后髁截骨平面、股骨后斜截骨平面、股骨远端截骨平面和胫骨截骨平面。In one embodiment, the target area includes: femoral front end osteotomy plane, femoral anterior oblique osteotomy plane, femoral posterior condyle osteotomy plane, femoral posterior oblique osteotomy plane, femoral distal end osteotomy plane and tibial osteotomy flat.
为了实现上述目的,根据本申请的第二方面,提供了一种机器人运动区域的限定系统,该系统包括:In order to achieve the above object, according to the second aspect of the present application, a system for defining the motion area of a robot is provided, the system includes:
模型建立模块,被配置为根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型;The model building module is configured to establish a virtual spring stiffness-damping model according to the displacement offset between the initial position and the actual position of the actuator at the end of the mechanical arm of the robot in multiple degrees of freedom directions;
刚度设定模块,被配置为设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。The stiffness setting module is configured to set the stiffness values of each of the virtual springs in directions of multiple degrees of freedom, so as to limit the movement of the actuator to a pre-planned target area.
在一种实施方式中,所述执行器向所述目标区域切入的方向记为进深方向,在所述目标区域内并与所述进深方向垂直的方向记为横向,与所述目标区域垂直的方向记为垂直方向;In one embodiment, the direction in which the actuator cuts into the target area is marked as the depth direction, the direction within the target area and perpendicular to the depth direction is marked as the transverse direction, and the direction perpendicular to the target area is marked as the horizontal direction. The direction is recorded as the vertical direction;
所述刚度设定模块还被配置为,在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值;The stiffness setting module is further configured to, in the direction of the translation degree of freedom, set the stiffness value of the virtual spring in the depth direction, the stiffness value of the virtual spring in the transverse direction, and the stiffness value of the virtual spring in the vertical direction ;
所述进深方向上的虚拟弹簧的刚度值等于或小于所述横向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction;
所述横向上的虚拟弹簧的刚度值大于所述垂直方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the transverse direction is greater than the stiffness value of the virtual spring in the vertical direction;
所述进深方向上的虚拟弹簧的刚度值、所述横向上的虚拟弹簧的刚度值均小于或等于第一平移预设刚度阈值,所述垂直方向上的虚拟弹簧的刚度值 大于或等于第二平移预设刚度阈值。The stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the transverse direction are both less than or equal to the first translation preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second Shift the preset stiffness threshold.
在一种实施方式中,刚度设定模块还被配置为,在旋转自由度方向上,设定以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值、以所述横向为轴旋转方向上的虚拟弹簧的刚度值和以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值;In one embodiment, the stiffness setting module is further configured to, in the direction of the rotational degree of freedom, set the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis, and set the stiffness value of the virtual spring in the rotation direction with the transverse direction as the axis. The stiffness value of the virtual spring on and the stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis;
以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值,并小于以所述横向为轴旋转方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the rotation direction taking the vertical direction as the axis is smaller than the stiffness value of the virtual spring in the rotation direction taking the depth direction as the axis, and is smaller than the stiffness of the virtual spring in the rotation direction taking the transverse direction as the axis value;
以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于或等于第一旋转预设刚度阈值;The stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis is less than or equal to the first rotation preset stiffness threshold;
以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值和以所述横向为轴旋转方向上的虚拟弹簧的刚度值大于或等于第二旋转预设刚度阈值。The stiffness value of the virtual spring in the rotation direction with the depth direction as the axis and the stiffness value of the virtual spring in the rotation direction with the transverse axis as the axis are greater than or equal to the second rotation preset stiffness threshold.
在一种实施方式中,刚度设定模块还被配置为,设定所述第一平移预设刚度阈值为0N/m~500N/m;In one embodiment, the stiffness setting module is further configured to set the first translation preset stiffness threshold to 0N/m-500N/m;
所述第二平移预设刚度阈值为4000N/m~5000N/m;The second translation preset stiffness threshold is 4000N/m-5000N/m;
所述第一旋转预设刚度阈值为0Nm/rad~20Nm/rad;The first rotational preset stiffness threshold is 0Nm/rad to 20Nm/rad;
所述第二旋转预设刚度阈值为200Nm/rad~300Nm/rad。The second rotational preset stiffness threshold is 200Nm/rad˜300Nm/rad.
在一种实施方式中,机器人运动区域的限定系统还包括阻尼设定模块,被配置为设定虚拟弹簧在多个自由度方向上的阻尼值。In one embodiment, the system for defining the motion region of the robot further includes a damping setting module configured to set damping values of the virtual spring in directions of multiple degrees of freedom.
第三方面,本申请还提出了一种电子设备,包括:至少一个处理器和至少一个存储器;所述存储器用于存储一个或多个程序指令;所述处理器,用于运行一个或多个程序指令,用以执行上述任意一项所述的方法。In a third aspect, the present application also proposes an electronic device, including: at least one processor and at least one memory; the memory is used to store one or more program instructions; the processor is used to run one or more Program instructions for performing any of the methods described above.
第四方面,本申请还提出了一种计算机可读存储介质,计算机可读存储介质中包含一个或多个程序指令,所述一个或多个程序指令用于执行上述任意一项所述的方法。In a fourth aspect, the present application also proposes a computer-readable storage medium, which contains one or more program instructions, and the one or more program instructions are used to execute the method described in any one of the above .
在本申请实施例中,根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型;设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。通过设定各个自由度的弹簧的刚度值,刚度值大的自由度方向上,执行器不容易发生位移,医生很难推动,如此就可以把执行器限定在目标区域上,避免给患者带来伤害,极大的提高了手术的安全性。In the embodiment of this application, according to the displacement offset between the initial position and the actual position of the actuator at the end of the robotic arm of the robot in the direction of multiple degrees of freedom, a stiffness-damping model of the virtual spring is established; The stiffness value of each virtual spring in the degree direction is used to limit the movement of the actuator to the pre-planned target area. By setting the stiffness value of the spring for each degree of freedom, in the direction of the degree of freedom with a large stiffness value, the actuator is not easy to displace, and it is difficult for the doctor to push it, so that the actuator can be limited to the target area and avoid bringing harm to the patient. injury, greatly improving the safety of surgery.
附图说明Description of drawings
构成本申请的一部分的附图用来提供对本申请的理解,使得本申请的其它特征、目的和优点变得更明显。本申请的示意性实施例附图及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:The accompanying drawings, which constitute a part of this application, are used to provide an understanding of the application and make other features, objects and advantages of the application more apparent. The drawings and descriptions of the schematic embodiments of the application are used to explain the application, and do not constitute an improper limitation to the application. In the attached picture:
图1是根据本申请实施例的一种机器人运动区域的限定方法的流程图;FIG. 1 is a flow chart of a method for defining a robot motion area according to an embodiment of the present application;
图2是根据本申请实施例的虚拟弹簧的刚度-阻尼模型的原理示意图;2 is a schematic diagram of the principle of a stiffness-damping model of a virtual spring according to an embodiment of the present application;
图3是根据本申请实施例的一种执行器的多个自由度方向的示意图;Fig. 3 is a schematic diagram of directions of multiple degrees of freedom of an actuator according to an embodiment of the present application;
图4A是根据本申请实施例的一种截骨前后对比的示意图;Fig. 4A is a schematic diagram of a comparison before and after osteotomy according to an embodiment of the present application;
图4B是根据本申请实施例的股骨第一方向示意图;Fig. 4B is a schematic diagram of a femur in a first direction according to an embodiment of the present application;
图4C是根据本申请实施例的股骨第二方向示意图;Fig. 4C is a schematic diagram of a femur in a second direction according to an embodiment of the present application;
图4D是根据本申请实施例的股骨第三方向示意图;Fig. 4D is a schematic diagram of the third direction of the femur according to an embodiment of the present application;
图4E是根据本申请实施例的股骨第四方向示意图;Fig. 4E is a schematic view of the fourth direction of the femur according to an embodiment of the present application;
图4F是根据本申请实施例的股骨第五方向示意图;Fig. 4F is a schematic diagram of the fifth direction of the femur according to an embodiment of the present application;
图4G是根据本申请实施例的一种胫骨示意图;Fig. 4G is a schematic diagram of a tibia according to an embodiment of the present application;
图5是根据本申请实施例的一种机器人运动区域的限定系统的结构示意图;FIG. 5 is a schematic structural diagram of a system for defining a robot motion area according to an embodiment of the present application;
图6是根据本申请实施例的一种机器人运动区域的限定设备的结构示意图。Fig. 6 is a schematic structural diagram of a device for defining a movement area of a robot according to an embodiment of the present application.
具体实施方式Detailed ways
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiment of the application will be clearly and completely described below in conjunction with the accompanying drawings in the embodiment of the application. Obviously, the described embodiment is only It is an embodiment of a part of the application, but not all of the embodiments. Based on the embodiments in this application, all other embodiments obtained by persons of ordinary skill in the art without creative efforts shall fall within the scope of protection of this application.
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。It should be noted that the terms "first" and "second" in the description and claims of the present application and the above drawings are used to distinguish similar objects, but not necessarily used to describe a specific sequence or sequence. It should be understood that the data so used may be interchanged under appropriate circumstances for the embodiments of the application described herein. Furthermore, the terms "comprising" and "having", as well as any variations thereof, are intended to cover a non-exclusive inclusion, for example, a process, method, system, product or device comprising a sequence of steps or elements is not necessarily limited to the expressly listed instead, may include other steps or elements not explicitly listed or inherent to the process, method, product or apparatus.
在本申请中,术语“上”、“下”、“左”、“右”、“前”、“后”、“顶”、“底”、“内”、“外”、“中”、“竖直”、“水平”、“横向”、“纵向”等指示的方位或位置关系为基于附图所示的方位或位置关系。这些术语主要是为了更好地描述本申请及其实施例,并非用于限定所指示的装置、元件或组成部分必须具有特定方位,或以特定方位进行构造和操作。In this application, the terms "upper", "lower", "left", "right", "front", "rear", "top", "bottom", "inner", "outer", "middle", The orientations or positional relationships indicated by "vertical", "horizontal", "horizontal", and "longitudinal" are based on the orientations or positional relationships shown in the drawings. These terms are mainly used to better describe the present application and its embodiments, and are not used to limit that the indicated devices, elements or components must have a specific orientation, or be constructed and operated in a specific orientation.
并且,上述部分术语除了可以用于表示方位或位置关系以外,还可能用于表示其他含义,例如术语“上”在某些情况下也可能用于表示某种依附关系或连接关系。对于本领域普通技术人员而言,可以根据具体情况理解这些术语在本实用新型中的具体含义。Moreover, some of the above terms may be used to indicate other meanings besides orientation or positional relationship, for example, the term "upper" may also be used to indicate a certain attachment relationship or connection relationship in some cases. Those of ordinary skill in the art can understand the specific meanings of these terms in the present invention according to specific situations.
此外,术语“安装”、“设置”、“设有”、“连接”、“相连”、“套接”应做广义理解。例如,可以是固定连接,可拆卸连接,或整体式构造;可以是机械连接,或电连接;可以是直接相连,或者是通过中间媒介间接相连,又或者是两个装置、元件或组成部分之间内部的连通。对于本领域普通技术人员而言,可以根据具体情况理解上述术语在本实用新型中的具体含义。Furthermore, the terms "installed", "disposed", "provided", "connected", "connected", "socketed" are to be interpreted broadly. For example, it may be a fixed connection, a detachable connection, or an integral structure; it may be a mechanical connection or an electrical connection; it may be a direct connection or an indirect connection through an intermediary; internal connectivity. Those of ordinary skill in the art can understand the specific meanings of the above terms in the present invention according to specific situations.
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。It should be noted that, in the case of no conflict, the embodiments in the present application and the features in the embodiments can be combined with each other. The present application will be described in detail below with reference to the accompanying drawings and embodiments.
本申请的机器人运动区域的限定方法可应用于膝关节置换的机器人截骨平面的限定方法,也可应用于机器人在其他领域的运动区域的限定方法。The method for defining the motion area of a robot in the present application can be applied to the method for defining the osteotomy plane of a robot for knee joint replacement, and can also be applied to the method for defining the motion area of a robot in other fields.
本申请的机器人运动区域的限定方法,参见附图1所示的一种机器人运动区域的限定方法的流程图;该方法包括以下的步骤:For the limiting method of the robot motion area of the present application, refer to the flow chart of a kind of robot motion area limitation method shown in accompanying drawing 1; This method comprises the following steps:
步骤S102,根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型。Step S102 , according to the displacement offsets between the initial position and the actual position of the actuator at the end of the mechanical arm of the robot in directions of multiple degrees of freedom, a stiffness-damping model of the virtual spring is established.
其中,虚拟弹簧的刚度-阻尼模型,也称为笛卡尔阻尼控制模式(Cartesian Impedance Control Mode,CICM)。在阻尼控制模式下,机器人的行为是顺从敏感的,并能对外部影响作出反应,外部影响比如,可以为障碍物或过程力。施加外力可使机器人离开计划的轨道路径。Among them, the stiffness-damping model of the virtual spring is also called Cartesian Impedance Control Mode (CICM). In damped control mode, the behavior of the robot is compliance-sensitive and reacts to external influences such as obstacles or process forces. Applying an external force can cause the robot to deviate from the planned orbital path.
此模型基于虚拟弹簧和阻尼器实现,它们随当前测量值和TCP(Tool Center Point,工具中心点)的指定位置的差值而伸展变化。弹簧的特性由刚度值(stiffness)描述,阻尼器的特性由阻尼值(damping)描述。这些参数均可以在每个平移或旋转维度单独设置。The model is based on virtual springs and dampers that stretch as the difference between the current measurement and the specified position of the TCP (Tool Center Point). The characteristics of the spring are described by the stiffness value (stiffness), and the characteristics of the damper are described by the damping value (damping). These parameters can be set individually for each translation or rotation dimension.
如果测量的机器人位置与指定的机器人位置相对应,则虚拟弹簧松弛。由于此时机器人的行为是顺从的,因此外力或运动指令导致机器人的位置设定点和实际值之间的偏差。这会导致虚拟弹簧发生偏移,产生符合胡克定律的力。合力F可根据胡克定律计算,使用设定的弹簧刚度C和偏移Δx:F=C·Δx。If the measured robot position corresponds to the specified robot position, the virtual spring is relaxed. Since the robot's behavior is compliant at this point, external forces or motion commands cause deviations between the robot's position setpoint and actual value. This causes the virtual spring to deflect, producing a force according to Hooke's law. The resultant force F can be calculated according to Hooke's law, using a set spring stiffness C and deflection Δx: F=C·Δx.
参见附图2所示的虚拟弹簧的刚度-阻尼模型的原理示意图;其中,1为弹簧偏移;2为虚拟弹簧;3为实际位置;4为力;5为设定点的位置。弹簧刚度决定了机器人屈服于外力并偏离其计划路径的程度。See the schematic diagram of the principle of the stiffness-damping model of the virtual spring shown in accompanying drawing 2; wherein, 1 is the spring offset; 2 is the virtual spring; 3 is the actual position; 4 is the force; 5 is the position of the set point. The spring stiffness determines how much the robot succumbs to external forces and deviates from its planned path.
步骤S104,设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。Step S104, setting the stiffness values of each virtual spring in multiple degrees of freedom directions, so as to limit the movement of the actuator to a pre-planned target area.
具体的,设定不同自由度方向的弹簧刚度时,可以使用函数setStiffness(…)(type:double)进行设定。Specifically, when setting the spring stiffness in different degrees of freedom directions, you can use the function setStiffness(…)(type:double) to set.
应用在膝关节置换手术中,上述的目标区域可以为目标平面,也即是截骨平面,具体地,目标区域可包括:股骨和胫骨上的多个不同位置的截 骨平面。Applied in knee joint replacement surgery, the above-mentioned target area may be a target plane, that is, an osteotomy plane. Specifically, the target area may include: multiple osteotomy planes at different positions on the femur and tibia.
示例性的,在任意的一个截骨平面中,在垂直于截骨平面的方向上,设置比较大的刚度值,刚度值大于预定的阈值,以限制执行器在垂直于截骨平面的方向上运动,从而有效避免执行器偏离截骨平面。其中,预定的阈值可以灵活进行设定,医生在推机械臂时,若执行器在垂直于截骨平面的方向上发生偏移,机械臂会输出相应的反馈力(阻力),医生可感受到阻力,便知晓执行器发生了不期望的偏移,便不会再用力推动机械臂。Exemplarily, in any one osteotomy plane, in the direction perpendicular to the osteotomy plane, a relatively large stiffness value is set, and the stiffness value is greater than a predetermined threshold, so as to limit the actuator to move in the direction perpendicular to the osteotomy plane. Movement, thereby effectively avoiding the actuator from deviating from the osteotomy plane. Among them, the predetermined threshold can be set flexibly. When the doctor pushes the mechanical arm, if the actuator deviates in the direction perpendicular to the osteotomy plane, the mechanical arm will output the corresponding feedback force (resistance), and the doctor can feel If there is no resistance, you know that the actuator has shifted undesirably, and you don't push the arm harder.
具体实施时,在执行器与当前目标区域对齐后,启动执行器,此时,,控制机器人就进入到虚拟弹簧阻尼模型的状态,此状态下,整个机械臂可以看成一个近似的虚拟弹簧,在任何的方向上施加力后,虚拟弹簧都会遵从胡克定律。示例性的,尤其是在垂直于截骨平面的方向上,如果该方向的刚度很大,则执行器在该方向上的偏移就会很小,如此就可以使得执行器稳定地限定在截骨平面上,而避免执行器超过截骨平面,尤其是可以有效的避免执行器在垂直于截骨平面的方向上运动,从而尽最大限度的降低执行器超出目标区域,减少给患者带来的误伤害。In specific implementation, after the actuator is aligned with the current target area, start the actuator. At this time, the control robot enters the state of the virtual spring damping model. In this state, the entire mechanical arm can be regarded as an approximate virtual spring. When a force is applied in any direction, the virtual spring obeys Hooke's law. Exemplarily, especially in the direction perpendicular to the osteotomy plane, if the stiffness in this direction is large, the deflection of the actuator in this direction will be small, so that the actuator can be stably limited to the osteotomy plane. On the bone plane, and avoid the actuator beyond the osteotomy plane, especially it can effectively prevent the actuator from moving in the direction perpendicular to the osteotomy plane, so as to minimize the actuator beyond the target area and reduce the patient’s accidental injury.
为了便于说明,参见附图3所示,所述执行器切割进深方向记为进深方向,用符号X表示。处于所述执行器所在区域内并与所述执行器切割方向垂直的方向记为横向,用符号Y表示。与执行器平面垂直的方向记为垂直方向,用符号Z表示。For the convenience of description, referring to Fig. 3 , the cutting depth direction of the actuator is marked as the depth direction, represented by a symbol X. The direction in the region where the actuator is located and perpendicular to the cutting direction of the actuator is marked as the transverse direction, represented by the symbol Y. The direction perpendicular to the plane of the actuator is recorded as the vertical direction and is represented by the symbol Z.
自由度包括平移自由度和旋转自由度两种,下面分两种情况来分别说明。The degrees of freedom include translation degrees of freedom and rotation degrees of freedom, which are described in two cases below.
对于平移自由度,在一种实施方式中,设定在多个自由度方向上的各个所述虚拟弹簧的刚度值时,在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值。For the translational degree of freedom, in one embodiment, when setting the stiffness values of the virtual springs in the direction of multiple degrees of freedom, in the direction of the translational degree of freedom, set the stiffness of the virtual spring in the depth direction The stiffness value, the stiffness value of the virtual spring in the lateral direction, and the stiffness value of the virtual spring in the vertical direction.
具体的,进深方向上的虚拟弹簧的刚度值等于或小于横向上的虚拟弹簧的刚度值;横向上的虚拟弹簧的刚度值大于垂直方向上的虚拟弹簧的刚度值。进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值均小于或等于第一平移预设刚度阈值。Specifically, the stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction; the stiffness value of the virtual spring in the transverse direction is greater than the stiffness value of the virtual spring in the vertical direction. Both the stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the lateral direction are less than or equal to the first translation preset stiffness threshold.
示例性的,第一平移预设刚度阈值的取值范围可以为0N/m~500N/m。从而可以把进深方向X上的虚拟弹簧的刚度值的范围、所述横向Y上的虚拟弹簧的刚度值的范围限定在0N/m~500N/m的范围之内。当然,也可以根据实际情况设置为其他范围的值。原则就是刚度设定的要比较小,因为根据胡克定律,当力一定时,刚度越小,弹簧形变量越大。所以,在进深方向的刚度设置的尽可能小,可以有助于执行器在该方向发生位移,进行切割。在横向Y上,设置的刚度也比较小,也有助于执行器在该方向移动,进行切割。进深方向和横向都在截骨平面上,执行器在这两个方向上的刚 度值设置的比较小,有利于执行器进行切割运动。Exemplarily, the value range of the first translation preset stiffness threshold may be 0N/m˜500N/m. Therefore, the range of the stiffness value of the virtual spring in the depth direction X and the range of the stiffness value of the virtual spring in the transverse direction Y can be limited within the range of 0 N/m to 500 N/m. Of course, it can also be set to other ranges of values according to actual conditions. The principle is that the stiffness should be set relatively small, because according to Hooke's law, when the force is constant, the smaller the stiffness, the greater the spring deformation. Therefore, setting the stiffness in the depth direction as small as possible can help the actuator to move in this direction and cut. In the transverse Y direction, the setting stiffness is also relatively small, which also helps the actuator move in this direction for cutting. Both the depth direction and the transverse direction are on the osteotomy plane, and the stiffness values of the actuator in these two directions are set relatively small, which is conducive to the cutting movement of the actuator.
对于垂直方向,所述垂直方向上的虚拟弹簧的刚度值大于或等于第二平移预设刚度阈值。第二平移预设刚度阈值可为4000N/m~5000N/m。由上可知,目标区域的垂直方向Z的刚度最大,设置的范围为4000N/m~5000N/m。当然,也可以根据实际情况灵活进行设定。原则就是应该尽可能大。因为根据胡克定律,当力一定时,刚度越大,弹簧形变量越小。所以,在Z方向的刚度设置的尽可能大,可以有助于避免刀片在Z方向发生位移,因为如果在Z方向发生位移之后,直接造成执行器脱离预定的截骨平面,容易给患者带来伤害,这是不允许的。For the vertical direction, the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second translation preset stiffness threshold. The second translation preset stiffness threshold may be 4000N/m˜5000N/m. It can be seen from the above that the stiffness of the vertical direction Z of the target area is the largest, and the setting range is 4000N/m-5000N/m. Of course, it can also be set flexibly according to the actual situation. The principle is that it should be as large as possible. Because according to Hooke's law, when the force is constant, the greater the stiffness, the smaller the spring deformation. Therefore, setting the stiffness in the Z direction as large as possible can help to avoid the displacement of the blade in the Z direction, because if the displacement occurs in the Z direction, it will directly cause the actuator to deviate from the predetermined osteotomy plane, which is easy to bring harm to the patient. Injury is not allowed.
对于旋转自由度,在一种实施方式中,设定在多个自由度方向上的各个所述虚拟弹簧的刚度值时,设定以进深方向X为轴旋转方向上的虚拟弹簧的刚度值;For the degree of freedom of rotation, in one embodiment, when setting the stiffness values of each of the virtual springs in the directions of multiple degrees of freedom, set the stiffness values of the virtual springs in the rotation direction with the depth direction X as the axis;
以所述横向Y为轴旋转方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the direction of rotation with the transverse Y as the axis;
以所述垂直方向Z为轴旋转方向上的虚拟弹簧的刚度值。The stiffness value of the virtual spring in the rotation direction with the vertical direction Z as the axis.
具体的,垂直方向Z为轴旋转方向上的虚拟弹簧的刚度值小于以进深方向X为轴旋转方向上的虚拟弹簧的刚度值,并小于以横向Y为轴旋转方向上的虚拟弹簧的刚度值。Specifically, the stiffness value of the virtual spring in the rotation direction of the axis in the vertical direction Z is smaller than the stiffness value of the virtual spring in the rotation direction of the axis in the depth direction X, and is smaller than the stiffness value of the virtual spring in the rotation direction of the axis in the horizontal direction Y .
以垂直方向Z为轴旋转方向上的虚拟弹簧的刚度值小于或等于第一旋转预设刚度阈值。可选的,第一旋转预设刚度阈值为0Nm/rad~20Nm/rad,使得执行器可以垂直方向Z为轴在当前目标区域内旋转,The stiffness value of the virtual spring in the rotation direction with the vertical direction Z as the axis is less than or equal to the first rotation preset stiffness threshold. Optionally, the preset stiffness threshold of the first rotation is 0Nm/rad to 20Nm/rad, so that the actuator can rotate in the current target area on the Z axis in the vertical direction,
以进深方向X为轴旋转方向上的虚拟弹簧的刚度值和以横向Y为轴旋转方向上的虚拟弹簧的刚度值大于或等于第二旋转预设刚度阈值。The stiffness of the virtual spring in the rotation direction with the depth direction X as the axis and the stiffness of the virtual spring in the rotation direction with the horizontal Y as the axis are greater than or equal to the second preset rotation stiffness threshold.
其中,所述第二旋转预设刚度阈值为200Nm/rad~300Nm/rad,限制了执行器以进深方向X为轴旋转、以横向Y为轴旋转的位移,避免了执行器脱离当前目标区域,保证截骨的安全性。Wherein, the second rotation preset stiffness threshold is 200Nm/rad to 300Nm/rad, which limits the displacement of the actuator rotating around the X axis in the depth direction and the Y axis in the lateral direction, and prevents the actuator from breaking away from the current target area. Ensure the safety of osteotomy.
在可选的一个具体实施方式中,进深方向X上的虚拟弹簧的预设刚度值、横向Y上的虚拟弹簧的预设刚度值均可为0N/m,垂直方向Z上的虚拟弹簧的预设刚度值可为5000N/m,以垂直方向Z为轴的旋转方向上的虚拟弹簧的刚度值可为10Nm/rad,以进深方向X为轴的旋转方向上的虚拟弹簧的刚度值、以横向Y为轴的旋转方向上虚拟弹簧的刚度值可均为300Nm/rad。In an optional specific implementation, the preset stiffness value of the virtual spring in the depth direction X and the preset stiffness value of the virtual spring in the lateral direction Y can be 0N/m, and the preset stiffness value of the virtual spring in the vertical direction Z is 0N/m. Let the stiffness value be 5000N/m, the stiffness value of the virtual spring in the rotation direction with the vertical direction Z as the axis can be 10Nm/rad, the stiffness value of the virtual spring in the rotation direction with the depth direction X as the axis, and the horizontal direction The stiffness values of the virtual springs in the rotation direction of the axis Y may all be 300 Nm/rad.
在一种实施方式中,限定方法还包括:设定虚拟弹簧在多个自由度方向上的阻尼值。其中,弹簧阻尼决定了虚拟弹簧在偏移中心位置后的振荡程度。阻尼值的范围可为0.1~1.0,例如,0.7。In one embodiment, the defining method further includes: setting damping values of the virtual spring in directions of multiple degrees of freedom. Among them, the spring damping determines how much the virtual spring oscillates after being offset from the center position. The damping value may range from 0.1 to 1.0, for example, 0.7.
具体的,采用以下的函数来设置阻尼值:Specifically, the following function is used to set the damping value:
setDamping(…)Spring damping(type:double)弹簧阻尼。setDamping(...) Spring damping(type:double) spring damping.
对于所有自由度的振荡系数:0.1~1.0;默认值:0.7。Oscillation coefficient for all degrees of freedom: 0.1 to 1.0; default value: 0.7.
在机器人API中,笛卡尔阻尼控制模式的自由度由枚举CartDOF(包com.kuka.roboticsAPI.geometricModel)。此枚举的值可用于描述单独的自由度,也可以是多个自由度的组合。In the Robotics API, the degrees of freedom of Cartesian damping control modes are given by the enumeration CartDOF (package com.kuka.roboticsAPI.geometricModel). The values of this enumeration can be used to describe individual degrees of freedom, or a combination of multiple degrees of freedom.
CartDOF.X X方向上的平移自由度;CartDOF.X Translational degrees of freedom in the X direction;
CartDOF.Y Y方向上的平移自由度;CartDOF.Y Translational degrees of freedom in the Y direction;
CartDOF.Z Z方向上的平移自由度;CartDOF.Z Translational degrees of freedom in the Z direction;
CartDOF.TRANSL X、Y和Z方向上平移自由度的组合;CartDOF.TRANSL A combination of translation degrees of freedom in the X, Y, and Z directions;
CartDOF.A绕Z轴旋转的自由度;CartDOF.A degree of freedom of rotation around the Z axis;
CartDOF.B绕Y轴旋转自由度;CartDOF.B rotation degree of freedom around the Y axis;
CartDOF.C绕X轴旋转自由度;CartDOF.C rotates degrees of freedom around the X axis;
CartDOF.ROT X、Y和Z轴的旋转自由度组合;CartDOF.ROT combination of rotational degrees of freedom for X, Y, and Z axes;
CartDOF.ALL所有笛卡尔自由度的所有组合;CartDOF.ALL All combinations of all Cartesian degrees of freedom;
在平移自由度方向上,通过在Z轴方向将刚度设置到允许的最大值(5000),在X,Y方向将刚度设置到较小值(0~500),同时在旋转自由度方向B,C上将刚度设置到允许的最大值(300),在绕Z轴的旋转自由度方向A上将刚度设置到较小值(0~100),可将机械臂末端工具TCP点的运动限定在XOY平面上,并可在XOY平面上小范围转动。In the direction of the translational degree of freedom, set the stiffness to the maximum allowable value (5000) in the Z-axis direction, and set the stiffness to a smaller value (0-500) in the X and Y directions. At the same time, in the direction of the rotational degree of freedom B, Set the stiffness to the maximum allowable value (300) on C, and set the stiffness to a smaller value (0 to 100) in the direction A of the rotational degree of freedom around the Z axis, which can limit the movement of the TCP point of the tool at the end of the manipulator to On the XOY plane, and can rotate in a small range on the XOY plane.
相应代码如下:The corresponding code is as follows:
CartesianImpedanceControlModeimpedanceMode=newCartesianImpedanceControlMode();CartesianImpedanceControlModeimpedanceMode = newCartesianImpedanceControlMode();
impedanceMode.parametrize(CartDOF.A).setStiffness(10);impedanceMode.parametrize(CartDOF.A).setStiffness(10);
impedanceMode.parametrize(CartDOF.B).setStiffness(300);impedanceMode.parametrize(CartDOF.B).setStiffness(300);
impedanceMode.parametrize(CartDOF.C).setStiffness(300);impedanceMode.parametrize(CartDOF.C).setStiffness(300);
impedanceMode.parametrize(CartDOF.Z).setStiffness(5000);impedanceMode.parametrize(CartDOF.Z).setStiffness(5000);
impedanceMode.parametrize(CartDOF.X).setStiffness(0);impedanceMode.parametrize(CartDOF.X).setStiffness(0);
impedanceMode.parametrize(CartDOF.Y).setStiffness(0);impedanceMode.parametrize(CartDOF.Y).setStiffness(0);
impedanceMode.parametrize(CartDOF.ALL).setDamping(1);所有笛卡尔自由度的所有组合,设置弹簧阻尼为1;impedanceMode.parametrize(CartDOF.ALL).setDamping(1); For all combinations of all Cartesian degrees of freedom, set the spring damping to 1;
motioncontainer=lbr.moveAsync(positionHold(impedanceMode,-1,TimeUnit.SECONDS))。motioncontainer = lbr. moveAsync(positionHold(impedanceMode, -1, TimeUnit. SECONDS)).
在一种实施方式中,应用在膝关节置换手术中,上述的目标区域包括:股骨前端截骨平面、股骨前斜截骨平面、股骨后髁截骨平面、股骨后斜截骨平面、股骨远端截骨平面和胫骨截骨平面。In one embodiment, when applied in knee joint replacement surgery, the aforementioned target areas include: femoral anterior oblique osteotomy plane, femoral anterior oblique osteotomy plane, femoral posterior condyle osteotomy plane, femoral posterior oblique osteotomy plane, distal femoral End osteotomy plane and tibial osteotomy plane.
参见附图4A所示的截骨前后对比的示意图。具体的,参见附图4B所示,深灰色覆盖区域未股骨前端待截骨区域,该区域截掉后即为股骨前端截骨平面。参见附图4C所述,深灰色覆盖区域为股骨前斜待截骨区域,该区域截掉后即为股骨前斜截骨平面。参见附图4D所示,深灰色区域为 股骨后髁待截骨区域,该区域截掉后即为股骨后髁截骨平面。参见附图4E所示,深灰色区域为截骨后的股骨后斜截骨平面。参见附图4F所示,深灰色区域为股骨远端待截骨区域,该区域截掉后即为股骨远端截骨平面,浅灰色区域为锯片的示意图。参见附图4G所示,深灰色区域为胫骨平台区域,该区域截掉后即为胫骨截骨平面。Refer to the schematic diagram of the comparison before and after osteotomy shown in Fig. 4A. Specifically, as shown in FIG. 4B , the area covered by dark gray is not the area to be osteotomized at the front end of the femur, and this area will be the osteotomy plane of the front end of the femur. Referring to Fig. 4C, the dark gray covered area is the femoral anterior oblique osteotomy area, and this area is the femoral anterior oblique osteotomy plane. Referring to shown in accompanying drawing 4D, the dark gray area is the posterior femoral condyle osteotomy area, which is the posterior femoral condyle osteotomy plane after this area is cut off. Referring to Figure 4E, the dark gray area is the posterior oblique femoral osteotomy plane after osteotomy. Referring to FIG. 4F , the dark gray area is the area of the distal femur to be osteotomized. After this area is cut off, it becomes the osteotomy plane of the distal femur. The light gray area is a schematic diagram of the saw blade. Referring to Fig. 4G, the dark gray area is the tibial plateau area, which is the tibial osteotomy plane after being cut off.
为了确定上述的截骨平面,需要在术前确定假体型号,根据假体型号确定目标区域,第二方面,本申请还提出了一种术前规划的方法,具体包括以下的步骤:In order to determine the above-mentioned osteotomy plane, it is necessary to determine the type of the prosthesis before the operation, and determine the target area according to the type of the prosthesis. In the second aspect, the present application also proposes a method for preoperative planning, which specifically includes the following steps:
在获取到膝关节的医学图像后,对所述医学图像进行分割和三维重建,得到膝关节的三维骨骼模型;After the medical image of the knee joint is obtained, the medical image is segmented and three-dimensionally reconstructed to obtain a three-dimensional bone model of the knee joint;
基于所述三维骨骼模型,确定骨骼关键参数;基于所述骨骼关键参数确定三维骨骼假体模型的类型和型号;Determine key bone parameters based on the three-dimensional bone model; determine the type and model of the three-dimensional bone prosthesis model based on the key bone parameters;
具体的,在得到各个骨骼区域的三维骨骼模型后,骨骼关键参数可包括骨骼关键解剖点、骨骼关键轴线和骨骼尺寸参数,骨骼关键解剖点可基于深度学习算法,例如神经网络模型,进行识别,并在三维骨骼模型上将识别的骨骼关键解剖点进行标记。Specifically, after obtaining the three-dimensional bone model of each bone region, the key parameters of the bone can include key anatomical points of the bone, key axes of the bone, and bone size parameters, and the key anatomical points of the bone can be identified based on a deep learning algorithm, such as a neural network model, And mark the identified key anatomical points of the bone on the three-dimensional bone model.
骨骼尺寸可包括股骨左右径、股骨前后径、胫骨左右径和胫骨前后径,股骨左右径根据股骨内外侧缘连线,股骨前后径根据股骨前皮质切线和股骨后髁切线确定,胫骨左右径根据胫骨内外侧缘连线确定,胫骨前后径根据胫骨前后缘连线确定。Bone size can include left and right femur diameter, femur anteroposterior diameter, tibial left and right diameter and tibial anteroposterior diameter. The line connecting the medial and lateral borders of the tibia is determined, and the anteroposterior diameter of the tibia is determined according to the line connecting the anterior and posterior borders of the tibia.
骨骼关键轴线基于骨骼关键解剖点确定,基于骨骼关键轴线确定骨骼关键角度。而基于骨骼关键轴线、骨骼关键角度有助于确定三维骨骼假体模型的类型和型号。膝关节的三维骨骼假体模型一般性地包括三维股骨假体模型、三维胫骨假体和连接三维胫骨假体模型和三维股骨假体模型的垫片模型。The key axis of the bone is determined based on the key anatomical points of the bone, and the key angle of the bone is determined based on the key axis of the bone. However, based on the key axis of the bone and the key angle of the bone, it is helpful to determine the type and model of the three-dimensional bone prosthesis model. The three-dimensional skeletal prosthesis model of the knee joint generally includes a three-dimensional femoral prosthesis model, a three-dimensional tibial prosthesis model, and a spacer model connecting the three-dimensional tibial prosthesis model and the three-dimensional femoral prosthesis model.
三维骨骼假体模型可为目前市场上已有的全膝关节置换用的假体模型,三维骨骼假体模型有多种类型,每种类型的三维骨骼假体模型有多种型号。例如,三维股骨假体模型的类型有ATTUNE-PS、ATTUNE-CR、SIGMA-PS150等,ATTUNE-PS的型号有1、2、3、3N、4、4N、5、5N、6、6N。The three-dimensional skeletal prosthesis model can be a prosthesis model for total knee replacement currently on the market. There are many types of three-dimensional bone prosthesis models, and each type of three-dimensional bone prosthesis model has multiple models. For example, the types of three-dimensional femoral prosthesis models include ATTUNE-PS, ATTUNE-CR, SIGMA-PS150, etc., and the models of ATTUNE-PS include 1, 2, 3, 3N, 4, 4N, 5, 5N, 6, 6N.
示例性地,系统通过交互界面确定假体型号的实现方式可以包括:可以在界面设置各个三维骨骼假体模型的配置项,例如,可以是三维股骨假体模型配置项、三维胫骨假体模型配置项和三维垫片模型的配置项,当某一个配置项被触发后(例如,选定方式触发配置项),可以自动匹配对应的假体库,而后检测假体库中哪一个假体模型被触发,将被触发的假体信号作为置换假体。例如,当股骨假体模型配置项被触发后,可以与股骨假体库建立关联,而后在界面显示股骨假体库中的所有假体模型的类型和型 号,之后检测哪一个类型的股骨假体模型和该类型下的哪一个型号的股骨假体模型被触发,从而选定被触发的股骨假体模型作为股骨假体模型。Exemplarily, the implementation of the system determining the prosthesis model through the interactive interface may include: setting the configuration items of each three-dimensional bone prosthesis model on the interface, for example, it may be a three-dimensional femoral prosthesis model configuration item, a three-dimensional tibial prosthesis model configuration item item and the configuration item of the 3D spacer model, when a certain configuration item is triggered (for example, the selected method triggers the configuration item), it can automatically match the corresponding prosthesis library, and then detect which phantom model in the prosthesis library is activated Trigger, the prosthesis that is triggered signals as a replacement prosthesis. For example, when the femoral prosthesis model configuration item is triggered, it can establish an association with the femoral prosthesis library, and then display the types and models of all the prosthesis models in the femoral prosthesis library on the interface, and then detect which type of femoral prosthesis model and which type of femoral prosthesis model under this type is triggered, so that the triggered femoral prosthesis model is selected as the femoral prosthesis model.
将选择的三维骨骼假体模型植入所述三维骨骼模型;Implanting the selected three-dimensional bone prosthesis model into the three-dimensional bone model;
基于所述骨骼关键参数和所述三维骨骼假体模型的类型和型号调整所述三维骨骼假体模型的安放位置和安放角度。Adjusting the installation position and installation angle of the three-dimensional bone prosthesis model based on the key bone parameters and the type and model of the three-dimensional bone prosthesis model.
具体的,为了实现了三维可视化显示骨骼与假体的匹配调节过程、匹配效果。在得到植入三维骨骼假体模型后的三维骨骼模型后,可以基于股骨外翻角、股骨内翻角、股骨外旋角、股骨内旋角、股骨左右径、股骨前后径确定股骨假体模型是否与三维股骨模型已安装适配。Specifically, in order to realize the three-dimensional visual display of the matching adjustment process and matching effect of the bone and the prosthesis. After obtaining the three-dimensional bone model after implanting the three-dimensional bone prosthesis model, the femoral prosthesis model can be determined based on the femoral valgus angle, femoral varus angle, femoral external rotation angle, femoral internal rotation angle, left and right femoral diameter, and femoral anteroposterior diameter Whether the 3D femur model has been installed and fitted.
可以基于胫骨内翻角、股骨外翻角、胫骨左右径、胫骨前后径确定胫骨假体模型是否与三维胫骨模型已安装适配。Based on the tibial varus angle, femoral valgus angle, left and right tibial diameter, and tibial anteroposterior diameter, it can be determined whether the tibial prosthetic model has been installed and adapted to the three-dimensional tibial model.
在一种实施方式中,所述三维骨骼模型包括三维股骨模型,所述三维骨骼假体模型包括三维股骨假体模型,所述骨骼关键参数包括股骨关键参数,所述股骨关键参数包括股骨机械轴、股骨通髁线、后髁连线、股骨左右径和股骨前后径;In one embodiment, the three-dimensional bone model includes a three-dimensional femoral model, the three-dimensional bone prosthesis model includes a three-dimensional femoral prosthesis model, the key parameters of the bone include key parameters of the femur, and the key parameters of the femur include the mechanical axis of the femur , femoral condyle line, posterior condyle line, femur left and right diameter and femur anteroposterior diameter;
基于所述骨骼关键参数和所述三维骨骼假体模型的类型和型号调整所述三维骨骼假体模型的安放位置和安放角度的步骤包括:The step of adjusting the placement position and placement angle of the three-dimensional skeleton prosthesis model based on the key bone parameters and the type and model of the three-dimensional skeleton prosthesis model includes:
基于所述股骨左右径和股骨前后径,调整所述三维股骨假体模型的放置位置;Adjust the placement position of the three-dimensional femoral prosthesis model based on the left-right diameter of the femur and the anterior-posterior diameter of the femur;
调整所述三维股骨假体模型的内翻角或外翻角,使所述三维股骨假体模型的横截面与所述股骨机械轴垂直;Adjusting the varus or valgus angle of the three-dimensional femoral prosthesis model so that the cross-section of the three-dimensional femoral prosthesis model is perpendicular to the mechanical axis of the femur;
调整所述三维股骨假体的内旋角或外旋角,使股骨后髁角PCA(股骨通髁线与后髁连线在横断面的投影线之间的夹角)在预设范围内。Adjust the internal rotation angle or external rotation angle of the three-dimensional femoral prosthesis so that the posterior femoral condyle angle PCA (the included angle between the femoral condyle line and the posterior condyle line on the cross-section projection line) is within a preset range.
在本可选的实现方式中,当股骨假体模型的放置位置满足股骨假体模型能覆盖股骨左右、股骨前后,则安装位置合适。In this optional implementation manner, when the placement position of the femoral prosthesis model satisfies that the femoral prosthesis model can cover the left and right sides of the femur and the front and back of the femur, the installation position is appropriate.
可以基于股骨假体模型的当前位置,根据股骨假体模型在冠状面上下方向上的中轴线与股骨力线的相对角度确定股骨外翻角和股骨内翻角,根据股骨假体模型的横轴和通髁线的相对角度确定外旋角和内旋角;通过股骨机械轴和股骨假体模型在矢状面前后方向上的中轴线的角度确定股骨屈曲角。通过调整上述角度,可以确定三维股骨假体模型的安装角度是否合适,例如,当内/外翻角被调整为0°时,PCA被调整为3°时,则可认定为股骨假体模型的安放位置和安放角度调整到合适的位置。Based on the current position of the femoral prosthesis model, the femoral valgus angle and femoral varus angle can be determined according to the relative angle between the central axis of the femoral prosthesis model in the upper and lower direction of the coronal plane and the femoral force line, and according to the transverse axis of the femoral prosthesis model The external rotation angle and internal rotation angle are determined by the relative angle to the condylar line; the femoral flexion angle is determined by the angle between the femoral mechanical axis and the central axis of the femoral prosthesis model in the sagittal front-posterior direction. By adjusting the above angles, it can be determined whether the installation angle of the three-dimensional femoral prosthesis model is appropriate. For example, when the varus/valgus angle is adjusted to 0°, and the PCA is adjusted to 3°, it can be determined as the correct installation angle of the femoral prosthesis model. Adjust the placement position and placement angle to a suitable position.
在一种实施方式中,所述三维骨骼模型还包括三维胫骨模型,所述三维股骨假体模型还包括三维胫骨假体模型;所述骨骼关键参数还包括胫骨关键参数,所述胫骨关键参数包括胫骨机械轴、胫骨左右径和胫骨前后径;In one embodiment, the three-dimensional bone model also includes a three-dimensional tibial model, and the three-dimensional femoral prosthesis model also includes a three-dimensional tibial prosthesis model; the key bone parameters also include tibial key parameters, and the tibial key parameters include Tibial mechanical axis, tibial left-right diameter and tibial anterior-posterior diameter;
基于所述骨骼关键参数和所述三维骨骼假体模型的类型和型号调整所述三维骨骼假体模型的安放位置和安放角度的步骤包括:The step of adjusting the placement position and placement angle of the three-dimensional skeleton prosthesis model based on the key bone parameters and the type and model of the three-dimensional skeleton prosthesis model includes:
基于所述胫骨左右径和胫骨前后径,调整三维胫骨假体模型的安放位置;Adjust the placement position of the three-dimensional tibial prosthesis model based on the tibial left-right diameter and tibial-posterior diameter;
调整三维胫骨假体的内翻角或外翻角,使所述胫骨机械轴与所述三维胫骨假体的横截面垂直。The varus angle or valgus angle of the three-dimensional tibial prosthesis is adjusted so that the tibial mechanical axis is perpendicular to the cross-section of the three-dimensional tibial prosthesis.
在一种实施方式中,在调整所述三维骨骼假体模型的安放位置和安放角度的步骤之后,所述方法还包括:In one embodiment, after the step of adjusting the placement position and placement angle of the three-dimensional skeletal prosthesis model, the method further includes:
基于三维骨骼假体模型与三维假体模型的匹配关系进行模拟截骨,得到三维骨骼术后模拟模型;Based on the matching relationship between the three-dimensional bone prosthesis model and the three-dimensional prosthesis model, the osteotomy is simulated, and the three-dimensional bone postoperative simulation model is obtained;
对所述三维股骨术后模拟模型进行包括伸直位和屈曲位的运动模拟;Carry out motion simulation including straight position and flexion position to described three-dimensional femoral postoperative simulation model;
在伸直位状态确定伸直间隙,在屈曲状态确定屈曲间隙;The extension gap is determined in the state of extension, and the flexion gap is determined in the flexion state;
对比所述伸直间隙与所述屈曲间隙,对所述三维骨骼假体模型进行匹配性验证。Comparing the straightening gap and the flexion gap, the compatibility of the three-dimensional bone prosthesis model is verified.
在本可选的实现方式中,根据骨骼假体模型设计原则确定骨骼截骨厚度,不同的骨骼假体模型可能对应不同的截骨厚度;基于骨骼假体模型确定截骨厚度、骨骼假体模型与骨骼匹配后,便可确定骨骼的截骨平面。In this optional implementation, the bone osteotomy thickness is determined according to the bone prosthesis model design principle, and different bone prosthesis models may correspond to different osteotomy thicknesses; the osteotomy thickness, bone prosthesis model Once matched to the bone, the bone's osteotomy plane can be determined.
在调整好三维骨骼假体模型的安放位置和安放角度之后,基于三维骨骼假体模型与三维骨骼模型的匹配关系进行模拟截骨,得到三维骨骼术后模拟模型。After adjusting the placement position and placement angle of the three-dimensional bone prosthesis model, simulate the osteotomy based on the matching relationship between the three-dimensional bone prosthesis model and the three-dimensional bone model, and obtain the three-dimensional bone postoperative simulation model.
在得到三维骨骼术后模拟模型后,进行运动模拟,可以通过伸直位模拟图、屈曲位模拟图,确定伸直间隙、屈曲间隙。基于伸直间隙和屈曲间隙,确定三维骨骼假体模型是否与截骨后的三维骨骼模型适配。通过对假体的安装效果进行模拟可从不同角度观察假体大小、位置是否合适,是否出现假体碰撞、异位,进而能够精确地确定假体与骨骼是否适配。用户可通过该最终的模拟图像,确定是否需要对骨骼假体模型进行调整,如果更换骨骼假体的类型和型号,则可重新调用假体库,基于新的骨骼假体模型生成置换后的三维骨骼术后模拟模型。通过对术后的预期效果进行模拟,可以使最终得到的骨骼假体模型与患者的膝关节更加匹配。After obtaining the three-dimensional skeletal postoperative simulation model, the motion simulation can be performed, and the extension gap and flexion gap can be determined through the extension position simulation map and the flexion position simulation map. Based on the straightening gap and the flexion gap, it is determined whether the three-dimensional bone prosthesis model fits the osteotomized three-dimensional bone model. By simulating the installation effect of the prosthesis, it can be observed from different angles whether the size and position of the prosthesis are appropriate, whether there is collision or misplacement of the prosthesis, and then it is possible to accurately determine whether the prosthesis and the bone fit. The user can determine whether the bone prosthesis model needs to be adjusted through the final simulation image. If the type and model of the bone prosthesis are changed, the prosthesis library can be called again to generate a three-dimensional replacement based on the new bone prosthesis model. Skeletal postoperative simulation model. By simulating the expected postoperative effect, the resulting bone prosthesis model can be more closely matched to the patient's knee joint.
本实施例通过对安装假体模型的骨骼模型进行术后模拟,能够准确地确定间隙,进而克服了相关技术中依靠手术医生的技术与经验,对间隙平衡和假体位置的安装等指标完全凭借主观感觉进行评估,进而导致的手术精度低的缺陷。In this embodiment, through the postoperative simulation of the bone model with the prosthesis model installed, the gap can be accurately determined, thereby overcoming the reliance on the technique and experience of the surgeon in the related art, and completely relying on the gap balance and the installation of the prosthesis position. The subjective feeling is assessed, which in turn leads to the defect of low surgical precision.
在一种实施方式中,术前规划方法还包括:基于所述三维股骨模型确定股骨髓腔中心点的三维坐标;通过圆形拟合法创建髓内定位模拟杆;由所述髓内定位模拟杆确定股骨开髓点。In one embodiment, the preoperative planning method further includes: determining the three-dimensional coordinates of the center point of the femoral medullary cavity based on the three-dimensional femoral model; creating an intramedullary positioning analog rod by a circular fitting method; using the intramedullary positioning analog rod Determine the opening point of the femur.
在可选的实现方式中,在膝关节置换术中还需要确定股骨髓内定位模拟杆入针点的位置,其中髁间窝的顶点可作为髓内定位模拟杆的入针点位置,入针点的位置即可作为股骨开髓点。在术中,三维骨骼模型上可视化 显示髓内定位模拟杆和股骨开髓点,引导医生开髓。In an optional implementation, in knee arthroplasty, it is also necessary to determine the position of the needle entry point of the femoral intramedullary positioning analog rod, wherein the apex of the intercondylar fossa can be used as the position of the needle entry point of the intramedullary positioning analog rod. The position of the point can be used as the opening point of the femur. During the operation, the intramedullary locating analog rod and the opening point of the femur are visualized on the three-dimensional bone model to guide the doctor to open the pulp.
在截骨之前,为了确保手术机器人运动时的位置与患者的膝关节位置相匹配,需要对骨骼进行配准,第三方面,本申请还提出了一种骨骼配准的方法,具体包括以下的步骤:Before the osteotomy, in order to ensure that the position of the surgical robot matches the position of the patient's knee joint, the bones need to be registered. In the third aspect, this application also proposes a bone registration method, which specifically includes the following step:
获取膝关节的三维模型中骨骼上的术前规划点在三维模型坐标下的空间位置,以及实体的膝关节骨骼上的术中标记点在世界坐标系下的空间位置;Obtain the spatial position of the preoperative planning point on the bone in the 3D model of the knee joint in the coordinates of the 3D model, and the spatial position of the intraoperative marker point on the solid knee joint bone in the world coordinate system;
将所述术前规划点在三维坐标系下的空间位置与所述术中标记点在世界坐标系下的空间位置进行粗配准,得到粗配准矩阵;Roughly registering the spatial position of the preoperative planning point in the three-dimensional coordinate system and the spatial position of the intraoperative marker point in the world coordinate system to obtain a coarse registration matrix;
获取实体的膝关节的目标骨骼上的划线点集在世界坐标系下的空间位置;根据所述粗配准矩阵将所述划线点集在世界坐标系下的空间位置与所述三维模型进行精配准,以将世界坐标系配准到三维模型坐标系。Obtain the spatial position of the lined point set on the target bone of the knee joint of the entity in the world coordinate system; compare the spatial position of the lined point set in the world coordinate system with the three-dimensional model according to the coarse registration matrix Perform fine registration to register the world coordinate system to the 3D model coordinate system.
具体的,三维模型是指膝关节的骨骼模型。术前规划点为预先在三维模型中规划的用于配准的点。术中标记点为医生在术中标记在骨骼表面的点。Specifically, the three-dimensional model refers to the bone model of the knee joint. The preoperative planning points are points planned in advance in the three-dimensional model for registration. Intraoperative marker points are the points marked on the bone surface by the doctor during the operation.
术前,会在膝关节的三维模型中的骨骼上确定术前规划点。三维模型具体可以包括三维股骨模型和三维胫骨模型。在膝关节置换手术过程中,患者采用仰卧位,医生可以分别在患者的膝关节的各骨骼上植入固定钉,并在各骨骼上安装示踪器。之后取膝关节内侧入路,切开皮肤和皮下组织,进入关节充分暴露胫骨平台,依次对膝关节的各骨骼进行注册配准。Before surgery, preoperative planning points are determined on the bones in a 3D model of the knee joint. The three-dimensional model may specifically include a three-dimensional femur model and a three-dimensional tibial model. During knee replacement surgery, with the patient in the supine position, doctors place pins and trackers on each bone in the patient's knee. Then take the medial approach of the knee joint, cut the skin and subcutaneous tissue, enter the joint to fully expose the tibial plateau, and register and register the bones of the knee joint in turn.
光学导航定位系统在骨骼配准过程中,获取膝关节的三维模型中骨骼上的术前规划点在三维模型坐标系下的空间位置,以及实体的膝关节各骨骼上的术中标记点在世界坐标系下的空间位置。例如,可以采集40个骨骼定位点作为术中标记点。During the bone registration process, the optical navigation and positioning system obtains the spatial position of the preoperative planning points on the bones in the 3D model of the knee joint in the coordinate system of the 3D model, and the intraoperative marker points on each bone of the knee joint in the world. The spatial position in the coordinate system. For example, 40 bone positioning points can be collected as intraoperative marker points.
对三维模型的配准过程可以分为两个阶段:粗配准阶段和精配准阶段。粗配准阶段,可以采用预设三维空间点云搜索方式进行粗配准。The registration process of the 3D model can be divided into two stages: the coarse registration stage and the fine registration stage. In the rough registration stage, the preset 3D space point cloud search method can be used for rough registration.
对于粗配准,在一种实施方式中,所述将所述术前规划点在三维坐标系下的空间位置与所述术中标记点在世界坐标系下的空间位置进行粗配准包括:For the coarse registration, in one embodiment, the rough registration of the spatial position of the preoperative planning point in the three-dimensional coordinate system and the spatial position of the intraoperative marker point in the world coordinate system includes:
通过预设三维空间点云搜索方式,分别将所述术前规划点在三维坐标系下的空间位置与所述术中标记点在世界坐标系下的空间位置进行三角化处理,得到术中标记点对应的实操三角形序列和术前规划点对应的规划三角形序列;Through the preset three-dimensional space point cloud search method, the spatial position of the preoperative planning point in the three-dimensional coordinate system and the spatial position of the intraoperative marker point in the world coordinate system are respectively triangulated to obtain the intraoperative marker The actual operation triangle sequence corresponding to the point and the planning triangle sequence corresponding to the preoperative planning point;
通过预设三维空间点云搜索方式,根据所述规划三角形序列对术前规划点进行修正,得到修正后的术前规划点;Correcting the preoperative planning points according to the planning triangle sequence by preset three-dimensional space point cloud search method to obtain the corrected preoperative planning points;
将所述实操三角形序列对应的术中标记点与所述修正后的术前规划点进行粗配准。The intraoperative marker points corresponding to the practical operation triangle sequence are roughly registered with the corrected preoperative planning points.
在一种实施方式中,所述通过预设三维空间点云搜索方式,分别对所述术前规划点在三维坐标系下的空间位置与所述术中标记点在世界坐标系下的空间位置进行三角化处理,得到术中标记点对应的实操三角形序列和术前规划点对应的规划三角形序列包括:In one embodiment, the preset three-dimensional space point cloud search method is used to respectively analyze the spatial position of the preoperative planning point in the three-dimensional coordinate system and the spatial position of the intraoperative marker point in the world coordinate system Perform triangulation processing to obtain the practical triangle sequence corresponding to the intraoperative marker points and the planning triangle sequence corresponding to the preoperative planning points, including:
通过预设三维空间点云搜索方式,根据所述术前规划点在三维坐标系下的空间位置将术前规划点的前三个点组成三角形,以及根据所述术中标记点在世界坐标系下的空间位置将术中标记点的前三个点组成三角形;By preset three-dimensional space point cloud search method, according to the spatial position of the preoperative planning point in the three-dimensional coordinate system, the first three points of the preoperative planning point are formed into a triangle, and according to the intraoperative marker point in the world coordinate system The spatial position below will form a triangle with the first three points of the intraoperative marker points;
从第四个点开始,分别在之前的点中选取两个点,与当前点组成三角形,得到术中标记点对应的实操三角形序列和术前规划点对应的规划三角形序列;所述实操三角形序列与所述规划三角形序列的三角形组成顺序是相同的。Starting from the fourth point, select two points from the previous points to form a triangle with the current point, and obtain the practical triangle sequence corresponding to the marked point in the operation and the planning triangle sequence corresponding to the preoperative planning point; the practical operation The triangular sequence is the same as the triangular composition order of the planned triangular sequence.
在一种实施方式中,所述通过预设三维空间点云搜索方式,根据所述规划三角形序列对术前规划点进行修正,得到修正后的术前规划点包括:In one embodiment, the pre-operative planning points are corrected according to the planning triangle sequence through the preset three-dimensional space point cloud search method, and the corrected pre-operative planning points obtained include:
通过预设三维空间点云搜索方式,确定术前规划点在三维模型上的第二邻域空间点集;Determine the second neighborhood space point set of the preoperative planning point on the 3D model by preset 3D space point cloud search method;
在所述第二邻域空间点集中筛选出第二目标点;Screening out a second target point from the set of points in the second neighborhood space;
根据所述规划三角形序列将所述术前规划点在三维模型坐标下的空间位置修正至对应第二目标点的位置。The spatial position of the preoperative planning point under the three-dimensional model coordinates is corrected to the position corresponding to the second target point according to the planning triangle sequence.
在完成粗配准后,需要进行第二阶段的精配准。在精配准阶段,不需要进行术前规划,在术中可以利用手术探针等表标定设备在实体的膝关节的各骨骼表面进行划线操作,通过划线操作采集到各骨骼表面的划线点集。其中,需要进行划线操作的划线区域是各骨骼表面的关键骨骼区域,即包含关键骨骼点的区域。After the rough registration is completed, the second stage of fine registration is required. In the stage of fine registration, no preoperative planning is required. During the operation, surgical probes and other surface calibration equipment can be used to draw lines on the bone surfaces of the solid knee joint, and the lines drawn on each bone surface can be collected through the line drawing operation. Line point set. Wherein, the scribing area where the scribing operation needs to be performed is the key bone area on the surface of each bone, that is, the area containing the key bone points.
具体的,划线点集是由多条线段上的点所组成的,例如,可以包括三条线段中的点。将划线点集中的点进行三角形配对,分别在每条线段中选取一个点,每三个点组成一个三角形,组成原则为三角形周长最大,按照该三角形配对方式,得到配对三角形序列。配对三角形序列包括多个三角形。Specifically, the dashed point set is composed of points on multiple line segments, for example, may include points in three line segments. The points in the set of dashed points are paired in triangles, and a point is selected in each line segment, and every three points form a triangle. The principle of composition is that the perimeter of the triangle is the largest. According to the triangle pairing method, a sequence of paired triangles is obtained. The sequence of paired triangles includes a plurality of triangles.
示例性的,通过光学导航定位系统中的跟踪相机追踪手术探针上的示踪器的位置,根据跟踪相机获取的手术探针在划线过程中,其上的探针示踪器在世界坐标系下的空间位置,确定实体的膝关节的各骨骼上的划线点集在世界坐标下的空间位置,以得到划线点集。Exemplarily, the position of the tracker on the surgical probe is tracked by the tracking camera in the optical navigation and positioning system, and the probe tracker on the surgical probe acquired by the tracking camera is in the world coordinates during the scribing process. Determine the spatial position of the lined point set on each bone of the knee joint of the entity under the world coordinates, so as to obtain the lined point set.
在本实施例的一种可选方式中,在划线操作中,可以通过手术探针以频率S进行采样,在线上进行采点操作,将整条线段细分为若干点集。In an optional manner of this embodiment, during the line marking operation, the surgical probe may be used to perform sampling at a frequency S, and the point collection operation may be performed on the line to subdivide the entire line segment into several point sets.
在精配准过程中,可以先确定划线点集在三维模型上的邻域空间点集,从而根据邻域空间点集中以及划线点集在世界坐标系下的空间位置对划线点集在三维模型坐标系下的空间位置进行修正,进而将修正后的划线点 集与划线点集在世界坐标系下的空间位置进行配准。In the fine registration process, the neighborhood space point set of the dashed point set on the 3D model can be determined first, and then the dashed point set can be aligned according to the neighborhood space point set and the spatial position of the dashed point set in the world coordinate system. The spatial position in the three-dimensional model coordinate system is corrected, and then the corrected line point set is registered with the space position of the line point set in the world coordinate system.
在一种实施方式中,所述根据所述粗配准矩阵将所述划线点集在世界坐标系下的空间位置与所述三维模型进行精配准包括:In one embodiment, the fine registration of the spatial position of the line point set in the world coordinate system with the 3D model according to the coarse registration matrix includes:
根据所述粗配准矩阵将所述划线点集在世界坐标系下的空间位置反射回三维模型坐标系中,得到划线点集在三维模型坐标系下的位置;Reflecting the spatial position of the dashed point set in the world coordinate system back into the three-dimensional model coordinate system according to the coarse registration matrix, to obtain the position of the dashed point set in the three-dimensional model coordinate system;
根据所述划线点集在三维模型坐标系下的位置在所述三维模型上进行邻域空间搜索,得到第一邻域空间点集;Performing a neighborhood space search on the three-dimensional model according to the position of the dashed point set in the three-dimensional model coordinate system, to obtain a first neighborhood space point set;
根据所述第一邻域空间点集对所述划线点集在世界坐标系下的空间位置进行修正,得到线段点集;将所述线段点集与所述三维模型进行精配准。Correcting the spatial position of the dashed point set in the world coordinate system according to the first neighborhood space point set to obtain a line segment point set; finely registering the line segment point set with the 3D model.
具体的,粗配准矩阵表示粗配准得到的世界坐标系与三维模型坐标系的转换关系。根据粗配准矩阵可以将划线点集在世界坐标系下的空间位置反射回三维模型坐标系中,从而得到划线点集在三维模型坐标系下的位置。由于三维模型对应三维模型坐标系,由此可根据划线点集在三维模型坐标系下的位置在三维模型上进行邻域空间搜索,得到第一邻域空间点集。第一邻域空间点集为三维模型坐标系下的划线点集对应的邻域空间点集。Specifically, the coarse registration matrix represents the conversion relationship between the world coordinate system and the three-dimensional model coordinate system obtained by the coarse registration. According to the coarse registration matrix, the spatial position of the dashed point set in the world coordinate system can be reflected back to the 3D model coordinate system, so as to obtain the position of the dashed point set in the 3D model coordinate system. Since the 3D model corresponds to the 3D model coordinate system, the neighborhood space search can be performed on the 3D model according to the position of the dashed point set in the 3D model coordinate system to obtain the first neighborhood space point set. The first neighborhood space point set is a neighborhood space point set corresponding to the dashed line point set in the three-dimensional model coordinate system.
在一种实施方式中,所述根据所述第一邻域空间点集对所述划线点集在世界坐标系下的空间位置进行修正包括:In an implementation manner, the correcting the spatial position of the lined point set in the world coordinate system according to the first neighborhood spatial point set includes:
将划线点集中的点进行三角形配对,得到配对三角形序列;根据所述第一邻域空间点集以及所述配对三角形序列对划线点集中的点进行修正;performing triangle pairing on the points in the dashed point set to obtain a paired triangle sequence; correcting the points in the dashed point set according to the first neighborhood space point set and the paired triangle sequence;
该步骤具体包括:在所述第一邻域空间点集中筛选出第一目标点;根据所述配对三角形序列将所述划线点集中的点的位置修正至对应第一目标点的位置。This step specifically includes: screening out a first target point from the point set in the first neighborhood space; correcting the positions of the points in the lined point set to the positions corresponding to the first target point according to the paired triangle sequence.
具体的,划线点集是由多条线段上的点所组成的,例如,可以包括三条线段中的点。将划线点集中的点进行三角形配对,分别在每条线段中选取一个点,每三个点组成一个三角形,组成原则为三角形周长最大,按照该三角形配对方式,得到配对三角形序列。配对三角形序列包括多个三角形。Specifically, the dashed point set is composed of points on multiple line segments, for example, may include points in three line segments. The points in the set of dashed points are paired in triangles, and a point is selected in each line segment, and every three points form a triangle. The principle of composition is that the perimeter of the triangle is the largest. According to the triangle pairing method, a sequence of paired triangles is obtained. The sequence of paired triangles includes a plurality of triangles.
第一邻域空间点集中包括大量的点。配对三角形序列中包括多个三角形,每个三角形包括三个三角点,对于当前三角形,可以根据配对三角形序列在第二邻域空间点集中筛选当前三角形的每个三角点对应的目标点,得到第一目标点集。预设筛选策略为筛选出的三个目标点组成的三角形与配对三角形序列中的三角形为全等三角形。由于全等三角形误差极小,可以当前三角形的三个三角点在三维模型坐标下的空间位置分别修正至第一目标点集中对应目标点的位置,重复该修正过程,实现通过配对三角形序列中的大量三角形不断对划线点集在三维模型坐标下的空间位置进行修正,使得划线点集反射到三维模型坐标系中的空间位置更为准确。The first neighborhood space point set includes a large number of points. The paired triangle sequence includes multiple triangles, and each triangle includes three triangle points. For the current triangle, the target point corresponding to each triangle point of the current triangle can be screened in the second neighborhood space point set according to the paired triangle sequence to obtain the first A set of target points. The default screening strategy is that the triangle formed by the screened three target points is congruent with the triangle in the paired triangle sequence. Since the error of congruent triangles is extremely small, the spatial positions of the three triangle points of the current triangle under the coordinates of the three-dimensional model can be respectively corrected to the positions corresponding to the target points in the first target point set, and the correction process can be repeated to achieve A large number of triangles continuously correct the spatial position of the dashed point set in the 3D model coordinates, making the spatial position of the dashed point set reflected in the 3D model coordinate system more accurate.
之后,通过配准算法将修正后的划线点集与划线点集在世界坐标系下的空间位置进行配准,得到配准结果。例如,配准算法可以是ICP(Iterative Closest Point,迭代最近点算法)。配准结果可以是最终得到的世界坐标系与三维坐标下的转换关系,通过配准结果可以提高术中操作的精准性。Afterwards, the corrected set of dashed points and the spatial position of the set of dashed points in the world coordinate system are registered through a registration algorithm to obtain a registration result. For example, the registration algorithm may be ICP (Iterative Closest Point, iterative closest point algorithm). The registration result can be the transformation relationship between the final world coordinate system and the three-dimensional coordinates, and the accuracy of the intraoperative operation can be improved through the registration result.
在本实施例中,通过划线操作获取实体的膝关节的各骨骼上的划线点集在世界坐标系下的空间位置,从而根据粗配准矩阵将所述划线点集在世界坐标系下的空间位置与所述三维模型进行精配准,与传统的取点配准算法相比,配准效率有利极大的提高,配准精准度也有较大提高。In this embodiment, the spatial position of the lined point set on each bone of the knee joint of the entity in the world coordinate system is acquired through the line line operation, so that the line point set is placed in the world coordinate system according to the rough registration matrix The spatial position below is precisely registered with the 3D model. Compared with the traditional point-taking registration algorithm, the registration efficiency is greatly improved, and the registration accuracy is also greatly improved.
与上述的第一方面的机器人运动区域的限定方法对应,第四方面,本申请还提出了一种手术机器人机械臂的控制方法,包括以下的步骤:Corresponding to the above-mentioned method for defining the robot movement area in the first aspect, in the fourth aspect, the present application also proposes a method for controlling the mechanical arm of a surgical robot, including the following steps:
在机械臂末端的执行器运行过程中,根据执行器的当前空间位置与膝关节的当前目标区域的空间位置确定执行器相对于当前目标区域的偏移量;During the operation of the actuator at the end of the mechanical arm, the offset of the actuator relative to the current target area is determined according to the current spatial position of the actuator and the spatial position of the current target area of the knee joint;
根据所述偏移量,对机械臂进行控制,以将执行器的运动限定在所述目标区域内。Based on the offset, the robotic arm is controlled to confine the movement of the actuator within the target area.
具体的,手术机器人可以是关节置换机器人(包括但是不限于,全膝关节置换机器人等需要进行截骨的机器人),机器人可以主要包括机械臂、以及(以可拆卸方式)设置在机器人末端的执行器,该执行器可以是截骨锯刀。上位机主控系统可以向机械臂发送截骨启动信号,机械臂在接收到该信号后,带动其末端的截骨锯刀进行运动。Specifically, the surgical robot may be a joint replacement robot (including, but not limited to, a total knee replacement robot and other robots that require osteotomy), and the robot may mainly include a mechanical arm, and (in a detachable manner) an executive arm installed at the end of the robot. device, the actuator may be an osteotomy saw blade. The main control system of the upper computer can send an osteotomy start signal to the robotic arm, and the robotic arm drives the osteotomy saw at the end to move after receiving the signal.
机械臂末端、实际待截骨区域(例如,膝关节的股骨区域、胫骨区域)均可预先设置有示踪器,示踪器包括可发射红外线的光感小球,通过双目红外相机实时追踪械臂末端设置的光感小球的位置、股骨区域上的光感小球的位置、胫骨区域上的光感小球的位置可以确定机械臂末端的执行器的当前空间位置、各个目标区域的当前空间位置,从而可以实时确定执行器的空间位置、当前目标区域的空间位置,进而可基于执行器的空间位置,当前目标区域的空间位置确定执行器相对于当前目标区域的偏移量。The end of the robotic arm and the actual area to be osteotomized (for example, the femoral area of the knee joint, the tibial area) can be pre-set with a tracer. The tracer includes a light-sensitive ball that can emit infrared rays and is tracked in real time by a binocular infrared camera. The position of the light-sensitive ball at the end of the manipulator, the position of the light-sensitive ball on the femoral area, and the position of the light-sensitive ball on the tibial area can determine the current spatial position of the actuator at the end of the manipulator, and the position of each target area. The current spatial position, so that the spatial position of the actuator and the spatial position of the current target area can be determined in real time, and the offset of the actuator relative to the current target area can be determined based on the spatial position of the actuator and the spatial position of the current target area.
三维模型中会显示预先规划的截骨顺序,当前目标区域则为响应于操作者从多个目标区域选定的一个目标区域。A pre-planned osteotomy sequence is displayed in the three-dimensional model, and the current target area is a target area selected from a plurality of target areas in response to the operator.
作为本实施例一种可选的实现方式,在执行器运行前,当机械臂被操作至膝关节处时,根据三维模型坐标系中规划的膝关节的当前目标区域的空间位置、执行器的当前空间位置确定当前目标区域的空间位置与执行器的当前空间位置之间的位置差量;根据所述位置差量确定机械臂被操作的位移量;在三维模型中显示与所述位移量对应的指示调节信息,以使操作者根据所述指示调节信息操作机械臂,从而将执行器调整至使其平面与当前目标区域共面。可以理解的,执行器的平面与目标区域共面,是指执行 器在当前目标区域的外缘,执行器的平面与当前目标区域大致在同一平面内对齐。As an optional implementation of this embodiment, before the actuator runs, when the robotic arm is operated to the knee joint, according to the spatial position of the current target area of the knee joint planned in the three-dimensional model coordinate system, the position of the actuator The current spatial position determines the position difference between the current spatial position of the target area and the current spatial position of the actuator; determines the displacement of the manipulator according to the position difference; displays in the three-dimensional model the corresponding displacement The instruction adjustment information of the instruction is used to enable the operator to operate the robotic arm according to the instruction adjustment information, so as to adjust the actuator so that its plane is coplanar with the current target area. It can be understood that the plane of the actuator is coplanar with the target area, which means that the actuator is on the outer edge of the current target area, and the plane of the actuator and the current target area are roughly aligned in the same plane.
与位移量对应的指示调节信息可包括目标区域放大显示的与该位移量对应的调节路径,引导医生托着机械臂,将执行器的平面调整到与截骨平面对齐(执行器在截骨平面的外缘,执行器与截骨平面大致共面)。The indication adjustment information corresponding to the displacement amount may include the adjustment path corresponding to the displacement amount enlarged and displayed in the target area, guiding the doctor to hold the mechanical arm and adjust the plane of the actuator to align with the osteotomy plane (the actuator is on the osteotomy plane , the actuator is approximately coplanar with the osteotomy plane).
在一种实施方式中,根据所述偏移量,对机械臂进行控制,以将执行器的运动限定在所述目标区域内的步骤包括:In one embodiment, the step of controlling the robotic arm to limit the movement of the actuator within the target area according to the offset includes:
在执行器运行时,启动以虚拟弹簧和阻尼器为模型的笛卡尔阻尼控制模式,机械臂基于前述的多个自由度方向上的各个虚拟弹簧的预设刚度值C和多个自由度方向上的偏移量Δx,输出与被操作方向相反的反馈力F,F=Δx*C,从而将执行器的运动限定在当前目标区域内。When the actuator is running, the Cartesian damping control mode modeled on the virtual spring and damper is started, and the manipulator is based on the preset stiffness value C of each virtual spring in the aforementioned multiple degrees of freedom directions and in multiple degrees of freedom directions The offset Δx, output the feedback force F opposite to the operated direction, F=Δx*C, so as to limit the movement of the actuator within the current target area.
各个自由度方向上的预设刚度值C的大小如前所述,在此不再赘述。The magnitudes of the preset stiffness values C in the directions of each degree of freedom are as described above, and will not be repeated here.
第六方面,本申请还提供了一种机器人运动平面的限定系统,参见附图5所示的一种机器人运动平面的限定系统的结构示意图;该系统包括:In the sixth aspect, the present application also provides a system for limiting the motion plane of a robot, refer to the schematic structural diagram of a system for limiting the motion plane of a robot shown in Figure 5; the system includes:
模型建立模块61,被配置为根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型;The model establishment module 61 is configured to establish a virtual spring stiffness-damping model according to the displacement offset between the initial position and the actual position of the actuator at the end of the mechanical arm of the robot in multiple degrees of freedom directions;
刚度设定模块62,被配置为设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。在一种实施方式中,所述执行器向所述目标区域切入的方向记为进深方向,在所述目标区域内并与所述进深方向垂直的方向记为横向,与所述目标区域垂直的方向记为垂直方向;The stiffness setting module 62 is configured to set stiffness values of each of the virtual springs in directions of multiple degrees of freedom, so as to limit the movement of the actuator to a pre-planned target area. In one embodiment, the direction in which the actuator cuts into the target area is marked as the depth direction, the direction within the target area and perpendicular to the depth direction is marked as the transverse direction, and the direction perpendicular to the target area is marked as the horizontal direction. The direction is recorded as the vertical direction;
刚度设定模块62还被配置为,在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值;The stiffness setting module 62 is further configured to, in the direction of the translation degree of freedom, set the stiffness value of the virtual spring in the depth direction, the stiffness value of the virtual spring in the transverse direction, and the stiffness value of the virtual spring in the vertical direction;
所述进深方向上的虚拟弹簧的刚度值等于或小于所述横向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction;
所述横向上的虚拟弹簧的刚度值大于所述垂直方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the transverse direction is greater than the stiffness value of the virtual spring in the vertical direction;
所述进深方向上的虚拟弹簧的刚度值、所述横向上的虚拟弹簧的刚度值均小于或等于第一平移预设刚度阈值,所述垂直方向上的虚拟弹簧的刚度值大于或等于第二平移预设刚度阈值。The stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the transverse direction are both less than or equal to the first translation preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second Shift the preset stiffness threshold.
在一种实施方式中,刚度设定模块62还被配置为,在旋转自由度方向上,设定以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值、以所述横向为轴旋转方向上的虚拟弹簧的刚度值和以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值;In one embodiment, the stiffness setting module 62 is further configured to, in the direction of the rotational degree of freedom, set the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis, and set the stiffness value of the virtual spring in the rotation direction with the transverse direction as the axis. The stiffness value of the virtual spring in the direction and the stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis;
以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于以所述进 深方向为轴旋转方向上的虚拟弹簧的刚度值,并小于以所述横向为轴旋转方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the rotation direction taking the vertical direction as the axis is smaller than the stiffness value of the virtual spring in the rotation direction taking the depth direction as the axis, and is smaller than the stiffness of the virtual spring in the rotation direction taking the transverse direction as the axis value;
以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于或等于第一旋转预设刚度阈值;The stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis is less than or equal to the first rotation preset stiffness threshold;
以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值和以所述横向为轴旋转方向上的虚拟弹簧的刚度值大于或等于第二旋转预设刚度阈值。The stiffness value of the virtual spring in the rotation direction with the depth direction as the axis and the stiffness value of the virtual spring in the rotation direction with the transverse axis as the axis are greater than or equal to the second rotation preset stiffness threshold.
在一种实施方式中,刚度设定模块62还被配置为,设定第一平移预设刚度阈值为0N/m~500N/m,第二平移预设刚度阈值为4000N/m~5000N/m,第一旋转预设刚度阈值为0N/m~20N/m,第二旋转预设刚度阈值为200N/m~300N/m。In one embodiment, the stiffness setting module 62 is further configured to set the first translation preset stiffness threshold to 0N/m-500N/m, and the second translation preset stiffness threshold to 4000N/m-5000N/m , the first rotation preset stiffness threshold is 0N/m˜20N/m, and the second rotation preset stiffness threshold is 200N/m˜300N/m.
在一种实施方式中,还包括阻尼设定模块63,被配置为设定虚拟弹簧在多个自由度方向上的阻尼值。In one embodiment, a damping setting module 63 is further included, configured to set damping values of the virtual spring in directions of multiple degrees of freedom.
模型建立模块61、刚度设定模块62和阻尼设定模块63均可位于机械臂子系统12中。The model building module 61 , the stiffness setting module 62 and the damping setting module 63 can all be located in the robotic arm subsystem 12 .
第六方面,本申请还提出了一种机器人运动平面的限定设备,参见附图6所示的机器人运动平面的限定设备的结构示意图;该设备包括:至少一个处理器71和至少一个存储器72;所述存储器72用于存储一个或多个程序指令;所述处理器71,用于运行一个或多个程序指令,用以执行上述任意一项所述的步骤。In the sixth aspect, the present application also proposes a device for defining a robot motion plane, refer to the schematic structural diagram of a device for defining a robot motion plane shown in FIG. 6 ; the device includes: at least one processor 71 and at least one memory 72; The memory 72 is used to store one or more program instructions; the processor 71 is used to run one or more program instructions to perform any of the steps described above.
第七方面,本申请还提出了一种计算机可读存储介质,计算机可读存储介质中包含一个或多个程序指令,所述一个或多个程序指令用于执行上述任意一项所述的步骤。In the seventh aspect, the present application also proposes a computer-readable storage medium, which contains one or more program instructions, and the one or more program instructions are used to perform the steps described in any one of the above .
可以实现或者执行本申请实施例中的公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。结合本申请实施例所公开的方法的步骤可以直接体现为硬件译码处理器执行完成,或者用译码处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器,闪存、只读存储器,可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。处理器读取存储介质中的信息,结合其硬件完成上述方法的步骤。Various methods, steps, and logic block diagrams disclosed in the embodiments of the present application may be implemented or executed. A general-purpose processor may be a microprocessor, or the processor may be any conventional processor, or the like. The steps of the method disclosed in connection with the embodiments of the present application may be directly implemented by a hardware decoding processor, or implemented by a combination of hardware and software modules in the decoding processor. The software module can be located in a mature storage medium in the field such as random access memory, flash memory, read-only memory, programmable read-only memory or electrically erasable programmable memory, register. The processor reads the information in the storage medium, and completes the steps of the above method in combination with its hardware.
存储介质可以是存储器,例如可以是易失性存储器或非易失性存储器,或可包括易失性和非易失性存储器两者。A storage medium may be a memory, which may be, for example, volatile memory or nonvolatile memory, or may include both volatile and nonvolatile memory.
其中,非易失性存储器可以是只读存储器(Read-Only Memory,简称ROM)、可编程只读存储器(Programmable ROM,简称PROM)、可擦除可编程只读存储器(Erasable PROM,简称EPROM)、电可擦除可编程只读存储器(Electrically EPROM,简称EEPROM)或闪存。Among them, the non-volatile memory can be read-only memory (Read-Only Memory, referred to as ROM), programmable read-only memory (Programmable ROM, referred to as PROM), erasable programmable read-only memory (Erasable PROM, referred to as EPROM) , Electrically Erasable Programmable Read-Only Memory (Electrically Erasable EPROM, referred to as EEPROM) or flash memory.
易失性存储器可以是随机存取存储器(Random Access Memory,简称RAM),其用作外部高速缓存。通过示例性但不是限制性说明,许多形式 的RAM可用,例如静态随机存取存储器(Static RAM,简称SRAM)、动态随机存取存储器(Dynamic RAM,简称DRAM)、同步动态随机存取存储器(Synchronous DRAM,简称SDRAM)、双倍数据速率同步动态随机存取存储器(Double Data RateSDRAM,简称DDRSDRAM)、增强型同步动态随机存取存储器(Enhanced SDRAM,简称ESDRAM)、同步连接动态随机存取存储器(Synchlink DRAM,简称SLDRAM)和直接内存总线随机存取存储器(DirectRambus RAM,简称DRRAM)。The volatile memory may be Random Access Memory (RAM for short), which acts as an external cache. By way of illustration and not limitation, many forms of RAM are available, such as Static Random Access Memory (Static RAM, SRAM for short), Dynamic Random Access Memory (Dynamic RAM, DRAM for short), Synchronous Dynamic Random Access Memory (Synchronous DRAM, referred to as SDRAM), double data rate synchronous dynamic random access memory (Double Data Rate SDRAM, referred to as DDRSDRAM), enhanced synchronous dynamic random access memory (Enhanced SDRAM, referred to as ESDRAM), synchronous connection dynamic random access memory (Synchlink DRAM, referred to as SLDRAM) and direct memory bus random access memory (DirectRambus RAM, referred to as DRRAM).
本申请实施例描述的存储介质旨在包括但不限于这些和任意其它适合类型的存储器。The storage medium described in the embodiments of the present application is intended to include but not limited to these and any other suitable types of storage.
显然,本领域的技术人员应该明白,上述的本申请的各模块或各步骤可以用通用的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本申请不限制于任何特定的硬件和软件结合。Obviously, those skilled in the art should understand that each module or each step of the above-mentioned application can be realized by a general-purpose computing device, and they can be concentrated on a single computing device, or distributed in a network composed of multiple computing devices Optionally, they can be implemented with program codes executable by a computing device, so that they can be stored in a storage device and executed by a computing device, or they can be made into individual integrated circuit modules, or they can be integrated into Multiple modules or steps are fabricated into a single integrated circuit module to realize. As such, the present application is not limited to any specific combination of hardware and software.
以上所述仅为本申请的优选实施例而已,并不用于限制本申请,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。The above descriptions are only preferred embodiments of the present application, and are not intended to limit the present application. For those skilled in the art, there may be various modifications and changes in the present application. Any modifications, equivalent replacements, improvements, etc. made within the spirit and principles of this application shall be included within the protection scope of this application.

Claims (10)

  1. 一种机器人运动区域的限定方法,包括:A method for limiting the movement area of a robot, comprising:
    根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型;According to the displacement offset between the initial position and the actual position of the actuator at the end of the robotic arm of the robot in multiple degrees of freedom directions, the stiffness-damping model of the virtual spring is established;
    设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。Stiffness values of each of the virtual springs in directions of multiple degrees of freedom are set to limit the movement of the actuator to a pre-planned target area.
  2. 根据权利要求1所述的机器人运动区域的限定方法,其中,所述执行器向所述目标区域切入的方向记为进深方向,在所述目标区域内并与所述进深方向垂直的方向记为横向,与所述目标区域垂直的方向记为垂直方向;The method for defining the movement area of a robot according to claim 1, wherein the direction in which the actuator cuts into the target area is marked as the depth direction, and the direction within the target area and perpendicular to the depth direction is marked as Horizontally, the direction perpendicular to the target area is recorded as the vertical direction;
    设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,包括:Set the stiffness values of each of the virtual springs in directions of multiple degrees of freedom, including:
    在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值;In the translation degree of freedom direction, set the stiffness value of the virtual spring in the depth direction, the stiffness value of the virtual spring in the lateral direction, and the stiffness value of the virtual spring in the vertical direction;
    所述进深方向上的虚拟弹簧的刚度值等于或小于所述横向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction;
    所述横向上的虚拟弹簧的刚度值小于所述垂直方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the transverse direction is smaller than the stiffness value of the virtual spring in the vertical direction;
    所述进深方向上的虚拟弹簧的刚度值、所述横向上的虚拟弹簧的刚度值均小于或等于第一平移预设刚度阈值,所述垂直方向上的虚拟弹簧的刚度值大于或等于第二平移预设刚度阈值。The stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the transverse direction are both less than or equal to the first translation preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second Shift the preset stiffness threshold.
  3. 根据权利要求2所述的机器人运动区域的限定方法,其中,设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,包括:The method for defining the motion region of a robot according to claim 2, wherein setting the stiffness values of each of the virtual springs in directions of multiple degrees of freedom includes:
    在旋转自由度方向上,设定以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值、以所述横向为轴旋转方向上的虚拟弹簧的刚度值和以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值;In the direction of the degree of freedom of rotation, set the stiffness value of the virtual spring in the rotation direction with the depth direction as the axis, the stiffness value of the virtual spring in the rotation direction with the horizontal axis as the axis, and the rotation with the vertical direction as the axis The stiffness value of the virtual spring in the direction;
    以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值,并小于以所述横向为轴旋转方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the rotation direction taking the vertical direction as the axis is smaller than the stiffness value of the virtual spring in the rotation direction taking the depth direction as the axis, and is smaller than the stiffness of the virtual spring in the rotation direction taking the transverse direction as the axis value;
    以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于或等于第一旋转预设刚度阈值;The stiffness value of the virtual spring in the rotation direction with the vertical direction as the axis is less than or equal to the first rotation preset stiffness threshold;
    以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值和以所述横向为轴旋转方向上的虚拟弹簧的刚度值大于或等于第二旋转预设刚度阈值。The stiffness value of the virtual spring in the rotation direction with the depth direction as the axis and the stiffness value of the virtual spring in the rotation direction with the transverse axis as the axis are greater than or equal to the second rotation preset stiffness threshold.
  4. 根据权利要求3所述的机器人运动区域的限定方法,其中,The limiting method of the robot motion area according to claim 3, wherein,
    所述第一平移预设刚度阈值为0N/m~500N/m;The first translation preset stiffness threshold is 0N/m-500N/m;
    所述第二平移预设刚度阈值为4000N/m~5000N/m;The second translation preset stiffness threshold is 4000N/m-5000N/m;
    所述第一旋转预设刚度阈值为0Nm/rad~20Nm/rad;The first rotational preset stiffness threshold is 0Nm/rad to 20Nm/rad;
    所述第二旋转预设刚度阈值为200Nm/rad~300Nm/rad。The second rotational preset stiffness threshold is 200Nm/rad˜300Nm/rad.
  5. 根据权利要求1所述的机器人运动区域的限定方法,所述方法还包括:设定虚拟弹簧在多个自由度方向上的阻尼值。The method for defining the motion area of a robot according to claim 1, further comprising: setting damping values of the virtual spring in directions of multiple degrees of freedom.
  6. 根据权利要求1所述的机器人运动区域的限定方法,其中,The limiting method of the robot motion area according to claim 1, wherein,
    所述目标区域包括:股骨前端截骨平面、股骨前斜截骨平面、股骨后髁截骨平面、股骨后斜截骨平面、股骨远端截骨平面和胫骨截骨平面。The target area includes: the osteotomy plane of the front end of the femur, the osteotomy plane of the anterior oblique femur, the osteotomy plane of the posterior femoral condyle, the osteotomy plane of the posterior oblique femur, the osteotomy plane of the distal femur and the osteotomy plane of the tibia.
  7. 一种机器人运动区域的限定系统,包括:A system for limiting the movement area of a robot, comprising:
    模型建立模块,被配置为根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型;The model building module is configured to establish a virtual spring stiffness-damping model according to the displacement offset between the initial position and the actual position of the actuator at the end of the mechanical arm of the robot in multiple degrees of freedom directions;
    刚度设定模块,被配置为设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。The stiffness setting module is configured to set the stiffness values of each of the virtual springs in directions of multiple degrees of freedom, so as to limit the movement of the actuator to a pre-planned target area.
  8. 根据权利要求7所述的机器人运动区域的限定系统,其中,所述执行器向所述目标区域切入的方向记为进深方向,在所述目标区域内并与所述进深方向垂直的方向记为横向,与所述目标区域垂直的方向记为垂直方向;The system for limiting the movement area of a robot according to claim 7, wherein the direction in which the actuator cuts into the target area is marked as the depth direction, and the direction within the target area and perpendicular to the depth direction is marked as Horizontally, the direction perpendicular to the target area is recorded as the vertical direction;
    所述刚度设定模块还被配置为,在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值;The stiffness setting module is further configured to, in the direction of the translation degree of freedom, set the stiffness value of the virtual spring in the depth direction, the stiffness value of the virtual spring in the transverse direction, and the stiffness value of the virtual spring in the vertical direction ;
    所述进深方向上的虚拟弹簧的刚度值等于或小于所述横向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the depth direction is equal to or smaller than the stiffness value of the virtual spring in the transverse direction;
    所述横向上的虚拟弹簧的刚度值大于所述垂直方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the transverse direction is greater than the stiffness value of the virtual spring in the vertical direction;
    所述进深方向上的虚拟弹簧的刚度值、所述横向上的虚拟弹簧的刚度值均小于或等于第一平移预设刚度阈值,所述垂直方向上的虚拟弹簧的刚度值大于或等于第二平移预设刚度阈值。The stiffness value of the virtual spring in the depth direction and the stiffness value of the virtual spring in the transverse direction are both less than or equal to the first translation preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is greater than or equal to the second Shift the preset stiffness threshold.
  9. 一种电子设备,包括:至少一个处理器和至少一个存储器;所述存储器用于存储一个或多个程序指令;所述处理器,用于运行一个或多个程序指令,用以执行如权利要求1-6任一项所述的方法。An electronic device, comprising: at least one processor and at least one memory; the memory is used to store one or more program instructions; the processor is used to run one or more program instructions to perform the The method described in any one of 1-6.
  10. 一种计算机可读存储介质,计算机可读存储介质中包含一个或多个程序指令,所述一个或多个程序指令用于执行如权利要求1-6任一项所述的方法。A computer-readable storage medium, the computer-readable storage medium contains one or more program instructions, and the one or more program instructions are used to execute the method according to any one of claims 1-6.
PCT/CN2022/111535 2021-09-03 2022-08-10 Method and system for limiting movement area of robot WO2023029922A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202111035714.2A CN113842217B (en) 2021-09-03 2021-09-03 Method and system for limiting motion area of robot
CN202111035714.2 2021-09-03

Publications (1)

Publication Number Publication Date
WO2023029922A1 true WO2023029922A1 (en) 2023-03-09

Family

ID=78973279

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/111535 WO2023029922A1 (en) 2021-09-03 2022-08-10 Method and system for limiting movement area of robot

Country Status (2)

Country Link
CN (1) CN113842217B (en)
WO (1) WO2023029922A1 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113842217B (en) * 2021-09-03 2022-07-01 北京长木谷医疗科技有限公司 Method and system for limiting motion area of robot
CN113842214B (en) * 2021-09-03 2022-10-11 北京长木谷医疗科技有限公司 Surgical robot navigation positioning system and method
CN113842213B (en) * 2021-09-03 2022-10-11 北京长木谷医疗科技有限公司 Surgical robot navigation positioning method and system

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109333497A (en) * 2018-11-30 2019-02-15 西华大学 A kind of remote control system control method with virtual constraint power
CN111956325A (en) * 2020-07-01 2020-11-20 北京和华瑞博医疗科技有限公司 Accurate positioning device, method and system for medical instrument
CN112568996A (en) * 2019-09-30 2021-03-30 格罗伯斯医疗有限公司 Surgical system
WO2021067597A1 (en) * 2019-10-01 2021-04-08 Mako Surgical Corp. Surgical systems for guiding robotic manipulators
CN113319857A (en) * 2021-08-03 2021-08-31 季华实验室 Mechanical arm force and position hybrid control method and device, electronic equipment and storage medium
CN113850851A (en) * 2021-09-03 2021-12-28 北京长木谷医疗科技有限公司 Surgical robot bone registration method and system
CN113842213A (en) * 2021-09-03 2021-12-28 北京长木谷医疗科技有限公司 Surgical robot navigation positioning method and system
CN113842214A (en) * 2021-09-03 2021-12-28 北京长木谷医疗科技有限公司 Surgical robot navigation positioning system and method
CN113842217A (en) * 2021-09-03 2021-12-28 北京长木谷医疗科技有限公司 Method and system for limiting motion area of robot
CN113855236A (en) * 2021-09-03 2021-12-31 北京长木谷医疗科技有限公司 Method and system for tracking and moving surgical robot
CN113907889A (en) * 2021-09-03 2022-01-11 北京长木谷医疗科技有限公司 Control method and system for robot mechanical arm

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101448468B (en) * 2006-05-19 2011-10-12 马科外科公司 System and method for verifying calibration of a surgical device
WO2014043702A1 (en) * 2012-09-17 2014-03-20 Rethink Robotics, Inc. Constraining robotic manipulators with redundant degrees of freedom
CN103105851B (en) * 2012-11-07 2015-03-11 吉林大学 Kinesthesis teaching control method based on vision sense for remote control of robot
EP3123284B1 (en) * 2014-03-24 2020-05-06 Intuitive Surgical Operations, Inc. System and method for virtual feedback with haptic devices
WO2018013848A1 (en) * 2016-07-15 2018-01-18 Mako Surgical Corp. Systems for a robotic-assisted revision procedure
CN107121930B (en) * 2017-05-26 2019-11-29 山东科技大学 Six Degree-of-Freedom Parallel Platform motion control method based on dummy model
EP3705074A1 (en) * 2019-03-08 2020-09-09 MAKO Surgical Corp. Systems and methods for controlling movement of a surgical tool along a predefined path
EP4037597A1 (en) * 2019-09-30 2022-08-10 MAKO Surgical Corp. Systems and methods for guiding movement of a tool

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109333497A (en) * 2018-11-30 2019-02-15 西华大学 A kind of remote control system control method with virtual constraint power
CN112568996A (en) * 2019-09-30 2021-03-30 格罗伯斯医疗有限公司 Surgical system
WO2021067597A1 (en) * 2019-10-01 2021-04-08 Mako Surgical Corp. Surgical systems for guiding robotic manipulators
CN111956325A (en) * 2020-07-01 2020-11-20 北京和华瑞博医疗科技有限公司 Accurate positioning device, method and system for medical instrument
CN113319857A (en) * 2021-08-03 2021-08-31 季华实验室 Mechanical arm force and position hybrid control method and device, electronic equipment and storage medium
CN113850851A (en) * 2021-09-03 2021-12-28 北京长木谷医疗科技有限公司 Surgical robot bone registration method and system
CN113842213A (en) * 2021-09-03 2021-12-28 北京长木谷医疗科技有限公司 Surgical robot navigation positioning method and system
CN113842214A (en) * 2021-09-03 2021-12-28 北京长木谷医疗科技有限公司 Surgical robot navigation positioning system and method
CN113842217A (en) * 2021-09-03 2021-12-28 北京长木谷医疗科技有限公司 Method and system for limiting motion area of robot
CN113855236A (en) * 2021-09-03 2021-12-31 北京长木谷医疗科技有限公司 Method and system for tracking and moving surgical robot
CN113907889A (en) * 2021-09-03 2022-01-11 北京长木谷医疗科技有限公司 Control method and system for robot mechanical arm

Also Published As

Publication number Publication date
CN113842217B (en) 2022-07-01
CN113842217A (en) 2021-12-28

Similar Documents

Publication Publication Date Title
WO2023029362A1 (en) Surgical robot navigation and positioning method and apparatus, and device and storage medium
CN113208689B (en) Osteotomy guiding tool
US11844577B2 (en) System and method for verifying calibration of a surgical system
WO2023029784A1 (en) Surgery robot tracking and moving method and system
WO2021179662A1 (en) Robot-assisted system for total knee arthroplasty, control method, and electronic device
WO2023029922A1 (en) Method and system for limiting movement area of robot
AU2021201999B2 (en) Systems and methods for adaptive planning and control of a surgical tool
CN113842214B (en) Surgical robot navigation positioning system and method
CN113850851B (en) Surgical robot bone registration method and system
CN113907889A (en) Control method and system for robot mechanical arm
US20220134558A1 (en) Robotic surgical system with slingshot prevention
US11957417B2 (en) Surgical registration tools, systems, and methods of use in computer-assisted surgery
US20220183768A1 (en) Systems and methods for initial assessment warnings
US20240216071A1 (en) Surgical registration tools, systems, and methods of use in computer-assisted surgery
Sugita et al. Deformation analysis and active compensation of surgical milling robot based on system error evaluation

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: 22863063

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE