Spatial variable impedance intelligent control method and device for mechanical arm of surgical robot

By constructing a spatial impedance control equation with variable parameters and adjusting the joint output torque in real-time target position, the problem of inaccurate joint angle guidance of the robotic arm in surgical robots is solved, and the accurate force guidance of the robotic arm and the target position arrival are achieved.

CN119036438APending Publication Date: 2024-11-29LONGWOOD VALLEY MEDICAL TECH CO LTD
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202411042258.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-31
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

In navigation surgical robots, the operator cannot intuitively guide the joint angle of the robotic arm to the appropriate position, resulting in inaccurate guidance.

Method used

By constructing a spatial impedance control equation based on the robotic arm dynamics model, variable parameters are set to adjust the joint output torque, torque adjustment is performed according to the real-time target position, providing force guidance, and ensuring that the robotic arm is accurately dragged to the target position.

Benefits of technology

It realizes intuitive force guidance for the operator in the joint space of the robot arm, avoids guidance errors caused by changes in the target position, and ensures that the robot arm can accurately reach the target position.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119036438A_ABST
    Figure CN119036438A_ABST
Patent Text Reader

Abstract

The invention provides a surgical robot mechanical arm space variable impedance intelligent control method and device, and the method comprises the steps that a space impedance control equation is built based on a mechanical arm dynamic model, and at least one control parameter of the space impedance control equation is a variable parameter; the real-time target position of the mechanical arm is obtained; according to the real-time target position of the mechanical arm and the spatial impedance control equation, the joint output torque is determined; and controlling the mechanical arm to execute a control action based on the joint output torque. In the application, by designing the joint space impedance controller, force guidance can be provided for an operator in the joint space, dragging to the target position is facilitated, and the joint output torque can be adjusted according to the real-time target position, so that force guidance is performed on the real-time target position, and guidance errors caused by target position changes are avoided.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of surgical robots, and in particular to a method and device for intelligently controlling spatially variable impedance of a surgical robot arm. Background Art

[0002] In navigational surgical robots, visual interaction, namely image navigation, can provide image information for guiding the dragging of the robotic arm. However, in the joint space of the robotic arm, the operator cannot intuitively guide the joint angle to a more appropriate angle. Summary of the invention

[0003] The problem that the present application solves is the problem that the operator cannot intuitively guide the joint angle to a more appropriate angle in the joint space of the robot arm.

[0004] In order to solve the above problems, the first aspect of the present application provides a method for intelligently controlling spatial variable impedance of a surgical robot manipulator, comprising:

[0005] Constructing a spatial impedance control equation based on the mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter;

[0006] Get the real-time target position of the robot arm;

[0007] Determine the joint output torque based on the real-time target position of the robot and the spatial impedance control equation;

[0008] Based on the joint output torque, the robotic arm is controlled to perform a control action.

[0009] The second aspect of the present application provides a spatial variable impedance intelligent control device for a surgical robot manipulator arm, comprising:

[0010] An equation building module, which is used to build a spatial impedance control equation based on a mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter;

[0011] A position acquisition module, which is used to obtain the real-time target position of the robotic arm;

[0012] A torque output module, which is used to determine the joint output torque according to the real-time target position of the robot arm and the spatial impedance control equation;

[0013] A robot arm control module is used to control the robot arm to perform a control action based on the joint output torque.

[0014] A third aspect of the present application provides an electronic device, comprising: a memory and a processor;

[0015] The memory is used to store programs;

[0016] The processor, coupled to the memory, is configured to execute the program to:

[0017] Constructing a spatial impedance control equation based on the mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter;

[0018] Get the real-time target position of the robot arm;

[0019] Determine the joint output torque based on the real-time target position of the robot and the spatial impedance control equation;

[0020] Based on the joint output torque, the robotic arm is controlled to perform a control action.

[0021] A fourth aspect of the present application provides a computer-readable storage medium having a computer program stored thereon, wherein the program is executed by a processor to implement the above-mentioned method for intelligent control of spatial variable impedance of a surgical robot arm.

[0022] In the present application, a joint space impedance controller is designed in order to provide force guidance for the operator in the joint space, so as to facilitate dragging to the target position.

[0023] In the present application, the joint output torque can be adjusted according to the real-time target position, so as to perform force guidance on the real-time target position and avoid guidance errors caused by changes in the target position. BRIEF DESCRIPTION OF THE DRAWINGS

[0024] Figure 1 It is a flow chart of a method for intelligently controlling spatial variable impedance of a surgical robot manipulator arm according to an embodiment of the present application;

[0025] Figure 2 It is a flow chart of torque output of the spatial variable impedance intelligent control method of the surgical robot manipulator arm according to an embodiment of the present application;

[0026] Figure 3 It is a structural block diagram of a spatial variable impedance intelligent control device for a surgical robot manipulator arm according to an embodiment of the present application;

[0027] Figure 4 is a structural block diagram of an electronic device according to an embodiment of the present application. DETAILED DESCRIPTION

[0028] In order to make the above-mentioned purposes, features and advantages of the present application more obvious and easy to understand, the specific embodiments of the present application are described in detail below in conjunction with the accompanying drawings. Although the exemplary embodiments of the present application are shown in the accompanying drawings, it should be understood that the present application can be implemented in various forms and should not be limited by the embodiments described herein. On the contrary, these embodiments are provided in order to enable a more thorough understanding of the present application and to fully convey the scope of the present application to those skilled in the art.

[0029] It should be noted that, unless otherwise specified, the technical terms or scientific terms used in this application should have the common meanings understood by technicians in the field to which this application belongs.

[0030] In response to the above problems, the present application provides a new spatial variable impedance intelligent control solution for the surgical robot manipulator arm, which can effectively implement force guidance and solve the problem that the operator cannot intuitively guide the joint angle to a more appropriate angle in the manipulator arm joint space.

[0031] The present application embodiment provides a method for intelligently controlling spatial variable impedance of a surgical robot mechanical arm. The specific scheme of the method is as follows: Figure 1-Figure 2 As shown, the method can be performed by a surgical robot arm space variable impedance intelligent control device, and the surgical robot arm space variable impedance intelligent control device can be integrated in electronic devices such as computers, servers, computers, server clusters, and data centers. Figure 1 As shown, it is a flow chart of a method for intelligently controlling a surgical robot manipulator arm spatially variable impedance according to an embodiment of the present application; wherein the method for intelligently controlling a surgical robot manipulator arm spatially variable impedance comprises:

[0032] S101, constructing a spatial impedance control equation based on a mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter;

[0033] Among them, the robot arm dynamics model is a mathematical model that describes the relationship between the force and motion of the robot arm during the movement process. It can be divided into forward dynamics and inverse dynamics. The forward dynamics problem is to calculate the motion (acceleration, velocity and position) of each joint of the robot arm when the torque or force of each joint of the robot arm is known; the inverse dynamics problem is to calculate the joint torque or force required to achieve this motion when the motion (position, velocity and acceleration) of each joint of the robot arm is known.

[0034] Among them, the control parameters of the spatial impedance control equation are mass, damping and stiffness parameters, which represent the motion control of the robot arm.

[0035] Among them, mass represents the inertia of the system, which affects the acceleration response of the system when subjected to external force; damping represents the energy dissipation characteristics of the system, which affects the vibration and stability of the system; stiffness represents the system's resistance to deformation and affects the elastic response of the system.

[0036] It should be noted that, when the control parameters remain unchanged, the farther the robot arm is from the target position, the greater the torque it generates; the closer it is to the target position, the smaller the torque it generates. This will lead to a problem: the guiding force of the robot arm will become smaller and smaller as it gets closer to the target position, until the operator cannot perceive it, which means that the robot arm can only be guided to the vicinity of the target position, but cannot ultimately reach the target position.

[0037] In the present application, by setting the control parameters as variable parameters, the problem that the guiding force becomes smaller and smaller as the distance to the target position becomes closer and closer is solved, thereby avoiding the problem that the robotic arm cannot be guided to the final target position.

[0038] Preferably, at least one control parameter is a variable parameter, the damping parameter and the stiffness parameter are variable parameters, and the mass parameter / spring coefficient is a non-variable parameter, so that the influence of the variable control parameter is constrained in the current impedance control of the robot arm while maintaining the overall control stability.

[0039] Preferably, the mass parameter Me is also referred to as the spring constant in the present application.

[0040] In one embodiment, the spatial impedance control equation is:

[0041]

[0042] Among them, M, B, K are proportional control parameters and differential control parameters respectively, e is the error parameter, To find the time derivative of the error parameter, is the second derivative in time, τ is the joint output torque, M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, and q is the current joint angle.

[0043] Among them, the control input τ is the n×1 joint torque vector, and n is the number of joints of the robot arm.

[0044] Among them, in the spatial impedance control equation, a comprehensive calculation is performed based on the error parameter and the joint angle to obtain the output torque; in this way, the error parameter control and the joint angle control are integrated to achieve a better fusion control effect.

[0045] S102, obtaining the real-time target position of the robotic arm;

[0046] The real-time target position of the robotic arm can be obtained through NDI equipment and preoperative planning. The relative position relationship between the target position of the robotic arm and the surgical object can be planned in preoperative planning. The NDI device can obtain the real-time position of the surgical object in real time, thereby calculating the real-time target position of the robotic arm.

[0047] The specific acquisition method may be: obtaining a preoperative CT two-dimensional / three-dimensional image, on which planning data is annotated, and performing image registration between the preoperative CT two-dimensional / three-dimensional image and the intraoperative surgical object image (which may be obtained through CT or X-ray) and a positioning frame (NDI) fixed on the surgical object, thereby obtaining the real-time target position of the robotic arm. The NDI is used to track the positioning frame to determine the real-time position of the surgical object.

[0048] In the present application, since the real-time target position is determined, when the target position of the robot arm changes, the real-time target position only needs to be updated. Therefore, the action can be accurately executed even when the target position changes.

[0049] S103, determining the joint output torque according to the real-time target position of the robot arm and the spatial impedance control equation;

[0050] In the present application, the joint output torque is the guiding torque, the purpose of which is to enable the operator to perceive the output torque and control the robotic arm based on the guiding torque, thereby guiding the operator to move the robotic arm to the target position and achieve accurate control.

[0051] S104: Based on the joint output torque, control the robotic arm to perform a control action.

[0052] In the present application, a joint space impedance controller is designed in order to provide force guidance for the operator in the joint space, so as to facilitate dragging to the target position.

[0053] In the present application, the joint output torque can be adjusted according to the real-time target position, so as to perform force guidance on the real-time target position and avoid guidance errors caused by changes in the target position.

[0054] In one embodiment, after determining the joint output torque, the method further includes:

[0055] The joint output torque is filtered by a filter to obtain a filtered joint output torque.

[0056] It should be noted that the farther the robotic arm is from the target position, the greater the torque it generates; the closer it is to the target position, the smaller the torque it generates; this will result in a large joint output torque when the robotic arm is far away from the target position. When the operator suddenly lets go of this torque, it will produce an instantaneous impact, causing great instability in the control of the robotic arm and possible danger.

[0057] In the present application, the output torque is filtered so that the output torque is kept within the corresponding range, thereby greatly avoiding possible impacts and dangers during the control process.

[0058] In one embodiment, the filter is configured as follows:

[0059]

[0060] Among them, τ e is the filter output, τ min is the minimum starting torque, dτ e is the output torque change rate, dτ is the torque change rate, τ max is the historical maximum output torque, dτ max is the historical maximum torque change rate.

[0061] In the present application, by setting up a filter, filtering is performed based on the minimum torque and the minimum torque change, so that the output torque is smoother and a better control effect is achieved.

[0062] In one embodiment, the step S103, determining the joint output torque according to the real-time target position of the robot arm and the spatial impedance control equation, includes:

[0063] S301, performing inverse kinematics solution on the real-time target position according to the kinematic parameters of the robot arm to determine the desired joint angle;

[0064] In one embodiment, the kinematic parameters of the robotic arm include the length of the robotic arm link and the pitch angle of the rotary joint.

[0065] Analyzing the robotic arm, it can be seen that the robotic arm is formed by connecting several rods (the place where two rods are connected is a joint), and these rods in the robotic arm are called connecting rods. Each connecting rod can rotate around a certain axis based on the husband connecting rod (the previous connecting rod) (the joint drives the connecting rod to rotate through the motor rotation), and this axis is only relative to the husband connecting rod. This results in that once multiple connecting rods are moving, the connecting rod can only have a direct spatial conversion relationship with the "previous level connecting rod" and the "next level connecting rod", that is, when the rotation angle of the first connecting rod (the pitch angle of the rotating joint) is determined, the specific position of the first connecting rod can be calculated according to the spatial coordinates of the base, and then the position of the end robotic arm can be obtained by calculating backward one level at a time, which is the end position of the loading and unloading ratio.

[0066] In summary, it can be seen that in the motion state of the robot arm, the coordinates of the tool at the end of the robot arm can be determined by knowing the posture of the robot arm (corresponding data / rotation data of each joint). Conversely, if the coordinates of the tool at the end of the robot arm (expected posture) are known, the posture of the robot arm (expected joint angle of each joint) can be determined by inverse kinematics solution.

[0067] It should be noted that the robotic arm can use more than one posture to make the end tool reach the corresponding coordinates. When solving the problem specifically, the feasible postures can be screened according to the actual situation. For example, the fastest way to achieve it relative to the current state, the most energy-efficient relative to the current state, the ability to avoid obstacles, etc. can be used as screening conditions. Just select one of them. The specific inverse kinematics solution method is not limited in this application (the specific solution process will not be repeated in this application).

[0068] It should be noted that the expected joint angle means that each joint on the robotic arm has an expected joint angle; by controlling the robotic arm to adjust each joint to the corresponding expected joint angle, the robotic arm posture solved by inverse kinematics can be achieved, and the end tool can be moved to the expected posture.

[0069] S302, calculating an error parameter based on the expected joint angle and the current joint angle;

[0070] In one implementation, the error parameter is determined by:

[0071] e=qq $

[0072] Among them, e is the error parameter, q is the current joint angle, and q $ is the desired joint angle.

[0073] S303, calculating the joint output torque based on the error parameter and the spatial impedance control equation.

[0074] When the error parameters are determined, the joint output torque can be calculated based on the spatial impedance control equation.

[0075] In one embodiment, the control parameter is determined by:

[0076] K % =diag(δ,...,δ)

[0077]

[0078] Among them, K - is the initial parameter, μ∈[0,1] is the weight factor, δ and S are intermediate variables; τ e is the filter output, dτ e is the rate of change of output torque, τ max is the historical maximum output torque, dτ max is the historical maximum torque change rate, K % , B % is the adjusted control parameter. a is the preset coefficient.

[0079] In the present application, the control parameters are adjusted through the filter parameters, so that the filtered output torque is associated with the control parameters, so as to achieve the linkage effect of output and control, thereby realizing the iteration of control.

[0080] In the present application, the KB control parameters are adjusted through the filter, so as to facilitate guiding the operator to lock the real-time target position.

[0081] An embodiment of the present application provides a spatially variable impedance intelligent control device for a surgical robot arm, which is used to execute the spatially variable impedance intelligent control method for a surgical robot arm described in the above content of the present application. The spatially variable impedance intelligent control device for a surgical robot arm is described in detail below.

[0082] like Figure 3 As shown, the spatial variable impedance intelligent control device for the surgical robot mechanical arm comprises:

[0083] An equation building module 101, which is used to build a spatial impedance control equation based on a mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter;

[0084] A position acquisition module 102, which is used to acquire the real-time target position of the robot arm;

[0085] A torque output module 103, which is used to determine the joint output torque according to the real-time target position of the manipulator and the spatial impedance control equation;

[0086] The robot arm control module 104 is used to control the robot arm to perform a control action based on the joint output torque.

[0087] In one implementation, the torque output module 103 is further configured to:

[0088] The joint output torque is filtered by a filter to obtain a filtered joint output torque.

[0089] In one embodiment, the filter is configured as follows:

[0090]

[0091] Among them, τ e is the filter output, τ min is the minimum starting torque, dτ e is the output torque change rate, dτ is the torque change rate, τ max is the historical maximum output torque, dτ max is the historical maximum torque change rate.

[0092] In one implementation, the torque output module 103 is further configured to:

[0093] The method of determining the joint output torque according to the real-time target position of the robot arm and the spatial impedance control equation includes: performing inverse kinematics on the real-time target position according to the kinematic parameters of the robot arm to determine the expected joint angle; calculating error parameters based on the expected joint angle and the current joint angle; and calculating the joint output torque based on the error parameters and the spatial impedance control equation.

[0094] In one embodiment, the spatial impedance control equation is:

[0095]

[0096] Among them, M, B, K are proportional control parameters and differential control parameters respectively, e is the error parameter, To find the time derivative of the error parameter, is the second derivative in time, τ is the joint output torque, M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, and G(q) is the n×1 dimensional gravity term vector.

[0097] In one implementation, the error parameter is determined by:

[0098] e=qq $

[0099] Among them, q is the current joint angle, q $ is the desired joint angle.

[0100] In one embodiment, the control parameter is determined by:

[0101] K % =diag(ε,...,ε)

[0102]

[0103]

[0104]

[0105] Among them, K - is the initial parameter, μ∈[0,1] is the weight factor, δ and S are intermediate variables; τ e is the filter output, dτ e is the rate of change of output torque, τ max is the historical maximum output torque, dτ max is the historical maximum torque change rate.

[0106] The spatial variable impedance intelligent control device for the surgical robot manipulator arm provided in the above-mentioned embodiment of the present application has a corresponding relationship with the spatial variable impedance intelligent control method for the surgical robot manipulator arm provided in the embodiment of the present application. Therefore, the specific content in the device has a corresponding relationship with the spatial variable impedance intelligent control method for the surgical robot manipulator arm. The specific content can be referred to the record in the spatial variable impedance intelligent control method for the surgical robot manipulator arm, and will not be repeated in this application.

[0107] The spatial variable impedance intelligent control device for the surgical robot arm provided in the above-mentioned embodiments of the present application and the spatial variable impedance intelligent control method for the surgical robot arm provided in the embodiments of the present application are based on the same inventive concept and have the same beneficial effects as the methods adopted, run or implemented by the application programs stored therein.

[0108] The above describes the internal functions and structure of the spatial variable impedance intelligent control device for the surgical robot manipulator arm. Figure 4 As shown, in practice, the spatial variable impedance intelligent control device for the surgical robot manipulator arm can be realized as an electronic device, including: a memory 301 and a processor 303.

[0109] The memory 301 may be configured to store programs.

[0110] In addition, the memory 301 may also be configured to store various other data to support operations on the electronic device. Examples of such data include instructions for any application or method operating on the electronic device, contact data, phone book data, messages, pictures, videos, etc.

[0111] The memory 301 can be implemented by any type of volatile or non-volatile storage device or a combination thereof, such as static random access memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic memory, flash memory, magnetic disk or optical disk.

[0112] The processor 303 is coupled to the memory 301 and is configured to execute a program in the memory 301 to:

[0113] Constructing a spatial impedance control equation based on the mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter;

[0114] Get the real-time target position of the robot arm;

[0115] Determine the joint output torque based on the real-time target position of the robot and the spatial impedance control equation;

[0116] Based on the joint output torque, the robotic arm is controlled to perform a control action.

[0117] In one implementation, the processor 303 is further configured to:

[0118] The joint output torque is filtered by a filter to obtain a filtered joint output torque.

[0119] In one embodiment, the filter is configured as follows:

[0120]

[0121] Among them, τ e is the filter output, τ min is the minimum starting torque, dτ e is the output torque change rate, dτ is the torque change rate, τ max is the historical maximum output torque, dτ max is the historical maximum torque change rate.

[0122] In one implementation, the processor 303 is further configured to:

[0123] The method of determining the joint output torque according to the real-time target position of the robot arm and the spatial impedance control equation includes: performing inverse kinematics on the real-time target position according to the kinematic parameters of the robot arm to determine the expected joint angle; calculating error parameters based on the expected joint angle and the current joint angle; and calculating the joint output torque based on the error parameters and the spatial impedance control equation.

[0124] In one embodiment, the spatial impedance control equation is:

[0125]

[0126] Among them, M, B, K are proportional control parameters and differential control parameters respectively, e is the error parameter, To find the time derivative of the error parameter, is the second derivative in time, τ is the joint output torque, M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, and G(q) is the n×1 dimensional gravity term vector.

[0127] In one implementation, the error parameter is determined by:

[0128] e=qq $

[0129] Among them, q is the current joint angle, q $ is the desired joint angle.

[0130] In one embodiment, the control parameter is determined by:

[0131] K % =diag(δ,...,δ)

[0132]

[0133]

[0134] Among them, K - is the initial parameter, μ∈[0,1] is the weight factor, δ and S are intermediate variables; τ e is the filter output, dτ e is the rate of change of output torque, τ max is the historical maximum output torque, dτ max is the historical maximum torque change rate.

[0135] In the present application, the processor is also specifically used to execute all processes and steps of the above-mentioned surgical robot arm spatial variable impedance intelligent control method. The specific content can refer to the records in the surgical robot arm spatial variable impedance intelligent control method, and will not be repeated in this application.

[0136] In this application, Figure 4 Only some components are shown schematically, which does not mean that the electronic device only includes Figure 4 Components shown.

[0137] The electronic device provided in this embodiment is based on the same inventive concept as the spatial variable impedance intelligent control method for the surgical robot arm provided in the embodiment of the present application, and has the same beneficial effects as the method adopted, run or implemented by the application program stored therein.

[0138] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented in one or more computer-readable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) that contain computer-usable program code.

[0139] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0140] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0141] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0142] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.

[0143] The memory may include non-permanent storage in a computer-readable medium, random access memory (RAM) and / or non-volatile memory in the form of read-only memory (ROM) or flash RAM. The memory is an example of a computer-readable medium.

[0144] The present application also provides a computer-readable storage medium corresponding to the method for intelligent control of spatial variable impedance of a surgical robot arm provided in the aforementioned embodiment, on which a computer program (i.e., a program product) is stored. When the computer program is run by a processor, it will execute the method for intelligent control of spatial variable impedance of a surgical robot arm provided in any of the aforementioned embodiments.

[0145] Computer readable media include permanent and non-permanent, removable and non-removable media that can be implemented by any method or technology to store information. Information can be computer readable instructions, data structures, program modules or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, magnetic tape magnetic disk storage or other magnetic storage devices or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined herein, computer readable media does not include temporary computer readable media (transitory media), such as modulated data signals and carrier waves.

[0146] The computer-readable storage medium provided in the above-mentioned embodiments of the present application and the spatial variable impedance intelligent control method of the surgical robot manipulator arm provided in the embodiments of the present application are based on the same inventive concept and have the same beneficial effects as the methods adopted, run or implemented by the application programs stored therein.

[0147] It should be noted that in the description provided herein, a large number of specific details are described. However, it is understood that the embodiments of the present application can be practiced without these specific details. In some instances, well-known structures and technologies are not shown in detail so as not to obscure the understanding of this description.

[0148] It should also be noted that the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, commodity 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, commodity or device. In the absence of more restrictions, the elements defined by the sentence "comprises a ..." do not exclude the existence of other identical elements in the process, method, commodity or device including the elements.

[0149] The above is only an embodiment of the present application and is not intended to limit the present application. For those skilled in the art, the present application may have various changes and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included in the scope of the claims of the present application.

Claims

1. A method for intelligent control of spatial variable impedance of a surgical robot arm, characterized in that: include: Constructing a spatial impedance control equation based on the mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter; Get the real-time target position of the robot arm; Determine the joint output torque based on the real-time target position of the robot and the spatial impedance control equation; Based on the joint output torque, the robotic arm is controlled to perform a control action.

2. The method for intelligent control of spatial variable impedance of a surgical robot arm according to claim 1, characterized in that: After determining the joint output torque, it also includes: The joint output torque is filtered by a filter to obtain a filtered joint output torque.

3. The method for intelligent control of spatial variable impedance of a surgical robot arm according to claim 2, characterized in that: The filter settings are: Among them, τ e is the filter output, τ min is the minimum starting torque, dτ e is the output torque change rate, dτ is the torque change rate, τ max is the historical maximum output torque, dτ max is the historical maximum torque change rate.

4. The method for intelligent control of spatial variable impedance of a surgical robot arm according to any one of claims 1 to 3, characterized in that: Determining the joint output torque according to the real-time target position of the robot arm and the spatial impedance control equation includes: Perform inverse kinematics solution on the real-time target position according to the kinematic parameters of the robot arm to determine the desired joint angle; Calculate error parameters based on the expected joint angle and the current joint angle; The joint output torque is calculated based on the error parameters and the spatial impedance control equation.

5. The method for intelligent control of spatial variable impedance of a surgical robot arm according to claim 4, characterized in that: The spatial impedance control equation is: Among them, M, B, K are proportional control parameters and differential control parameters respectively, e is the error parameter, To find the time derivative of the error parameter, is the second derivative in time, τ is the joint output torque, M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, and G(q) is the n×1 dimensional gravity term vector.

6. The method for intelligent control of spatial variable impedance of a surgical robot arm according to claim 4, characterized in that: The formula for determining the error parameter is: e=q-q $ Among them, q is the current joint angle, q $ is the desired joint angle.

7. The method for intelligent control of spatial variable impedance of a surgical robot arm according to claim 5, characterized in that: The formula for determining the control parameters is: K e =diag(e,...,e) Among them, K - is the initial parameter, μ∈[0,1] is the weight factor, ε and S are intermediate variables; τ e is the filter output, dτ e is the rate of change of output torque, τ max is the historical maximum output torque, dτ max is the historical maximum torque change rate.

8. A spatial variable impedance intelligent control device for a surgical robot arm, characterized in that: include: An equation building module, which is used to build a spatial impedance control equation based on a mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter; A position acquisition module, which is used to obtain the real-time target position of the robotic arm; A torque output module, which is used to determine the joint output torque according to the real-time target position of the robot arm and the spatial impedance control equation; A robot arm control module is used to control the robot arm to perform a control action based on the joint output torque.

9. An electronic device, characterized in that: include: Memory and processor; The memory is used to store programs; The processor, coupled to the memory, is configured to execute the program to: Constructing a spatial impedance control equation based on the mechanical arm dynamics model, wherein at least one control parameter of the spatial impedance control equation is a variable parameter; Get the real-time target position of the robot arm; Determine the joint output torque based on the real-time target position of the robot and the spatial impedance control equation; Based on the joint output torque, the robotic arm is controlled to perform a control action.

10. A computer-readable storage medium having a computer program stored thereon, characterized in that: The program is executed by the processor to implement the spatial variable impedance intelligent control method of the surgical robot manipulator arm according to any one of claims 1 to 7.

Citation Information

Patent Citations

  • Mechanical arm dragging guiding and positioning method based on joint torque

    CN113143465A

  • Ultrasonic robot scanning control method, device and equipment and storage medium

    CN116175584A

  • LSTM-based navigation operation mechanical arm visual servo pose prediction PD control method

    CN117860382A