Cartesian impedance control method for robot with controlled energy and power
Through the Cartesian impedance control method of robots with energy and power controlled, the safety problem of the robot when it is disconnected from the working object is solved. By correcting the stiffness and damping characteristic matrix and the use of energy tanks of the impedance controller, the robot is ensuring that the robot is performing Security and stability during tasks.
Patent Information
- Application Number
- CN202410959815.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-17
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-07-17
AI Technical Summary
Existing robot control methods ignore safety when the robot is disconnected from the work object, resulting in physical impacts that may damage the robot and work object and may pose a safety threat to the operator, especially in physical human-computer interaction scenarios.
A Cartesian impedance control method for robots with energy and power is proposed. By constructing an impedance model, time-varying stiffness factor and time-varying damping factor are obtained, the stiffness and damping characteristic matrix of joint space impedance controller is corrected, and energy tanks are introduced to Limit the release of energy and power to ensure the safety and stability of the robot when performing tasks.
Real-time adjustment of robot energy and power is achieved, ensuring that the system is continuously passive, avoiding unexpected energy release or power overload, and ensuring safety and stability during physical human-computer interaction.
Smart Images

Figure CN118927235A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robot control, and in particular, to a robot Cartesian impedance control method with controlled energy and power. Background Art
[0002] As the application of robots continues to expand, more and more tasks require robots to interact dynamically with the external environment. Energy exchange is the main form of interaction between robots and the environment, that is, robots can actively apply force to the environment to complete tasks such as flexible assembly and surface polishing, or the environment can actively apply force to the robot to complete tasks such as compliant interaction and drag teaching. Methods such as force-position hybrid control, impedance control, and admittance control are widely used in these scenarios to achieve stable interaction between robots and the environment.
[0003] However, existing control methods generally focus on constant force control of continuous contact between the robot and the work object, ignoring safety. Especially when the robot's end tool suddenly loses contact with the work object, irreversible damage will be caused due to the physical impact behavior between the robot and the environment. This impact may not only damage the robot and the work object, but also cause tool failure or reduced work quality. More importantly, in physical human-machine interaction scenarios, sudden energy release may pose a safety threat to operators. Therefore, online monitoring and limiting the energy and power that the controller is allowed to inject into the robot is the key to achieving safe force control tasks. Summary of the invention
[0004] In order to overcome at least one shortcoming in the prior art, the present application proposes an energy and power limited robot Cartesian impedance control method to limit the energy and power generated by the robot's own system when performing Cartesian space impedance tasks, thereby ensuring the safety of the interactive environment and humans.
[0005] In a first aspect, the present application provides a method for controlling Cartesian impedance of a robot with controlled energy and power, the method comprising:
[0006] Step S1, constructing a Cartesian impedance controller of the robot according to an impedance model, wherein the impedance model describes the contact relationship between the robot and the environment;
[0007] Step S2, obtaining a time-varying stiffness factor for limiting the total energy of the robot and a time-varying damping factor for limiting the total power of the robot;
[0008] Step S3, obtaining an energy tank associated with the robot task power and a power scaling factor that limits the release rate of energy in the energy tank;
[0009] Step S4, correcting the time-varying stiffness factor according to the energy tank characteristics, and using the obtained time-varying stiffness factor and time-varying damping factor to correct the stiffness characteristic matrix and the damping characteristic matrix in the joint space impedance controller, to obtain an energy and power controlled joint space impedance controller, and output the control torque of each joint of the robot, wherein the joint space impedance controller is obtained by mapping the robot Cartesian impedance controller into the joint space;
[0010] Step S5, inputting the obtained control torque of each joint of the robot into the inner loop of the robot torque control to complete the motion control of the robot.
[0011] In conjunction with the optional implementation manner of the first aspect, step S1 specifically includes:
[0012] S11, establishing a dynamic model of the robot according to the robot performing the force control task:
[0013]
[0014] in, Impedance control force for the robotic system in Cartesian space; The disturbance force generated by the external environment on the robot; They represent the inertia matrix, Coriolis matrix and gravity term in Cartesian space respectively; They represent the actual position, velocity and acceleration of the robot end respectively;
[0015] S12, the impedance model The corresponding second-order differential equation is expressed as:
[0016]
[0017] in, denote the desired inertia, damping and stiffness characteristic matrices respectively; They represent the actual and expected position deviation, velocity deviation and acceleration deviation of the robot end, respectively, and are specifically expressed as:
[0018]
[0019] in, They represent the desired position, velocity, and acceleration of the robot end, respectively;
[0020] S13, taking the inertia matrix of the Cartesian space as the desired inertia characteristic matrix, and obtaining the Cartesian impedance controller of the robot according to the dynamic model and the impedance model, the expression of the Cartesian impedance controller of the robot is:
[0021]
[0022] In conjunction with the optional implementation manner of the first aspect, step S2 specifically includes:
[0023] S21, using the Jacobian matrix to map the Cartesian impedance controller to the joint space to obtain a joint space impedance controller, which is specifically expressed as:
[0024]
[0025] in, is the joint space impedance control force; is the gravity term in joint space; is the Jacobian matrix of the robot;
[0026] According to the time-varying stiffness factor, the modified stiffness characteristic matrix is obtained: The modified stiffness characteristic matrix It is expressed as:
[0027]
[0028] Where λ(t) represents the time-varying stiffness factor; U tot and T tot Respectively represent the kinetic energy and elastic potential energy of the robot; E tot Represents the total energy of the robot's kinetic energy and elastic potential energy; E max It represents the maximum energy allowed to be generated by the robot system;
[0029] According to the time-varying damping factor, the modified damping characteristic matrix is obtained: The modified damping characteristic matrix The expression is:
[0030]
[0031] Where β(t) represents the time-varying damping factor; P tot Indicates the total power generated by the robot during movement; P max Indicates the maximum power allowed to be delivered by the robot system.
[0032] In conjunction with the optional implementation manner of the first aspect, step S3 specifically includes:
[0033] S31, the energy tank E t The first derivative of Equal to robot task power Specifically expressed as:
[0034]
[0035] in, It represents the power generated by the robot terminal when performing tasks; α and γ represent the opening and closing factors of the energy tank, which are used to control the on and off of the energy exchange between the energy tank and the impedance controller;
[0036] S32, the lower limit of energy that can be stored in the energy tank and the corresponding opening and closing conditions:
[0037]
[0038] in, E tank Indicates the initial energy in the energy tank;
[0039] S33, the upper limit of energy that can be stored in the energy tank and the corresponding opening and closing conditions:
[0040]
[0041] in, Indicates the upper limit of energy in the energy tank;
[0042] S34, the power scaling factor η, is expressed as:
[0043]
[0044] Among them, P low Indicates the maximum permissible extraction power of the energy tank;
[0045] According to the power scaling factor and the upper limit of energy that can be stored in the energy tank and the corresponding opening and closing conditions, a modified energy tank is obtained. The revised energy tank It is expressed as:
[0046]
[0047] In conjunction with the optional implementation manner of the first aspect, step S4 specifically includes:
[0048] S41, when it is impossible to extract energy from the energy tank to maintain the passivity of the time-varying impedance controller, the time-varying stiffness factor λ(t) is corrected to:
[0049]
[0050] in, represents the modified time-varying stiffness factor;
[0051] S42, according to the revised energy tank Modified time-varying stiffness factor and the time-varying damping factor β(t), the energy and power controlled joint space impedance controller is constructed, and the expression is:
[0052]
[0053] Compared with the prior art, this application has the following beneficial effects:
[0054] The present invention proposes a robot Cartesian impedance control method from the perspective of controlling the robot's energy and power. The robot's energy and power can be adjusted in real time when performing tasks by scaling stiffness and damping injection, and an energy tank is introduced to ensure the system's continuous passivity, thereby ensuring the safety and stability of the robot's tasks. The present invention can be widely used in force-controlled assembly tasks with human-machine interaction scenarios, with a simple process and easy engineering implementation. BRIEF DESCRIPTION OF THE DRAWINGS
[0055] In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings required for use in the embodiments will be briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present application and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without paying creative work.
[0056] Figure 1 The energy and power controlled joint space impedance controller provided by the embodiment of the present application;
[0057] Figure 2 A schematic flow chart of a method for controlling Cartesian impedance of a robot with controlled energy and power provided in an embodiment of the present application;
[0058] Figure 3 A comparison chart of energy changes provided in the embodiments of the present application;
[0059] Figure 4 A power variation comparison diagram provided in an embodiment of the present application;
[0060] Figure 5 A diagram showing the relationship between the power scaling factor and the robot task power provided in an embodiment of the present application.
[0061] Icons: 11- second energy change curve; 12- first energy change curve; 13- second power curve; 14- first power curve; 15- parameter curve; 16- task power curve. DETAILED DESCRIPTION
[0062] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all the embodiments. The components of the embodiments of the present application described and shown in the drawings here can be arranged and designed in various different configurations.
[0063] Therefore, the following detailed description of the embodiments of the present application provided in the accompanying drawings is not intended to limit the scope of the present application for which protection is sought, but merely represents selected embodiments of the present application. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present application.
[0064] It should be noted that similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, further definition and explanation thereof is not required in subsequent drawings.
[0065] In the description of this application, it should be noted that the terms "include", "comprises" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, an element defined by the sentence "comprises a ..." does not exclude the presence of other identical elements in the process, method, article or device including the element.
[0066] Based on the above statement, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that these embodiments are only used to illustrate the present invention and are not used to limit the scope of the present invention. After reading the present invention, the modifications of various equivalent forms of the present invention by those skilled in the art all fall within the scope defined by the appended claims of the present application.
[0067] This embodiment provides a method for controlling the Cartesian impedance of a robot with controlled energy and power. Figure 1As shown, in this method, the contact between the robot and the environment is considered, and a Cartesian impedance controller is constructed in combination with the "mass-spring-damping" impedance model; a time-varying stiffness factor is designed to limit the robot's kinetic energy, and a time-varying damping factor is designed to limit the power transmitted by the robot; the energy tank is designed to associate task power, and the energy discharge rate in the energy tank is adjusted by a power scaling factor; the time-varying stiffness factor and the time-varying damping factor are introduced into the impedance controller, and the control torque of each joint of the robot is output; the control torque of each joint of the robot is input into the inner loop of the robot torque control to complete the motion control of the robot. The present invention realizes the energy and power control of the robot in the impedance mode, which can effectively avoid the safety hazards caused by accidental energy release or power overload of the robot, thereby ensuring the safety and stability in the physical human-machine interaction process.
[0068] To make the solution provided by this embodiment clearer, Figure 2 Each step of the method is described in detail. However, it should be understood that the operations of the flowchart may not be implemented in order, and steps without logical contextual relationships may be reversed in order or implemented simultaneously. In addition, those skilled in the art may add one or more other operations to the flowchart, or remove one or more operations from the flowchart under the guidance of the content of this application. Figure 2 As shown, the method includes:
[0069] Step S1, constructing a robot Cartesian impedance controller according to the impedance model.
[0070] Among them, the impedance model describes the contact relationship between the robot and the environment. Since the robot is in contact with the environment, the robot Cartesian impedance controller is constructed in combination with the "mass-spring-damper" impedance model. In a specific implementation method, according to the robot performing the force control task, the dynamic model of the robot is established using the Newton-Euler iteration method, and the specific expression is:
[0071]
[0072] in, is the robot's Cartesian space impedance control force; The disturbance force generated by the external environment on the robot; They represent the inertia matrix, Coriolis matrix and gravity term in Cartesian space respectively; They represent the actual position, velocity and acceleration of the robot end respectively.
[0073] Based on the dynamic model in the above embodiment, it should be noted that the robot impedance control does not directly control the force or position, but maintains a dynamic relationship between the control force and the position similar to the mechanical impedance, and changes the target impedance parameters to make the robot exhibit compliant motion characteristics. Therefore, the "mass-spring-damper" impedance model can be used to describe the dynamic contact relationship between the robot and the environment, and its mathematical model can be expressed by the following second-order differential equation:
[0074]
[0075] in, denote the desired inertia, damping and stiffness characteristic matrices respectively; They represent the actual and expected position deviation, velocity deviation and acceleration deviation of the robot end, respectively, which can be expressed as:
[0076]
[0077] in, They represent the desired position, velocity, and acceleration of the robot end, respectively.
[0078] Next, combine the above equations (1) and (2) to design V d =V(x), and then construct the robot Cartesian impedance controller, the specific expression is:
[0079]
[0080] Based on the robot Cartesian impedance controller obtained in step S1 above, continue to refer to Figure 2 The energy and power controlled robot Cartesian impedance control method provided in this embodiment also includes:
[0081] Step S2, obtaining a time-varying stiffness factor for limiting the total energy of the robot and a time-varying damping factor for limiting the total power of the robot.
[0082] It should be understood that the Jacobian matrix can describe the mapping relationship between the robot end effector velocity and the joint velocity. In the force mapping, the transpose or pseudo-inverse of the Jacobian matrix is usually used to convert the end operation force and torque into the joint torque. Therefore, in the specific implementation of step S2, the Cartesian impedance controller obtained in the above-mentioned embodiment can be mapped to the joint space using the Jacobian matrix, which can be specifically expressed as:
[0083]
[0084] in, is the joint space impedance control force; is the gravity term in joint space; is the Jacobian matrix of the robot;
[0085] In addition, it should be understood that when the robot works in impedance mode, the total energy of the robot system includes the kinetic energy T generated by the movement tot and the elastic potential energy U generated by interaction with the environment tot Among them, the robot kinetic energy is positively correlated with the robot's movement speed, and the robot's elastic potential energy is positively correlated with the stiffness matrix K d Without changing the robot's expected motion, K can be scaled d Control the total energy of the robot. Therefore, this embodiment provides a time-varying stiffness factor that limits the total energy of the robot, which can be specifically expressed as:
[0086]
[0087] Where λ(t) represents the time-varying stiffness factor; E tot Represents the total energy of the robot's kinetic energy and elastic potential energy; E max Represents the maximum energy allowed by the robot. Using this time-varying stiffness factor, the modified stiffness characteristic matrix can be obtained: It can be expressed as:
[0088]
[0089] In addition, when the robot works in impedance mode, the controller can respond to external forces by adjusting the stiffness, damping and inertia parameters of the robot. For a constant stiffness matrix, increasing the damping D d The dissipation capacity of the system can be improved, thereby controlling the total power transmitted by the robot to the environment. Therefore, this embodiment also provides a time-varying damping factor that limits the total power of the robot, which can be specifically expressed as:
[0090]
[0091] Where β(t) represents the time-varying damping factor; P tot Indicates the total power generated by the robot during movement; P max Represents the maximum power allowed to be transmitted by the robot system. Using this time-varying damping factor, the modified damping characteristic matrix can be obtained: It can be expressed as:
[0092]
[0093] Based on the variable stiffness factor and time-varying damping factor obtained in step S2 above, continue to refer to Figure 2 , the energy and power controlled robot Cartesian impedance control method provided by this embodiment also includes:
[0094] Step S3, obtaining an energy tank associated with the robot task power and a power scaling factor that limits the release rate of energy in the energy tank.
[0095] It should be noted that the time-varying impedance controller manipulates the system energy, resulting in an uncertain sign of the derivative of its energy storage function, and the passivity of the system cannot be guaranteed. Therefore, a virtual energy tank named E is designed in the robot controller. t Storage container, used to store the energy of the system and supply or absorb energy when needed to maintain the overall energy balance of the system. t The first derivative of Equal to the robot's mission power Specifically, it can be expressed as:
[0096]
[0097] in, It represents the power generated by the robot terminal when performing tasks; α and γ represent the opening and closing factors of the energy tank, which are used to control the on and off of the energy exchange between the energy tank and the impedance controller.
[0098] In this embodiment, in order to prevent the system from extracting energy from the energy tank without limit, the lower limit of the energy that can be stored in the energy tank and the corresponding opening and closing conditions are also provided:
[0099]
[0100] in, E tank Indicates the initial energy in the energy tank;
[0101] In addition, to prevent the energy stored in the energy tank from being too high, the upper limit of the energy that can be stored in the energy tank and the corresponding opening and closing conditions are also provided:
[0102]
[0103] in, Indicates the upper limit of energy that can be stored in the energy tank;
[0104] From the formula (10) in the above embodiment, it can be seen that the injection / discharge rate of the energy tank is related to the mission power A release rate that is too high may cause the energy in the system to increase rapidly, resulting in high acceleration behavior of the robot in a short period of time, which is still accompanied by the risk of system instability. Therefore, this embodiment also provides a power scaling factor η, which can be specifically expressed as:
[0105]
[0106] Among them, P lowrepresents the maximum allowable extraction power of the energy tank. Using the power scaling factor η, the corrected energy tank It can be expressed as:
[0107]
[0108] The energy tank obtained in step S3 above is used to correct the time-varying stiffness factor. Figure 2 The energy and power controlled robot Cartesian impedance control method provided in this embodiment further includes:
[0109] Step S4, correcting the time-varying stiffness factor according to the characteristics of the energy tank, and using the obtained time-varying stiffness factor and time-varying damping factor to correct the stiffness characteristic matrix and the damping characteristic matrix in the joint space impedance controller, to obtain the energy and power controlled joint space impedance controller, and output the control torque of each joint of the robot.
[0110] The joint space impedance controller is obtained by mapping the robot Cartesian impedance controller to the joint space. In the specific implementation of step S4, when the system cannot extract energy from the energy tank to maintain the passivity of the time-varying impedance controller, λ(t) obtained by equation (4) needs to be further modified to:
[0111]
[0112] in, represents the modified time-varying stiffness factor. Finally, the equation (15) obtained is Substitute β(t) obtained by equation (8) into equation (5) to obtain the energy and power controlled joint space impedance controller, which is expressed as:
[0113]
[0114] The control torque of each joint of the robot can be obtained by using the above energy and power controlled joint space impedance controller. Figure 2 The energy and power controlled robot Cartesian impedance control method provided in this embodiment further includes:
[0115] Step S5, inputting the obtained control torque of each joint of the robot into the inner loop of the robot torque control to complete the motion control of the robot.
[0116] For the above embodiment, this embodiment is also verified in an actual simulation environment. According to the above embodiment, a robot simulation model is established in the Matlab / SimScape simulation environment. The simulation parameters are set as follows: initial Cartesian space stiffness K d=diag(900,900,900,130,130,130), initial Cartesian space damping D d =diag(5,5,5,5,5,5), the maximum energy E allowed to be generated by the robot system max =0.05J, the maximum power P allowed to be transmitted by the robot system max =0.1W, the maximum allowable extraction power of the energy tank P low =-0.175W, the initial energy of the energy tank E tank =3J, the energy limit of the energy tank Energy tank energy limit E tank = 0.5 J. The simulation process simulates the movement of the end effector of the seven-degree-of-freedom robot from the force contact to the free state in the impedance mode.
[0117] like Figure 3 As shown, the first energy change curve 12 shows the energy change of the robot under the energy and power controlled impedance controller, and the second energy change curve 11 shows the energy change of the robot under the ordinary impedance controller. By comparison, it can be seen that the energy and power controlled robot Cartesian impedance control method provided in this embodiment can ensure that the total energy of the robot system does not exceed the preset energy threshold.
[0118] like Figure 4 As shown, the first power curve 14 shows the power change of the robot under the energy and power controlled impedance controller, and the second power curve 13 shows the power change of the robot under the ordinary impedance controller. By comparison, it can be seen that the energy and power controlled robot Cartesian impedance control method provided in this embodiment can ensure that the power transmitted by the robot system to the environment does not exceed the preset power threshold.
[0119] like Figure 5 As shown, the figure shows the relationship between the parameter curve 15 of the power scaling factor η and the task power curve 16 of the robot task power. It can be seen that the release rate of the energy tank is limited within the specified threshold by the power scaling factor η.
[0120] Finally, it should be noted that the above embodiments of the present invention are merely examples for clearly illustrating the present invention, and are not intended to limit the embodiments of the present invention. For those skilled in the art, other different forms of changes or modifications can be made based on the above description. It is not necessary and impossible to list all the embodiments here. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the protection scope of the claims of the present invention.
[0121] It should be understood that the apparatus and method disclosed in the above-mentioned embodiments can also be implemented in other ways. The apparatus embodiments described above are merely schematic. For example, the flowcharts and block diagrams in the accompanying drawings show the possible architecture, functions and operations of the apparatus, methods and computer program products according to the multiple embodiments of the present application. In this regard, each box in the flowchart or block diagram can represent a module, a program segment or a part of a code, and the module, a program segment or a part of a code contains one or more executable instructions for implementing the specified logical function. It should also be noted that in some alternative implementations, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two consecutive boxes can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram and / or the flowchart, and the combination of boxes in the block diagram and / or the flowchart can be implemented with a dedicated hardware-based system that performs a specified function or action, or can be implemented with a combination of dedicated hardware and computer instructions.
[0122] The above are only various implementations of the present application, but the protection scope of the present application is not limited thereto. Any person skilled in the art who is familiar with the present technical field can easily think of changes or substitutions within the technical scope disclosed in the present application, which should be included in the protection scope of the present application. Therefore, the protection scope of the present application should be based on the protection scope of the claims.
Claims
1. A method for controlling Cartesian impedance of a robot with controlled energy and power, characterized in that: The method comprises: Step S1, constructing a Cartesian impedance controller of the robot according to an impedance model, wherein the impedance model describes the contact relationship between the robot and the environment; Step S2, obtaining a time-varying stiffness factor for limiting the total energy of the robot and a time-varying damping factor for limiting the total power of the robot; Step S3, obtaining an energy tank associated with the robot task power and a power scaling factor that limits the release rate of energy in the energy tank; Step S4, correcting the time-varying stiffness factor according to the energy tank characteristics, and using the obtained time-varying stiffness factor and time-varying damping factor to correct the stiffness characteristic matrix and the damping characteristic matrix in the joint space impedance controller, to obtain an energy and power controlled joint space impedance controller, and output the control torque of each joint of the robot, wherein the joint space impedance controller is obtained by mapping the robot Cartesian impedance controller into the joint space; Step S5, inputting the obtained control torque of each joint of the robot into the inner loop of the robot torque control to complete the motion control of the robot.
2. The method according to claim 1, characterized in that The step S1 specifically includes: S11, establishing a dynamic model of the robot according to the robot performing the force control task: in, Impedance control force for the robotic system in Cartesian space; The disturbance force generated by the external environment on the robot; They represent the inertia matrix, Coriolis matrix and gravity term in Cartesian space respectively; They represent the actual position, velocity and acceleration of the robot end respectively; S12, the impedance model The corresponding second-order differential equation is expressed as: in, denote the desired inertia, damping and stiffness characteristic matrices respectively; They represent the actual and expected position deviation, velocity deviation and acceleration deviation of the robot end, respectively, and are specifically expressed as: in, They represent the desired position, velocity, and acceleration of the robot end, respectively; S13, taking the inertia matrix of the Cartesian space as the desired inertia characteristic matrix, and obtaining the Cartesian impedance controller of the robot according to the dynamic model and the impedance model, the expression of the Cartesian impedance controller of the robot is:
3. The method according to claim 1, characterized in that The step S2 specifically includes: S21, using the Jacobian matrix to map the Cartesian impedance controller to the joint space to obtain a joint space impedance controller, which is specifically expressed as: in, is the joint space impedance control force; is the gravity term in joint space; is the Jacobian matrix of the robot; According to the time-varying stiffness factor, the modified stiffness characteristic matrix is obtained: The modified stiffness characteristic matrix It is expressed as: Where λ(t) represents the time-varying stiffness factor; U tot and T tot Respectively represent the kinetic energy and elastic potential energy of the robot; E tot Represents the total energy of the robot's kinetic energy and elastic potential energy; E max It represents the maximum energy allowed to be generated by the robot system; According to the time-varying damping factor, the modified damping characteristic matrix is obtained: The modified damping characteristic matrix The expression is: Where β(t) represents the time-varying damping factor; P tot Indicates the total power generated by the robot during movement; P max Indicates the maximum power allowed to be delivered by the robot system.
4. The method according to claim 1, characterized in that The step S3 specifically includes: S31, the energy tank E t The first derivative of Equal to robot task power Specifically expressed as: in, It represents the power generated by the robot terminal when performing tasks; α and γ represent the opening and closing factors of the energy tank, which are used to control the on and off of the energy exchange between the energy tank and the impedance controller; S32, the lower limit of energy that can be stored in the energy tank and the corresponding opening and closing conditions: in, E tank Indicates the initial energy in the energy tank; S33, the upper limit of energy that can be stored in the energy tank and the corresponding opening and closing conditions: in, Indicates the upper limit of energy in the energy tank; S34, the power scaling factor η, is expressed as: Among them, P low Indicates the maximum permissible extraction power of the energy tank; According to the power scaling factor and the upper limit of energy that can be stored in the energy tank and the corresponding opening and closing conditions, a modified energy tank is obtained. The revised energy tank It is expressed as:
5. The method according to claim 1, characterized in that The step S4 specifically includes: S41, when it is impossible to extract energy from the energy tank to maintain the passivity of the time-varying impedance controller, the time-varying stiffness factor λ(t) is corrected to: in, represents the modified time-varying stiffness factor, E tot Represents the total energy of the robot's kinetic energy and elastic potential energy, E max Indicates the maximum energy allowed to be generated by the robot, U tot and T tot represent the kinetic energy and elastic potential energy of the robot respectively; S42, according to the revised energy tank Modified time-varying stiffness factor and the time-varying damping factor β(t), the energy and power controlled joint space impedance controller is constructed, and the expression is:
Citation Information
Patent Citations
Robot-assembling-oriented superposition oscillating force cartesian impedance control method
CN109366488A
Parameter setting method for industrial robot variable impedance controller
CN110744540A
Impedance control method and device, impedance controller and robot
CN111730599A
Universal control method for mobile operation robot on basis of full-state impedance controller
CN112497208A
Impedance control method for robot-environment compliant contact process based on Zener model
CN113400313A
Cited By
Robot joint control method, device, equipment, medium and product
CN119501931A
Operation control method, device and equipment of flying operation robot and medium
CN121806935A
