[go: up one dir, main page]

CN113842217B - Method and system for limiting motion area of robot - Google Patents

Method and system for limiting motion area of robot Download PDF

Info

Publication number
CN113842217B
CN113842217B CN202111035714.2A CN202111035714A CN113842217B CN 113842217 B CN113842217 B CN 113842217B CN 202111035714 A CN202111035714 A CN 202111035714A CN 113842217 B CN113842217 B CN 113842217B
Authority
CN
China
Prior art keywords
stiffness
virtual spring
stiffness value
value
freedom
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202111035714.2A
Other languages
Chinese (zh)
Other versions
CN113842217A (en
Inventor
张逸凌
刘星宇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhang Yiling
Longwood Valley Medtech Co Ltd
Original Assignee
Beijing Changmugu Medical Technology Co Ltd
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 Beijing Changmugu Medical Technology Co Ltd filed Critical Beijing Changmugu Medical Technology Co Ltd
Priority to CN202111035714.2A priority Critical patent/CN113842217B/en
Publication of CN113842217A publication Critical patent/CN113842217A/en
Application granted granted Critical
Publication of CN113842217B publication Critical patent/CN113842217B/en
Priority to PCT/CN2022/111535 priority patent/WO2023029922A1/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • A61B17/14Surgical saws
    • 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 for implanting artificial joints
    • A61F2/4603Special tools for implanting artificial joints for insertion or extraction of endoprosthetic joints or of accessories thereof
    • A61F2/461Special tools for implanting artificial joints 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 for implanting artificial joints
    • A61F2002/4632Special tools for implanting artificial joints using computer-controlled surgery, e.g. robotic surgery
    • A61F2002/4633Special tools for implanting artificial joints using computer-controlled surgery, e.g. robotic surgery for selection of endoprosthetic joints or for pre-operative planning

Landscapes

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

Abstract

The application discloses a method and a system for limiting a motion area of a robot. The method comprises the following steps: establishing a stiffness-damping model of a virtual spring according to displacement offsets of an actuator at the tail end of a mechanical arm of the robot in the directions of multiple degrees of freedom from an actual position; setting stiffness values of each of the virtual springs in a plurality of degrees of freedom to define movement of the actuator over a pre-planned target area. The method adopts a virtual spring stiffness-damping model, sets the stiffness in each degree of freedom direction, and can limit the movement in each degree of freedom direction, when external force acts on each degree of freedom, the displacement is very small in the direction of the degree of freedom with high stiffness, and even the displacement can not be generated, so that the actuator can be limited on a target area, and the actuator is prevented from deviating from the target area to cause injury to a patient.

Description

机器人运动区域的限定方法及系统Method and system for limiting motion area of robot

技术领域technical field

本申请涉及医疗器械技术领域,具体而言,涉及一种机器人运动区域的限定方法及系统。The present application relates to the technical field of medical devices, and in particular, to a method and system for defining a motion area of a robot.

背景技术Background technique

现有的手术中,采用机器人进行辅助时,医生手扶持机器人的机械臂进行操作。在操作的过程中,由于操作的疏忽大意,主动或被动的在不该用力的地方可能会用力过猛,使得机械臂末端的锯片超出了预定的操作区域,从而给患者带来不必要的伤害。In the existing surgery, when a robot is used for assistance, the doctor's hand supports the robotic arm of the robot to operate. During the operation, due to the negligence of the operation, the active or passive force may be too strong in the place where the force should not be applied, so that the saw blade at the end of the robot arm exceeds the predetermined operation area, thus causing unnecessary unnecessary damage to the patient. harm.

发明内容SUMMARY OF THE INVENTION

本申请的主要目的在于提供一种机器人运动区域的限定方法及系统,以把机械臂末端的执行器限定在目标区域内,从而提高安全性。The main purpose of the present application is to provide a method and system for defining a movement area of a robot, so as to limit the actuator at the end of the robot arm within the target area, thereby improving safety.

为了实现上述目的,根据本申请的一个方面,提供了一种机器人运动区域的限定方法,包括:In order to achieve the above object, according to one aspect of the present application, a method for defining a 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 manipulator arm of the robot in the directions of multiple degrees of freedom, the stiffness-damping model of the virtual spring is established;

设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。The stiffness values of each of the virtual springs in a plurality of degrees of freedom directions are set to confine the movement of the actuator to a pre-planned target area.

在一种实施方式中,所述执行器向所述目标区域切入的方向记为进深方向,所述目标区域内并与进深方向垂直的方向记为横向,与所述目标区域垂直的方向记为垂直方向;In an embodiment, the direction in which the actuator cuts into the target area is denoted as the depth direction, the direction in the target area and perpendicular to the depth direction is denoted as the lateral direction, and the direction perpendicular to the target area is denoted as the horizontal direction vertical direction;

设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,包括:Set the stiffness value of each of the virtual springs in the directions of multiple degrees of freedom, including:

在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值;In the direction of 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 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 lateral direction;

所述横向上的虚拟弹簧的刚度值小于所述垂直方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the lateral 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 lateral 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 Translate the preset stiffness threshold.

在一种实施方式中,设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,包括:In one embodiment, the stiffness values of each of the virtual springs in the directions of multiple degrees of freedom are set, including:

在旋转自由度方向上,设定以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值、以所述横向为轴旋转方向上的虚拟弹簧的刚度值和以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值;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, the stiffness value of the virtual spring in the rotation direction with the lateral axis as the axis, and set the stiffness value of the virtual spring in the vertical direction as the axis stiffness value of the virtual spring in the direction;

以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值,并小于以所述横向为轴旋转方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the rotational direction of the axis is smaller than the stiffness value of the virtual spring in the rotational direction of the axis, and is smaller than the stiffness of the virtual spring in the rotational direction of 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 rotational direction of the axis with the depth direction as the axis and the stiffness value of the virtual spring in the rotational direction of the axis with the lateral direction are greater than or equal to the second rotational preset stiffness threshold.

在一种实施方式中,所述第一平移预设刚度阈值为0N/m~500N/m;In an embodiment, the first translation preset stiffness threshold is 0 N/m˜500 N/m;

所述第二平移预设刚度阈值为4000N/m~5000N/m;The second translation preset stiffness threshold is 4000N/m~5000N/m;

所述第一旋转预设刚度阈值为0Nm/rad~20Nm/rad;The first rotation preset stiffness threshold is 0Nm/rad~20Nm/rad;

所述第二旋转预设刚度阈值为200Nm/rad~300Nm/rad。The second rotation preset stiffness threshold is 200Nm/rad˜300Nm/rad.

在一种实施方式中,设定虚拟弹簧在多个自由度方向上的阻尼值。In one embodiment, damping values of the virtual spring in the directions of the multiple degrees of freedom are set.

在一种实施方式中,所述目标区域包括:股骨前端截骨平面、股骨前斜截骨平面、股骨后髁截骨平面、股骨后斜截骨平面、股骨远端截骨平面和胫骨截骨平面。In one embodiment, the target area includes: anterior femoral osteotomy plane, anterior oblique femoral osteotomy plane, posterior femoral condyle osteotomy plane, posterior oblique femoral osteotomy plane, distal femoral osteotomy plane, and tibial osteotomy plane flat.

为了实现上述目的,根据本申请的第二方面,提供了一种机器人运动区域的限定系统,该系统包括:In order to achieve the above object, according to the second aspect of the present application, a system for defining a movement area of a robot is provided, the system comprising:

模型建立模块,用于根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型;The model building module is used to establish the stiffness-damping model of the virtual spring according to the displacement offsets between the initial position and the actual position of the actuator at the end of the manipulator arm of the robot in the directions of multiple degrees of freedom;

刚度设定模块,用于设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。The stiffness setting module is used for setting stiffness values of each of the virtual springs in the directions of multiple degrees of freedom, so as to limit the motion of the actuator to a pre-planned target area.

在一种实施方式中,所述执行器向所述目标区域切入的方向记为进深方向,在所述目标区域内并与所述进深方向垂直的方向记为横向,与所述目标区域垂直的方向记为垂直方向;In one embodiment, the direction in which the actuator cuts into the target area is denoted as the depth direction, the direction in the target area and perpendicular to the depth direction is denoted as the lateral direction, and the direction perpendicular to the target area is denoted as the lateral direction. The direction is recorded as the vertical direction;

所述刚度设定模块还用于,在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值;The stiffness setting module is further configured to, in the direction of the translational degree of freedom, 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 lateral direction;

所述横向上的虚拟弹簧的刚度值大于所述垂直方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the lateral 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 lateral 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 Translate the preset stiffness threshold.

在一种实施方式中,刚度设定模块还用于,在旋转自由度方向上,设定以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值、以所述横向为轴旋转方向上的虚拟弹簧的刚度值和以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值;In an 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 with the depth direction as the axis of rotation, and the transverse direction as the axis of rotation. The stiffness value of the virtual spring and the stiffness value of the virtual spring in the rotation direction of the axis with the vertical direction;

以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值,并小于以所述横向为轴旋转方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the rotational direction of the axis is smaller than the stiffness value of the virtual spring in the rotational direction of the axis, and is smaller than the stiffness of the virtual spring in the rotational direction of 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 rotational direction of the axis with the depth direction as the axis and the stiffness value of the virtual spring in the rotational direction of the axis with the lateral direction are greater than or equal to the second rotational 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 be 0 N/m˜500 N/m;

所述第二平移预设刚度阈值为4000N/m~5000N/m;The second translation preset stiffness threshold is 4000N/m~5000N/m;

所述第一旋转预设刚度阈值为0Nm/rad~20Nm/rad;The first rotation preset stiffness threshold is 0Nm/rad~20Nm/rad;

所述第二旋转预设刚度阈值为200Nm/rad~300Nm/rad。The second rotation preset stiffness threshold is 200Nm/rad˜300Nm/rad.

在一种实施方式中,机器人运动区域的限定系统还包括阻尼设定模块,用于设定虚拟弹簧在多个自由度方向上的阻尼值。In one embodiment, the system for defining the motion area of the robot further includes a damping setting module for setting damping values of the virtual spring in the directions of multiple degrees of freedom.

第三方面,本申请还提出了一种电子设备,包括:至少一个处理器和至少一个存储器;所述存储器用于存储一个或多个程序指令;所述处理器,用于运行一个或多个程序指令,用以执行上述任意一项所述的方法。In a third aspect, the present application also provides 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 for executing any of the methods described above.

第四方面,本申请还提出了一种计算机可读存储介质,计算机可读存储介质中包含一个或多个程序指令,所述一个或多个程序指令用于执行上述任意一项所述的方法。In a fourth aspect, the present application also provides a computer-readable storage medium, where the computer-readable storage medium 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 the present application, the stiffness-damping model of the virtual spring is established 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 the directions of multiple degrees of freedom; The stiffness value of each of the virtual springs in the degree direction is used to limit the movement of the actuator to a 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 easily displaced, and it is difficult for the doctor to push, so that the actuator can be limited to the target area to avoid causing 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 a further understanding of the application and make other features, objects and advantages of the application more apparent. The accompanying drawings and descriptions of the exemplary embodiments of the present application are used to explain the present application, and do not constitute an improper limitation of the present application. In the attached image:

图1是根据本申请实施例的一种机器人运动区域的限定方法的流程图;1 is a flowchart of a method for defining a motion area of a robot according to an embodiment of the present application;

图2是根据本申请实施例的虚拟弹簧的刚度-阻尼模型的原理示意图;2 is a schematic diagram of a stiffness-damping model of a virtual spring according to an embodiment of the present application;

图3是根据本申请实施例的一种执行器的多个自由度方向的示意图;3 is a schematic diagram of the directions of multiple degrees of freedom of an actuator according to an embodiment of the present application;

图4A是根据本申请实施例的一种截骨前后对比的示意图;4A is a schematic diagram of a comparison before and after an osteotomy according to an embodiment of the present application;

图4B是根据本申请实施例的股骨第一方向示意图;4B is a schematic diagram of the femur in the first direction according to an embodiment of the present application;

图4C是根据本申请实施例的股骨第二方向示意图;4C is a schematic diagram of a second orientation of the femur according to an embodiment of the present application;

图4D是根据本申请实施例的股骨第三方向示意图;4D is a schematic diagram of a third orientation of the femur according to an embodiment of the present application;

图4E是根据本申请实施例的股骨第四方向示意图;4E is a schematic diagram of the fourth direction of the femur according to an embodiment of the present application;

图4F是根据本申请实施例的股骨第五方向示意图;4F is a schematic diagram of the fifth direction of the femur according to an embodiment of the present application;

图4G是根据本申请实施例的一种胫骨示意图;4G is a schematic diagram of a tibia according to an embodiment of the present application;

图5是根据本申请实施例的一种机器人运动区域的限定系统的结构示意图;5 is a schematic structural diagram of a system for defining a motion area of a robot 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 make those skilled in the art better understand the solutions of the present application, the technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present application. Obviously, the described embodiments are only The embodiments are part of the present application, but not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the scope of protection of the present application.

需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。It should be noted that the terms "first", "second", etc. in the description and claims of the present application and the above drawings are used to distinguish similar objects, and are not necessarily used to describe a specific sequence or sequence. It is to be understood that the data so used are interchangeable under appropriate circumstances for the embodiments of the application described herein. Furthermore, the terms "comprising" and "having" and any variations thereof, are intended to cover non-exclusive inclusion, for example, a process, method, system, product or device comprising a series of steps or units is not necessarily limited to those expressly listed Rather, those steps or units may include other steps or units not expressly listed or inherent to these processes, methods, products or devices.

在本申请中,术语“上”、“下”、“左”、“右”、“前”、“后”、“顶”、“底”、“内”、“外”、“中”、“竖直”、“水平”、“横向”、“纵向”等指示的方位或位置关系为基于附图所示的方位或位置关系。这些术语主要是为了更好地描述本发明及其实施例,并非用于限定所指示的装置、元件或组成部分必须具有特定方位,或以特定方位进行构造和操作。In this application, the terms "upper", "lower", "left", "right", "front", "rear", "top", "bottom", "inner", "outer", "middle", The orientation or positional relationship indicated by "vertical", "horizontal", "horizontal", "longitudinal", etc. is based on the orientation or positional relationship shown in the drawings. These terms are primarily used to better describe the invention and its embodiments, and are not intended to limit the fact that the indicated device, element or component must have a particular orientation, or be constructed and operated in a particular orientation.

并且,上述部分术语除了可以用于表示方位或位置关系以外,还可能用于表示其他含义,例如术语“上”在某些情况下也可能用于表示某种依附关系或连接关系。对于本领域普通技术人员而言,可以根据具体情况理解这些术语在本发明中的具体含义。In addition, some of the above-mentioned terms may be used to express other meanings besides orientation or positional relationship. For example, the term "on" may also be used to express a certain attachment or connection relationship in some cases. For those of ordinary skill in the art, the specific meanings of these terms in the present invention can be understood according to specific situations.

此外,术语“安装”、“设置”、“设有”、“连接”、“相连”、“套接”应做广义理解。例如,可以是固定连接,可拆卸连接,或整体式构造;可以是机械连接,或电连接;可以是直接相连,或者是通过中间媒介间接相连,又或者是两个装置、元件或组成部分之间内部的连通。对于本领域普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。Furthermore, the terms "installed", "set up", "provided with", "connected", "connected", "socketed" should be construed broadly. For example, it may be a fixed connection, a detachable connection, or a unitary structure; it may be a mechanical connection, or an electrical connection; it may be directly connected, or indirectly connected through an intermediary, or between two devices, elements, or components. internal communication. For those of ordinary skill in the art, the specific meanings of the above terms in the present invention can be understood according to specific situations.

需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。It should be noted that the embodiments in the present application and the features of the embodiments may be combined with each other in the case of no conflict. The present application will be described in detail below with reference to the accompanying drawings and in conjunction with the embodiments.

本申请的机器人运动区域的限定方法可应用于膝关节置换的机器人截骨平面的限定方法,也可应用于机器人在其他领域的运动区域的限定方法。The method for defining the motion area of the robot in the present application can be applied to the method for defining the osteotomy plane of the robot for knee joint replacement, and can also be applied to the method for defining the motion area of the robot in other fields.

本申请的机器人运动区域的限定方法,参见附图1所示的一种机器人运动区域的限定方法的流程图;该方法包括以下的步骤:For the method for limiting the motion area of a robot of the present application, refer to the flowchart of a method for limiting the motion area of a robot shown in FIG. 1 ; the method includes the following steps:

步骤S102,根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型。In step S102, a stiffness-damping model of the virtual spring is established 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 the directions of multiple degrees of freedom.

其中,虚拟弹簧的刚度-阻尼模型,也称为笛卡尔阻尼控制模式(CartesianImpedance Control Mode,CICM)。在阻尼控制模式下,机器人的行为是顺从敏感的,并能对外部影响作出反应,外部影响比如,可以为障碍物或过程力。施加外力可使机器人离开计划的轨道路径。Among them, the stiffness-damping model of the virtual spring is also called Cartesian Impedance Control Mode (CICM). In the damping control mode, the behavior of the robot is compliance-sensitive and can respond to external influences, such as obstacles or process forces. Applying an external force moves the robot away from the planned orbital path.

此模型基于虚拟弹簧和阻尼器实现,它们随当前测量值和TCP(Tool CenterPoint,工具中心点)的指定位置的差值而伸展变化。弹簧的特性由刚度值 (stiffness)描述,阻尼器的特性由阻尼值(damping)描述。这些参数均可以在每个平移或旋转维度单独设置。This model is implemented based on virtual springs and dampers that stretch as the difference between the current measurement and the specified position of the TCP (Tool CenterPoint). The properties of the spring are described by the stiffness value (stiffness), and the properties of the damper are described by the damping value (damping). Each of these parameters can be set individually in 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 time, external forces or motion commands cause deviations between the robot's position set point and the actual value. This causes the virtual spring to deflect, producing a force in accordance with Hooke's law. The resultant force F can be calculated according to Hooke's law, using the set spring stiffness C and offset Δx: F=C·Δx.

参见附图2所示的虚拟弹簧的刚度-阻尼模型的原理示意图;其中,1为弹簧偏移;2为虚拟弹簧;3为实际位置;4为力;5为设定点的位置。弹簧刚度决定了机器人屈服于外力并偏离其计划路径的程度。Refer to the schematic diagram of the stiffness-damping model of the virtual spring shown in FIG. 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 stiffness values of the virtual springs in the directions of multiple degrees of freedom, so as to limit the motion 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 it.

应用在膝关节置换手术中,上述的目标区域可以为目标平面,也即是截骨平面,具体地,目标区域可包括:股骨和胫骨上的多个不同位置的截骨平面。Applied in knee replacement surgery, the above-mentioned target area may be the target plane, that is, the osteotomy plane. Specifically, the target area may include: multiple osteotomy planes at different positions on the femur and the tibia.

示例性的,在任意的一个截骨平面中,在垂直于截骨平面的方向上,设置比较大的刚度值,刚度值大于预定的阈值,以限制执行器在垂直于截骨平面的方向上运动,从而有效避免执行器偏离截骨平面。其中,预定的阈值可以灵活进行设定,医生在推机械臂时,若执行器在垂直于截骨平面的方向上发生偏移,机械臂会输出相应的反馈力(阻力),医生可感受到阻力,便知晓执行器发生了不期望的偏移,便不会再用力推动机械臂。Exemplarily, in any 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 in the direction perpendicular to the osteotomy plane. movement, so as to effectively avoid the actuator from deviating from the osteotomy plane. Among them, the predetermined threshold can be flexibly set. When the doctor pushes the robotic arm, if the actuator is offset in the direction perpendicular to the osteotomy plane, the robotic arm will output a corresponding feedback force (resistance), and the doctor can feel it. resistance, you will know that the actuator has an undesired deflection, and will not push the robotic arm too hard.

具体实施时,在执行器与当前目标区域对齐后,启动执行器,此时,,控制机器人就进入到虚拟弹簧阻尼模型的状态,此状态下,整个机械臂可以看成一个近似的虚拟弹簧,在任何的方向上施加力后,虚拟弹簧都会遵从胡克定律。示例性的,尤其是在垂直于截骨平面的方向上,如果该方向的刚度很大,则执行器在该方向上的偏移就会很小,如此就可以使得执行器稳定地限定在截骨平面上,而避免执行器超过截骨平面,尤其是可以有效的避免执行器在垂直于截骨平面的方向上运动,从而尽最大限度的降低执行器超出目标区域,减少给患者带来的误伤害。In the specific implementation, after the actuator is aligned with the current target area, the actuator is started. At this time, the control robot enters the state of the virtual spring damping model. In this state, the entire robotic 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 cutting plane. On the bone plane, and avoid the actuator from exceeding 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 from exceeding the target area and reduce the risk to the patient. wrong injury.

为了便于说明,参见附图3所示,所述执行器切割进深方向记为进深方向,用符号X表示。处于所述执行器所在区域内并与所述执行器切割方向垂直的方向记为横向,用符号Y表示。与执行器平面垂直的方向记为垂直方向,用符号Z表示。For the convenience of description, referring to FIG. 3 , the cutting depth direction of the actuator is denoted as the depth direction, which is represented by the symbol X. The direction in the area where the actuator is located and perpendicular to the cutting direction of the actuator is denoted as the transverse direction, which is represented by the symbol Y. The direction perpendicular to the plane of the actuator is recorded as the vertical direction, which is represented by the symbol Z.

自由度包括平移自由度和旋转自由度两种,下面分两种情况来分别说明。The degrees of freedom include translational degrees of freedom and rotational degrees of freedom, which are described in the following two cases.

对于平移自由度,在一种实施方式中,设定在多个自由度方向上的各个所述虚拟弹簧的刚度值时,在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值。For translational degrees of freedom, in one embodiment, when setting the stiffness values of the virtual springs in the directions of the multiple degrees of freedom, in the direction of the translational degrees of freedom, the stiffness of the virtual springs in the depth direction is set. 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 lateral direction; the stiffness value of the virtual spring in the lateral 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 lateral direction are both 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 0 N/m˜500 N/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 lateral 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 the actual situation. The principle is to set the stiffness smaller, because according to Hooke's law, when the force is constant, the smaller the stiffness, the larger the spring deformation. Therefore, setting the stiffness in the depth direction as small as possible can help the actuator to move in this direction to perform cutting. In the transverse direction Y, the rigidity of the setting is also relatively small, which also helps the actuator to 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 motion 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 in 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 flexibly set 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 rigidity 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 in the Z direction directly causes the actuator to deviate from the predetermined osteotomy plane, it is easy to cause problems to the patient. Injury, this is not allowed.

对于旋转自由度,在一种实施方式中,设定在多个自由度方向上的各个所述虚拟弹簧的刚度值时,设定以进深方向X为轴旋转方向上的虚拟弹簧的刚度值;For the rotational degree of freedom, in one embodiment, when setting the stiffness value of each of the virtual springs in the directions of the multiple degrees of freedom, set the stiffness value of the virtual spring in the rotational direction of the axis with the depth direction X as the axis;

以所述横向Y为轴旋转方向上的虚拟弹簧的刚度值;Taking the lateral Y as the stiffness value of the virtual spring in the rotational direction of the axis;

以所述垂直方向Z为轴旋转方向上的虚拟弹簧的刚度值。Take the vertical direction Z as the stiffness value of the virtual spring in the axis rotation direction.

具体的,垂直方向Z为轴旋转方向上的虚拟弹簧的刚度值小于以进深方向X 为轴旋转方向上的虚拟弹簧的刚度值,并小于以横向Y为轴旋转方向上的虚拟弹簧的刚度值。Specifically, the stiffness value of the virtual spring in the vertical direction Z is the axis rotation direction is smaller than the stiffness value of the virtual spring in the axis rotation direction in the depth direction X, and is smaller than the stiffness value of the virtual spring in the lateral Y axis rotation direction .

以垂直方向Z为轴旋转方向上的虚拟弹簧的刚度值小于或等于第一旋转预设刚度阈值。可选的,第一旋转预设刚度阈值为0Nm/rad~20Nm/rad,使得执行器可以垂直方向Z为轴在当前目标区域内旋转,The stiffness value of the virtual spring in the rotational direction with the vertical direction Z as the axis is less than or equal to the first rotational 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 in the vertical direction Z as the axis,

以进深方向X为轴旋转方向上的虚拟弹簧的刚度值和以横向Y为轴旋转方向上的虚拟弹簧的刚度值大于或等于第二旋转预设刚度阈值。The stiffness value of the virtual spring in the rotational direction with the depth direction X as the axis and the stiffness value of the virtual spring in the rotational direction with the lateral Y as the axis are greater than or equal to the second rotational preset stiffness threshold.

其中,所述第二旋转预设刚度阈值为200Nm/rad~300Nm/rad,限制了执行器以进深方向X为轴旋转、以横向Y为轴旋转的位移,进一步避免了执行器脱离当前目标区域,保证截骨的安全性。Among them, the second rotation preset stiffness threshold is 200Nm/rad to 300Nm/rad, which limits the displacement of the actuator rotating with the depth direction X as the axis and the lateral Y axis as the axis, and further prevents the actuator from leaving the current target area. , to ensure the safety of osteotomy.

在可选的一个具体实施方式中,进深方向X上的虚拟弹簧的预设刚度值、横向Y上的虚拟弹簧的预设刚度值均可为0N/m,垂直方向Z上的虚拟弹簧的预设刚度值可为5000N/m,以垂直方向Z为轴的旋转方向上的虚拟弹簧的刚度值可为10 Nm/rad,以进深方向X为轴的旋转方向上的虚拟弹簧的刚度值、以横向Y为轴的旋转方向上虚拟弹簧的刚度值可均为300Nm/rad。In an optional specific embodiment, 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 all be 0 N/m, and the preset stiffness value of the virtual spring in the vertical direction Z can be 0 N/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 10 Nm/rad, the stiffness value of the virtual spring in the rotation direction with the depth direction X as the axis, with The stiffness value of the virtual spring in the rotation direction of the lateral Y axis can be 300Nm/rad.

在一种实施方式中,限定方法还包括:设定虚拟弹簧在多个自由度方向上的阻尼值。其中,弹簧阻尼决定了虚拟弹簧在偏移中心位置后的振荡程度。阻尼值的范围可为0.1~1.0,例如,0.7。In one embodiment, the defining method further includes: setting damping values of the virtual spring in the directions of the 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, eg, 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 coefficients for all degrees of freedom: 0.1 to 1.0; default: 0.7.

在机器人API中,笛卡尔阻尼控制模式的自由度由枚举CartDOF(包 com.kuka.roboticsAPI.geometricModel)。此枚举的值可用于描述单独的自由度,也可以是多个自由度的组合。In the Robotics API, the degrees of freedom of the Cartesian damping control modes are enumerated by CartDOF (package com.kuka.roboticsAPI.geometricModel). The values of this enumeration can be used to describe individual degrees of freedom or a combination of degrees of freedom.

CartDOF.X X方向上的平移自由度;CartDOF.X translation degrees of freedom in the X direction;

CartDOF.Y Y方向上的平移自由度;CartDOF.Y translation 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 The combination of translational degrees of freedom in the X, Y and Z directions;

CartDOF.A绕Z轴旋转的自由度;The degrees of freedom of CartDOF.A to rotate around the Z axis;

CartDOF.B绕Y轴旋转自由度;CartDOF.B rotates degrees 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, by setting the stiffness to the maximum allowable value (5000) in the Z-axis direction, and setting the stiffness to a smaller value (0-500) in the X and Y directions, while 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-100) in the direction A of the rotational degree of freedom around the Z-axis, so that the movement of the TCP point of the end-of-manipulator tool can be limited to On the XOY plane, it can rotate in a small range on the XOY plane.

相应代码如下:The corresponding code is as follows:

CartesianImpedanceControlModeimpedanceMode=newCartesianImpedanceContr olMode();CartesianImpedanceControlModeimpedanceMode=newCartesianImpedanceContr olMode();

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); All combinations of all Cartesian degrees of freedom, set the spring damping to 1;

motioncontainer=lbr.moveAsync(positionHold(impedanceMode,-1,TimeUnit.SEC ONDS))。motioncontainer=lbr.moveAsync(positionHold(impedanceMode, -1, TimeUnit.SEC ONDS)).

在一种实施方式中,应用在膝关节置换手术中,上述的目标区域包括:股骨前端截骨平面、股骨前斜截骨平面、股骨后髁截骨平面、股骨后斜截骨平面、股骨远端截骨平面和胫骨截骨平面。In one embodiment, applied in knee replacement surgery, the above-mentioned target area includes: anterior femoral osteotomy plane, anterior oblique femoral osteotomy plane, posterior femoral condyle osteotomy plane, posterior oblique femoral osteotomy plane, distal femoral osteotomy plane End osteotomy plane and tibial osteotomy plane.

参见附图4A所示的截骨前后对比的示意图。具体的,参见附图4B所示,深灰色覆盖区域未股骨前端待截骨区域,该区域截掉后即为股骨前端截骨平面。参见附图4C所述,深灰色覆盖区域为股骨前斜待截骨区域,该区域截掉后即为股骨前斜截骨平面。参见附图4D所示,深灰色区域为股骨后髁待截骨区域,该区域截掉后即为股骨后髁截骨平面。参见附图4E所示,深灰色区域为截骨后的股骨后斜截骨平面。参见附图4F所示,深灰色区域为股骨远端待截骨区域,该区域截掉后即为股骨远端截骨平面,浅灰色区域为锯片的示意图。参见附图4G所示,深灰色区域为胫骨平台区域,该区域截掉后即为胫骨截骨平面。See Fig. 4A for a schematic diagram showing the comparison before and after osteotomy. Specifically, as shown in FIG. 4B , the dark gray coverage area is not the area to be osteotomy of the anterior end of the femur, which is the osteotomy plane of the anterior end of the femur after being cut off. Referring to Fig. 4C, the dark gray coverage area is the anterior oblique femoral osteotomy area, which is the anterior oblique femoral osteotomy plane after being cut off. Referring to Fig. 4D, the dark gray area is the area to be osteotomy of the posterior femoral condyle, which is the osteotomy plane of the posterior femoral condyle after the area is cut off. Referring to Fig. 4E, the dark gray area is the posterior oblique osteotomy plane of the femur after osteotomy. Referring to FIG. 4F , the dark gray area is the area to be osteotomy of the distal femur, which is the osteotomy plane of the distal femur after the area is cut off, and the light gray area is a schematic diagram of the saw blade. Referring to Figure 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, the model of the prosthesis needs to be determined before the operation, and the target area is determined according to the model of the prosthesis. In the second aspect, the present application also proposes a method for preoperative planning, which specifically includes the following steps:

在获取到膝关节的医学图像后,对所述医学图像进行分割和三维重建,得到膝关节的三维骨骼模型;After acquiring the medical image of the knee joint, perform segmentation and three-dimensional reconstruction on the medical image 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 bone parameters may include key bone anatomical points, bone key axes and bone size parameters, and the key bone anatomical points may be identified based on deep learning algorithms, such as neural network models, The identified key anatomical points of the bone are marked on the 3D bone model.

骨骼尺寸可包括股骨左右径、股骨前后径、胫骨左右径和胫骨前后径,股骨左右径根据股骨内外侧缘连线,股骨前后径根据股骨前皮质切线和股骨后髁切线确定,胫骨左右径根据胫骨内外侧缘连线确定,胫骨前后径根据胫骨前后缘连线确定。The bone size can include the left and right diameters of the femur, the anterior and posterior diameters of the femur, the left and right diameters of the tibia, and the anterior and posterior diameters of the tibia. The line connecting the medial and lateral edges of the tibia is determined, and the anterior and posterior diameters of the tibia are determined according to the line connecting the anterior and posterior edges 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. 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 3D skeletal prosthesis model can be a prosthesis model for total knee joint replacement currently on the market. There are many types of 3D skeletal prosthesis models, and each type of 3D skeletal prosthesis model has various models. For example, the types of three-dimensional femoral prosthesis models are ATTUNE-PS, ATTUNE-CR, SIGMA-PS150, etc., and the models of ATTUNE-PS are 1, 2, 3, 3N, 4, 4N, 5, 5N, 6, 6N.

示例性地,系统通过交互界面确定假体型号的实现方式可以包括:可以在界面设置各个三维骨骼假体模型的配置项,例如,可以是三维股骨假体模型配置项、三维胫骨假体模型配置项和三维垫片模型的配置项,当某一个配置项被触发后(例如,选定方式触发配置项),可以自动匹配对应的假体库,而后检测假体库中哪一个假体模型被触发,将被触发的假体信号作为置换假体。例如,当股骨假体模型配置项被触发后,可以与股骨假体库建立关联,而后在界面显示股骨假体库中的所有假体模型的类型和型号,之后检测哪一个类型的股骨假体模型和该类型下的哪一个型号的股骨假体模型被触发,从而选定被触发的股骨假体模型作为股骨假体模型。Exemplarily, the implementation manner of the system determining the prosthesis model through the interactive interface may include: the configuration items of each 3D skeletal prosthesis model may be set on the interface, for example, the configuration items of the 3D femoral prosthesis model, the configuration items of the 3D tibial prosthesis model may be set. item and the configuration item of the 3D gasket model, when a certain configuration item is triggered (for example, the selected mode triggers the configuration item), the corresponding prosthesis library can be automatically matched, and then which prosthesis model in the prosthesis library is detected. Triggered to use the triggered prosthesis signal as a replacement prosthesis. For example, when the femoral prosthesis model configuration item is triggered, it can be associated with the femoral prosthesis library, and then the type and model of all prosthesis models in the femoral prosthesis library can be displayed on the interface, and then which type of femoral prosthesis is detected. The 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;

基于所述骨骼关键参数和所述三维骨骼假体模型的类型和型号调整所述三维骨骼假体模型的安放位置和安放角度。The placement position and placement angle of the 3D skeletal prosthesis model are adjusted based on the key skeletal parameters and the type and model of the 3D skeletal prosthesis model.

具体的,为了实现了三维可视化显示骨骼与假体的匹配调节过程、匹配效果。在得到植入三维骨骼假体模型后的三维骨骼模型后,可以基于股骨外翻角、股骨内翻角、股骨外旋角、股骨内旋角、股骨左右径、股骨前后径确定股骨假体模型是否与三维股骨模型已安装适配。Specifically, in order to realize the three-dimensional visualization of the matching adjustment process and matching effect between the bone and the prosthesis. After obtaining the 3D skeletal model after implanting the 3D skeletal 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, femoral left-right diameter, and femoral anteroposterior diameter. Whether it is fitted with the 3D femur model.

可以基于胫骨内翻角、股骨外翻角、胫骨左右径、胫骨前后径确定胫骨假体模型是否与三维胫骨模型已安装适配。Whether the tibial prosthesis model has been installed and fitted with the three-dimensional tibial model can be determined based on the tibial varus angle, the femoral valgus angle, the left-right diameter of the tibia, and the anterior-posterior diameter of the tibia.

在一种实施方式中,所述三维骨骼模型包括三维股骨模型,所述三维骨骼假体模型包括三维股骨假体模型,所述骨骼关键参数包括股骨关键参数,所述股骨关键参数包括股骨机械轴、股骨通髁线、后髁连线、股骨左右径和股骨前后径;In one embodiment, the three-dimensional skeletal model includes a three-dimensional femur model, the three-dimensional skeletal prosthesis model includes a three-dimensional femoral prosthesis model, the skeletal key parameter includes a femoral key parameter, and the femoral key parameter includes a femoral mechanical axis , femoral condyle line, posterior condyle connecting line, left and right diameter of femur and anteroposterior diameter of femur;

基于所述骨骼关键参数和所述三维骨骼假体模型的类型和型号调整所述三维骨骼假体模型的安放位置和安放角度的步骤包括:The steps of adjusting the placement position and placement angle of the 3D skeletal prosthesis model based on the key skeletal parameters and the type and model of the 3D skeletal prosthesis model include:

基于所述股骨左右径和股骨前后径,调整所述三维股骨假体模型的放置位置;Based on the left-right diameter of the femur and the anterior-posterior diameter of the femur, adjusting the placement position of the three-dimensional femoral prosthesis model;

调整所述三维股骨假体模型的内翻角或外翻角,使所述三维股骨假体模型的横截面与所述股骨机械轴垂直;adjusting the varus angle 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(股骨通髁线与后髁连线在横断面的投影线之间的夹角)在预设范围内。The internal rotation angle or the external rotation angle of the three-dimensional femoral prosthesis is adjusted so that the posterior femoral condyle angle PCA (the angle between the projection line of the femoral transcondylar line and the line connecting the posterior condyle in the transverse section) 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 rear of the femur, the installation position is appropriate.

可以基于股骨假体模型的当前位置,根据股骨假体模型在冠状面上下方向上的中轴线与股骨力线的相对角度确定股骨外翻角和股骨内翻角,根据股骨假体模型的横轴和通髁线的相对角度确定外旋角和内旋角;通过股骨机械轴和股骨假体模型在矢状面前后方向上的中轴线的角度确定股骨屈曲角。通过调整上述角度,可以确定三维股骨假体模型的安装角度是否合适,例如,当内/外翻角被调整为0°时,PCA被调整为3°时,则可认定为股骨假体模型的安放位置和安放角度调整到合适的位置。The femoral valgus angle and femoral varus angle can be determined based on the current position of the femoral prosthesis model and the relative angle between the mid-axis of the femoral prosthesis model in the up-down direction on the coronal plane and the femoral line of force. The angle of external rotation and internal rotation was determined by the relative angle to the transcondylar line; the angle of femoral flexion was determined by the angle of the femoral mechanical axis and the central axis of the femoral prosthesis model in the sagittal anterior-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 that the femoral prosthesis model has an appropriate installation angle. Adjust the placement position and placement angle to a suitable position.

在一种实施方式中,所述三维骨骼模型还包括三维胫骨模型,所述三维股骨假体模型还包括三维胫骨假体模型;所述骨骼关键参数还包括胫骨关键参数,所述胫骨关键参数包括胫骨机械轴、胫骨左右径和胫骨前后径;In one embodiment, the three-dimensional skeletal model further includes a three-dimensional tibia model, the three-dimensional femoral prosthesis model further includes a three-dimensional tibial prosthesis model; the key skeletal parameters further include key tibial parameters, and the key tibial parameters include Tibial mechanical axis, left and right diameter of tibia and anterior and posterior diameter of tibia;

基于所述骨骼关键参数和所述三维骨骼假体模型的类型和型号调整所述三维骨骼假体模型的安放位置和安放角度的步骤包括:The steps of adjusting the placement position and placement angle of the 3D skeletal prosthesis model based on the key skeletal parameters and the type and model of the 3D skeletal prosthesis model include:

基于所述胫骨左右径和胫骨前后径,调整三维胫骨假体模型的安放位置;Adjust the placement position of the three-dimensional tibial prosthesis model based on the left-right diameter of the tibia and the anterior-posterior diameter of the tibia;

调整三维胫骨假体的内翻角或外翻角,使所述胫骨机械轴与所述三维胫骨假体的横截面垂直。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 steps of adjusting the placement position and placement angle of the three-dimensional bone prosthesis model, the method further includes:

基于三维骨骼假体模型与三维假体模型的匹配关系进行模拟截骨,得到三维骨骼术后模拟模型;Based on the matching relationship between the 3D bone prosthesis model and the 3D prosthesis model, simulated osteotomy was performed to obtain a 3D skeletal postoperative simulation model;

对所述三维股骨术后模拟模型进行包括伸直位和屈曲位的运动模拟;performing motion simulation including extension position and flexion position on the three-dimensional femoral surgery simulation model;

在伸直位状态确定伸直间隙,在屈曲状态确定屈曲间隙;The extension gap is determined in the extension state, and the flexion gap is determined in the flexion state;

对比所述伸直间隙与所述屈曲间隙,对所述三维骨骼假体模型进行匹配性验证。Comparing the extension gap with the flexion gap, the three-dimensional skeletal prosthesis model is verified for matching.

在本可选的实现方式中,根据骨骼假体模型设计原则确定骨骼截骨厚度,不同的骨骼假体模型可能对应不同的截骨厚度;基于骨骼假体模型确定截骨厚度、骨骼假体模型与骨骼匹配后,便可确定骨骼的截骨平面。In this optional implementation manner, the bone osteotomy thickness is determined according to the design principle of the bone prosthesis model, and different bone prosthesis models may correspond to different osteotomy thicknesses; the osteotomy thickness and the bone prosthesis model are determined based on the bone prosthesis model Once matched to the bone, the osteotomy plane of the bone can be determined.

在调整好三维骨骼假体模型的安放位置和安放角度之后,基于三维骨骼假体模型与三维骨骼模型的匹配关系进行模拟截骨,得到三维骨骼术后模拟模型。After adjusting the placement position and placement angle of the 3D skeletal prosthesis model, a simulated osteotomy is performed based on the matching relationship between the 3D skeletal prosthesis model and the 3D skeletal model to obtain a 3D skeletal postoperative simulation model.

在得到三维骨骼术后模拟模型后,进行运动模拟,可以通过伸直位模拟图、屈曲位模拟图,确定伸直间隙、屈曲间隙。基于伸直间隙和屈曲间隙,确定三维骨骼假体模型是否与截骨后的三维骨骼模型适配。通过对假体的安装效果进行模拟可从不同角度观察假体大小、位置是否合适,是否出现假体碰撞、异位,进而能够精确地确定假体与骨骼是否适配。用户可通过该最终的模拟图像,确定是否需要对骨骼假体模型进行调整,如果更换骨骼假体的类型和型号,则可重新调用假体库,基于新的骨骼假体模型生成置换后的三维骨骼术后模拟模型。通过对术后的预期效果进行模拟,可以使最终得到的骨骼假体模型与患者的膝关节更加匹配。After obtaining the three-dimensional skeletal simulation model after surgery, the motion simulation can be performed, and the extension gap and flexion gap can be determined through the simulation map of extension position and flexion position. Based on the extension gap and flexion gap, determine whether the 3D bone prosthesis model fits the 3D bone model after osteotomy. 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 misalignment of the prosthesis, and then can accurately determine whether the prosthesis fits the bone. The user can use the final simulated image to determine whether the skeletal prosthesis model needs to be adjusted. If the type and model of the skeletal prosthesis are changed, the prosthesis library can be recalled, and the replaced 3D model can be generated based on the new skeletal prosthesis model. Bone surgery simulation model. By simulating the expected effect after surgery, the final skeletal prosthesis model can be more closely matched to the patient's knee joint.

本实施例通过对安装假体模型的骨骼模型进行术后模拟,能够准确地确定间隙,进而克服了相关技术中依靠手术医生的技术与经验,对间隙平衡和假体位置的安装等指标完全凭借主观感觉进行评估,进而导致的手术精度低的缺陷。In this embodiment, the post-operative simulation of the bone model on which the prosthesis model is installed can accurately determine the gap, thereby overcoming the technique and experience of the surgeon in the related art, and the indicators such as gap balance and the installation of the prosthesis position are completely dependent on the Subjective sensations are 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 femur model; creating an intramedullary positioning simulation rod by a circular fitting method; using the intramedullary positioning simulation rod Determine the femoral opening point.

在可选的实现方式中,在膝关节置换术中还需要确定股骨髓内定位模拟杆入针点的位置,其中髁间窝的顶点可作为髓内定位模拟杆的入针点位置,入针点的位置即可作为股骨开髓点。在术中,三维骨骼模型上可视化显示髓内定位模拟杆和股骨开髓点,引导医生开髓。In an optional implementation manner, it is also necessary to determine the position of the needle insertion point of the femoral intramedullary positioning simulation rod during knee replacement, wherein the apex of the intercondylar fossa can be used as the position of the needle insertion point of the intramedullary positioning simulation rod. The position of the point can be used as the opening point of the femur. During the operation, the intramedullary positioning simulation rod and the femoral opening point were visualized on the 3D bone model to guide the surgeon 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, the present application also proposes a method for bone registration, which specifically includes the following step:

获取膝关节的三维模型中骨骼上的术前规划点在三维模型坐标下的空间位置,以及实体的膝关节骨骼上的术中标记点在世界坐标系下的空间位置;Obtain the spatial position of the preoperative planning point on the bone in the three-dimensional model of the knee joint under the coordinates of the three-dimensional model, and the spatial position of the intraoperative marker point on the solid knee joint bone under the world coordinate system;

将所述术前规划点在三维坐标系下的空间位置与所述术中标记点在世界坐标系下的空间位置进行粗配准,得到粗配准矩阵;Roughly register the spatial position of the preoperative planning point under the three-dimensional coordinate system with the spatial position of the intraoperative marker point under the world coordinate system to obtain a rough registration matrix;

获取实体的膝关节的目标骨骼上的划线点集在世界坐标系下的空间位置;根据所述粗配准矩阵将所述划线点集在世界坐标系下的空间位置与所述三维模型进行精配准,以将世界坐标系配准到三维模型坐标系。Obtaining the spatial position of the dashed point set on the target bone of the entity's knee joint under the world coordinate system; according to the rough registration matrix, the spatial position of the dashed point set under the world coordinate system is compared with the three-dimensional model Perform fine registration to register the world coordinate system to the 3D model coordinate system.

具体的,三维模型是指膝关节的骨骼模型。术前规划点为预先在三维模型中规划的用于配准的点。术中标记点为医生在术中标记在骨骼表面的点。Specifically, the three-dimensional model refers to the skeletal model of the knee joint. The preoperative planning point is the point that is pre-planned in the three-dimensional model for registration. Intraoperative markers are points that the doctor marks on the bone surface during surgery.

术前,会在膝关节的三维模型中的骨骼上确定术前规划点。三维模型具体可以包括三维股骨模型和三维胫骨模型。在膝关节置换手术过程中,患者采用仰卧位,医生可以分别在患者的膝关节的各骨骼上植入固定钉,并在各骨骼上安装示踪器。之后取膝关节内侧入路,切开皮肤和皮下组织,进入关节充分暴露胫骨平台,依次对膝关节的各骨骼进行注册配准。Before surgery, preoperative planning points are determined on the bones in the 3D model of the knee joint. The three-dimensional model may specifically include a three-dimensional femur model and a three-dimensional tibia model. During knee replacement surgery, the patient is in a supine position, and the doctor can implant fixation pins on each bone of the patient's knee joint and install a tracer on each bone. Then, the medial approach of the knee joint was taken, the skin and subcutaneous tissue were incised, and the tibial plateau was fully exposed by entering the joint, and the bones of the knee joint were registered in turn.

光学导航定位系统在骨骼配准过程中,获取膝关节的三维模型中骨骼上的术前规划点在三维模型坐标系下的空间位置,以及实体的膝关节各骨骼上的术中标记点在世界坐标系下的空间位置。例如,可以采集40个骨骼定位点作为术中标记点。In the process of bone registration, the optical navigation and positioning system obtains the spatial position of the preoperative planning points on the bones in the three-dimensional model of the knee joint under the coordinate system of the three-dimensional model, and the intraoperative marking points on the bones of the solid knee joint in the world. The spatial position in the coordinate system. For example, 40 bone anchor points can be collected as intraoperative markers.

对三维模型的配准过程可以分为两个阶段:粗配准阶段和精配准阶段。粗配准阶段,可以采用预设三维空间点云搜索方式进行粗配准。The registration process of the 3D model can be divided into two stages: the coarse registration stage and the fine registration stage. In the coarse registration stage, a preset 3D space point cloud search method can be used for coarse registration.

对于粗配准,在一种实施方式中,所述将所述术前规划点在三维坐标系下的空间位置与所述术中标记点在世界坐标系下的空间位置进行粗配准包括:For rough registration, in one embodiment, the performing rough registration between 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 3D space point cloud search method, the spatial position of the preoperative planning point in the 3D 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;

通过预设三维空间点云搜索方式,根据所述规划三角形序列对术前规划点进行修正,得到修正后的术前规划点;By using a preset three-dimensional space point cloud search method, the preoperative planning points are corrected according to the planning triangle sequence, and the corrected preoperative planning points are obtained;

将所述实操三角形序列对应的术中标记点与所述修正后的术前规划点进行粗配准。The intraoperative marker points corresponding to the practical operation triangle sequence are roughly registered with the corrected preoperative planning points.

在一种实施方式中,所述通过预设三维空间点云搜索方式,分别对所述术前规划点在三维坐标系下的空间位置与所述术中标记点在世界坐标系下的空间位置进行三角化处理,得到术中标记点对应的实操三角形序列和术前规划点对应的规划三角形序列包括:In one embodiment, the pre-operative planning point under the three-dimensional coordinate system and the intraoperative marked point under the world coordinate system are respectively searched in a preset three-dimensional space point cloud search method. Perform triangulation processing to obtain the actual operation triangle sequence corresponding to the intraoperative marker points and the planning triangle sequence corresponding to the preoperative planning points, including:

通过预设三维空间点云搜索方式,根据所述术前规划点在三维坐标系下的空间位置将术前规划点的前三个点组成三角形,以及根据所述术中标记点在世界坐标系下的空间位置将术中标记点的前三个点组成三角形;By using a preset 3D space point cloud search method, the first three points of the preoperative planning point are formed into a triangle according to the spatial position of the preoperative planning point in the 3D coordinate system, and according to the intraoperative marking point in the world coordinate system The first three points of the intraoperative marked points form a triangle in the spatial position below;

从第四个点开始,分别在之前的点中选取两个点,与当前点组成三角形,得到术中标记点对应的实操三角形序列和术前规划点对应的规划三角形序列;所述实操三角形序列与所述规划三角形序列的三角形组成顺序是相同的。Starting from the fourth point, two points are respectively selected from the previous points to form a triangle with the current point, and the practical operation triangle sequence corresponding to the marked points in the operation and the planning triangle sequence corresponding to the preoperative planning points are obtained; the practical operation The triangle sequence and the triangle composition order of the planning triangle sequence are the same.

在一种实施方式中,所述通过预设三维空间点云搜索方式,根据所述规划三角形序列对术前规划点进行修正,得到修正后的术前规划点包括:In one embodiment, the preoperative planning points are modified according to the planning triangle sequence by using a preset three-dimensional space point cloud search method, and the modified preoperative planning points obtained include:

通过预设三维空间点云搜索方式,确定术前规划点在三维模型上的第二邻域空间点集;Determine the second neighborhood space point set of the preoperative planning point on the 3D model by presetting the 3D space point cloud search method;

在所述第二邻域空间点集中筛选出第二目标点;Screen out the second target point in the second neighborhood space point set;

根据所述规划三角形序列将所述术前规划点在三维模型坐标下的空间位置修正至对应第二目标点的位置。The spatial position of the preoperative planning point in the three-dimensional model coordinates is corrected to a 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 fine registration stage, no preoperative planning is required. During the operation, a surface calibration device such as a surgical probe can be used to perform a scribing operation on the surface of each bone of the solid knee joint. Line point set. Wherein, the scribed area to be scribed is the key bone area on the surface of each bone, that is, the area including the key bone points.

具体的,划线点集是由多条线段上的点所组成的,例如,可以包括三条线段中的点。将划线点集中的点进行三角形配对,分别在每条线段中选取一个点,每三个点组成一个三角形,组成原则为三角形周长最大,按照该三角形配对方式,得到配对三角形序列。配对三角形序列包括多个三角形。Specifically, the dash point set is composed of points on multiple line segments, for example, points in three line segments may be included. The points in the set of dashed points are paired in a triangle, and a point is selected in each line segment, and every three points form a triangle. The paired triangle sequence includes multiple triangles.

示例性的,通过光学导航定位系统中的跟踪相机追踪手术探针上的示踪器的位置,根据跟踪相机获取的手术探针在划线过程中,其上的探针示踪器在世界坐标系下的空间位置,确定实体的膝关节的各骨骼上的划线点集在世界坐标下的空间位置,以得到划线点集。Exemplarily, the position of the tracer on the surgical probe is tracked by the tracking camera in the optical navigation and positioning system, and the probe tracer on the surgical probe obtained by the tracking camera is in world coordinates during the scribing process. The space position under the system is determined, and the space position of the line point set on each bone of the knee joint of the entity is determined in the world coordinate, so as to obtain the line point set.

在本实施例的一种可选方式中,在划线操作中,可以通过手术探针以频率S 进行采样,在线上进行采点操作,将整条线段细分为若干点集。In an optional manner of this embodiment, in the scribing operation, the surgical probe may be used for sampling at the frequency S, and the point sampling operation may be performed on the line to subdivide the entire line segment into several point sets.

在精配准过程中,可以先确定划线点集在三维模型上的邻域空间点集,从而根据邻域空间点集中以及划线点集在世界坐标系下的空间位置对划线点集在三维模型坐标系下的空间位置进行修正,进而将修正后的划线点集与划线点集在世界坐标系下的空间位置进行配准。In the process of fine registration, the neighborhood space point set of the dash point set on the 3D model can be determined first, so that the dash point set can be assigned according to the neighborhood space point set and the spatial position of the dash point set in the world coordinate system. The spatial position under the three-dimensional model coordinate system is corrected, and then the corrected dash point set and the space position of the dash point set under the world coordinate system are registered.

在一种实施方式中,所述根据所述粗配准矩阵将所述划线点集在世界坐标系下的空间位置与所述三维模型进行精配准包括:In an embodiment, the performing fine registration of the spatial position of the dashed point set in the world coordinate system with the three-dimensional model according to the rough registration matrix includes:

根据所述粗配准矩阵将所述划线点集在世界坐标系下的空间位置反射回三维模型坐标系中,得到划线点集在三维模型坐标系下的位置;Reflecting the spatial position of the dash point set in the world coordinate system back into the 3D model coordinate system according to the rough registration matrix, to obtain the position of the dash point set in the 3D model coordinate system;

根据所述划线点集在三维模型坐标系下的位置在所述三维模型上进行邻域空间搜索,得到第一邻域空间点集;Perform a neighborhood space search on the 3D model according to the position of the dash point set in the 3D model coordinate system to obtain a first neighborhood space point set;

根据所述第一邻域空间点集对所述划线点集在世界坐标系下的空间位置进行修正,得到线段点集;将所述线段点集与所述三维模型进行精配准。Correct the spatial position of the dash point set in the world coordinate system according to the first neighborhood space point set to obtain a line segment point set; perform precise registration on the line segment point set and the three-dimensional model.

具体的,粗配准矩阵表示粗配准得到的世界坐标系与三维模型坐标系的转换关系。根据粗配准矩阵可以将划线点集在世界坐标系下的空间位置反射回三维模型坐标系中,从而得到划线点集在三维模型坐标系下的位置。由于三维模型对应三维模型坐标系,由此可根据划线点集在三维模型坐标系下的位置在三维模型上进行邻域空间搜索,得到第一邻域空间点集。第一邻域空间点集为三维模型坐标系下的划线点集对应的邻域空间点集。Specifically, the rough registration matrix represents the conversion relationship between the world coordinate system obtained by the rough registration and the three-dimensional model coordinate system. According to the rough registration matrix, the spatial position of the dash point set in the world coordinate system can be reflected back into the 3D model coordinate system, so as to obtain the position of the dash point set in the 3D model coordinate system. Since the 3D model corresponds to the 3D model coordinate system, a 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 line point set under the three-dimensional model coordinate system.

在一种实施方式中,所述根据所述第一邻域空间点集对所述划线点集在世界坐标系下的空间位置进行修正包括:In an embodiment, the modifying the spatial position of the dashed point set in the world coordinate system according to the first neighborhood spatial point set includes:

将划线点集中的点进行三角形配对,得到配对三角形序列;根据所述第一邻域空间点集以及所述配对三角形序列对划线点集中的点进行修正;The points in the dash point set are triangularly paired to obtain a paired triangle sequence; the points in the dash point set are corrected according to the first neighborhood space point set and the paired triangle sequence;

该步骤具体包括:在所述第一邻域空间点集中筛选出第一目标点;根据所述配对三角形序列将所述划线点集中的点的位置修正至对应第一目标点的位置。The step specifically includes: screening out a first target point in the first neighborhood space point set; and correcting the position of the point in the dashed point set to a position corresponding to the first target point according to the paired triangle sequence.

具体的,划线点集是由多条线段上的点所组成的,例如,可以包括三条线段中的点。将划线点集中的点进行三角形配对,分别在每条线段中选取一个点,每三个点组成一个三角形,组成原则为三角形周长最大,按照该三角形配对方式,得到配对三角形序列。配对三角形序列包括多个三角形。Specifically, the dash point set is composed of points on multiple line segments, for example, points in three line segments may be included. The points in the set of dashed points are paired in a triangle, and a point is selected in each line segment, and every three points form a triangle. The paired triangle sequence includes multiple 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 point. A set of target points. The preset screening strategy is that the triangle formed by the three screened target points and the triangle in the paired triangle sequence are congruent triangles. Since the error of congruent triangles is extremely small, the spatial positions of the three triangle points of the current triangle in the three-dimensional model coordinates can be respectively corrected to the positions of the corresponding target points in the first target point set, and the correction process is repeated to realize the matching of the three triangles in the sequence. A large number of triangles continuously correct the spatial position of the dash point set in the 3D model coordinate system, so that the spatial position of the dash point set reflected in the 3D model coordinate system is more accurate.

之后,通过配准算法将修正后的划线点集与划线点集在世界坐标系下的空间位置进行配准,得到配准结果。例如,配准算法可以是ICP(Iterative Closest Point,迭代最近点算法)。配准结果可以是最终得到的世界坐标系与三维坐标下的转换关系,通过配准结果可以提高术中操作的精准性。Afterwards, the corrected dash point set and the space position of the dash point set in the world coordinate system are registered by the registration algorithm, and the registration result is obtained. For example, the registration algorithm may be ICP (Iterative Closest Point). The registration result can be the conversion relationship between the finally obtained world coordinate system and the three-dimensional coordinate, and the accuracy of the intraoperative operation can be improved through the registration result.

在本实施例中,通过划线操作获取实体的膝关节的各骨骼上的划线点集在世界坐标系下的空间位置,从而根据粗配准矩阵将所述划线点集在世界坐标系下的空间位置与所述三维模型进行精配准,与传统的取点配准算法相比,配准效率有利极大的提高,配准精准度也有较大提高。In this embodiment, the spatial position of the set of dashed points on each bone of the knee joint of the entity in the world coordinate system is obtained through the dashing operation, so that the set of dashed points is set in the world coordinate system according to the rough registration matrix Compared with the traditional point registration algorithm, the registration efficiency is greatly improved, and the registration accuracy is also greatly improved.

目标区域目标区域目标区域目标区域目标区域目标区域目标区域目标区域目标区域目标区域目标区域目标区域与上述的第一方面的机器人运动区域的限定方法对应,第四方面,本申请还提出了一种手术机器人机械臂的控制方法,包括以下的步骤:target area target area target area target area target area target area target area target area target area target area The control method of the surgical robot manipulator includes the following steps:

在机械臂末端的执行器运行过程中,根据执行器的当前空间位置与膝关节的当前目标区域的空间位置确定执行器相对于当前目标区域的偏移量;During the operation of the actuator at the end of the robotic 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 robot that needs to perform osteotomy, such as a total knee replacement robot), and the robot may mainly include a robotic arm, and (in a detachable manner) an execution device provided at the end of the robot The actuator may be an osteotomy saw. The main control system of the host computer can send an osteotomy start signal to the manipulator, and after the manipulator receives the signal, it drives the osteotomy saw at its end to move.

机械臂末端、实际待截骨区域(例如,膝关节的股骨区域、胫骨区域)均可预先设置有示踪器,示踪器包括可发射红外线的光感小球,通过双目红外相机实时追踪械臂末端设置的光感小球的位置、股骨区域上的光感小球的位置、胫骨区域上的光感小球的位置可以确定机械臂末端的执行器的当前空间位置、各个目标区域的当前空间位置,从而可以实时确定执行器的空间位置、当前目标区域的空间位置,进而可基于执行器的空间位置,当前目标区域的空间位置确定执行器相对于当前目标区域的偏移量。The end of the robotic arm and the actual area to be osteotomy (for example, the femoral area of the knee joint, the tibia area) can be preset with a tracer. The tracer includes a light-sensing ball that emits infrared rays, and is tracked in real time by a binocular infrared camera The position of the light-sensing ball set at the end of the manipulator, the position of the light-sensing ball on the femur area, and the position of the light-sensing ball on the tibia 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 then 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.

三维模型中会显示预先规划的截骨顺序,当前目标区域则为响应于操作者从多个目标区域选定的一个目标区域。The pre-planned osteotomy sequence is displayed in the 3D model, and the current target area is a target area selected from multiple target areas in response to the operator.

作为本实施例一种可选的实现方式,在执行器运行前,当机械臂被操作至膝关节处时,根据三维模型坐标系中规划的膝关节的当前目标区域的空间位置、执行器的当前空间位置确定当前目标区域的空间位置与执行器的当前空间位置之间的位置差量;根据所述位置差量确定机械臂被操作的位移量;在三维模型中显示与所述位移量对应的指示调节信息,以使操作者根据所述指示调节信息操作机械臂,从而将执行器调整至使其平面与当前目标区域共面。可以理解的,执行器的平面与目标区域共面,是指执行器在当前目标区域的外缘,执行器的平面与当前目标区域大致在同一平面内对齐。As an optional implementation manner 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 operated displacement of the manipulator according to the position difference; displays the displacement corresponding to the displacement in the three-dimensional model The indicated adjustment information, so that the operator operates the robotic arm according to the indicated 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 at 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 indicated adjustment information corresponding to the displacement amount may include the adjustment path corresponding to the displacement amount displayed by the enlarged target area of the target area, and guide the doctor to hold the robotic arm to adjust the plane of the actuator to align with the osteotomy plane (the actuator is in the cutting plane). The outer edge of the bone plane, the actuator is roughly coplanar with the osteotomy plane).

在一种实施方式中,根据所述偏移量,对机械臂进行控制,以将执行器的运动限定在所述目标区域内的步骤包括:In one embodiment, the step of controlling the robotic arm to confine 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 based on the virtual spring and damper is activated. The offset Δx of Δx outputs a feedback force F opposite to the operated direction, F=Δx*C, thereby limiting the movement of the actuator within the current target area.

各个自由度方向上的预设刚度值C的大小如前所述,在此不再赘述。The magnitude of the preset stiffness value C in the direction of each degree of freedom is as described above, and will not be repeated here.

目标区域目标区域目标区域目标区域目标区域目标区域目标区域目标区域第六方面,本申请还提供了一种机器人运动平面的限定系统,参见附图5所示的一种机器人运动平面的限定系统的结构示意图;该系统包括:target area target area target area target area target area target area target area target area Schematic diagram of the structure; the system includes:

模型建立模块61,用于根据机器人的机械臂末端的执行器在多个自由度方向上的初始位置与实际位置的位移偏移量,建立虚拟弹簧的刚度-阻尼模型;The model establishment module 61 is used for establishing the stiffness-damping model of the virtual spring 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 the directions of multiple degrees of freedom;

刚度设定模块62,用于设定在多个自由度方向上的各个所述虚拟弹簧的刚度值,以将所述执行器的运动限定在预先规划的目标区域上。在一种实施方式中,所述执行器向所述目标区域切入的方向记为进深方向,在所述目标区域内并与所述进深方向垂直的方向记为横向,与所述目标区域垂直的方向记为垂直方向;The stiffness setting module 62 is configured to set stiffness values of the virtual springs in the directions of multiple degrees of freedom, so as to limit the motion of the actuator to a pre-planned target area. In one embodiment, the direction in which the actuator cuts into the target area is denoted as the depth direction, the direction in the target area and perpendicular to the depth direction is denoted as the lateral direction, and the direction perpendicular to the target area is denoted as the lateral direction. The direction is recorded as the vertical direction;

刚度设定模块62还用于,在平移自由度方向上,设定所述进深方向上的虚拟弹簧的刚度值、横向上的虚拟弹簧的刚度值、垂直方向上的虚拟弹簧的刚度值;The stiffness setting module 62 is further configured to, in the direction of the translational degree of freedom, 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 lateral direction;

所述横向上的虚拟弹簧的刚度值大于所述垂直方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the lateral 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 lateral 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 Translate 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 with the depth direction as the axis of rotation, and the transverse direction as the axis of rotation The stiffness value of the virtual spring on the vertical direction and the stiffness value of the virtual spring in the rotation direction of the axis;

以所述垂直方向为轴旋转方向上的虚拟弹簧的刚度值小于以所述进深方向为轴旋转方向上的虚拟弹簧的刚度值,并小于以所述横向为轴旋转方向上的虚拟弹簧的刚度值;The stiffness value of the virtual spring in the rotational direction of the axis is smaller than the stiffness value of the virtual spring in the rotational direction of the axis, and is smaller than the stiffness of the virtual spring in the rotational direction of 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 rotational direction of the axis with the depth direction as the axis and the stiffness value of the virtual spring in the rotational direction of the axis with the lateral direction are greater than or equal to the second rotational 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 rigidity threshold to be 0N/m~500N/m, and the second translation preset rigidity threshold to be 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 the 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 a sixth aspect, the present application also proposes a device for defining a motion plane of a robot, refer to the schematic structural diagram of the device for defining a motion plane of a robot 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 execute one or more program instructions, so as to execute any of the steps described above.

第七方面,本申请还提出了一种计算机可读存储介质,计算机可读存储介质中包含一个或多个程序指令,所述一个或多个程序指令用于执行上述任意一项所述的步骤。In a seventh aspect, the present application further provides a computer-readable storage medium, where the computer-readable storage medium contains one or more program instructions, and the one or more program instructions are used to perform any of the steps described above. .

可以实现或者执行本发明实施例中的公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。结合本发明实施例所公开的方法的步骤可以直接体现为硬件译码处理器执行完成,或者用译码处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器,闪存、只读存储器,可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。处理器读取存储介质中的信息,结合其硬件完成上述方法的步骤。Various methods, steps, and logical block diagrams disclosed in the embodiments of the present invention can 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 conjunction with the embodiments of the present invention may be directly embodied as executed by a hardware decoding processor, or executed by a combination of hardware and software modules in the decoding processor. The software module may be located in random access memory, flash memory, read-only memory, programmable read-only memory or electrically erasable programmable memory, registers and other storage media mature in the art. The processor reads the information in the storage medium, and completes the steps of the above method in combination with its hardware.

存储介质可以是存储器,例如可以是易失性存储器或非易失性存储器,或可包括易失性和非易失性存储器两者。The storage medium may be memory, eg, may be 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 may be a read-only memory (Read-Only Memory, referred to as ROM), a programmable read-only memory (Programmable ROM, referred to as PROM), an erasable programmable read-only memory (Erasable PROM, referred to as EPROM) , Electrically Erasable Programmable Read-Only Memory (Electrically EPROM, EEPROM for short) or flash memory.

易失性存储器可以是随机存取存储器(Random Access Memory,简称RAM),其用作外部高速缓存。通过示例性但不是限制性说明,许多形式的RAM可用,例如静态随机存取存储器(Static RAM,简称SRAM)、动态随机存取存储器(Dynamic RAM,简称DRAM)、同步动态随机存取存储器(Synchronous DRAM,简称 SDRAM)、双倍数据速率同步动态随机存取存储器(Double Data RateSDRAM,简称DDRSDRAM)、增强型同步动态随机存取存储器(EnhancedSDRAM,简称 ESDRAM)、同步连接动态随机存取存储器(Synchlink DRAM,简称SLDRAM) 和直接内存总线随机存取存储器(DirectRambus RAM,简称DRRAM)。The volatile memory may be a random access memory (Random Access Memory, RAM for short), which is used as an external cache. By way of example and not limitation, many forms of RAM are available, such as Static Random Access Memory (SRAM), Dynamic RAM (DRAM), 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 invention is intended to include, but not limited to, these and any other suitable types of memory.

显然,本领域的技术人员应该明白,上述的本发明的各模块或各步骤可以用通用的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本发明不限制于任何特定的硬件和软件结合。Obviously, those skilled in the art should understand that the above-mentioned modules or steps of the present invention can be implemented by a general-purpose computing device, and they can be centralized on a single computing device or distributed in a network composed of multiple computing devices Alternatively, 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 the computing device, or they can be made into individual integrated circuit modules, or they can be integrated into The multiple modules or steps are fabricated into a single integrated circuit module. As such, the present invention is not limited to any particular 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, the present application may have various modifications and changes. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of this application shall be included within the protection scope of this application.

Claims (10)

1. A method for defining a robot motion area, comprising:
establishing a stiffness-damping model of a virtual spring according to displacement offsets of an actuator at the tail end of a mechanical arm of the robot in the directions of multiple degrees of freedom from an actual position;
setting stiffness values of each of the virtual springs in a plurality of degrees of freedom to define movement of the actuator over a pre-planned target area;
the direction of the actuator cutting into the target area is recorded as a depth direction, the direction in the target area and perpendicular to the depth direction is recorded as a transverse direction, and the direction perpendicular to the target area is recorded as a vertical direction;
setting stiffness values of each of the virtual springs in a plurality of degrees of freedom directions, including:
setting 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 in the direction of translational freedom;
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 smaller than or equal to a first translational preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is larger than or equal to a second translational preset stiffness threshold;
the first translation preset rigidity threshold value is 0N/m-500N/m;
the second translational preset stiffness threshold value is 4000N/m-5000N/m.
2. The method of defining a robot motion zone of claim 1,
the stiffness value of the virtual spring in the depth direction is equal to or less 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.
3. The method of claim 2, wherein setting stiffness values of each of the virtual springs in a plurality of degrees of freedom comprises:
setting, in a rotational degree of freedom direction, a stiffness value of a virtual spring in a direction of axial rotation with the depth direction as an axis, a stiffness value of a virtual spring in a direction of axial rotation with the lateral direction as an axis, and a stiffness value of a virtual spring in a direction of axial rotation with the vertical direction as an axis;
the stiffness value of the virtual spring taking the vertical direction as the axis rotation direction is smaller than the stiffness value of the virtual spring taking the depth direction as the axis rotation direction and smaller than the stiffness value of the virtual spring taking the transverse direction as the axis rotation direction;
the stiffness value of the virtual spring taking the vertical direction as the axis rotation direction is smaller than or equal to a first rotation preset stiffness threshold value;
and the rigidity value of the virtual spring taking the depth direction as the shaft rotation direction and the rigidity value of the virtual spring taking the transverse direction as the shaft rotation direction are greater than or equal to a second rotation preset rigidity threshold value.
4. The method of defining a robot motion zone of claim 3,
the first rotational preset stiffness threshold is 0 Nm/rad-20 Nm/rad;
the second rotation preset rigidity threshold value is 200 Nm/rad-300 Nm/rad.
5. The method of defining a robot motion zone of claim 1, further comprising: damping values of the virtual spring in a plurality of degrees of freedom are set.
6. The method of defining a robot motion zone of claim 1,
the target area includes: a femoral anterior resection plane, a femoral anterior oblique resection plane, a femoral posterior condylar resection plane, a femoral posterior oblique resection plane, a femoral distal resection plane, and a tibial resection plane.
7. A system for defining a robot motion field, comprising:
the model establishing module is used for establishing a stiffness-damping model of the virtual spring according to displacement offsets of an actuator at the tail end of a mechanical arm of the robot in the directions of multiple degrees of freedom and an actual position;
a stiffness setting module for setting stiffness values of each of the virtual springs in a plurality of degrees of freedom to define movement of the actuator on a pre-planned target area;
the direction of the actuator cutting into the target area is recorded as a depth direction, the direction in the target area and perpendicular to the depth direction is recorded as a transverse direction, and the direction perpendicular to the target area is recorded as a vertical direction;
the stiffness setting module is further used for setting 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 in the direction of translational freedom;
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 smaller than or equal to a first translational preset stiffness threshold, and the stiffness value of the virtual spring in the vertical direction is larger than or equal to a second translational preset stiffness threshold;
the rigidity setting module is also used for setting the first translational preset rigidity threshold value to be 0N/m-500N/m and the second translational preset rigidity threshold value to be 4000N/m-5000N/m.
8. The system for defining a robot motion zone of claim 7,
the stiffness value of the virtual spring in the depth direction is equal to or less 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.
9. An electronic device, comprising: at least one processor and at least one memory; the memory is to store one or more program instructions; the processor, configured to execute one or more program instructions to perform the method of any of claims 1-6.
10. A computer-readable storage medium having one or more program instructions embodied therein for performing the method of any of claims 1-6.
CN202111035714.2A 2021-09-03 2021-09-03 Method and system for limiting motion area of robot Active CN113842217B (en)

Priority Applications (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
PCT/CN2022/111535 WO2023029922A1 (en) 2021-09-03 2022-08-10 Method and system for limiting movement area of robot

Applications Claiming Priority (1)

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

Publications (2)

Publication Number Publication Date
CN113842217A CN113842217A (en) 2021-12-28
CN113842217B true CN113842217B (en) 2022-07-01

Family

ID=78973279

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111035714.2A Active CN113842217B (en) 2021-09-03 2021-09-03 Method and system for limiting motion 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
CN113842213B (en) * 2021-09-03 2022-10-11 北京长木谷医疗科技有限公司 Surgical robot navigation positioning method and system
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 and positioning system and method

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101448467A (en) * 2006-05-19 2009-06-03 马科外科公司 Method and apparatus for controlling a haptic device
CN103105851A (en) * 2012-11-07 2013-05-15 吉林大学 Kinesthesis teaching control method based on vision sense for remote control of robot
CN104781050A (en) * 2012-09-17 2015-07-15 睿信科机器人有限公司 Constraining a Manipulator with Redundant Degrees of Freedom
CN106462243A (en) * 2014-03-24 2017-02-22 直观外科手术操作公司 System and method for virtual feedback with haptic devices
CN107121930A (en) * 2017-05-26 2017-09-01 山东科技大学 Six Degree-of-Freedom Parallel Platform motion control method based on dummy model
CN109333497A (en) * 2018-11-30 2019-02-15 西华大学 A remote operating system control method with virtual binding force
CN109688963A (en) * 2016-07-15 2019-04-26 马科外科公司 System for robot assisted revision program
CN113319857A (en) * 2021-08-03 2021-08-31 季华实验室 Mechanical arm force and position hybrid control method and device, electronic equipment and storage medium

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11564761B2 (en) * 2019-03-08 2023-01-31 Mako Surgical Corp. Systems and methods for controlling movement of a surgical tool along a predefined path
US11890066B2 (en) * 2019-09-30 2024-02-06 Globus Medical, Inc Surgical robot with passive end effector
WO2021067438A1 (en) * 2019-09-30 2021-04-08 Mako Surgical Corp. Systems and methods for guiding movement of a tool
JP7704743B2 (en) * 2019-10-01 2025-07-08 マコ サージカル コーポレーション Surgical system and method for guiding a robotic manipulator - Patents.com
CN111956325B (en) * 2020-07-01 2021-08-20 北京和华瑞博医疗科技有限公司 Accurate positioning device, method and system for medical instrument
CN113850851B (en) * 2021-09-03 2022-10-21 北京长木谷医疗科技有限公司 Surgical robot bone registration method and system
CN113842214B (en) * 2021-09-03 2022-10-11 北京长木谷医疗科技有限公司 Surgical robot navigation and positioning system and method
CN113855236B (en) * 2021-09-03 2022-05-31 北京长木谷医疗科技有限公司 Method and system for tracking and moving surgical robot
CN113842217B (en) * 2021-09-03 2022-07-01 北京长木谷医疗科技有限公司 Method and system for limiting motion area of robot
CN113907889A (en) * 2021-09-03 2022-01-11 北京长木谷医疗科技有限公司 Control method and system for robot mechanical arm
CN113842213B (en) * 2021-09-03 2022-10-11 北京长木谷医疗科技有限公司 Surgical robot navigation positioning method and system

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101448467A (en) * 2006-05-19 2009-06-03 马科外科公司 Method and apparatus for controlling a haptic device
CN104781050A (en) * 2012-09-17 2015-07-15 睿信科机器人有限公司 Constraining a Manipulator with Redundant Degrees of Freedom
CN103105851A (en) * 2012-11-07 2013-05-15 吉林大学 Kinesthesis teaching control method based on vision sense for remote control of robot
CN106462243A (en) * 2014-03-24 2017-02-22 直观外科手术操作公司 System and method for virtual feedback with haptic devices
CN109688963A (en) * 2016-07-15 2019-04-26 马科外科公司 System for robot assisted revision program
CN107121930A (en) * 2017-05-26 2017-09-01 山东科技大学 Six Degree-of-Freedom Parallel Platform motion control method based on dummy model
CN109333497A (en) * 2018-11-30 2019-02-15 西华大学 A remote operating system control method with virtual binding force
CN113319857A (en) * 2021-08-03 2021-08-31 季华实验室 Mechanical arm force and position hybrid control method and device, electronic equipment and storage medium

Also Published As

Publication number Publication date
CN113842217A (en) 2021-12-28
WO2023029922A1 (en) 2023-03-09

Similar Documents

Publication Publication Date Title
CN113842213B (en) Surgical robot navigation positioning method and system
CN113855236B (en) Method and system for tracking and moving surgical robot
US12220183B2 (en) Systems and methods for adaptive planning and control of a surgical tool
CN113842214B (en) Surgical robot navigation and positioning system and method
US12042230B2 (en) Preoperative planning and associated intraoperative registration for a surgical system
CN113850851B (en) Surgical robot bone registration method and system
CN113208689B (en) Osteotomy guiding tool
CN113842217B (en) Method and system for limiting motion area of robot
US10743951B2 (en) Systems and methods for repairing bone with multiple tools
CN113040920B (en) System and method for manipulating anatomy
AU2016408411A1 (en) Preoperative planning and associated intraoperative registration for a surgical system
US20250114939A1 (en) Robotic surgical system with recovery alignment
CN113907889A (en) Control method and system for robot mechanical arm

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP01 Change in the name or title of a patent holder

Address after: 100176 2201, 22 / F, building 1, yard 2, Ronghua South Road, Beijing Economic and Technological Development Zone, Daxing District, Beijing

Patentee after: Beijing Changmugu Medical Technology Co.,Ltd.

Patentee after: Zhang Yiling

Address before: 100176 2201, 22 / F, building 1, yard 2, Ronghua South Road, Beijing Economic and Technological Development Zone, Daxing District, Beijing

Patentee before: BEIJING CHANGMUGU MEDICAL TECHNOLOGY Co.,Ltd.

Patentee before: Zhang Yiling

CP01 Change in the name or title of a patent holder