A method for positioning a robotic arm trolley

By planning the target channel and using the robot arm kinematic adjustment, the problem of inaccurate placement of the robot arm trolley was solved, ensuring that the end tool reaches the target and is within the visual range of the optical tracking system, improving the smoothness and accuracy of the operation.

CN119818189BActive Publication Date: 2025-09-12NANJING TUODAO MEDICAL TECHNOLOGY CO LTD
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202411931543.5
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-12-26
Publication Date
2025-09-12
Estimated Expiration
2044-12-26

AI Technical Summary

Technical Problem

During spinal surgery, the placement of the robotic arm trolley depends on the experience of medical staff, resulting in failure to reach the target position or the end tracer being out of the visual range of the optical tracking system, affecting the smoothness and accuracy of the operation.

Method used

By acquiring medical images to plan the target channel, calculating the transformation relationship between the robotic arm trolley and the patient tracer, and combining it with the optical tracking system positioning, the robotic arm forward and inverse kinematics are used to adjust the trolley position to ensure that the end tool can reach the target channel and is within the visual range of the optical tracking system.

Benefits of technology

Accurate positioning of the robotic arm trolley is achieved, eliminating the need to frequently move the trolley or adjust the optical tracking system, ensuring smooth surgery and execution accuracy, and reducing surgical time.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119818189B_ABST
    Figure CN119818189B_ABST
Patent Text Reader

Abstract

The present invention discloses a method for positioning a manipulator trolley, comprising: (1) obtaining the transformation relationship between all planned target channels and patient tracers; (2) setting the patient tracer as a relative static point and the manipulator trolley as a relative action point, and adjusting the relative distance between the two according to a set step length; (3) calculating the transformation relationship between each target channel and the adjusted manipulator base; (4) judging whether each target channel is reachable through manipulator inverse kinematics; if so, proceeding to step (5); otherwise, returning to step (2); (5) judging whether the end tracer is within the visual range of the optical tracking system when the manipulator executes to the reachable position of each target channel; if so, obtaining the target positioning; otherwise, returning to step (2). The present invention can accurately complete the positioning of the manipulator trolley without frequently moving the manipulator trolley or adjusting the position of the optical tracking system, thereby ensuring execution accuracy.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot navigation technology, and in particular to a robot arm trolley positioning method. Background Art

[0002] Currently, for spinal surgery, the placement of the robotic trolley during surgery is heavily dependent on the operating experience of medical staff. If the robotic trolley is not placed properly, the following two problems may occur:

[0003] 1. The robotic arm may not be able to reach the target position, and the operation cannot continue, resulting in the need for medical staff to frequently move the robotic arm trolley, and the medical staff do not know the moving direction of the trolley;

[0004] 2. When the robotic arm is in place, the end tracer is not within the visual range of the optical tracking system. At this time, medical staff need to frequently adjust the position of the optical tracking system, which affects the execution accuracy.

[0005] Among the above problems, the process of moving the trolley and adjusting the optical tracker is time-consuming and labor-intensive, seriously affecting the operating experience of medical staff and the smoothness of the surgical process, and even having a negative impact on the quality of the surgery. Summary of the Invention

[0006] Purpose of the invention: In response to the above-mentioned shortcomings, the present invention proposes a method for positioning a robotic arm trolley, which can accurately complete the positioning of the robotic arm trolley without the need to frequently move the robotic arm trolley, thereby ensuring the smooth progress of the operation and eliminating the need for medical staff to adjust the position of the optical tracking system, thereby reducing the operation time and ensuring execution accuracy.

[0007] Technical solution:

[0008] The present invention provides a method for positioning a robotic arm trolley, comprising:

[0009] (1) Obtain a medical image containing the surgical area, plan several target channels in the surgical area in the medical image, and calculate the transformation relationship between all planned target channels and the patient tracer installed in the patient's surgical area;

[0010] (2) Set the patient tracer as the relative static point and the robotic arm trolley as the relative action point, and adjust the relative distance between the two according to the set step length;

[0011] (3) Positioning the end tracer through the optical tracking system, and calculating the transformation relationship between the adjusted manipulator base of the manipulator trolley and the optical tracking system according to the forward kinematics of the manipulator, thereby combining the calculation in step (1) to obtain the transformation relationship between each target channel and the adjusted manipulator base;

[0012] (4) Based on the transformation relationship obtained in step (3), determine whether all target channels are reachable through the inverse kinematics of the manipulator. If they are all reachable, go to step (5); otherwise, return to step (2);

[0013] (5) Determine whether the end tracer is within the visual range of the optical tracking system when the robot arm reaches the reachable position of each target channel;

[0014] If the end tracer is within the visual range of the optical tracking system at this time, the corresponding robotic arm trolley position is used as the target position; otherwise, return to step (2).

[0015] Specifically, in step (4), the determination of whether all target channels are reachable is as follows:

[0016] (41) According to the transformation relationship obtained in step (3), each target channel is raised along its axis by a set distance, and the transformation relationship between the end tool and the robot arm base is calculated;

[0017] (42) According to the set rotation step size, the navigation angle of the end tool is traversed, and according to the inverse kinematics of the manipulator, it is determined whether there is a non-singular inverse solution for the transformation relationship between the end tool and the manipulator base at the corresponding navigation angle; if there is an inverse solution, the target channel is considered to be reachable, otherwise it is considered to be unreachable;

[0018] S43, repeat step (42), and traverse to determine whether all target channels are reachable.

[0019] More specifically, in step (42), the navigation angle range of the end tool is 360°, and the set rotation step is 2°.

[0020] More specifically, step (5) includes:

[0021] (51) according to the transformation relationship between the end tool and the robot arm base obtained in step (41) and the reachable angle obtained in step (42), combined with the transformation relationship between the end tracer and the robot arm base, the transformation relationship between the end tracer and the robot arm base when in the reachable position is calculated;

[0022] (52) combining step (3) and step (51), calculating the transformation relationship between the end tracer and the optical tracking system when the end tool is located at the reachable position;

[0023] (53) When the end tool is located at the reachable position, the transformation relationship between the end tracer and the optical tracking system obtained in step (52) is used to calculate the angle between the normal vector of the end tracer and the normal vector of the optical tracking system. If the angle is less than 90°, the end tracer is considered to be within the visible range of the optical tracking system; otherwise, the end tracer is considered to be outside the visible range of the optical tracking system.

[0024] Specifically, the transformation relationship between the manipulator base of the adjusted manipulator trolley and the optical tracking system is obtained according to the forward kinematics calculation of the manipulator, which is specifically:

[0025] After each distance adjustment, the transformation relationship between the end of the manipulator and the base of the manipulator is calculated through the forward kinematics of the manipulator. The transformation relationship between the end of the manipulator and the end tracer is calculated based on the installation parameters of the end of the manipulator and the end tracer. The transformation relationship between the end tracer and the optical tracking system is calculated by positioning the end tracer through the optical tracking system.

[0026] Through the above conversion relationship, the conversion relationship between the adjusted robotic arm base of the robotic arm trolley and the optical tracking system is calculated.

[0027] Specifically, in step (2), the robotic arm trolley is adjusted in two orthogonal directions according to a set step size within the adjustable range of the robotic arm trolley.

[0028] More specifically, the adjustable range of the robotic arm trolley is a square range with a length of 130 cm and a width of 50 cm formed on the side of the operating table near the patient's feet. The wide side of the square range is 30 cm and 100 cm away from the tail side of the operating table near the patient's feet, respectively, and the long side is 50 cm and 100 cm away from the side of the operating table, respectively; accordingly, the step length is set to 10 cm.

[0029] Specifically, the step (1) includes:

[0030] (11) Obtaining a medical image containing the surgical area, and obtaining the transformation relationship between the patient tracer and the medical image through registration calculation;

[0031] (12) according to the positions of several target channels planned in the medical image, obtaining the transformation relationship between each target channel and the medical image;

[0032] (13) Calculating the transformation relationship between each target channel and the patient tracer based on the transformation relationship between the patient tracer and the medical image obtained in step (11) and the transformation relationship between each target channel and the medical image obtained in step (12).

[0033] More specifically, in step (11), the registration calculation process is completed by calibrating the tooling.

[0034] More specifically, the registration calculation process is completed by the calibration tool, specifically as follows:

[0035] The patient tracer is identified and positioned by the optical positioning system to obtain a transformation relationship between the patient tracer and the optical tracking system;

[0036] Positioning a calibration fixture placed on the patient through an optical tracking system, and identifying the calibration fixture in the medical image, and calculating a transformation relationship between the medical image and the optical tracking system;

[0037] In summary, the transformation relationship between the patient tracer and the medical image is calculated.

[0038] Beneficial Effects: The present invention continuously adjusts the position of the robotic arm trolley during positioning. After each adjustment, it determines whether the end tool on the end of the robotic arm of the robotic arm trolley can reach each target channel. When the robotic arm reaches each target channel, it determines whether the guide on the end of the robotic arm is within the visual range of the optical tracking system. This allows accurate positioning of the robotic arm trolley, eliminating the need for frequent movement of the robotic arm trolley and ensuring smooth surgical progress. In addition, medical staff no longer need to adjust the position of the optical tracking system, reducing surgical time and ensuring execution accuracy. BRIEF DESCRIPTION OF THE DRAWINGS

[0039] In order to more clearly illustrate the technical solutions in the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are merely embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0040] Figure 1 This is a schematic diagram of the scene where the robotic arm trolley is positioned;

[0041] Figure 2 This is a flow chart of the robot arm trolley positioning;

[0042] Figure 3 It is a position relationship diagram of the target end tool and the channel;

[0043] Figure 4 It is a flowchart for calculating the reachability of the target channel;

[0044] Figure 5 This is a flow chart for determining whether the terminal tracer is visible.

[0045] Among them, 10 is the optical tracking system, 20 is the operating table, 30 is the patient, 31 is the patient's skin, 32 is the patient's vertebra, 40 is the patient's tracer, 50 is the target channel area, 51 is the channel entry point, 52 is the channel exit point, 60 is the robotic arm trolley, 61 is the robotic arm, 62 is the end guide, and 70 is the target position. DETAILED DESCRIPTION

[0046] In order to make the objectives, technical solutions and advantages of the present invention more clearly understood, the present application is further described in detail below in combination with specific embodiments and with reference to the accompanying drawings.

[0047] It should be noted that, unless otherwise defined, the technical or scientific terms used in the embodiments of the present invention should have the usual meanings understood by persons with ordinary skills in the field to which the present invention belongs. "Include" or "comprising" and similar words mean that the elements or objects preceding the word include the elements or objects listed after the word and their equivalents, without excluding other elements or objects. "Connect" or "connected" and similar words are not limited to physical or mechanical connections, but can include electrical connections, whether direct or indirect.

[0048] The scene of the robot arm trolley positioning of the present invention is as follows Figure 1 As shown, the optical tracking system 10 is placed on the side of the operating table 20, the patient 30 is placed on the operating table 20, and the patient tracker 40 is installed in the surgical area of ​​the patient 30; the robot arm trolley 60 is movable within the set range on the side of the operating table 20, as shown in FIG. Figure 1 In the box on the lower left side of the middle operating table 20 , an end tool 62 is installed at the end of a robotic arm 61 of a robotic arm trolley 60 , and an end tracer is installed on the end tool 62 .

[0049] In the present invention, the optical tracking system 10 can be placed on the side of the operating table 20 close to the patient's head to obtain the position and posture of the patient tracer 40 and the end tracer in real time, thereby providing position and posture navigation for the robotic arm 601.

[0050] In the present invention, the surgical area of ​​the patient 30 includes the patient's spine, that is, the patient tracer 40 is fixed on the patient's spine.

[0051] In the present invention, the robotic arm trolley 60 is movably arranged on the left or right side of the operating table 20. The setting range size on the side of the operating table 20 can be set to m×n, where m represents the maximum distance from the edge of the operating table and n represents the maximum distance from the edge of the operating table close to the patient's feet. In a specific embodiment of the present invention, m can be 70 cm and n can be 50 cm.

[0052] The process of the robot arm trolley positioning method of the present invention is as follows: Figure 2 Shown, including:

[0053] S1. Acquire a medical image containing a surgical procedure area, plan several target channels in the surgical procedure area in the medical image, and calculate the transformation relationship between all planned target channels and the patient's tracer;

[0054] In the present invention, the acquired medical images containing the surgical area are generally three-dimensional images, including CT images, CBCT images, and the like.

[0055] Specifically, the steps include:

[0056] S11, obtaining a medical image containing a surgical area such as a spine, and obtaining a transformation relationship between the patient's tracer and the medical image through registration calculation;

[0057] In the present invention, the coordinate system C corresponding to the patient tracer can be calculated by registration. p Relative to the image coordinate system C corresponding to the medical image i The transformation matrix

[0058] In the present invention, the registration calculation process can be completed by a calibration tool. Specifically, the patient tracer can be recognized by the optical tracking system, so the transformation relationship between the patient tracer and the optical tracking system can be obtained; at the same time, the calibration tool is installed near the surgical area (such as above the lesion), which can be visualized in the medical image and recognized by the optical tracking system at the same time, so the transformation relationship between the medical image and the optical tracking system can be established. Based on the transformation relationship between the patient tracer and the medical image relative to the optical tracking system, both are under the reference of the optical tracking system, so the transformation relationship between the patient tracer and the medical image can be determined, that is, the coordinate system C corresponding to the patient tracer can be obtained. p Relative to the image coordinate system C corresponding to the medical image i The transformation matrix

[0059] S12. The medical staff plans several target channels in the medical image, and obtains the transformation relationship between each target channel and the medical image according to the position of the target channels in the medical image;

[0060] In the present invention, medical personnel plan several target channels in the medical image, and obtain the position of the target channel in the medical image by establishing the corresponding channel coordinate system C according to the target channel. c .

[0061] As one of the implementation methods, refer to Figure 3 , the entry point 51 of the target channel is the channel coordinate system C c The origin of the channel, the direction from the entry point 51 to the exit point 52 is set as the channel coordinate system C cThe z-axis of each target channel is determined by the right-hand rule, and the x-axis and y-axis are determined to obtain the coordinate system C of each target channel. c Relative to the image coordinate system C i The transformation matrix That is, the transformation relationship between each target channel and the medical image;

[0062] S13, based on the transformation relationship between the patient tracer and the medical image obtained in S11 and the transformation relationship between each target channel and the medical image obtained in S12, the transformation relationship between each target channel and the patient tracer can be calculated;

[0063] Specifically, the patient tracer coordinate system C obtained in S11 is p Relative to the image coordinate system C i The transformation matrix The coordinate system C of each target channel obtained by S12 c Relative to the image coordinate system C i The transformation matrix Multiply them together to get the coordinate system C of each target channel c Relative to the patient tracer coordinate system C p The transformation matrix

[0064]

[0065] S2. Set the patient tracer as the relative static point and the robotic arm trolley as the relative action point, and adjust the relative distance between the two according to the set step length;

[0066] In the present invention, a plane coordinate system can be established on a horizontal plane, with the patient tracer 40 as the origin O, and the position of the robotic arm trolley can be adjusted according to a set step length along the coordinate axis direction of the plane coordinate system.

[0067] In the present invention, reference is made to Figure 1 The adjustable range of the robotic arm trolley is set within the range in the lower left corner of the figure. The plane coordinate system established on the horizontal plane can take the patient tracer as the origin, the head and feet direction of the human body as the x-axis, and the left and right direction of the human body as the y-axis. The displacement of the robotic arm trolley is reflected in the coordinate system of the patient tracer 40. The setting range of the displacement is [-100cm, -30cm] in the x-axis direction and [50cm, 100cm] in the y-axis direction; accordingly, the step lengths in the x- and y-axis directions are both set to 10cm.

[0068] S3. Positioning the end tracer through the optical tracking system, and calculating the transformation relationship between the manipulator base and the optical tracking system after the manipulator trolley adjusts its position according to the manipulator forward kinematics;

[0069] Specifically, each time the position of the robotic arm trolley is adjusted, the end tracer is positioned by the optical tracking system to obtain the end tracer coordinate system C e Transformation matrix relative to the optical tracking system It is known that the flange coordinate system C corresponding to the end flange of the robotic arm can be calculated through the forward kinematics of the robotic arm. f Relative to the base coordinate system C corresponding to the robotic arm base b The transformation matrix Calculate the flange coordinate system C according to the installation parameters of the end flange of the manipulator and the end tracer f The end tracer coordinate system C corresponding to the end tracer e The transformation matrix Through the above transformation relationship, the base coordinate system C can be calculated b Transformation matrix relative to the optical tracking system as follows:

[0070]

[0071] That is, the adjusted robotic arm base is transformed to the optical tracking system, and the transformation relationship between the robotic arm base after adjustment of the robotic arm trolley and the optical tracking system is obtained.

[0072] S4. Positioning the patient tracer through the optical tracking system, combining the transformation relationships between all planned target channels and the patient tracer obtained in S1 and the transformation relationship between the robotic arm base and the optical tracking system obtained in S3, and calculating the transformation relationship between each target channel and the robotic arm base;

[0073] By positioning the patient tracer through the optical tracking system, the patient tracer coordinate system C can be obtained. p Transformation matrix relative to the optical tracking system Combined with S1, the coordinate system C of each target channel is obtained c Relative to the patient tracer coordinate system C p The transformation matrix and the base coordinate system C obtained by S3 b Transformation matrix relative to the optical tracking system The coordinate system C of each target channel can be calculated c Equivalent to the base coordinate system C b The transformation matrix as follows:

[0074]

[0075] That is, the pose of each target channel in the patient tracer coordinate system is transformed into the adjusted robotic arm base coordinate system, that is, the transformation relationship between each target channel and the adjusted robotic arm base of the robotic arm trolley is obtained.

[0076] S5. Based on the transformation relationship between each target channel and the robot base obtained in S4, determine whether each target channel is reachable through the inverse kinematics of the robot. If so, go to S6; otherwise, return to S2.

[0077] The requirement for the target channel to be accessible is that before nail placement, the axis of the end tool on the robot arm must move to coincide with the axis of the target channel. Specifically, refer to Figure 4 , including the steps of:

[0078] S51, based on the transformation relationship between each target channel and the robot arm base obtained in S4, each target channel is raised by a set distance along its axis direction, and the transformation relationship between the end tool and the robot arm base is calculated;

[0079] In this invention, to prevent the end tool of the robotic arm from contacting human skin, a set distance of 150 cm is used. Therefore, based on each planned target channel, the end tool is raised along the axis by the set distance. The target position of the end tool is obtained, and the axis direction of the end tool coincides with the axis of the target channel. Determining whether the target position is reachable is the process of determining whether the robotic arm's movement enables the end tool to move to the target position.

[0080] Specifically, the coordinate system C of each target channel obtained based on S4 c Relative to the base coordinate system C b The transformation matrix After calculating the set distance of each target channel moving along its axis, the end tool coordinate system C t Relative to the robot base coordinate system C b The transformation matrix of

[0081] S52: Traverse the navigation angle of the end tool according to the set rotation step size, and determine whether there is a non-singular inverse solution for the transformation relationship between the end tool and the base of the manipulator at the corresponding navigation angle based on the inverse kinematics of the manipulator. If there is an inverse solution, the target path is considered to be reachable; otherwise, the target path is considered to be unreachable.

[0082] like Figure 3 As shown, the navigation angle of the end tool is the angle of rotation of the end tool around its own axis (that is, the planned channel axis, namely the Z axis). It can be understood that the navigation angle range of the end tool is 360°.

[0083] Therefore, different navigation angles of the end tool correspond to different robot arm postures. When the transformation matrix of the end tool relative to the robot arm base has an inverse solution and is non-singular, it means that the robot arm can drive the end tool to the target position corresponding to the planned channel; otherwise, the target position is unreachable, and the corresponding target channel cannot be reached by the robot arm to perform tool operation.

[0084] For example, the navigation angle traversal range of the end tool is [-180°, 180°], and the set rotation step is 2°.

[0085] Specifically, starting from the initial angle of the end tool, the navigation angle is traversed according to the above rotation step, and the inverse kinematics of the manipulator is used to calculate the coordinate system C of each target channel. c Relative to the base coordinate system C b The transformation matrix Find the inverse solution. When an inverse solution exists and is not singular, stop traversal immediately, indicating that the robot arm has found a path to reach the target position.

[0086] S53, repeat S52, traverse and determine whether all target channels are reachable, if they are all reachable, go to S6, otherwise return to S2;

[0087] S6, determining whether the end tracer is within the visual range of the optical tracking system when the robot arm reaches the reachable position of each target channel;

[0088] If the end tracer is within the visual range of the optical tracking system, the corresponding position of the manipulator trolley is used as the target position of the manipulator trolley, such as Figure 1 As shown by mark 70; otherwise, return to S2;

[0089] It should be noted that the execution process of the robotic arm includes first driving the end tool to a reachable position coaxial with the target position (ie, the Z axis), and then rotating according to the navigation angle obtained in S52, so that the end tool is finally at the target position.

[0090] Specifically, refer to Figure 5 , including the steps of:

[0091] S61, calculating the transformation relationship between the end tool and the robot arm base when in the reachable position based on the transformation relationship between the end tool and the robot arm base obtained in S51 and the reachable angle obtained in S52, combined with the transformation relationship between the end tool tracer and the robot arm base and the installation parameters of the end tool and the end tool tracer;

[0092] Specifically, the end tool coordinate system C obtained according to S51 t Relative to the base coordinate system C b The transformation matrix According to the reachable angle rotation, the reachable end tool coordinate system C is obtained t1 Relative to the base coordinate system C b The transformation matrix It is understandable that the reachable end tool coordinate system C mentioned here is t1 It represents the coordinate system of the robot arm driving the end tool to the reachable position; the reachable end tool coordinate system C t1 According to the rotation angle, it can be converted into the end tool coordinate system C t expression.

[0093] In addition, the end tool coordinate system C is obtained according to the installation parameters of the end tool and the end tracer. t Relative to the end tracer coordinate system C e The transformation matrix Combined with the reachable end tool coordinate system C t1 Relative to the base coordinate system C b The transformation matrix Get the tracer coordinate system C e1 Relative to the base coordinate system C b The transformation matrix as follows:

[0094]

[0095] S62. Calculate the transformation relationship between the end tool tracer and the optical tracking system when the end tool is in the reachable position based on the transformation relationship between the robot arm base and the optical tracking system obtained in S3 and the transformation relationship between the end tool tracer and the robot arm base when in the reachable position obtained in S61.

[0096] Specifically, S3 obtains the base coordinate system C b Transformation matrix in optical tracking system S61 obtains the coordinate system C of the tracer that can be reached e1 Relative to the base coordinate system C b The transformation matrix The coordinate system C of the tracer that can be reached under the optical tracking system is calculated. e1 The transformation matrix as follows:

[0097]

[0098] S63. When the end tool is located at a reachable position, the transformation relationship between the end tracer and the optical tracking system obtained in S62 is used to calculate the angle between the normal vector of the end tracer and the normal vector of the optical tracking system. If the angle is less than 90°, the end tracer is considered to be within the visible range of the optical tracking system; otherwise, the end tracer is considered to be outside the visible range of the optical tracking system.

[0099] The present invention continuously adjusts the position of the robotic arm trolley during positioning, and after each adjustment, determines whether the end tool on the end of the robotic arm of the robotic arm trolley can reach each target channel, and determines whether the guide on the end of the robotic arm is within the visual range of the optical tracking system when the robotic arm executes to each target channel, thereby accurately completing the positioning of the robotic arm trolley, ensuring that the end tool can reach its target position during subsequent execution, without the need to frequently move the robotic arm trolley, and ensuring the smooth progress of the operation. In addition, it can be ensured that when the robotic arm is in place, the end guide is within the visual range of the optical tracking system, without the need for medical staff to adjust the position of the optical tracking system, reducing surgical time and ensuring execution accuracy.

[0100] Those skilled in the art should understand that the discussion of any of the above embodiments is merely illustrative and is not intended to imply that the scope of the present invention (including the claims) is limited to these examples. Within the scope of the present invention, the technical features in the above embodiments or different embodiments may be combined, the steps may be implemented in any order, and there are many other variations of the different aspects of the embodiments of the present invention as described above, which are not provided in detail for the sake of simplicity.

[0101] The embodiments of the present invention are intended to cover all such substitutions, modifications, and variations that fall within the broad scope of the appended claims. Therefore, any omissions, modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the embodiments of the present invention should be included in the scope of protection of the present invention.

Claims

1. A method for positioning a robot arm trolley, characterized in that: include: Step (1) obtaining a medical image containing a surgical area, planning a number of target channels in the surgical area in the medical image, and calculating the transformation relationship between all planned target channels and the patient tracer installed in the patient's surgical area; Step (2) setting the patient tracer as a relative static point and the robotic arm trolley as a relative action point, and adjusting the relative distance between the two according to the set step length; Step (3) Positioning the end tracer by the optical tracking system, and calculating the transformation relationship between the adjusted manipulator base of the manipulator trolley and the optical tracking system according to the forward kinematics of the manipulator, thereby combining the calculation in step (1) to obtain the transformation relationship between each target channel and the adjusted manipulator base; Step (4) Based on the transformation relationship obtained in step (3), determine whether all target channels are reachable through the inverse kinematics of the manipulator. If they are all reachable, go to step (5); otherwise, return to step (2). Step (5) determining whether the end tracer is within the visual range of the optical tracking system when the robotic arm reaches the reachable position of each target channel; If the end tracer is within the visual range of the optical tracking system at this time, the corresponding robotic arm trolley position is used as the target position; Otherwise, return to step (2).

2. The method for positioning a robot arm trolley according to claim 1, characterized in that: In step (4), the determination of whether all target channels are reachable is as follows: Step (41) lifts each target channel along its axis by a set distance according to the transformation relationship obtained in step (3), and calculates the transformation relationship between the end tool and the robot arm base; Step (42) traverses the navigation angle of the end tool according to the set rotation step size, and determines whether there is a non-singular inverse solution for the transformation relationship between the end tool and the base of the manipulator under the corresponding navigation angle based on the inverse kinematics of the manipulator; if there is an inverse solution, it is considered that the target channel is reachable, otherwise it is considered that the target channel is unreachable; Step (43): Repeat step (42) to traverse and determine whether all target channels are reachable.

3. The method for positioning a robot arm trolley according to claim 2, characterized in that: In the step (42), the navigation angle range of the end tool is 360°, and the set rotation step is 2°.

4. The method for positioning a robot arm trolley according to claim 2, characterized in that: The step (5) comprises: Step (51) calculates the transformation relationship between the end tool and the robot arm base when in the reachable position based on the transformation relationship between the end tool and the robot arm base obtained in step (41) and the reachable angle obtained in step (42), combined with the transformation relationship between the end tracer and the robot arm base; Step (52) combines step (3) and step (51) to calculate the transformation relationship between the end tracer and the optical tracking system when the end tool is located at the reachable position; Step (53) calculates the angle between the normal vector of the end tracer and the normal vector of the optical tracking system based on the transformation relationship between the end tool and the optical tracking system when the end tool is at the reachable position obtained in step (52). If the angle is less than 90°, it is considered that the end tracer is within the visible range of the optical tracking system; otherwise, it is considered that the end tracer is outside the visible range of the optical tracking system.

5. The method for positioning a robot arm trolley according to claim 1, characterized in that: The transformation relationship between the adjusted manipulator base and the optical tracking system of the manipulator trolley obtained by calculating the manipulator forward kinematics is specifically: After each distance adjustment, the transformation relationship between the end of the manipulator and the base of the manipulator is calculated through the forward kinematics of the manipulator. The transformation relationship between the end of the manipulator and the end tracer is calculated based on the installation parameters of the end of the manipulator and the end tracer. The transformation relationship between the end tracer and the optical tracking system is calculated by positioning the end tracer through the optical tracking system. Through the above-mentioned groups of transformation relationships, the transformation relationship between the adjusted manipulator base of the manipulator trolley and the optical tracking system is calculated.

6. The method for positioning a robot arm trolley according to claim 1, characterized in that: In the step (2), the robotic arm trolley is adjusted in two orthogonal directions according to a set step length within the adjustable range of the robotic arm trolley.

7. The method for positioning a robot arm trolley according to claim 6, characterized in that: The adjustable range of the robotic arm trolley is specifically a square range with a length of 130 cm and a width of 50 cm formed on the side of the operating table close to the patient's feet. The wide side of the square range is 30 cm and 100 cm away from the tail side of the operating table close to the patient's feet, respectively, and the long side is 50 cm and 100 cm away from the side of the operating table, respectively; accordingly, the step length is set to 10 cm.

8. The method for positioning a robot arm trolley according to claim 1, characterized in that: The step (1) comprises: Step (11) obtaining a medical image containing the surgical area, and obtaining a transformation relationship between the patient tracer and the medical image through registration calculation; Step (12) obtaining a transformation relationship between each target channel and the medical image according to the positions of the target channels planned in the medical image; Step (13) calculates the transformation relationship between each target channel and the patient tracer based on the transformation relationship between the patient tracer and the medical image obtained in step (11) and the transformation relationship between each target channel and the medical image obtained in step (12).

9. The method for positioning a robot arm trolley according to claim 8, characterized in that: In the step (11), the registration calculation process is completed by calibrating the fixture.

10. The method for positioning a robot arm trolley according to claim 9, characterized in that: The registration calculation process is completed by calibrating the fixture, specifically: The patient tracer is identified and positioned by the optical positioning system to obtain a transformation relationship between the patient tracer and the optical tracking system; Positioning a calibration fixture placed on the patient through an optical tracking system, and identifying the calibration fixture in the medical image, and calculating a transformation relationship between the medical image and the optical tracking system; In summary, the transformation relationship between the patient tracer and the medical image is calculated.

Citation Information

Patent Citations

  • Mechanical arm end effector calibration system and method

    CN112603544A

  • Calculation method and control method for effective working space of mechanical arm

    CN114391958A