Mechanical arm control method, device, equipment and medium

By detecting the interference state, calculating the rotation angle and joint angle, adjusting the relative position of the robotic arm reference frame and the surgical area reference frame, the problem of intraoperative reference frame interference is solved, simplifying the surgical process and improving efficiency and safety.

CN119014984AActive Publication Date: 2024-11-26BEIJING NATONG MEDICAL ROBOT TECH CO LTD
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202411119052.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-15
Publication Date
2024-11-26
Estimated Expiration
2044-08-15

AI Technical Summary

Technical Problem

In robotic arm assisted surgery, the interference problem between the reference frames in the operation leads to a reduction in surgical efficiency. The prior art requires the removal and refixation of the reference frame to resolve interference, affecting the normal operation of the surgery.

Method used

By detecting the interference state between the robotic arm reference frame and the surgical area reference frame, obtaining external torque, and using the tool axis direction and the bone path direction as the constraint condition, calculate the rotation angle and joint angle to control the rotation of the robotic arm and adjust the reference The frame is positioned relative to avoid interference.

Benefits of technology

There is no need to reposition the target position, simplify the surgical process, avoid interference between the robotic arm reference frame and the surgical area reference frame, and improve surgical efficiency and safety.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119014984A_ABST
    Figure CN119014984A_ABST
Patent Text Reader

Abstract

The invention relates to a mechanical arm control method, device and equipment and a medium, and the method comprises the steps that in response to the fact that a mechanical arm reaches a target pose, the interference state between a mechanical arm reference frame and an operation area reference frame is detected; if the interference state is that interference exists, the external torque of the mechanical arm is obtained; the rotation angle of the mechanical arm is calculated according to the external torque under the constraint condition that the tool axis direction of the mechanical arm is consistent with the bone tunnel direction; and the joint angle of the mechanical arm is determined according to the rotation angle, so that the mechanical arm is controlled to rotate according to the joint angle. According to the technical scheme, the problem of interference of the reference frame in the operation can be solved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present disclosure relates to the field of robotic arm technology, and in particular to a robotic arm control method, device, equipment and medium. Background Art

[0002] With the development of robots, robotic arms are widely used to assist in the completion of surgery. The anterior cruciate ligament reconstruction surgery robot assisted by the robotic arm is positioned through an optical navigation system, and the robotic arm is used to complete the bone tunnel drilling operation. The robotic arm and the surgical area are respectively provided with markers, and the optical navigation system identifies the markers (hereinafter referred to as reference frames) and processes them to obtain the position of the bone tunnel in the surgical area.

[0003] Currently, in relevant surgical scenarios, if there is interference between reference frames, it is often necessary to remove the reference frames and then re-fix them, which affects the normal progress and efficiency of the operation. How to solve the interference of reference frames during surgery is a technical problem that needs to be solved urgently. Summary of the invention

[0004] In order to solve the above technical problems, the present disclosure provides a robot arm control method, device, equipment and medium.

[0005] In a first aspect, an embodiment of the present disclosure provides a method for controlling a robotic arm, comprising:

[0006] In response to the robot arm reaching the target posture, detecting the interference state between the robot arm reference frame and the surgical area reference frame;

[0007] If the interference state is interference exists, obtaining the external torque of the robot arm;

[0008] Taking the tool axis direction of the robot arm and the bone channel direction as a constraint condition, calculating the rotation angle of the robot arm according to the external torque;

[0009] The joint angle of the robot arm is determined according to the rotation angle, so as to control the rotation of the robot arm according to the joint angle.

[0010] In a second aspect, an embodiment of the present disclosure provides a robot arm control device, comprising:

[0011] A detection module, for detecting the interference state between the manipulator reference frame and the surgical area reference frame in response to the manipulator reaching the target posture;

[0012] an acquisition module, configured to acquire the external torque of the robotic arm if the interference state is interference exists;

[0013] A determination module, used to calculate the rotation angle of the robotic arm according to the external torque, taking the direction of the tool axis of the robotic arm and the direction of the bone tunnel as a constraint condition;

[0014] A control module is used to determine the joint angle of the robotic arm according to the rotation angle, so as to control the rotation of the robotic arm according to the joint angle.

[0015] In a third aspect, an embodiment of the present disclosure provides an electronic device, comprising: a processor; a memory for storing executable instructions of the processor; the processor is used to read the executable instructions from the memory and execute the instructions to implement the robotic arm control method described in the first aspect above.

[0016] In a fourth aspect, an embodiment of the present disclosure provides a computer-readable storage medium, wherein the storage medium stores a computer program, and when the computer program is executed by a processor, the robot arm control method described in the first aspect is implemented.

[0017] Compared with the prior art, the technical solution provided by the disclosed embodiment has the following advantages: in response to the robot arm reaching the target posture, if there is interference between the robot arm reference frame and the surgical area reference frame, the external torque of the robot arm is obtained, and the direction of the tool axis of the robot arm is consistent with the direction of the bone channel as a constraint condition, and the rotation angle of the robot arm is calculated according to the external torque, and then, the joint angle of the robot arm is determined according to the rotation angle to control the rotation of the robot arm according to the joint angle, thereby solving the problem of reference frame interference during surgery. When the robot arm is controlled according to the external torque, the rotation angle is calculated with the direction of the tool axis of the robot arm being consistent with the direction of the bone channel as a constraint condition, so that the robot arm rotates around the tool axis direction, thereby adjusting the relative position of the robot arm reference frame and the surgical area reference frame during bone channel drilling. While avoiding mutual interference between the robot arm reference frame and the surgical area reference frame, there is no need for the robot arm to reposition the target posture, thereby simplifying the surgical process. BRIEF DESCRIPTION OF THE DRAWINGS

[0018] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the present disclosure and, together with the description, serve to explain the principles of the present disclosure.

[0019] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.

[0020] Figure 1 A schematic diagram of a flow chart of a robot arm control method provided by an embodiment of the present disclosure;

[0021] Figure 2 A schematic diagram of a mechanical arm provided by an embodiment of the present disclosure;

[0022] Figure 3A schematic diagram of the structure of a robotic arm control device provided in an embodiment of the present disclosure. DETAILED DESCRIPTION

[0023] In order to more clearly understand the above-mentioned objectives, features and advantages of the present disclosure, the scheme of the present disclosure will be further described below. It should be noted that the embodiments of the present disclosure and the features in the embodiments can be combined with each other without conflict.

[0024] In the following description, many specific details are set forth to facilitate a full understanding of the present disclosure, but the present disclosure may also be implemented in other ways different from those described herein; it is obvious that the embodiments in the specification are only part of the embodiments of the present disclosure, rather than all of the embodiments.

[0025] Figure 1 This is a flow chart of a robot arm control method provided in an embodiment of the present disclosure. The method provided in an embodiment of the present disclosure can be executed by a robot arm control device, which can be implemented in software and / or hardware and can be integrated on any electronic device with computing capabilities.

[0026] like Figure 1 As shown, the robot arm control method provided by the embodiment of the present disclosure may include:

[0027] Step 101, in response to the robot arm reaching a target posture, detecting the interference state between the robot arm reference frame and the surgical area reference frame.

[0028] The method of the disclosed embodiment can be applied to control a robotic arm in a robotic-assisted surgery scenario, for example, controlling the robotic arm to reach a target position in orthopedic surgery, and then using the robotic arm to perform a bone drilling operation.

[0029] In this embodiment, a tool is provided at the end of the robotic arm. When the tool axis direction of the robotic arm is consistent with the bone tunnel direction and the distance between the tool and the bone tunnel entry point is a preset distance, it is determined that the robotic arm has reached the target posture. When the robotic arm reaches the target posture, the interference state between the robotic arm reference frame and the surgical area reference frame is detected.

[0030] In the robotic arm-assisted surgery scenario, the robotic arm and the surgical area are respectively provided with markers. The markers are identified by a positioning system such as an infrared optical navigation system, and coordinate conversion is performed based on the identification results so that the robotic arm can obtain the position and posture of the bone channel in the surgical area. Among them, the robotic arm reference frame is a marker fixed to the robotic arm, and the surgical area reference frame is a marker fixed to the surgical area. The interference state between the robotic arm reference frame and the surgical area reference frame includes interference and non-interference. When any side of the robotic arm reference frame collides with any side of the surgical area reference frame, the interference state is interference. When any side of the robotic arm reference frame does not collide with any side of the surgical area reference frame, the interference state is non-interference.

[0031] The following is an example of how to detect the interference state between the robot arm reference frame and the surgical area reference frame.

[0032] In one embodiment of the present disclosure, the manipulator reference frame and the surgical area reference frame can be identified by the positioning system, and then the interference state between the manipulator reference frame and the surgical area reference frame can be determined according to the identification result of the positioning system. In this embodiment, the interference state between the manipulator reference frame and the surgical area reference frame is detected, including: obtaining the first position information of the first side in the positioning coordinate system and the second position information of the second side in the positioning coordinate system, establishing the parametric equation of the first side and the second side according to the first position information and the second position information, judging whether the first side and the second side intersect according to the parametric equation, if the first side and the second side intersect, then determining that the interference state is interference exists, otherwise, determining that the interference state is interference does not exist.

[0033] The positioning coordinate system includes an optical navigation coordinate system, the first position information includes the coordinates of the first side in the positioning coordinate system, and the second position information includes the coordinates of the second side in the positioning coordinate system. The first side is any side of the manipulator reference frame, and the second side is any side of the surgical area reference frame. Further, based on the actual installation situation, when interference occurs between the manipulator reference frame and the surgical area reference frame, it is usually the specific side of the manipulator reference frame that intersects with the specific side of the surgical area reference frame. Based on this, the first side can be the specific side of the manipulator reference frame, and the second side can be the specific side of the surgical area reference frame.

[0034] As an example, the first side is recorded as AB, and the second side is recorded as EF. By judging whether the line segment AB intersects with the line segment EF, the interference state between the manipulator reference frame and the surgical area reference frame is determined. If AB intersects with EF, the interference state is interference exists. If AB does not intersect with EF, the interference state is no interference exists. Among them, the relative position of A and B is a known quantity, that is, when the coordinates of point A are (0, 0, 0), the coordinates of point B are (k, m, n), and the relative position of E and F is a known quantity, that is, when the coordinates of point E are (0, 0, 0), the coordinates of point F are (d, e, f). EF is parallel to the tool axis direction of the manipulator. In the optical navigation coordinate system, the coordinates of point A are (x1, y1, z1), the coordinates of point B are (x1+k, y1+m, z1+n), recorded as B(x2, y2, z2), the coordinates of point E are (x3, y3, z3), the coordinates of point F are (x3+d, y3+e, z3+f), recorded as F(x4, y4, z4), and the parametric equation is established according to the coordinates of points A, B, E, and F:

[0035]

[0036] Wherein, formula (1) is the parametric equation of line segment AB, and formula (2) is the parametric equation of line segment EF. If a T a is irreversible, then line segment AB does not intersect line segment EF; a T a is reversible, calculate t1, t2, and substitute t1, t2 to determine whether x, y, z in formula (1) and formula (2) are equal. If they are equal, line segment AB intersects line segment EF. If they are not equal, line segment AB does not intersect line segment EF.

[0037] It should be noted that the above-mentioned use of linear equations to determine the interference state between the robotic arm reference frame and the surgical area reference frame is only one implementation method, and other methods other than linear equations can also be used to observe the interference state between the robotic arm reference frame and the surgical area reference frame, and no specific restrictions are made here.

[0038] Step 102: If the interference state is interference exists, the external torque of the robot arm is obtained.

[0039] In this embodiment, after the robot reaches the target posture, if interference is detected between the robot reference frame and the surgical area reference frame, the external torque of the robot is obtained. If there is no interference between the robot reference frame and the surgical area reference frame, there is no need to perform the step of obtaining the external torque of the robot. Optionally, a prompt message is generated according to the interference state. When the interference state is interference, the prompt message is used to prompt the existence of interference, so that an external force is applied to the robot according to the prompt message, and the external torque of the robot is obtained at this time; when the interference state is no interference, the prompt message is used to prompt the absence of interference, so that the normal surgical process is performed according to the prompt message. Among them, the implementation method of the prompt message includes but is not limited to voice prompts, text prompts, etc.

[0040] The following describes how to obtain the external torque of the robotic arm.

[0041] In one embodiment of the present disclosure, a force sensor is provided at the end of the manipulator, and the coordinate system of the manipulator includes: a manipulator flange coordinate system, a manipulator tool coordinate system, a manipulator base coordinate system, and a sensor coordinate system. Force and torque are collected by the force sensor, and the torque collected by the force sensor is recorded as the first torque, and a first conversion matrix is ​​determined according to the rotation conversion relationship and the translation conversion relationship between the manipulator base coordinate system and the manipulator tool coordinate system. The first conversion matrix is ​​used to map the first torque from the manipulator base coordinate system to the manipulator tool coordinate system, thereby converting the first torque according to the first conversion matrix to obtain a second torque in the manipulator tool coordinate system, so as to determine the external torque according to the second torque.

[0042] Optionally, a load is provided at the end of the manipulator, and when determining the external torque of the manipulator, gravity compensation can also be performed on the collected torque, and the coordinate system of the manipulator also includes: a load center of mass coordinate system. Determining the external torque according to the second torque includes: obtaining the first gravity and the first gravity moment of the load in the load center of mass coordinate system, determining the second transformation matrix according to the rotation transformation relationship and the translation transformation relationship between the load center of mass coordinate system and the manipulator tool coordinate system, and the second transformation matrix is ​​used to map the first gravity and the first gravity moment to the manipulator tool coordinate system, thereby converting the first gravity and the first gravity moment according to the second transformation matrix to obtain the second gravity moment in the manipulator tool coordinate system, and gravity compensating the second torque according to the second gravity moment to obtain the external torque.

[0043] As an example, the robot arm flange coordinate system is recorded as flange, the robot arm tool coordinate system is recorded as tool, the robot arm base coordinate system is recorded as base, the gravity of the load is recorded as G, and the load center of mass coordinate system is recorded as ct. The calculation process is explained below. It should be noted that for the sake of ease of description, the following description describes the force collected by the force sensor and the external force in the calculation results, which should not be regarded as a limitation of this solution.

[0044] In this example, the force and torque data collected by the force sensor at the end of the robotic arm are recorded as Among them, f base is the force collected by the force sensor, n base This is the first torque acquired by the force sensor.

[0045]

[0046] in, is the translation transformation relationship between the robot base coordinate system and the robot tool coordinate system, is the rotation transformation relationship between the robot base coordinate system and the robot tool coordinate system; is the coordinate transformation relationship between the robot flange coordinate system and the robot tool coordinate system, which is a known quantity; It can be read through the robot arm interface and is a known quantity; F tool Include tool , n tool is the second torque.

[0047]

[0048] in, is the rotation transformation relationship between the load center of mass coordinate system and the robot tool coordinate system, is the translation transformation relationship between the load center of mass coordinate system and the robot tool coordinate system, f cct_G is the first gravity of the load in the load center of mass coordinate system, n ct_G is the first gravity moment of the load in the load center of mass coordinate system, F tool_G is the gravity and gravity moment generated by the load in the robot tool coordinate system, F tool_G Include tiol_G , n tool_G is the second gravitational moment.

[0049] Among them, the relative direction relationship between the load center of mass coordinate system and the robot base coordinate system is known, such as Figure 2 As shown, Figure 2 The solid line part shows the robot flange, robot tool, robot base, and load. The dotted line part shows the robot base coordinate system and the load center of mass coordinate system. For the convenience of calculation, the load center of mass coordinate system and the robot base coordinate system have the same direction, that is,

[0050]

[0051] in, is a known quantity, is the rotation transformation relationship between the robot base coordinate system and the robot flange coordinate system. In the tool coordinate system, the external force and torque F perceived by the robot ext =F tool -F tool_G .

[0052] Step 103, taking the tool axis direction of the robot arm and the bone channel direction as a constraint condition, calculate the rotation angle of the robot arm according to the external torque.

[0053] In this embodiment, the rotation angle of the manipulator is calculated according to the external torque, so as to control the manipulator to rotate around the tool axis according to the rotation angle, and the position of the tool tip point is kept unchanged during the rotation process. Under this constraint, the torque component of the external torque in the tool axis direction is obtained, so as to control according to the torque component of the external torque in the tool axis direction. It can be understood that based on controlling the manipulator to rotate around the tool axis direction, the position of the tool tip point is kept unchanged during the rotation process, rather than the posture, which increases the flexibility during the operation.

[0054] Optionally, the torque component of the external torque in the tool axis direction is obtained, and the admittance control is performed according to the torque component to obtain the rotation angle of the robot arm. It should be noted that in this embodiment, the admittance formula or a variation of the admittance formula can be used to control the robot arm, and other algorithms with similar functions can also be used to control the robot arm.

[0055] The calculation process of the rotation angle is described below.

[0056] As an example, the external force and torque F ext as follows:

[0057]

[0058] Among them, n x_ext 、n y_ext 、n z_ext are the torque components of the external torque in the x-direction, y-direction, and z-direction, respectively. For example, when the y-direction of the robot tool coordinate system is consistent with the bone channel direction, the formula is as follows:

[0059]

[0060] Among them, B and M are fixed coefficients, and Δθ is the rotation angle.

[0061] Step 104 , determining the joint angle of the robot arm according to the rotation angle, so as to control the rotation of the robot arm according to the joint angle.

[0062] In this embodiment, after calculating the rotation angle of the robot arm according to the external torque, the coordinate transformation relationship between the robot arm tool coordinate system and the robot arm base coordinate system is determined after the robot arm rotates around the tool axis according to the rotation angle, and the coordinate transformation relationship includes a rotation transformation relationship and a translation transformation relationship. Then, the coordinate transformation relationship between the robot arm tool coordinate system and the robot arm base coordinate system after rotation is solved to obtain the joint angle of the robot arm.

[0063] As an example,

[0064]

[0065] Convert the required rotation angle to the robot base coordinate system to obtain:

[0066]

[0067] in, is the coordinate transformation relationship between the robot tool coordinate system and the robot base coordinate system after rotation, is the rotation transformation relationship between the robot tool coordinate system and the robot base coordinate system after rotation. The inverse solution is q, where q represents the joint angle of the robotic arm. If q has a solution, the robotic arm is reachable. If q has no solution, the robotic arm is unreachable. Therefore, according to the solved joint angle of the robotic arm, the robotic arm is controlled to rotate around the tool axis until there is no interference between the robotic arm reference frame and the surgical area reference frame.

[0068] In one embodiment of the present disclosure, the maximum rotatable angle can be preset, and after calculating the rotation angle of the mechanical arm according to the external torque, it is determined based on the rotation angle whether the target angle of the mechanical arm after rotation exceeds the preset angle in the current rotation direction, and if the target angle exceeds the preset angle in the current rotation direction, a prompt message is generated. The preset angle is used to indicate the maximum rotatable angle in the current rotation direction, and the prompt message is used to prompt the adjustment of the rotation direction. The prompt message includes but is not limited to voice prompts and text prompts, and the direction of applying the external force to the mechanical arm is changed through the prompt message to adjust the rotation direction.

[0069] In one embodiment of the present disclosure, after solving the joint angles of the robotic arm, if there is no solution, it is determined that the robotic arm is unreachable and a prompt message is generated. The prompt message is used to indicate that the robotic arm is unreachable. The direction of the external force applied to the robotic arm is changed through the prompt message to adjust the rotation direction.

[0070] In one embodiment of the present disclosure, after the mechanical arm is controlled to rotate according to the joint angle, the interference state between the mechanical arm reference frame and the surgical area reference frame is detected, and prompt information is generated according to the interference state. The prompt information is used to indicate the interference state between the current mechanical arm reference frame and the surgical area reference frame. For example, after the mechanical arm is controlled to rotate according to the joint angle, if there is still interference between the mechanical arm reference frame and the surgical area reference frame, it is prompted that there is interference, so that external force is applied to the mechanical arm according to the prompt information, and the aforementioned steps of obtaining external torque, calculating rotation angle and controlling are repeated. If there is no interference between the mechanical arm reference frame and the surgical area reference frame, it is prompted that there is no interference, so that the application of external force to the mechanical arm is stopped according to the prompt information, and the mechanical arm rotation is no longer controlled.

[0071] According to the technical solution of the embodiment of the present disclosure, in response to the robot arm reaching the target posture, if there is interference between the robot arm reference frame and the surgical area reference frame, the external torque of the robot arm is obtained, and the tool axis direction of the robot arm is consistent with the bone channel direction as a constraint condition, and the rotation angle of the robot arm is calculated according to the external torque. Then, the joint angle of the robot arm is determined according to the rotation angle to control the rotation of the robot arm according to the joint angle. In this way, the problem of reference frame interference during surgery can be solved. When the robot arm is controlled according to the external torque, the rotation angle is calculated with the tool axis direction of the robot arm being consistent with the bone channel direction as a constraint condition, so that the robot arm rotates around the tool axis direction, thereby adjusting the relative position of the robot arm reference frame and the surgical area reference frame during bone channel drilling. While avoiding mutual interference between the robot arm reference frame and the surgical area reference frame, there is no need for the robot arm to reposition the target posture, which simplifies the surgical process. In addition, by real-time detection of whether the robot arm is reachable, surgical safety is guaranteed.

[0072] Figure 3 A schematic diagram of the structure of a robot arm control device provided by an embodiment of the present disclosure is shown in FIG. Figure 3 As shown, the robot arm control device includes: a detection module 31, an acquisition module 32, a determination module 33, and a control module 34.

[0073] A detection module 31, configured to detect the interference state between the manipulator reference frame and the surgical area reference frame in response to the manipulator reaching the target posture;

[0074] An acquisition module 32, for acquiring an external torque of the robot arm if the interference state is interference exists;

[0075] A determination module 33, for calculating the rotation angle of the robot arm according to the external torque, taking the tool axis direction of the robot arm and the bone channel direction as a constraint condition;

[0076] The control module 34 is used to determine the joint angle of the robot arm according to the rotation angle, so as to control the rotation of the robot arm according to the joint angle.

[0077] In one embodiment of the present disclosure, the detection module 31 is specifically used to:

[0078] Obtaining first position information of the first side in the positioning coordinate system and second position information of the second side in the positioning coordinate system; wherein the first side is any side of the manipulator reference frame, and the second side is any side of the surgical area reference frame;

[0079] Establishing a parametric equation of the first side and the second side according to the first position information and the second position information, and determining whether the first side and the second side intersect according to the parametric equation;

[0080] If the first edge and the second edge intersect, then the interference state is determined to be interference exists.

[0081] In one embodiment of the present disclosure, a force sensor is provided on the mechanical arm, and the acquisition module 32 is specifically used for:

[0082] Obtaining a first moment collected by the force sensor;

[0083] Determine a first transformation matrix according to a rotation transformation relationship and a translation transformation relationship between a robot arm base coordinate system and a robot arm tool coordinate system;

[0084] The first torque is transformed according to the first transformation matrix to obtain a second torque in the robot tool coordinate system, so as to determine the external torque according to the second torque.

[0085] In one embodiment of the present disclosure, a load is disposed at the end of the mechanical arm, and the acquisition module 32 is specifically used for:

[0086] Obtain the first gravity and first gravity moment of the load in the load center of mass coordinate system;

[0087] Determine a second transformation matrix according to the rotational transformation relationship and the translational transformation relationship between the load center of mass coordinate system and the robot arm tool coordinate system;

[0088] The first gravity and the first gravity moment are converted according to the second conversion matrix to obtain a second gravity moment in the robot tool coordinate system;

[0089] The second moment is gravity compensated according to the second gravity moment to obtain an external moment.

[0090] In one embodiment of the present disclosure, the determination module 33 is specifically used to:

[0091] Obtain the torque component of the external torque in the direction of the tool axis;

[0092] Admittance control is performed according to the torque component to obtain the rotation angle of the robot arm.

[0093] In one embodiment of the present disclosure, the device further includes:

[0094] The first prompt module is used to determine whether the target angle of the robot arm after rotation exceeds the preset angle in the current rotation direction based on the rotation angle; if the target angle exceeds the preset angle in the current rotation direction, a first prompt message is generated; the first prompt message is used to prompt the adjustment of the rotation direction.

[0095] In one embodiment of the present disclosure, the device further includes:

[0096] The second prompt module is used to detect the interference state between the robot arm reference frame and the surgical area reference frame; generate second prompt information; the second prompt information is used to indicate the interference state between the current robot arm reference frame and the surgical area reference frame.

[0097] The robot arm control device provided in the embodiment of the present disclosure can execute any robot arm control method provided in the embodiment of the present disclosure, and has the corresponding functional modules and beneficial effects of the execution method. The contents not described in detail in the embodiment of the device of the present disclosure can refer to the description in any method embodiment of the present disclosure.

[0098] The present disclosure also provides an electronic device, which includes one or more processors and a memory. The processor may be a central processing unit (CPU) or other forms of processing units with data processing capabilities and / or instruction execution capabilities, and may control other components in the electronic device to perform desired functions. The memory may include one or more computer program products, and the computer program product may include various forms of computer-readable storage media, such as volatile memory and / or non-volatile memory. Volatile memory may include, for example, random access memory (RAM) and / or cache memory (cache), etc. Non-volatile memory may include, for example, read-only memory (ROM), hard disk, flash memory, etc. One or more computer program instructions may be stored on a computer-readable storage medium, and the processor may run the program instructions to implement the method of the above embodiment of the present disclosure and / or other desired functions. Various contents such as input signals, signal components, noise components, etc. may also be stored in the computer-readable storage medium.

[0099] In one example, the electronic device may further include: an input device and an output device, and these components are interconnected through a bus system and / or other forms of connection mechanisms. In addition, the input device may also include, for example, a keyboard, a mouse, etc. The output device may output various information to the outside, including determined distance information, direction information, etc. The output device may include, for example, a display, a speaker, a printer, and a communication network and a remote output device connected thereto, etc. In addition, according to the specific application, the electronic device may also include any other appropriate components such as a bus, an input / output interface, etc.

[0100] In addition to the above methods and devices, the embodiments of the present disclosure may also be a computer program product, which includes computer program instructions. When the computer program instructions are executed by a processor, the processor executes any method provided by the embodiments of the present disclosure.

[0101] The computer program product may be written in any combination of one or more programming languages ​​to write program code for performing the operations of the disclosed embodiments, including object-oriented programming languages ​​such as Java, C++, etc., and conventional procedural programming languages ​​such as "C" or similar programming languages. The program code may be executed entirely on the user computing device, partially on the user device, as a separate software package, partially on the user computing device and partially on a remote computing device, or entirely on a remote computing device or server.

[0102] In addition, the embodiments of the present disclosure may also be a computer-readable storage medium on which computer program instructions are stored. When the computer program instructions are executed by a processor, the processor executes any method provided by the embodiments of the present disclosure.

[0103] Computer readable storage media can adopt any combination of one or more readable media. The readable medium can be a readable signal medium or a readable storage medium. The readable storage medium can include, for example, but is not limited to, a system, device or device of electricity, magnetism, light, electromagnetic, infrared, or semiconductor, or any combination of the above. More specific examples (non-exhaustive list) of readable storage media include: an electrical connection with one or more wires, a portable disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above.

[0104] It should be noted that, in this article, relational terms such as "first" and "second" are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.

[0105] The above description is only a specific embodiment of the present disclosure, so that those skilled in the art can understand or implement the present disclosure. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present disclosure. Therefore, the present disclosure will not be limited to the embodiments described herein, but will conform to the widest scope consistent with the principles and novel features disclosed herein.

Claims

1. A robot arm control method, characterized in that: include: In response to the robot arm reaching the target posture, detecting the interference state between the robot arm reference frame and the surgical area reference frame; If the interference state is interference exists, obtaining the external torque of the robot arm; Taking the tool axis direction of the robot arm and the bone channel direction as a constraint condition, calculating the rotation angle of the robot arm according to the external torque; The joint angle of the robot arm is determined according to the rotation angle, so as to control the rotation of the robot arm according to the joint angle.

2. The method according to claim 1, characterized in that The detecting the interference state between the manipulator reference frame and the surgical area reference frame comprises: Acquire first position information of a first side in a positioning coordinate system and second position information of a second side in the positioning coordinate system; wherein the first side is any side of the manipulator reference frame, and the second side is any side of the surgical area reference frame; Establishing a parametric equation of the first edge and the second edge according to the first position information and the second position information, and determining whether the first edge and the second edge intersect according to the parametric equation; If the first edge and the second edge intersect, the interference state is determined to be interference exists.

3. The method according to claim 1, characterized in that The mechanical arm is provided with a force sensor, and obtaining the external torque of the mechanical arm includes: Acquire a first torque collected by the force sensor; Determine a first transformation matrix according to a rotation transformation relationship and a translation transformation relationship between a robot arm base coordinate system and a robot arm tool coordinate system; The first torque is transformed according to the first transformation matrix to obtain a second torque in the robot tool coordinate system, so as to determine the external torque according to the second torque.

4. The method according to claim 3, characterized in that A load is disposed at the end of the mechanical arm, and determining the external torque according to the second torque includes: Obtaining a first gravity and a first gravity moment of the load in a load center of mass coordinate system; Determine a second transformation matrix according to the rotational transformation relationship and the translational transformation relationship between the load center of mass coordinate system and the robot arm tool coordinate system; Convert the first gravity and the first gravity moment according to the second conversion matrix to obtain a second gravity moment in the robot tool coordinate system; The second moment is gravity compensated according to the second gravity moment to obtain the external moment.

5. The method according to claim 1, characterized in that The method of calculating the rotation angle of the robot arm according to the external torque with the tool axis direction of the robot arm being consistent with the bone tunnel direction as a constraint condition includes: Obtaining a torque component of the external torque in the direction of the tool axis; Admittance control is performed according to the torque component to obtain the rotation angle of the robot arm.

6. The method according to claim 1, characterized in that After calculating the rotation angle of the mechanical arm according to the external torque, the method further includes: Based on the rotation angle, determining whether the target angle of the robotic arm after rotation exceeds a preset angle in the current rotation direction; If the target angle exceeds the preset angle in the current rotation direction, a first prompt message is generated; the first prompt message is used to prompt the user to adjust the rotation direction.

7. The method according to claim 1, characterized in that After controlling the rotation of the robotic arm according to the joint angle, the method further includes: Detecting the interference state between the manipulator reference frame and the surgical area reference frame; Generate a second prompt message; the second prompt message is used to indicate the interference state between the current robot arm reference frame and the surgical area reference frame.

8. A robot arm control device, characterized in that: include: A detection module, for detecting the interference state between the manipulator reference frame and the surgical area reference frame in response to the manipulator reaching the target posture; an acquisition module, configured to acquire the external torque of the robotic arm if the interference state is interference exists; A determination module, used to calculate the rotation angle of the robotic arm according to the external torque, taking the direction of the tool axis of the robotic arm and the direction of the bone tunnel as a constraint condition; A control module is used to determine the joint angle of the robotic arm according to the rotation angle, so as to control the rotation of the robotic arm according to the joint angle.

9. An electronic device, characterized in that: include: processor; a memory for storing instructions executable by the processor; The processor is used to read the executable instructions from the memory and execute the instructions to implement the robot arm control method described in any one of claims 1-7.

10. A computer-readable storage medium, characterized in that: The storage medium stores a computer program, and when the computer program is executed by a processor, the robot arm control method described in any one of claims 1 to 7 is implemented.

Citation Information

Patent Citations

  • A surgical instrument calibration system and method for navigating surgery

    CN109171962A

  • Active navigation system for surgical operation and control method thereof

    CN113499138A

  • Interference detection method for multiple arms of mobile robot

    CN113664874A

  • Surgical robot motion control system and method, surgical robot and surgical system

    CN116549115A

  • Method and device for determining target attitude of mechanical arm and storage medium

    CN117084788A