WO2022141153A1 - Système de ponction à positionnement par ultrasons et support de stockage - Google Patents

Système de ponction à positionnement par ultrasons et support de stockage Download PDF

Info

Publication number
WO2022141153A1
WO2022141153A1 PCT/CN2020/141231 CN2020141231W WO2022141153A1 WO 2022141153 A1 WO2022141153 A1 WO 2022141153A1 CN 2020141231 W CN2020141231 W CN 2020141231W WO 2022141153 A1 WO2022141153 A1 WO 2022141153A1
Authority
WO
WIPO (PCT)
Prior art keywords
coordinate system
joint
ultrasonic detection
ultrasonic
detection device
Prior art date
Application number
PCT/CN2020/141231
Other languages
English (en)
Chinese (zh)
Inventor
黄善灯
柏龙
陈晓红
潘鲁锋
柳建飞
Original Assignee
诺创智能医疗科技(杭州)有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 诺创智能医疗科技(杭州)有限公司 filed Critical 诺创智能医疗科技(杭州)有限公司
Priority to PCT/CN2020/141231 priority Critical patent/WO2022141153A1/fr
Publication of WO2022141153A1 publication Critical patent/WO2022141153A1/fr

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
    • A61B17/34—Trocars; Puncturing needles
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00—Diagnosis using ultrasonic, sonic or infrasonic waves

Definitions

  • the present application relates to the field of robotic arm control, and in particular, to an ultrasonic positioning puncture system and a storage medium.
  • the doctor manually sends small surgical instruments (such as biopsy needles) into the patient's body to detect or treat the lesion.
  • small surgical instruments such as biopsy needles
  • the nearby 2D or 3D scan images determine the appropriate needle entry point and needle entry direction, and then manually complete the puncture operation based on experience.
  • the working principle of the puncture robot with the surgical navigation system is as follows: first, the computer 3D synthesizes the scanned 2D image to form a 3D image near the lesion, and then the doctor judges the target position and the appropriate needle insertion path through the 3D image and inputs it into the navigation system. , and then the navigation system calculates the current state and target point of the robot manipulator arm and plans a trajectory. Finally, the manipulator arm completes the puncture positioning according to the planned trajectory, and then manually completes the needle insertion through the needle insertion mechanism or the doctor, avoiding pure manual operation. errors caused.
  • the existing navigation technology usually locates and registers the puncture needle and medical imaging equipment through optical positioning, and performs puncture with the aid of medical images, but there are large errors in the process of optical positioning and registration, and in During the operation, the optical ball cannot be blocked, which limits the implementation of the operation.
  • an ultrasonic positioning and puncturing system includes a computer device, a first serial manipulator arm, and an ultrasonic detection device mounted on the end of the first serial manipulator arm.
  • Computer equipment is electrically connected to the first serial robotic arm and the ultrasonic detection device respectively, the computer equipment includes a memory and a processor, the memory stores a computer program, and the processor runs the computer program Perform the following steps: locate the first position information of the target point in the ultrasonic detection plane projected by the ultrasonic detection device; obtain the first attitude information of the ultrasonic detection plane and the second attitude information of the first serial robot arm ; According to the first attitude information and the second attitude information, determine the position conversion relationship between the reference coordinate system of the ultrasonic positioning puncture system and the coordinate system where the ultrasonic detection plane is located; According to the position conversion relationship and the described position conversion relationship The first position information determines the second position information of the target point in the reference coordinate system.
  • the above ultrasonic positioning puncture system has the following advantages: by directly obtaining the coordinates of the lesion in the ultrasonic image, without the need for indirect registration through registration datums such as optical positioning, it solves the existing positioning and registration technology for puncture surgery under medical image navigation There is also the problem of error, which improves the accuracy of the puncture operation.
  • the locating the first position information of the target point in the ultrasound detection plane projected by the ultrasound detection device includes: acquiring an ultrasound image acquired by the ultrasound detection device, in which the ultrasound image is Locate the position information of the target point; according to the position information of the target point in the ultrasonic image and the calibration parameters of the ultrasonic detection device, determine that the target point is in the ultrasonic detection plane projected by the ultrasonic detection device of the first location information.
  • the ultrasonic detection device is rotatably connected to the end of the first serial manipulator, and the ultrasonic detection plane is formed at the end of the ultrasonic detection device and extends from the ultrasonic detection device.
  • the end point of the ultrasonic detection plane extends along the fan plane; the ultrasonic detection plane rotates with the ultrasonic detection device, and the rotation axis of the ultrasonic detection plane passes through the end point; the first attitude information includes the rotation angle of the ultrasonic detection plane.
  • the first position information includes the distance of the target point relative to the end point, and the included angle of the connecting line between the target point and the end point and the rotation axis.
  • the first serial robotic arm includes a plurality of joints
  • the plurality of joints include: rotation joints and/or movement joints
  • the second posture information includes motion amount information of each of the joints .
  • the determining, according to the first attitude information and the second attitude information, the position conversion relationship between the reference coordinate system of the ultrasound positioning and puncturing system and the coordinate system where the ultrasound detection plane is located includes: : when the first serial manipulator is in the initial state, establish the reference coordinate system of the first serial manipulator and the joint coordinate system of each joint of the first serial manipulator, and when the ultrasonic detection device is in the In the initial state, a probe coordinate system is established with the end point of the ultrasonic detection device as the coordinate origin; the reference coordinate system of the first serial manipulator and the DH of the joint coordinate system of each joint of the first serial manipulator are obtained.
  • the parameters determine the first position conversion relationship between the reference coordinate system of the first serial manipulator and the joint coordinate system of the end joint of the first serial manipulator; obtain the probe coordinates The position information of the coordinate origin of the system in the joint coordinate system of the terminal joint, and the attitude angle of the probe coordinate system relative to the joint coordinate system of the terminal joint, and according to the position information, attitude angle and the first a position conversion relationship, determining a second position conversion relationship between the reference coordinate system and the probe coordinate system; acquiring the rotation angle of the ultrasonic detection plane, and determining the coordinates of the ultrasonic detection plane according to the rotation angle The third position conversion relationship between the system and the probe coordinate system; according to the second position conversion relationship and the third position conversion relationship, determine the reference coordinate system of the ultrasonic positioning and puncturing system and the ultrasonic detection plane.
  • the first serial manipulator includes a rotating joint and a moving joint
  • the Z axis of the joint coordinate system of the rotating joint is set along the rotating axis
  • the Z axis of the joint coordinate system of the moving joint is set along the moving direction
  • the reference coordinate system and the joint coordinate system of each joint are both left-handed or right-handed systems
  • the origin of the joint coordinate system of the rotary joint is the joint coordinate system of the previous mobile joint. The origin coincides.
  • the directions of the X, Y, and Z axes of the probe coordinate system are the same as the directions of the X, Y, and Z axes of the joint coordinate system of the distal joint, and the Z axis of the probe coordinate system The axis is collinear with the Z-axis of the joint coordinate system of the end joint.
  • the end joint of the first serial manipulator is a parallel motion platform
  • the parallel motion platform includes a static platform, a moving platform, and a plurality of pieces disposed between the static platform and the moving platform
  • the telescopic assembly, the ultrasonic detection device is set on the moving platform.
  • the ultrasonic positioning and puncturing system further includes a second serial robotic arm and a puncturing instrument mounted on the end of the second serial robotic arm; the computer equipment is further connected to the second serial robotic arm, respectively. electrically connected, the processor further executes the following steps when running the computer program: taking the second position information of the target point in the reference coordinate system as the target puncture point, and controlling the second serial robotic arm The puncture instrument punctures the target puncture point.
  • a storage medium in which a computer program is stored, the computer program being configured to execute the following steps when running: in an ultrasound detection plane projected by the ultrasound detection device Locating the first position information of the target point; obtaining the first attitude information of the ultrasonic detection plane and the second attitude information of the first serial manipulator; according to the first attitude information and the second attitude information, determine The position conversion relationship between the reference coordinate system of the ultrasonic positioning puncture system and the coordinate system where the ultrasonic detection plane is located; according to the position conversion relationship and the first position information, it is determined that the target point is in the reference coordinate system the second location information.
  • FIG. 1 is a structural block diagram of an ultrasonic positioning and puncturing system provided by an embodiment of the present application.
  • FIG. 2 is a flowchart of a working method of the ultrasonic positioning puncture system provided by the embodiment of the present application.
  • FIG. 3 is a flowchart of a coordinate conversion method for a multi-joint robotic arm according to an embodiment of the present application.
  • FIG. 4 is a schematic structural diagram of a multi-joint robotic arm provided by a preferred embodiment of the present application.
  • FIG. 5 is a schematic diagram of a mechanical coordinate system and a joint coordinate system of a multi-joint manipulator provided by a preferred embodiment of the present application.
  • FIG. 6 is a schematic diagram of a probe coordinate system and a Stewart calculation coordinate system of an ultrasonic detection device according to a preferred embodiment of the present application.
  • the ultrasonic positioning puncture system and storage medium provided by the present application will be further described below.
  • FIG. 1 is a structural block diagram of an ultrasonic positioning and puncturing system provided by an embodiment of the present application.
  • the ultrasonic positioning and puncturing system includes a computer device 101 , a first serial robotic arm 102 , and a device mounted on the end of the first serial robotic arm 102 .
  • the ultrasonic detection device 103 and the computer equipment 101 are electrically connected to the first serial manipulator 102 and the ultrasonic detection device 103 respectively.
  • the computer equipment 101 includes a memory 1011 and a processor 1012, and the memory 1011 stores a computer program 10111.
  • FIG. 2 is a flowchart of the working method of the ultrasonic positioning and puncturing system provided by the embodiment of the present application. As shown in FIG. 2 , the processor 1012 executes the following steps S201 to S204 when running a computer program.
  • Step S201 Locating the first position information of the target point in the ultrasonic detection plane projected by the ultrasonic detection device.
  • the ultrasonic detection plane projected by the ultrasonic detection device 103 is usually in the shape of a fan, and the fan center of the fan is the starting point of the ultrasonic generation.
  • the ultrasonic detection is sent at the fan center and the echoes reflected by the substance are received to detect the target position in the ultrasonic detection plane.
  • the first serial machine equipped with the ultrasonic detection device 103 The arm 102 needs to move the ultrasonic detection device 103 to a position near the target point.
  • the movement amount of each joint of the first serial robotic arm 102 will change. It is called the second attitude information.
  • the first serial robotic arm includes a plurality of joints, the plurality of joints include: a rotation joint and/or a movement joint, and the second posture information includes motion amount information of each joint.
  • the ultrasonic detection device is rotatably connected to the end of the first serial robotic arm 102, and the ultrasonic detection plane is formed at the end of the ultrasonic detection device and extends from the end of the ultrasonic detection device along the sector; ultrasonic detection The plane rotates following the ultrasonic detection device, and the rotation axis of the ultrasonic detection plane passes through the end point; the first attitude information includes the rotation angle of the ultrasonic detection plane.
  • the ultrasonic detection plane is irradiated toward the target point.
  • the ultrasonic detection device 103 is rotated along the symmetry axis of the fan plane. , the ultrasonic detection plane rotates accordingly, so as to realize the target detection in the truncated or conical space area, and the ultrasonic image of each ultrasonic detection plane will be displayed on the electronic screen in real time.
  • the position of the target point in the real ultrasound detection plane can be determined from the position of the target point in the ultrasound image, which is the first position information.
  • the calibration parameters of the device determine the first position information of the target point in the ultrasonic detection plane projected by the ultrasonic detection device.
  • the calibration parameters of the ultrasonic detection device include, but are not limited to, at least one of the following: the number of array elements, the radius of curvature, the width of the linear array, the field of view (FOV), and the like.
  • the first position information may be represented in the form of Cartesian coordinates or polar coordinates.
  • the first position information includes the distance of the target point relative to the end point, and the angle between the connecting line between the target point and the end point and the rotation axis.
  • Step S202 Acquire first attitude information of the ultrasonic detection plane and second attitude information of the first serial manipulator.
  • Step S203 According to the first attitude information and the second attitude information, determine the position conversion relationship between the reference coordinate system of the ultrasonic positioning puncture system and the coordinate system where the ultrasonic detection plane is located.
  • Step S204 Determine the second position information of the target point in the reference coordinate system according to the position conversion relationship and the first position information.
  • the conversion relationship between any point on the ultrasonic detection plane and the reference coordinate system is determined. Therefore, according to the first attitude information and the second attitude information, can determine the position conversion relationship between the reference coordinate system of the ultrasonic positioning puncture system and the coordinate system where the ultrasonic detection plane is located, and then according to the position conversion relationship and the first position information, it can be determined that the target point is in the reference coordinate system.
  • the second position information of realizes the positioning of the target point in the reference coordinate system.
  • step S201 may also be performed after step S202 or step S203.
  • determining the position conversion relationship between the reference coordinate system of the ultrasonic positioning puncture system and the coordinate system where the ultrasonic detection plane is located includes the following steps.
  • Step S203-1 When the first serial manipulator is in the initial state, establish the reference coordinate system of the first serial manipulator and the joint coordinate system of each joint of the first serial manipulator, and when the ultrasonic detection device is in the initial state, The probe coordinate system is established with the end point of the ultrasonic detection device as the coordinate origin.
  • Step S203-2 Obtain the reference coordinate system of the first serial manipulator and the DH parameters of the joint coordinate system of each joint of the first serial manipulator, and determine the reference coordinate system of the first serial manipulator to the first serial manipulator according to the DH parameter.
  • Step S203-3 Obtain the position information of the coordinate origin of the probe coordinate system in the joint coordinate system of the terminal joint, and the attitude angle of the probe coordinate system relative to the joint coordinate system of the terminal joint, and according to the position information, attitude angle and the first A position conversion relationship, which determines a second position conversion relationship between the reference coordinate system and the probe coordinate system.
  • Step S203-4 Obtain the rotation angle of the ultrasonic detection plane, and determine a third position conversion relationship between the coordinate system where the ultrasonic detection plane is located and the probe coordinate system according to the rotation angle.
  • Step S203-5 According to the second position conversion relationship and the third position conversion relationship, determine the position conversion relationship between the reference coordinate system of the ultrasonic positioning and puncturing system and the coordinate system where the ultrasonic detection plane is located.
  • step S203-2 aims to determine the first position conversion relationship between the reference coordinate system of the first serial manipulator and the joint coordinate system of the end joint of the first serial manipulator.
  • this embodiment provides a coordinate conversion method for a multi-joint manipulator, which is applied to a manipulator including a rotating joint and a moving joint, and these rotating joints and moving joints are sequentially connected in series .
  • the number of rotating joints and moving joints can be set according to the required degrees of freedom and motion range, that is, the number of rotating joints and moving joints can be one or more.
  • FIG. 3 is a flowchart of a coordinate conversion method for a multi-joint robotic arm according to an embodiment of the present application. As shown in FIG. 3 , the flowchart includes the following steps S301 to S303 .
  • Step S301 When the robot arm is in an initial state, a mechanical coordinate system of the robot arm and a joint coordinate system of each joint of the robot arm are established.
  • the control of the manipulator is usually based on DH parameters for coordinate system transformation, and DH parameters include traditional DH parameters and improved DH parameters.
  • Two connected joints are adjacent joints.
  • the transformation of the joint coordinate system of two adjacent joints is usually represented by a DH parameter or an improved DH parameter.
  • a DH parameter as an example, two adjacent joint coordinate systems can overlap each other by rotating ⁇ around the Z axis and translating d, and then rotating ⁇ around the X axis and translating a.
  • ⁇ , d, ⁇ and a are DH parameters. It can be seen from this that the simpler the DH parameter is, the simpler the transformation of two adjacent joint coordinate systems will be.
  • the Z axis of the joint coordinate system of the rotating joint is set along the rotation axis
  • the Z axis of the joint coordinate system of the moving joint is set along the moving direction
  • the mechanical coordinate system is the same as the joint coordinate system of each joint. It is a left-handed system or a right-handed system, and when the joint before the rotating joint is a moving joint, the origin of the joint coordinate system of the rotating joint coincides with the origin of the joint coordinate system of the moving joint.
  • the above-mentioned mechanical coordinate system can also be called a reference coordinate system or a world coordinate system.
  • the mechanical coordinate system is usually set at the center of the base of the manipulator, and is located directly below the first joint of the multi-joint arm, which can make the mechanical coordinate system
  • the transformation relationship to the first joint is as simple as possible.
  • a rotary joint In a serial manipulator, in most cases, when a rotary joint receives a command with a rotation angle of 0 or 2 ⁇ , it may not be necessary to distinguish between the two, but it will not rotate according to a preset setting or rotate by 2 ⁇ in a set direction. However, in some cases, it is necessary to distinguish between these two corners. In the case where the 0 or 2 ⁇ rotation angle needs to be distinguished, the rotation angle of the Z axis in the DH parameter of the rotary joint is not 0 or 2 ⁇ , so as to avoid confusing the rotation angle of 0 or 2 ⁇ .
  • Step S302 Obtain the mechanical coordinate system of the manipulator and the DH parameters of the joint coordinate system of each joint of the manipulator, and determine the conversion between the mechanical coordinate system of the manipulator and the joint coordinate system of the end joint of the manipulator according to the DH parameters relation.
  • the DH parameters between adjacent joints can be obtained in turn, and according to the DH parameters, the conversion relationship between the mechanical coordinate system of the manipulator and the joint coordinate system of the end joint of the manipulator can be determined. .
  • the homogeneous transformation from the coordinates of the i-1th joint to the coordinates of the ith joint is constructed as a sequence with two rotations and two transformations, which can be expressed as follows using a matrix:
  • n is the total number of rotating joints and moving joints of the robotic arm.
  • the DH parameter of the first joint of the manipulator is the transformation of the coordinate system between the first joint and the mechanical coordinate system, which is recorded as Then the conversion relationship between the mechanical coordinate system and the joint coordinate system of the first joint:
  • the Nth joint is the end joint.
  • Step S303 Perform coordinate conversion between the mechanical coordinate system and the joint coordinate system of the end joint according to the conversion relationship.
  • step S302 It represents the coordinate conversion relationship between the mechanical coordinate system and the joint coordinate system of the end joint. According to the conversion relationship, the coordinate conversion between the mechanical coordinate system and the joint coordinate system of the end joint can be realized.
  • FIG. 4 is a schematic structural diagram of a multi-joint mechanical arm provided by a preferred embodiment of the present application.
  • the multi-joint mechanical arm shown in FIG. The moving joint 6 , the rotating joint 7 , the moving joint 8 , the rotating joint 9 and the moving joint 10 , in addition, the multi-joint robotic arm further includes a base 11 fixedly connected with the moving joint 1 .
  • the coordinate transformation method for a multi-joint robotic arm in this preferred embodiment includes steps 1 to 3, respectively corresponding to steps S301 to S303 in FIG. 3 .
  • Step 1 According to the rules of the world coordinate system, the mechanical coordinate system and the joint coordinate system of each joint are established at the base of the manipulator.
  • FIG. 5 is a schematic diagram of a mechanical coordinate system and a joint coordinate system of a multi-joint manipulator provided by a preferred embodiment of the present application.
  • the origin of the mechanical coordinate system F 0 -X 0 Y 0 Z 0 is fixed at the base of the robot arm, the Z 0 axis points from F 0 to the moving joint 1 , and the Y 0 axis points from the base F 0 Point to the robotic arm, and the X 0 axis points to conform to the right-handed coordinate system.
  • the origin L 1 of the joint coordinate system L 1 -X 1 Y 1 Z 1 of the mobile joint 1 is fixed on the mobile joint 1 , and the orientation of each coordinate axis is the same as that of the corresponding axis of the mechanical coordinate system.
  • the origin of the joint coordinate system R 2 -X 2 Y 2 Z 2 of the rotary joint 2 is fixed on the rotary joint 2 and coincides with L 1.
  • the Z 2 and Z 1 axes point in the same direction, the X 2 axis and the Y 2 axis The directions are opposite to the X 1 axis and Y 1 axis respectively.
  • the joint coordinate system L 3 -X 3 Y 3 Z 3 of the mobile joint 3 is fixed at the origin L 3 of the mobile joint 3, the Z 3 axis points from the L 1 point to the L 3 point, and the X 3 axis and the Y 3 axis are respectively connected with the X 2 Axis and Z 2 axis point the same.
  • the joint coordinate system R 4 -X 4 Y 4 Z 4 of the rotary joint 4 is fixed at the origin R 4 of the rotary joint 4 and coincides with the point L 3 (Fig. 5 is a clear indication of the joint coordinate system of the mobile joint 3 and the rotary joint 4).
  • the joint coordinate system of L 3 and R 4 are marked separately, the same below), the Z 4 axis points to the opposite direction to the Y 3 axis, initially, the X 4 axis and the Y 4 axis point to the X 3 axis and the Z 3 axis respectively. on the contrary.
  • the joint coordinate system R 5 -X 5 Y 5 Z 5 of the rotary joint 5 is fixed at the origin R 5 of the rotary joint 5.
  • the direction of the Z 5 axis and the Z 4 axis are the same. Initially, the X 5 axis and the Y 5 axis point respectively.
  • the X 4 -axis and Y 4 -axis point opposite.
  • the joint coordinate system L 6 -X 6 Y 6 Z 6 of the mobile joint 6 is fixed at the origin L 6 of the mobile joint 6.
  • the Z 6 axis points from the R 5 point to the L 6 point, and the X 6 axis and the Y 6 axis point to the X axis respectively.
  • the 5 -axis and the Z 5 -axis point the same.
  • the joint coordinate system R 7 -X 7 Y 7 Z 7 of the rotary joint 7 is fixed at the origin R 7 of the rotary joint 7 and coincides with the L 6 point. Initially, the Z 7 axis and the Y 7 axis point to the Y 6 axis respectively. The X 7 axis and the Z 6 axis point in the same direction, as opposed to the X 6 axis.
  • the origin of the joint coordinate system L 8 -X 8 Y 8 Z 8 of the mobile joint 8 is fixed on the mobile joint 8.
  • the Z 8 axis points from the L 8 point to the R 7 point, and the directions of the X 8 and Y 8 axes are respectively the same as The X 7 and Y 7 axes point the same.
  • the origin of the joint coordinate system R9 - X9Y9Z9 of the rotary joint 9 is fixed on the rotary joint 9 and coincides with the L8 point.
  • the direction of the Z9 axis is opposite to the direction of the Y8 axis.
  • the direction of the X 9 axis is opposite to the direction of the Z 8 axis, and the direction of the Y 9 axis is the same as the direction of the X8 axis.
  • the origin of the joint coordinate system L 10 -X 10 Y 10 Z 10 of the mobile joint 10 is fixed on the mobile joint 10.
  • the Z 10 axis points from the R 9 point to the L 10 point, and the X 10 axis and the Y 10 axis point respectively. The same point as the X 9 and Z 9 axes.
  • the length of F 0 R 2 is l 1
  • the length of R 2 R 4 is l 2
  • the length of R 4 R 5 is l 3
  • the length of R 5 R 7 is l 4
  • the length of R 7 R 9 is l 5
  • the length of R 9 L 10 is l 6
  • the points L 1 , R 2 , L 3 , R 4 , R 5 , L 6 and R 7 are located on the same horizontal plane.
  • Step 2 Obtain the DH parameters and calculate the conversion relationship from the mechanical coordinate system to the end joints of the multi-joint robotic arm.
  • DH parameters are shown in Table 1.
  • Table 1 in order to avoid confusing the rotation angles 0 and 2 ⁇ of the rotary joint, a deflection angle is added to the Z-axis rotation angle ⁇ of each rotary joint.
  • the Z-axis rotation angle of the rotary joint 2 is ⁇ + ⁇ 2 , where ⁇ 2 is the deflection angle.
  • a parallel platform can also be mounted on the end joint of the multi-joint manipulator shown in Figure 4.
  • the parallel platform includes a static platform, a moving platform, and a plurality of telescopic components arranged between the static platform and the moving platform.
  • the calculation coordinate system of the parallel platform It is completely coincident with the joint coordinate system of the end joint of the multi-joint mechanical arm, and the ultrasonic detection device is arranged on the moving platform.
  • the parallel platform in this embodiment can realize motion with multiple degrees of freedom.
  • the Stewart parallel platform includes a static platform, a moving platform, and a plurality of telescopic and retractable platforms arranged between the static platform and the moving platform.
  • the component can realize six degrees of freedom movement in space, namely displacement along the X axis, displacement along the Y axis, displacement along the Z axis, rotation around the X axis, rotation around the Y axis, and rotation around the Z axis.
  • the Stewart parallel platform is supported by 6 telescopic components. Compared with the passive arm using the cantilever beam structure in series, the rigidity is higher and the structure is stable.
  • the parallel structure Due to the high rigidity, the parallel structure has a higher self-weight or volume than the series structure. Carrying capacity.
  • the error at the end of the passive arm using the cantilever beam structure in series is the accumulation and amplification of the errors of each joint, so the error is large and the precision is low. Precision surgical operation.
  • the inverse solution of the parallel platform is very easy, and it is easy to obtain the motion posture of each telescopic component of the parallel platform according to the coordinate position.
  • the displacement of the master operator can be mapped to the slave user coordinate system by establishing the slave user coordinate system on the static platform, and then the slave user coordinate system can be used to map the displacement of the master operator into the slave user coordinate system.
  • the position information of the target position in the calculation coordinate system can be obtained by the conversion of the system and the calculation coordinate system. According to the position information, the motion posture of each telescopic assembly of the parallel platform can be easily obtained through the inverse solution.
  • the transformation matrix from the mth joint (containing the m degree of freedom) to the nth joint can be expressed as:
  • T trans_mach_st the transformation matrix from the Stewart calculation coordinate system to the mechanical coordinate system
  • Step 3 According to the transformation matrix and the inverse matrix of the transformation matrix, coordinate transformation between the mechanical coordinate system and the Stewart calculation coordinate system is performed.
  • the directions of the X, Y, and Z axes of the probe coordinate system and the directions of the X, Y, and Z axes of the joint coordinate system of the end joint are The directions are the same, and the Z axis of the probe coordinate system and the Z axis of the joint coordinate system of the end joint are collinear.
  • the directions of the X, Y, and Z axes of the probe coordinate system are the same as the directions of the X, Y, and Z axes of the moving platform coordinate system, and the Z axis of the probe coordinate system is the same.
  • the axis and the Z axis of the moving platform coordinate system are collinear.
  • FIG. 6 is a schematic diagram of a probe coordinate system and a Stewart calculation coordinate system of an ultrasonic detection device according to a preferred embodiment of the present application.
  • a rotary motor is arranged between the ultrasonic detection device and the Stewart moving platform, and the rotation angle of the motor is recorded as ⁇ m .
  • the end point of the ultrasonic detection device is located on the Z axis of the Stewart moving platform coordinate system. No matter what the value of ⁇ m is, the position of the end point of the ultrasonic detection device relative to the Stewart moving platform remains unchanged.
  • a probe coordinate system is established at the end of the ultrasonic detection device.
  • the origin of the probe coordinate system coincides with the end point of the probe, and the motion of the rotating motor between the Stewart moving platform and the ultrasonic detection device is ignored.
  • the XYZ axis of the probe coordinate system is always the same as the Stewart moving platform.
  • the XYZ axes of the coordinate system are parallel. That is, the rotation amount ⁇ m of the motor between the Stewart moving platform and the ultrasonic detection device is regarded as the movement of the ultrasonic detection plane relative to the probe coordinate system.
  • the establishment of the probe coordinate system is not unique, and it is not necessary to convert the rotation ⁇ m of the probe relative to the Stewart moving platform into the rotation of the ultrasonic detection plane relative to the probe coordinate system.
  • the motion of the ultrasound probe can be controlled by the master operator.
  • the amount of movement in the horizontal plane of the master manipulator is mapped to the tandem robotic arm.
  • the position C coord_det_st three-dimensional column vector
  • the attitude angle of the coordinate system of the probe relative to the coordinate system calculated by Stewart can be obtained (in is a fixed value)
  • the transformation matrix T trans_det_st from the probe coordinate system to the Stewart calculation coordinate system can be calculated:
  • R coord_det_st is the rotation matrix, using the attitude angle Expressed as:
  • the operator can control the mechanical arm with the ultrasonic detection device installed at the end through the main operator, so that the puncture target is located on the ultrasonic detection plane (sound beam plane).
  • the ultrasonic detection plane is a plane that passes through the end point of the ultrasonic detection device and is perpendicular to the XY plane of the probe coordinate system. At any point in the ultrasonic detection plane, the distance l c relative to the probe coordinate system and the included angle with the Z axis can be measured. ⁇ c .
  • C coord_tar_det [l c sin ⁇ c cos ⁇ m l c sin ⁇ c sin ⁇ m l c cos ⁇ c 1] T .
  • the coordinate C coord_tar_mach of the target point in the mechanical coordinate system can be obtained by coordinate transformation:
  • C coord_tar_mach T trans_mach_st T trans_st_det C coord_tar_det .
  • the ultrasonic positioning and puncturing system further includes a second serial robotic arm and a puncturing instrument mounted on the end of the second serial robotic arm; the computer equipment is also electrically connected to the second serial robotic arm, and the processor is running
  • the computer program also executes the following steps: taking the second position information of the target in the reference coordinate system as the target puncture point, and controlling the puncture instrument of the second serial robotic arm to puncture the target puncture point.
  • the coordinate C coord_tar_stl of the target point in the coordinate system calculated by Stewart of the puncture manipulator can be obtained by coordinate transformation:
  • T trans_stl_mach is the transformation matrix from the calculated coordinate system of the puncture manipulator Stewart to the calculated coordinate system.
  • the joint motion of the Stewart platform of the puncture manipulator can be calculated through the inverse kinematics of the Stewart parallel platform. Arm for precise puncture.
  • the end of the first serial robotic arm is equipped with an ultrasonic detection device
  • the end of the second serial robotic arm is equipped with a puncture instrument
  • the execution of the puncture and ablation operation is completed by the cooperation of the two robotic arms, and the first serial
  • the arm holds the ultrasound probe, scans the surface of the human body to find the lesions, and locates the puncture target, which can achieve precise positioning of the target.
  • the second serial robotic arm holds the ablation needle and performs puncture and ablation on the target point, which can achieve precise puncture of the target point.
  • the embodiments of the present application further provide a computer-readable storage medium for implementation.
  • a computer program is stored on the computer-readable storage medium; the computer program is configured to perform the following steps when executed.
  • S1 The first position information of the target point is located in the ultrasonic detection plane projected by the ultrasonic detection device.
  • S2 Acquire the first attitude information of the ultrasonic detection plane and the second attitude information of the first serial manipulator.
  • S4 Determine the second position information of the target point in the reference coordinate system according to the position conversion relationship and the first position information.
  • locating the first position information of the target point in the ultrasonic detection plane projected by the ultrasonic detection device includes: acquiring an ultrasonic image collected by the ultrasonic detection device, and locating the position information of the target point in the ultrasonic image; The position information of the point in the ultrasonic image and the calibration parameters of the ultrasonic detection device determine the first position information of the target point in the ultrasonic detection plane projected by the ultrasonic detection device.
  • the first position information includes the distance of the target point relative to the end point, and the angle between the connecting line between the target point and the end point and the rotation axis.
  • determining the position conversion relationship between the reference coordinate system of the ultrasonic positioning and puncturing system and the coordinate system where the ultrasonic detection plane is located includes: when the first serial robotic arm is in an initial state , establish the reference coordinate system of the first serial manipulator and the joint coordinate system of each joint of the first serial manipulator, and when the ultrasonic detection device is in the initial state, establish the probe coordinate system with the end point of the ultrasonic detection device as the coordinate origin; Obtain the reference coordinate system of the first serial manipulator and the DH parameters of the joint coordinate system of each joint of the first serial manipulator, and determine the reference coordinate system of the first serial manipulator to the end of the first serial manipulator according to the DH parameters
  • the first position conversion relationship between the joint coordinate systems of the joints obtain the position information of the coordinate origin of the probe coordinate system in the joint coordinate system of the end joint, and the attitude angle of the probe coordinate system relative to the joint coordinate system of the end joint, and According to the position information, the attitude angle
  • the first serial manipulator includes a rotating joint and a moving joint
  • the Z axis of the joint coordinate system of the rotating joint is set along the rotating axis
  • the Z axis of the joint coordinate system of the moving joint is set along the moving direction
  • the reference coordinate system The joint coordinate system of each joint is the same as the left-handed or right-handed system, and when the rotary joint is connected to the previous mobile joint, the origin of the joint coordinate system of the rotary joint coincides with the origin of the joint coordinate system of the previous mobile joint .
  • the directions of the X, Y, and Z axes of the probe coordinate system are the same as the directions of the X, Y, and Z axes of the joint coordinate system of the end joint, and the Z axis of the probe coordinate system and the joint coordinates of the end joint
  • the Z axis of the system is collinear.
  • the computer program is further configured to execute the following steps when running: using the second position information of the target point in the reference coordinate system as the target puncture point, and controlling the puncture instrument of the second serial robotic arm to puncture the target puncture point Perform puncture.

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Medical Informatics (AREA)
  • Pathology (AREA)
  • Veterinary Medicine (AREA)
  • Engineering & Computer Science (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Public Health (AREA)
  • Molecular Biology (AREA)
  • General Health & Medical Sciences (AREA)
  • Animal Behavior & Ethology (AREA)
  • Biophysics (AREA)
  • Physics & Mathematics (AREA)
  • Radiology & Medical Imaging (AREA)
  • Ultra Sonic Daignosis Equipment (AREA)

Abstract

L'invention concerne un système de ponction à positionnement par ultrasons et un support de stockage. Le système de ponction à positionnement par ultrasons comprend un dispositif informatique (101), un premier bras mécanique série (102) et un appareil de détection par ultrasons (103). Le dispositif informatique (101) comprend un processeur (1012) et, lors de l'exécution d'un programme informatique, le processeur (1012) exécute les étapes suivantes consistant à : acquérir des premières informations d'orientation d'un plan de détection par ultrasons, des secondes informations d'orientation du premier bras mécanique série (102) et des premières informations de position d'un point cible dans le plan de détection par ultrasons ; déterminer, en fonction des premières informations d'orientation et des secondes informations d'orientation, la relation de conversion de position entre un système de coordonnées de référence du système de ponction à positionnement par ultrasons et un système de coordonnées dans lequel se situe le plan de détection par ultrasons (S203) ; et déterminer, en fonction de la relation de conversion de position et des premières informations de position, des secondes informations de position du point cible dans le système de coordonnées de référence (S204), ce qui permet d'améliorer la précision d'une intervention de ponction.
PCT/CN2020/141231 2020-12-30 2020-12-30 Système de ponction à positionnement par ultrasons et support de stockage WO2022141153A1 (fr)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/141231 WO2022141153A1 (fr) 2020-12-30 2020-12-30 Système de ponction à positionnement par ultrasons et support de stockage

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/141231 WO2022141153A1 (fr) 2020-12-30 2020-12-30 Système de ponction à positionnement par ultrasons et support de stockage

Publications (1)

Publication Number Publication Date
WO2022141153A1 true WO2022141153A1 (fr) 2022-07-07

Family

ID=82258797

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/141231 WO2022141153A1 (fr) 2020-12-30 2020-12-30 Système de ponction à positionnement par ultrasons et support de stockage

Country Status (1)

Country Link
WO (1) WO2022141153A1 (fr)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115005991A (zh) * 2022-08-03 2022-09-06 北京壹点灵动科技有限公司 手术导航装置的精度检测方法及手术导航精度检测装置
CN115252131A (zh) * 2022-08-12 2022-11-01 上海精劢医疗科技有限公司 手术工具的位姿信息校正方法
CN115556109A (zh) * 2022-10-24 2023-01-03 深圳市通用测试系统有限公司 一种测试系统中机械臂的定位方法和装置
CN116077155A (zh) * 2023-04-06 2023-05-09 深圳惟德精准医疗科技有限公司 基于光学追踪设备和机械臂的穿刺方法及相关装置
CN117481682A (zh) * 2023-09-12 2024-02-02 中山大学 彩超探头的遥控方法和装置、系统、电子设备及介质

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030187345A1 (en) * 2002-03-27 2003-10-02 Aloka Co., Ltd. Ultrasonic medical system
US20170055940A1 (en) * 2014-04-28 2017-03-02 Mazor Robotics Ltd. Ultrasound guided hand held robot
CN109701169A (zh) * 2018-12-27 2019-05-03 成植温 一种机械臂穿刺的肿瘤治疗系统
CN110200683A (zh) * 2019-07-03 2019-09-06 北京积水潭医院 超声引导下穿刺姿态监测方法及装置
CN111227943A (zh) * 2020-01-23 2020-06-05 诺创智能医疗科技(杭州)有限公司 手术机械臂的控制方法、计算机设备及一种手术机械臂
CN111437011A (zh) * 2020-03-30 2020-07-24 中国科学院深圳先进技术研究院 一种穿刺手术机器人系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030187345A1 (en) * 2002-03-27 2003-10-02 Aloka Co., Ltd. Ultrasonic medical system
US20170055940A1 (en) * 2014-04-28 2017-03-02 Mazor Robotics Ltd. Ultrasound guided hand held robot
CN109701169A (zh) * 2018-12-27 2019-05-03 成植温 一种机械臂穿刺的肿瘤治疗系统
CN110200683A (zh) * 2019-07-03 2019-09-06 北京积水潭医院 超声引导下穿刺姿态监测方法及装置
CN111227943A (zh) * 2020-01-23 2020-06-05 诺创智能医疗科技(杭州)有限公司 手术机械臂的控制方法、计算机设备及一种手术机械臂
CN111437011A (zh) * 2020-03-30 2020-07-24 中国科学院深圳先进技术研究院 一种穿刺手术机器人系统

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115005991A (zh) * 2022-08-03 2022-09-06 北京壹点灵动科技有限公司 手术导航装置的精度检测方法及手术导航精度检测装置
CN115252131A (zh) * 2022-08-12 2022-11-01 上海精劢医疗科技有限公司 手术工具的位姿信息校正方法
CN115556109A (zh) * 2022-10-24 2023-01-03 深圳市通用测试系统有限公司 一种测试系统中机械臂的定位方法和装置
CN115556109B (zh) * 2022-10-24 2024-06-11 深圳市通用测试系统有限公司 一种测试系统中机械臂的定位方法和装置
CN116077155A (zh) * 2023-04-06 2023-05-09 深圳惟德精准医疗科技有限公司 基于光学追踪设备和机械臂的穿刺方法及相关装置
CN116077155B (zh) * 2023-04-06 2023-06-27 深圳惟德精准医疗科技有限公司 基于光学追踪设备和机械臂的手术导航方法及相关装置
CN117481682A (zh) * 2023-09-12 2024-02-02 中山大学 彩超探头的遥控方法和装置、系统、电子设备及介质
CN117481682B (zh) * 2023-09-12 2024-04-09 中山大学 彩超探头的遥控方法和装置、系统、电子设备及介质

Similar Documents

Publication Publication Date Title
WO2022141153A1 (fr) Système de ponction à positionnement par ultrasons et support de stockage
CN112754616B (zh) 超声定位穿刺系统和存储介质
CN114041875B (zh) 一种一体式手术定位导航系统
CN113133832B (zh) 一种双臂机器人穿刺系统标定方法及系统
WO2022218389A1 (fr) Procédé, dispositif et système d'opération d'exécution combinée par ultrasons et rayons x, et support de stockage lisible par ordinateur
CN113288429A (zh) 一种乳腺微创介入手术机器人空间配准与实时导航方法
JP7383489B2 (ja) ロボット的装置ガイドと音響プローブの統合
CN113940755A (zh) 一种术像一体的外科手术规划与导航方法
CN113180828B (zh) 基于旋量理论的手术机器人约束运动控制方法
CN113400325A (zh) 一种种植牙机器人导航定位方法
WO2022141138A1 (fr) Procédé de mappage maître-esclave hybride, système de bras robotique et dispositif informatique
CN111603205A (zh) 用于穿刺手术机器人ct舱内三维影像重建和定位分析系统
CN113974835A (zh) 一种基于远心不动点约束的手术机器人运动控制方法
CN115500940A (zh) 手术针的定位显示方法及相关装置
CN113456220B (zh) 对准方法、手术机器人及计算机存储介质
CN116269812A (zh) 主从操作的穿刺系统和规划方法
WO2022198615A1 (fr) Procédé et système d'étalonnage pour système de ponction de robot à deux bras
Onogi et al. Robotic ultrasound guidance by B-scan plane positioning control
CN112107366B (zh) 一种混合现实超声导航系统
Azimi et al. Teleoperative control of intraocular robotic snake: Vision-based angular calibration
WO2021012142A1 (fr) Système de robot chirurgical et son procédé de commande
CN117084790B (zh) 一种穿刺方位控制方法、装置、计算机设备、存储介质
Tseng et al. Image‐guided robotic navigation system for neurosurgery
CN116919596B (zh) 器械导航方法、系统、装置、设备和存储介质
CN117084791B (zh) 一种穿刺方位解算方法以及穿刺作业执行系统

Legal Events

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

Ref document number: 20967498

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20967498

Country of ref document: EP

Kind code of ref document: A1