Motion control method of surgical robot system and surgical robot system

By detecting collisions in the manipulator components and adjusting the control parameters of the actuators in the surgical robot system, the problem of limited movement of the surgical robot was solved, achieving high precision and safety in surgery.

CN121337473APending Publication Date: 2026-01-16CORNERSTONE TECH (SHENZHEN) LTD

Patent Information

Application Number
CN202410954118.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-15
Publication Date
2026-01-16

AI Technical Summary

Technical Problem

In existing technologies, surgical robots cannot dynamically adjust the movement of their robotic arms according to the actual situation during surgery, which leads to limited movement when there is a risk of collision, affecting the accuracy of the surgery and potentially causing damage.

Method used

By determining whether a collision has occurred with the manipulator assembly and adjusting the actuator's control parameters, such as reducing current output, when a collision does occur, the movement of the manipulator assembly can be dynamically adjusted to reduce the risk of collision and damage.

Benefits of technology

It improves the precision and safety of surgery, reduces damage caused by collisions, and ensures efficient and accurate surgical procedures.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN121337473A_ABST
    Figure CN121337473A_ABST
Patent Text Reader

Abstract

The invention provides a motion control method of a surgical robot and a surgical robot system. In accordance with an example of the present application, the surgical robotic system includes a manipulator assembly that is movable under actuation of an actuator; the method comprises the following steps: determining whether the manipulator assembly collides or not, wherein the collision comprises an imminent collision or an already-collided collision; in response to the collision of the manipulator assembly, adjusting a control parameter of the actuator to reduce a current output of the actuator; the manipulator assembly is actuated by the actuator to move. The motion state of the manipulator can be adjusted in time, and damage caused by collision is effectively reduced; meanwhile, adjustment can be carried out when it is detected that the manipulator assembly collides, the motion tracking performance of the manipulator assembly is effectively maintained without the collision risk, and the accuracy of the operation is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This application relates to the field of surgical robot technology, and in particular to a motion control method for a surgical robot system and a surgical robot system. Background Technology

[0002] With the continuous advancement of medical technology, surgical robots are being used more and more widely. Surgical robots can provide precise surgical procedures, reduce surgical trauma, shorten patient recovery time, and improve surgical success rates. However, during surgery, surgical robots may accidentally collide with their own robotic arms, surgical instruments, medical staff, or patients. This could not only damage the robot itself but also pose a threat to the safety of patients and medical staff.

[0003] To address this issue, related technologies typically employ limiting the maximum current output of the robotic arm to control its movement and ensure surgical safety. However, this method cannot dynamically adjust based on the actual state of the robotic arm, resulting in restricted movement even when there is no risk of collision, degraded tracking performance, and impacted surgical precision. Furthermore, because this method cannot adjust the robotic arm's movement in a timely manner, it cannot effectively reduce damage caused by collisions. Summary of the Invention

[0004] To overcome the problems existing in related technologies, this application provides a motion control method for a surgical robot and a surgical robot system.

[0005] According to a first aspect of the embodiments of this application, a motion control method for a surgical robot system is provided, the surgical robot system including a manipulator assembly, the manipulator assembly being movable under the actuation of an actuator; the method includes:

[0006] Determine whether the manipulator component has collided, including whether a collision is about to occur or has already occurred;

[0007] In response to a collision with the manipulator assembly, the control parameters of the actuator are adjusted to reduce the current output of the actuator;

[0008] The actuator actuates the manipulator assembly to make it move.

[0009] According to a second aspect of the embodiments of this application, a computer-readable storage medium is provided, which stores a computer program that, when executed by a processor, implements the steps of the above-described motion control method.

[0010] According to a third aspect of the present application, a surgical robot system is provided, comprising: a manipulator assembly and a control device, wherein the manipulator assembly is movable under the actuation of an actuator, and the control device is configured to perform the steps of the above-described motion control method.

[0011] The technical solutions provided by the embodiments of this application may include the following beneficial effects:

[0012] This application proposes a motion control method. This method determines whether a collision has occurred with the manipulator assembly and adjusts the control parameters of the actuator when a collision occurs to reduce the current output of the actuator, thereby actuating the manipulator assembly. This achieves current adjustment only when a collision risk is detected in the manipulator assembly, thus effectively maintaining the motion tracking performance of the manipulator assembly when there is no collision risk, improving the accuracy of the surgery. At the same time, this method can promptly reduce the current output of the actuator when the manipulator assembly is about to collide or has already collided, thereby adjusting the motion of the manipulator assembly and effectively reducing the damage caused by the collision.

[0013] It should be understood that the above general description and the following detailed description are exemplary and explanatory only, and do not limit this application. Attached Figure Description

[0014] The accompanying drawings, which are incorporated in and form part of this application, illustrate embodiments consistent with this application and, together with the description, serve to explain the principles of this application.

[0015] Figure 1 A schematic diagram of the structure of a surgical robot system 10 according to one or more embodiments is shown.

[0016] Figure 2A A schematic diagram of the structure of a robot manipulation system 102 according to one or more embodiments is shown.

[0017] Figure 2B A schematic diagram of the structure of a robot manipulation system 102 according to one or more embodiments is shown.

[0018] Figure 2C A schematic diagram of the structure of a robot manipulation system 102 according to one or more embodiments is shown.

[0019] Figure 3A A schematic diagram of the control principle of a control device including a current feedback loop according to one or more embodiments is shown.

[0020] Figure 3B A schematic diagram of the control principle of a control device comprising multiple feedback loops according to one or more embodiments is shown.

[0021] Figure 4This is a flowchart illustrating a motion control method according to an exemplary embodiment of this application.

[0022] Figure 5 This is a flowchart illustrating another motion control method according to an exemplary embodiment of this application.

[0023] Figure 6 This is a flowchart illustrating another motion control method according to an exemplary embodiment of this application. Detailed Implementation

[0024] Exemplary embodiments will now be described in detail, examples of which are illustrated in the accompanying drawings. When the following description relates to the drawings, unless otherwise indicated, the same numbers in different drawings denote the same or similar elements. The embodiments described in the following exemplary embodiments do not represent all embodiments consistent with this application. Rather, they are merely examples of apparatuses and methods consistent with some aspects of this application as detailed in the appended claims.

[0025] The terminology used in this application is for the purpose of describing particular embodiments only and is not intended to be limiting of the application. The singular forms “a,” “the,” and “the” used in this application and the appended claims are also intended to include the plural forms unless the context clearly indicates otherwise. It should also be understood that the term “and / or” as used herein refers to and includes any or all possible combinations of one or more of the associated listed items.

[0026] It should be understood that although the terms first, second, third, etc., may be used in this application to describe various information, such information should not be limited to these terms. These terms are only used to distinguish information of the same type from one another. For example, without departing from the scope of this application, first information may also be referred to as second information, and similarly, second information may also be referred to as first information. Depending on the context, the word "if" as used herein may be interpreted as "when," "when," or "in response to determination."

[0027] The motion control method involved in this application is a motion control method for a surgical robot system. Therefore, in order to better explain this application, the surgical robot system to which the motion control method is applied will be described in detail first.

[0028] Figure 1A schematic diagram of a surgical robot system 10 is shown. The surgical robot system 10 may include one or more consoles 101 for use by a user (e.g., a clinician, such as a surgeon in the medical example). One or more assistants may also participate. The console 101 includes a display unit showing the surgical environment (e.g., an image of a surgical site in a surgical scene) and an operation control mechanism. An observation window is provided on the display unit for the doctor to observe the surgical environment. The operation control mechanism is used to capture manual operations by the doctor, which can drive actuators of the manipulator components, thereby actuating the manipulator components of the robot manipulator system 102 to perform corresponding driven tasks.

[0029] The surgical robot system 10 may also include a robot manipulation system 102 (e.g., a patient-side robotic device in a medical example). The robot manipulation system 102 may include at least one manipulator assembly. The manipulator assembly may be a manipulator arm or a manipulator arm detachably mounted with tools. The tools that can be mounted on the manipulator arm may include surgical instruments or imaging devices, wherein the imaging devices are capable of imaging the work site (e.g., endoscopes, optical cameras, ultrasound probes, etc.).

[0030] The surgical robot system 10 may also include an imaging system 103, which has a display screen, an endoscope controller, system electronics, an image processor, etc., for observing and controlling the movement and viewing angle of the endoscope and processing the images, providing clear images of the surgical site, helping doctors to accurately identify and locate the surgical site, and assisting in surgical operations.

[0031] Figure 2A A schematic diagram of a robot manipulation system 102 is shown. The robot manipulation system 102 includes a base and multiple manipulator assemblies mounted on the base. Each manipulator assembly has several connecting arms, with adjacent connecting arms connected by joints, allowing for relative movement with specific degrees of freedom. Under the actuation of actuators, each joint enables the manipulator assembly to achieve multiple degrees of freedom (e.g., 7 degrees of freedom, depending on the instrument). The actuators can be various actuating elements used to actuate the movement of the manipulator assemblies, such as motors, hydraulic cylinders, or pneumatic cylinders.

[0032] Figure 2B A schematic diagram of another robot manipulation system 102 is shown. This robot manipulation system 102 includes a base and a single manipulator assembly mounted on the base. The structure of this single manipulator assembly is compatible with... Figure 2A same.

[0033] Figure 2CA schematic diagram of another robotic manipulation system 102 is shown. The robotic manipulation system 102 includes a base and multiple manipulator components disposed on the base, which can be inserted into the patient's body through a single port.

[0034] It is understandable that the robot manipulation system 102 can also take other structural forms, which will not be listed here.

[0035] The surgical robot system 10 also includes a control device 104, which is communicatively coupled to the console 101, the robot manipulation system 102, and the imaging system 103, or is disposed within the console 100. This control device is configured to perform the steps of the motion control method described in the embodiments of this application.

[0036] The control device 104 can control the surgical robot system 10 using either open-loop or closed-loop control. Open-loop control typically does not include a feedback loop, while closed-loop control typically includes one or more feedback loops. Each feedback loop can be used to adjust parameters (such as speed, position, or current) that control the movement of the manipulator components, thereby achieving precise control of the manipulator components.

[0037] For reference Figure 3A The diagram illustrates the control principle of a control device 104 containing only a current feedback loop. This control device 104 uses a current controller as the current loop controller. When it receives a control command, the current controller processes the difference between the desired current in the control command and the actual current of the actuator M based on preset current loop control parameters to obtain the current used to drive the actuator M. This current then drives the actuator M, which in turn actuates the manipulator assembly to move. The current controller can be a PID controller, and the current loop control parameters include at least one of proportional gain, integral gain, or derivative gain.

[0038] For reference Figure 3BThis diagram illustrates the control principle of a control device 104 that simultaneously includes position, speed, and current feedback loops. The position controller, acting as a position loop controller, determines the desired speed based on the difference between the desired position in the control command and the actual position of the manipulator component under the actuation of the actuator M. The speed controller, acting as a speed loop controller, determines the desired current based on the difference between the desired speed and the actual speed of the manipulator component under the actuation of the actuator M. The current controller, acting as a current loop controller, processes the difference between the desired current and the actual current of the actuator M based on preset current loop control parameters to obtain the current used to drive the actuator M. This current drives the actuator M, which in turn actuates the manipulator component to move. The current controller can be a PID controller, and the current loop control parameters include at least one of proportional gain, integral gain, or derivative gain.

[0039] During surgery, the manipulator components may collide unexpectedly with their own robotic arm, surgical instruments, medical staff, or patients under the actuation of the actuator. This may not only damage the surgical robot system 10 itself, but also pose a threat to the safety of patients and medical staff.

[0040] To address this issue, related technologies typically employ limiting the maximum current output of the actuator to control the movement of the manipulator assembly, ensuring the safety of the surgical robot system 10. However, this method cannot dynamically adjust according to the actual state of the manipulator assembly, resulting in restricted movement even when there is no risk of collision, degraded tracking performance, and impacted surgical accuracy. Furthermore, because this method cannot adjust the movement state of the manipulator assembly in a timely manner, it cannot effectively reduce damage caused by collisions.

[0041] Therefore, to improve the safety and surgical precision of the surgical robot system 10, this application proposes a motion control method. This method determines whether a collision has occurred with the manipulator component and reduces the upper limit of the actuator current when a collision occurs, thereby actuating the manipulator component. This achieves current adjustment only when a collision risk is detected in the manipulator component, effectively maintaining the motion tracking performance of the manipulator component when there is no collision risk, thus improving surgical precision. Furthermore, this method can promptly reduce the upper limit of the actuator current when the manipulator component is about to collide or has already collided, thereby adjusting the movement of the manipulator component and effectively reducing damage caused by the collision.

[0042] The motion control method proposed in this application will be described in detail below with reference to the accompanying drawings.

[0043] Figure 4 This is a flowchart illustrating a motion control method according to an exemplary embodiment of this application. Figure 4As shown, the motion control method includes:

[0044] S401. Determine if a collision has occurred in the manipulator assembly.

[0045] In a surgical robot system, whether a collision has occurred can be determined by comparing the real-time state of the manipulator component with its expected collision state. The real-time state refers to various information related to the current motion state of the manipulator component, including but not limited to at least one of the following: position, velocity, acceleration, and forces acting on the manipulator component. This information can be acquired in real time by sensors (such as position sensors, velocity sensors, acceleration sensors, force sensors, etc.) mounted on the manipulator component. The collision state refers to various preset states of the manipulator component when a collision is expected, such as the expected collision location, minimum velocity, minimum acceleration, and minimum force at the time of collision. These can be preset based on the design parameters of the surgical robot system 10, the surgical environment, and safety standards.

[0046] Specifically, a collision involving the control component can be categorized into two scenarios: an impending collision or an already occurring collision. An impending collision can be understood as the control component not yet making contact with the surrounding environment, but being too close, posing a potential collision risk; an already occurring collision can be understood as the control component having actually made contact with the surrounding environment. When comparing the real-time state of the control component with the collision state, if the real-time state is close to the preset collision state—for example, when the real-time movement trajectory of the control component shows that the control component is moving towards the surrounding environment such as an operating table or medical personnel, and the distance is less than the preset collision safety distance—then the control component can be considered to be about to collide. Conversely, if the real-time state has reached or exceeded the preset collision state—for example, when the force acting on the control component exceeds the minimum force required for a collision—then the control component can be considered to have already collided.

[0047] S402. In response to a collision in the manipulator assembly, adjust the control parameters of the actuator to reduce the current output of the actuator.

[0048] The control parameters of the actuator refer to the control parameters that can affect the current output of the actuator. Such control parameters may include, but are not limited to, at least one of the following: the upper limit value of the current of the actuator, or the current loop control parameters of the actuator.

[0049] As the power source for the manipulator assembly, the actuator's output torque directly determines the assembly's speed and force. Its current output, in turn, determines the maximum torque the actuator can output. Therefore, by adjusting the actuator's current output, the manipulator assembly's motion performance can be adjusted. In this embodiment, when a collision is detected, the actuator's control parameters are adjusted promptly to reduce its current output. This means reducing the actuator's maximum output torque, thereby limiting the manipulator assembly's speed and force. This effectively reduces the collision force and minimizes damage during a collision. Furthermore, this embodiment only adjusts the actuator's control parameters to reduce its current output when a collision is detected. This means that when no collision occurs, the manipulator assembly's motion tracking performance is maintained, ensuring high precision and efficiency in surgical procedures.

[0050] Adjusting the actuator's control parameters to reduce the actuator's current output specifically involves: reducing the actuator's upper current limit to reduce the current output; or reducing the actuator's current loop control parameters, such as reducing at least one of the proportional gain or integral gain in the current loop control parameters to reduce the actuator's current output; or reducing the actuator's upper current limit and at least one of the proportional gain or integral gain in the current loop control parameters to reduce the actuator's current output.

[0051] S403, The actuator actuates the manipulator assembly to make it move.

[0052] Specifically, an actuator can be a device that converts electrical energy or other forms of energy into mechanical motion or force. During the operation, the console 101 can first acquire the surgical instructions or surgical plan input by the user, generate control instruction electrical signals for the manipulator components, and send them to the actuator. The actuator then converts these electrical signals into mechanical energy, thereby driving the manipulator components to move according to the predetermined state in the control instructions.

[0053] Conversely, in some embodiments, if no collision is detected in the manipulator assembly, the control parameters of the actuator can be maintained at preset control parameters, thereby maintaining the current output of the actuator. These preset control parameters can be current values ​​that are pre-set according to the design parameters of the surgical robot and the needs of the surgical operation, and can maintain the normal operation of the manipulator assembly. This allows the actuator to provide sufficient power to drive the manipulator assembly to make precise movements in normal working condition, ensuring the smooth progress of the surgical operation.

[0054] Figure 5 This is a flowchart illustrating another motion control method according to the above embodiments. Figure 5As shown, the motion control method includes:

[0055] S501. Determine if a collision has occurred in the control unit;

[0056] S502a: In response to a collision in the manipulator assembly, the control parameters of the actuator are adjusted to reduce the current output of the actuator.

[0057] Adjusting the actuator's control parameters to reduce the actuator's current output specifically involves: reducing the actuator's upper current limit to reduce the current output; or reducing the actuator's current loop control parameters, such as reducing at least one of the proportional gain or integral gain in the current loop control parameters to reduce the actuator's current output; or reducing the actuator's upper current limit and at least one of the proportional gain or integral gain in the current loop control parameters to reduce the actuator's current output.

[0058] S502b: In response to the absence of a collision in the manipulator assembly, the control parameters of the actuator are maintained at the preset control parameters;

[0059] Specifically, maintaining the actuator's control parameters as preset control parameters means: if the control parameter reduced in 502a is the upper limit of current, then in response to no collision occurring in the manipulator assembly, maintaining the upper limit of current of the actuator as the preset upper limit of current; if the control parameter reduced in 502a is a current loop control parameter, such as reducing at least one of the proportional gain or integral gain in the current loop control parameters, then in response to no collision occurring in the manipulator assembly, maintaining the proportional gain in the current loop control parameters of the actuator as the preset proportional gain, or maintaining the integral gain in the current loop control parameters of the actuator as the preset integral gain.

[0060] S503, The actuator actuates the manipulator assembly to make it move.

[0061] By employing the above methods, the control parameters of the actuator can be adjusted promptly when a collision risk is detected in the manipulator components. This reduces the actuator's current output, thereby minimizing collision damage and protecting the safety of patients and medical staff. Conversely, when no collision risk is detected, normal operational performance is maintained, ensuring the precision and efficiency of the surgery. This dynamic adjustment mechanism allows the surgical robot system 10 to adapt to different surgical environments and situations, improving the overall safety and success rate of the surgery.

[0062] Meanwhile, the collision situation of the manipulator assembly may change at any time during the operation. For example, in some embodiments, after a collision of the manipulator assembly is detected and the control parameters of the actuator are adjusted accordingly to reduce the current output of the actuator, if no collision is detected again at the next moment, indicating that the manipulator assembly is no longer in a collision state, the control parameters of the actuator should be increased to the preset control parameters to increase the current output of the actuator. This allows the actuator to return to the normal power output level, allowing the manipulator assembly to move at normal speed and precision, ensuring the efficiency and accuracy of the surgical operation.

[0063] Based on this Figure 6 This is another motion control method illustrated in an exemplary embodiment of this application. For example... Figure 5 As shown, the motion control method includes:

[0064] S601. Determine if a collision has occurred in the control unit;

[0065] S602. In response to a collision in the manipulator assembly, adjust the control parameters of the actuator to reduce the current output of the actuator.

[0066] S603, The actuator actuates the manipulator assembly to make movement;

[0067] S604. In response to the fact that no collision occurs in the manipulator assembly at the next moment, the control parameters of the actuator are increased to the preset control parameters.

[0068] Specifically, increasing the actuator's control parameters to preset control parameters involves: if the control parameter reduced in 602 is the upper limit of current, then in response to no collision occurring in the next moment of the manipulator assembly, increasing the upper limit of current of the actuator to the preset upper limit of current; if the control parameter reduced in 602 is a current loop control parameter, such as reducing at least one of the proportional gain or integral gain in the current loop control parameters, then in response to no collision occurring in the next moment of the manipulator assembly, increasing the proportional gain in the current loop control parameters of the actuator to a preset proportional gain, or increasing the integral gain in the current loop control parameters of the actuator to a preset integral gain.

[0069] This dynamic adjustment mechanism allows for timely and flexible adjustment of the actuator's control parameters based on the actual collision situation of the manipulator components during surgery. This, in turn, adjusts the actuator's current output to modify the motion control strategy of the manipulator components. Under the premise of ensuring safety, the manipulator components can quickly return to their optimal performance state as needed, thereby improving the safety and reliability of the surgery.

[0070] In the aforementioned motion control methods, selecting an appropriate collision detection method is crucial, as it directly impacts the accuracy and efficiency of the overall method for collision detection of the manipulator components. The forces acting on the manipulator components, as a form of their real-time state, directly reflect the contact between the manipulator components and the external environment, such as the operating table, medical personnel, or patients, during their real-time movement. This allows for the rapid and accurate detection of whether a collision has occurred, making it a key indicator for collision detection.

[0071] Therefore, in some embodiments, the force acting on the manipulator component can be obtained and it can be determined whether the force is higher than a first threshold, which is not less than the minimum force acting on the manipulator component when it collides. If the force is higher than the first threshold, it is determined that the manipulator component has collided, and the control parameters of the actuator are adjusted accordingly to reduce the current output of the actuator.

[0072] This approach ensures that a collision can only be detected when the force acting on the manipulator component exceeds the first threshold at which a collision occurs. Only then will the control parameters of the actuator be adjusted to reduce the current output of the actuator. This effectively avoids false collision detection due to noise or sensor interference, thereby improving the accuracy and efficiency of collision detection.

[0073] When determining whether to use the forces acting on the manipulator components for collision detection, the methods for obtaining these forces mainly fall into two categories: one is direct measurement using force sensors, and the other is estimation using non-force sensor methods. In practice, the appropriate method can be chosen flexibly based on actual needs.

[0074] In some embodiments, where the force on a manipulator assembly is measured directly using a force sensor, a force sensor can be mounted on the manipulator assembly to detect the force acting on it. The real-time force on the manipulator assembly can then be determined based on the force sensor's output information. Here, the force sensor's output information refers to the force sensor's reading or other information that indicates the measurement result.

[0075] More specifically, in order to accurately measure the forces acting on the manipulator assembly, a force sensor can be mounted at the expected collision location of the manipulator assembly or on the joint assembly.

[0076] In some embodiments, the force sensor is mounted at the expected collision location of the manipulator assembly, so the output information of the force sensor can be directly used as the force acting on the manipulator assembly.

[0077] In this embodiment, the expected collision location of the manipulator assembly refers to the area on the manipulator assembly that may come into direct contact with the external environment, such as the operating table, medical staff, or patient, during the operation, potentially leading to a collision. For example, the end of the manipulator arm, where surgical instruments or imaging equipment are mounted, may collide with the patient's body or other surgical instruments during movement; or the connection structure of the manipulator assembly, which is mainly used to connect to and follow the movement of the manipulator arm, and may collide with the operating table or medical staff, etc. These expected collision locations are all positions where the manipulator assembly can directly contact the external environment; therefore, the measurement results from the force sensors mounted on them can be directly used as the magnitude of the force acting on the manipulator assembly.

[0078] In other embodiments, the force sensor is mounted on the joint assembly of the manipulator assembly, and the output information of the force sensor needs to be converted based on a preset Jacobian matrix to obtain the force acting on the manipulator assembly.

[0079] In this embodiment, the joint assembly is typically an internal structure of the manipulator assembly and does not directly contact the external environment. Therefore, the force sensors mounted on the joint assembly measure the torque generated at the joint, rather than the force directly acting on the manipulator assembly from the external environment. Thus, a Jacobi matrix is ​​needed to convert these joint torques into real-time forces acting on the manipulator assembly. The Jacobi matrix is ​​a predefined matrix describing the relationship between the joint space and the operating space of the manipulator assembly. Through this matrix, forces in the joint space can be converted into forces in the operating space, i.e., the forces acting on the manipulator assembly.

[0080] For estimating real-time forces using non-force sensor methods, the following two specific estimation methods can generally be adopted.

[0081] One approach, in some embodiments, is to obtain the output current of the actuator and then determine the real-time force acting on the manipulator assembly based on the output current, the actuator constant, and a preset Jacobian matrix.

[0082] The output current of an actuator is typically proportional to the torque it generates, while the actuator constant (such as the motor constant) is a key parameter describing actuator performance and is directly related to the output torque. The Jacobian matrix describes the transformation relationship between the joint space and the operating space of the manipulator assembly. Therefore, by combining these parameters, the forces acting on the manipulator assembly can be calculated relatively accurately without relying on force sensors.

[0083] Another approach, in some other embodiments, involves obtaining the position, velocity, acceleration, and dynamic parameters of the actuator and the manipulator assembly. Based on these parameters, the total output force and actual load of the manipulator assembly are first determined. Then, based on the difference between the total output force and the actual load, the force acting on the manipulator assembly is determined.

[0084] Since the actuator is the direct driving source of the manipulator assembly's motion, its position, velocity, acceleration, and other motion state information directly reflect the manipulator assembly's motion state. The manipulator assembly's dynamic parameters are the parameters that the manipulator assembly must follow during its motion, and may include the manipulator assembly's mass, moment of inertia, coefficient of friction, etc. The total output force refers to the force generated by the manipulator assembly to complete the surgical operation, while the actual force it bears includes all forces acting on the manipulator assembly, such as contact forces from the external environment, and frictional and inertial forces generated during motion. Therefore, by calculating the difference between these two forces, the real-time forces exerted on the manipulator assembly by the external environment during surgery can be obtained. The calculation of the total output force and the actual force it bears can be based on the actuator's position, velocity, acceleration, and the manipulator assembly's dynamic parameters, using methods such as dynamic equations (e.g., Newton's second law).

[0085] Furthermore, when a collision is detected in the manipulator assembly through force analysis, and the actuator control parameters need to be adjusted to reduce the actuator current output, various adverse situations may arise if the adjustment amount of the control parameters is not limited. For example, if the force on the manipulator assembly is large, but the reduction in the actuator control parameters is insufficient to significantly reduce the speed and force of the manipulator assembly, the collision force and damage generated during the collision will still be large. Conversely, if the force on the manipulator assembly is small, but the reduction in the actuator control parameters is too large, the motion performance of the manipulator assembly may be excessively restricted, thereby reducing the efficiency of the surgical operation and potentially affecting the accuracy of the surgery.

[0086] Therefore, in order to adjust the control parameters of the actuator appropriately and accurately, in some embodiments, the control parameters of the actuator can be controlled to decrease by a decreasing value, such that the decreasing value is positively correlated with the force applied to the manipulator assembly.

[0087] Regarding the adjustment of the actuator's control parameters, some embodiments may employ two specific adjustment methods: reducing the actuator's control parameters to a first preset value, or reducing the actuator's control parameters to a second preset value. Reducing the actuator's control parameters to the first preset value means decreasing the actuator's control parameters by a specific amount, which is pre-set and called the "first preset value." This adjustment method typically means that the control parameters will decrease by a fixed value, but not to zero, but rather remain above a certain safety level. Reducing the actuator's control parameters to the second preset value means reducing the actuator's control parameters to a preset value, called the "second preset value." This adjustment method means that the control parameters may decrease to a lower level, possibly approaching or reaching zero, to maximally limit the movement of the manipulator assembly, thereby providing additional safety assurance when a high-risk collision is detected.

[0088] In addition to collision detection based on the force acting on the manipulator assembly, some embodiments may further determine whether the force acting on the manipulator assembly exceeds a second threshold, which is greater than a first threshold. In response to the force exceeding the second threshold, the actuator is controlled to stop actuating. In this embodiment, when a force exceeding the second threshold is detected, since the second threshold is set higher than the first threshold, this indicates that the force acting on the manipulator assembly not only exceeds the minimum force required for a collision but also reaches a higher level, suggesting a potentially greater collision force and greater potential damage. In this case, controlling the actuator to stop actuating means that the movement of the manipulator assembly will be stopped immediately, minimizing harm to the patient and the surgical environment and ensuring surgical safety.

[0089] In other embodiments, the surgical robot system may further include an input device. Input operations on the input device can drive actuators to actuate. The motion control method of this application may further include determining whether the applied force is higher than a third threshold, which is greater than a first threshold, and providing force feedback to the user via the input device in response to the applied force being higher than the third threshold. In this embodiment, the input device can be various devices capable of human-machine interaction with the user, such as joysticks, buttons, user interfaces, etc., mainly used to receive user input operation commands and provide feedback to the user based on the actual movement of the manipulator components. When an applied force exceeding the third threshold is detected, since the third threshold is set higher than the first threshold, this indicates that the force acting on the manipulator components not only exceeds the minimum force required for a collision but also reaches a higher level, suggesting that the manipulator components may be experiencing abnormal, potentially dangerous contact or pressure. In this case, force feedback can be provided to the user via the input device to alert the user to potential dangers to the manipulator components, prompting the user to adjust their operating strategy or take necessary precautions in a timely manner, thereby improving the safety and accuracy of the surgical operation. Specifically, the form of providing force feedback to the user via the input device may be by increasing the resistance of the joystick, vibration, or issuing an audible alarm.

[0090] In addition to collision detection through the forces acting on the manipulator components, some embodiments can also obtain a kinematic model of the manipulator components by performing kinematic and geometric modeling on the manipulator components, and then predict the motion trajectory of the manipulator components based on the kinematic model and the current state of the manipulator components, and then determine whether the manipulator components have collided based on the motion trajectory and a preset collision threshold.

[0091] In this embodiment, kinematic modeling refers to the process of analyzing and describing the motion characteristics of the manipulator assembly. This may include establishing kinematic equations for the manipulator assembly, which describe the motion relationships between its various parts, including joint angles, velocities, and accelerations. Kinematic modeling allows us to understand how the manipulator assembly moves in space, regardless of the forces acting on it. Geometric modeling, on the other hand, constructs a model of the manipulator assembly's geometry and dimensions. This includes the assembly's physical structure, dimensions, shape, and the relative positions of its parts, aiding in understanding the physical layout of the manipulator assembly in space. By combining kinematic and geometric modeling, a complete kinematic model of the manipulator assembly can be obtained. This model integrates the motion characteristics and physical structure of the manipulator assembly, providing a foundation for predicting its trajectory. The current state of the manipulator assembly primarily refers to its real-time position, velocity, and acceleration during the surgical procedure. This information can be acquired in real-time by sensors mounted on the manipulator assembly. Combining the current state of the manipulator assembly with the kinematic model allows us to predict its trajectory over a given period. Finally, the preset collision threshold can be various safety standards used in the surgical robot system to determine whether the manipulator component may collide with the surrounding environment, which may include distance thresholds, velocity thresholds, or acceleration thresholds. If the predicted motion trajectory is close to or exceeds the preset collision threshold, it indicates that the manipulator component is too close to or in contact with the surrounding environment, and a collision is determined to have occurred.

[0092] This application also provides a computer-readable storage medium storing a computer program, which, when executed by a processor, implements the steps of the above-described motion control method.

[0093] The foregoing has described specific embodiments of this application. Other embodiments are within the scope of the appended claims. In some cases, the actions or steps recited in the claims may be performed in a different order than that shown in the embodiments and may still achieve the desired results. Furthermore, the processes depicted in the drawings do not necessarily require the specific or sequential order shown to achieve the desired results. In some embodiments, multitasking and parallel processing are also possible or may be advantageous.

[0094] Other embodiments of this application will readily occur to those skilled in the art upon consideration of the specification and practice of the invention filed herein. This application is intended to cover any variations, uses, or adaptations of this application that follow the general principles of this application and include common knowledge or customary techniques in the art not claimed herein. The specification and examples are to be considered exemplary only, and the true scope and spirit of this application are indicated by the following claims.

[0095] It should be understood that this application is not limited to the precise structure described above and shown in the accompanying drawings, and various modifications and changes can be made without departing from its scope. The scope of this application is limited only by the appended claims.

[0096] The above description is merely a preferred embodiment of this application and is not intended to limit this application. Any modifications, equivalent substitutions, improvements, etc., made within the spirit and principles of this application should be included within the scope of protection of this application.

Claims

1. A motion control method of a surgical robotic system, characterized by, The surgical robot system comprises a manipulator assembly which is movable under actuation of an actuator; the method comprises: determining whether the manipulator assembly is in a collision, the collision including an impending collision or a collision having occurred; in response to the manipulator assembly being in a collision, adjusting a control parameter of the actuator to reduce a current output of the actuator; actuating the manipulator assembly to move by the actuator.

2. The method of claim 1, wherein, The method further comprises: in response to the manipulator assembly not being in a collision, maintaining the control parameter of the actuator as a preset control parameter.

3. The method of claim 1, wherein, After adjusting the control parameter of the actuator to reduce the current output of the actuator, the method further comprises: in response to the manipulator assembly not being in a collision at a next time, increasing the control parameter of the actuator to the preset control parameter.

4. The method of claim 1, wherein, The control parameter of the actuator comprises a current upper limit value of the actuator and / or a current loop control parameter of the actuator.

5. The method according to any one of claims 1 to 4, characterized in that, The determination of whether the manipulator assembly is in a collision comprises: obtaining an acting force on the manipulator assembly; determining whether the acting force is higher than a first threshold value, the first threshold value being not less than a minimum acting force on the manipulator assembly when the collision occurs; if the acting force is higher than the first threshold value, determining that the manipulator assembly is in a collision.

6. The method of claim 5, wherein, A force sensor is mounted on the manipulator assembly to detect the acting force on the manipulator assembly; The obtaining of the acting force on the manipulator assembly comprises: determining the acting force on the manipulator assembly according to output information of the force sensor.

7. The method of claim 6, wherein, The force sensor is mounted at an expected collision position of the manipulator assembly; the determination of the acting force on the manipulator assembly according to the output information of the force sensor comprises: taking the output information of the force sensor as the acting force on the manipulator assembly.

8. The method of claim 6, wherein, The force sensor is mounted on a joint assembly of the manipulator assembly; The determination of the acting force on the manipulator assembly according to the output information of the force sensor comprises: transforming the output information of the force sensor based on a preset Jacobian matrix to obtain the acting force on the manipulator assembly.

9. The method of claim 5, wherein, The obtaining of the acting force on the manipulator assembly comprises: obtaining an output current of the actuator; determining the acting force on the manipulator assembly based on the output current, an actuator constant of the actuator and a preset Jacobian matrix.

10. The method of claim 5, wherein, The obtaining of the acting force on the manipulator assembly comprises: obtaining a position of the actuator, a speed of the actuator, an acceleration of the actuator and a dynamic parameter of the manipulator assembly; determining a total output force and an actual bearing force of the manipulator assembly based on the position of the actuator, the speed of the actuator, the acceleration of the actuator and the dynamic parameter of the manipulator assembly; determining the acting force on the manipulator assembly based on a difference between the total output force and the actual bearing force.

11. The method of claim 5, wherein, The adjustment of the control parameter of the actuator to reduce the current output of the actuator comprises: a control parameter of the actuator is decreased by a decrease value, the decrease value being positively correlated with the force experienced by the manipulator assembly.

12. The method of claim 5, wherein, the control parameter of the actuator is adjusted to decrease the current output of the actuator, including: the control parameter of the actuator is decreased by a first preset value, or the control parameter of the actuator is decreased to a second preset value.

13. The method of claim 5, wherein, the method further includes: determining whether the force is higher than a second threshold, the second threshold being greater than the first threshold; in response to the force being higher than the second threshold, controlling the actuator to stop actuating.

14. The method of claim 5, wherein, the surgical robotic system further includes an input device, an input operation of the input device being capable of driving the actuator to actuate, the method further includes: determining whether the force is higher than a third threshold, the third threshold being greater than the first threshold; in response to the force being higher than the third threshold, providing force feedback to a user through the input device.

15. The method according to any one of claims 1 to 4, characterized in that, the determining whether the manipulator assembly collides, including: kinematically modeling and geometrically modeling the manipulator assembly to obtain a kinematic model of the manipulator assembly; predicting a motion trajectory of the manipulator assembly based on the kinematic model and a current state of the manipulator assembly; determining whether the manipulator assembly collides based on the motion trajectory and a preset collision threshold.

16. A computer readable storage medium storing a computer program, wherein the computer program comprises program instructions configured to cause a processor to perform the method according to any one of claims 1 to 15. the program, when executed by a processor, implements the steps of the method of any one of claims 1-15.

17. A surgical robotic system, characterized by, including: a manipulator assembly, the manipulator assembly being movable under actuation of an actuator, and a control device, the control device being configured to perform the steps of the method of any one of claims 1-15.

Citation Information

Patent Citations

  • Surgical robot with mechanical arm and method for detecting collision of mechanical arm

    CN109288592A

  • Surgical robot and anti-collision method and anti-collision system of arm of surgical robot

    CN115500954A

  • Robot, collision protection method and device thereof and storage medium

    CN115890666A

  • A robot collision avoidance detection method, device and storage medium

    CN116810789A

  • Safety control method of surgical robot and related equipment

    CN117462270A

Cited By

  • Abnormal collision detection-based training set optimization method and related device

    CN122087427A

  • Training set optimization method based on abnormal collision detection and related device

    CN122087427B