Flexible robot control method and device, electronic equipment and storage medium

The dynamic model of the flexible robot is simplified through virtual links and virtual universal rotating joints, which solves the problem of low control accuracy and stability, and achieves a more accurate dynamic model and higher control accuracy.

CN119017384APending Publication Date: 2024-11-26THE UNIV OF NOTTINGHAM NINGBO CHINA
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411164929.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-23
Publication Date
2024-11-26

Smart Images

  • Figure CN119017384A_ABST
    Figure CN119017384A_ABST
Patent Text Reader

Abstract

The invention provides a control method and device of a flexible robot, electronic equipment and a storage medium, and relates to the technical field of robotics.The control method of the flexible robot comprises the steps that a current kinetic model of a target flexible robot is determined, the current kinetic model is determined according to a plurality of virtual spring parameters and a plurality of virtual damping parameters which are identified at the current moment, and the plurality of virtual spring parameters comprise spring parameters of a virtual connecting rod and spring parameters of a virtual universal rotating joint in a plurality of directions; the multiple virtual damping parameters comprise damping parameters of a virtual connecting rod and damping parameters of a virtual universal rotating joint in multiple directions; acquiring an expected pose of the target flexible robot; determining an expected output force and an expected torque vector according to the expected pose and the current kinetic model; and controlling the target flexible robot to move according to the expected output force and the expected torque vector.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robotics technology, and in particular to a control method, device, electronic equipment and storage medium for a flexible robot. Background Art

[0002] The airbag soft robot is a new type of robot system built on airbags and flexible materials. It is highly soft, deformable and safe. Traditional rigid robots have limitations in certain applications, such as operation in a small space and safety when working with humans. In contrast, the airbag soft robot has many advantages, such as softness, deformability, safety and versatility.

[0003] However, the dynamics of the airbag flexible robot is usually nonlinear, and the system's motion equation contains nonlinear terms, which makes the dynamic model of the flexible robot more complicated. The dynamic model of the complex system may have parameter uncertainty, nonlinear effects, etc., which affects the accuracy of the model and leads to low control accuracy and stability of the flexible robot. Summary of the invention

[0004] The problem solved by the present invention is that the control accuracy and stability of the flexible robot are not high.

[0005] In order to solve the above problems, the present invention provides a control method, device, electronic device and storage medium for a flexible robot.

[0006] In a first aspect, the present invention provides a control method for a flexible robot, comprising: determining a current dynamic model of a target flexible robot, wherein the target flexible robot comprises a slider, an end effector, and a flexible airbag connecting the slider and the end effector, the current dynamic model is determined based on a plurality of virtual spring parameters and a plurality of virtual damping parameters identified at a current moment, the plurality of virtual spring parameters comprising spring parameters of a virtual connecting rod and spring parameters of a virtual universal joint in a plurality of directions, the plurality of virtual damping parameters comprising damping parameters of a virtual connecting rod and damping parameters of a virtual universal joint in a plurality of directions, the virtual connecting rod being a virtual rod connecting the end effector and the slider, the virtual universal joint being a virtual universal joint connected between the slider and the virtual connecting rod; Acquiring a desired position and posture of the target flexible robot; Determining a desired output force and a desired torque vector according to the desired posture and the current dynamics model; The target flexible robot is controlled to move according to the desired output force and the desired torque vector.

[0007] Optionally, determining the current dynamic model of the target flexible robot includes: obtaining a dynamic relationship, wherein the dynamic relationship is used to represent the mechanical relationship between the slider and the end effector; generating a target thrust of a preset direction and a preset magnitude through the end effector, and measuring the force and torque on the slider to obtain a target force and a target torque; obtaining a virtual link length and a target angle set corresponding to the virtual link at the current moment, wherein the target angle set includes the angles between the virtual link and each plane in a reference coordinate system, and the reference coordinate system is the coordinate system corresponding to the slider; identifying unknown parameters in the mechanical relationship according to the target force, the target torque, the virtual link length and the target angle set to obtain a plurality of virtual spring parameters and a plurality of virtual damping parameters; determining the current dynamic model according to the plurality of virtual spring parameters and the plurality of virtual damping parameters.

[0008] Optionally, obtaining the target angle set corresponding to the virtual connecting rod at the current moment includes: Acquire first angle data and second angle data collected by an inertial measurement unit; determine the target angle set according to a difference between the first angle data and the second angle data; The difference between the first angle data and the second angle data is Represented by the following quaternion:

[0009] in, is the quaternion representation of the first angle data, is the quaternion representation of the second angle data, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient.

[0010] Optionally, determining the target angle set according to the difference between the first angle data and the second angle data includes: determining each angle in the target angle set by using the following formula:

[0011]

[0012]

[0013] in, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient.

[0014] Optionally, the kinetic relationship includes:

[0015]

[0016]

[0017]

[0018]

[0019]

[0020] Where, M is the mass of the end effector, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the displacement of the object, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are , and Elastic parameters in three directions, , , The virtual universal joints are , and Damping coefficients in three directions, , , The moment of inertia of the end effector rotating around the rotation axis is respectively along , and The components of the moment of inertia in the three directions, , , are the components of the force applied by the end effector to the slider along the x-axis, y-axis, and z-axis directions, respectively, , , are the moment components of the slider along the x, y, and z axes, respectively, is the gyro torque component.

[0021] Optionally, controlling the movement of the target flexible robot according to the expected output force and the expected torque vector includes: measuring the real-time angular acceleration and angular velocity of the end effector around each axis in the effector coordinate system to obtain multiple angular accelerations and multiple angular velocities; determining the real-time output force and real-time torque vector of the end effector according to the multiple angular accelerations and multiple angular velocities; and controlling the movement of the target flexible robot according to the expected output force and the expected torque vector, the real-time output force and the real-time torque vector.

[0022] Optionally, the relationship between the multiple angular accelerations and the real-time output force is expressed by the following formula:

[0023]

[0024]

[0025] The relationship between the multiple angular velocities and the real-time torque vector is expressed by the following formula:

[0026]

[0027]

[0028] in, , , are the angular accelerations of the end effector around each axis in the effector coordinate system, , , are the real-time output forces of the end effector around each axis in the effector coordinate system, is the acceleration due to gravity, , , are the angular velocities of the real-time torque vector along each axis in the actuator coordinate system, , , are the torque vectors of the real-time torque vector along each axis in the actuator coordinate system, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are respectively , and Elastic parameters in three directions, , , The virtual universal joints are respectively , and Damping coefficients in three directions, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system.

[0029] In a second aspect, the present invention provides a control device for a flexible robot, comprising: A first determination module is used to determine a current dynamic model of a target flexible robot, wherein the target flexible robot includes a slider, an end effector, and a flexible airbag connecting the slider and the end effector, and the current dynamic model is determined based on a plurality of virtual spring parameters and a plurality of virtual damping parameters identified at a current moment, wherein the plurality of virtual spring parameters include spring parameters of a virtual connecting rod and spring parameters of a virtual universal joint in multiple directions, and the plurality of virtual damping parameters include damping parameters of a virtual connecting rod and damping parameters of a virtual universal joint in multiple directions, wherein the virtual connecting rod is a virtual rod connecting the end effector and the slider, and the virtual universal joint is a virtual universal joint connected between the slider and the virtual connecting rod; An acquisition module, used to acquire the desired position and posture of the target flexible robot; A second determination module, configured to determine an expected output force and an expected torque vector according to the expected posture and the current dynamics model; A control module is used to control the movement of the target flexible robot according to the expected output force and the expected torque vector.

[0030] In a third aspect, the present invention provides an electronic device, including a memory and a processor; The memory is used to store computer programs; The processor is used to implement the control method of the flexible robot as described in the first aspect when executing the computer program.

[0031] In a fourth aspect, the present invention provides a computer-readable storage medium having a computer program stored thereon. When the computer program is executed by a processor, the control method of the flexible robot as described in the first aspect is implemented.

[0032] The beneficial effect of the control method of the flexible robot of the present invention is: the system of the target flexible robot is appropriately simplified by virtual connecting rods and virtual universal rotating joints, so that a simplified dynamic model can be established, and the spring parameters and damping parameters of the current virtual connecting rods and the spring parameters and damping coefficients of the virtual universal rotating joints in multiple directions are estimated and corrected by parameter identification, and multiple virtual spring parameters and multiple virtual damping coefficients are obtained, which are brought into the simplified dynamic model to obtain the dynamic model corresponding to the target flexible robot at the current moment, that is, the current dynamic model. By simplifying the dynamic model of the flexible robot, the complexity and nonlinear effects of the dynamic model are reduced, and the current dynamic model is determined by identifying the current multiple virtual spring parameters and multiple virtual damping parameters, so that the parameters in the dynamic model are more accurate, the accuracy of the dynamic model is improved, and the control accuracy and stability of the flexible robot are improved. BRIEF DESCRIPTION OF THE DRAWINGS

[0033] Figure 1 A schematic flow chart of a control method for a flexible robot according to an embodiment of the present invention; Figure 2 A simplified structural diagram of a flexible robot according to an embodiment of the present invention Figure 3 A schematic structural diagram of a control device for a flexible robot according to an embodiment of the present invention; Figure 4 The figure is a schematic diagram of the structure of an electronic device according to an embodiment of the present invention. DETAILED DESCRIPTION

[0034] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, the specific embodiments of the present invention are described in detail below in conjunction with the accompanying drawings. Although certain embodiments of the present invention are shown in the accompanying drawings, it should be understood that the present invention can be implemented in various forms and should not be interpreted as being limited to the embodiments described herein. On the contrary, these embodiments are provided to provide a more thorough and complete understanding of the present invention. It should be understood that the drawings and embodiments of the present invention are only for exemplary purposes and are not intended to limit the scope of protection of the present invention.

[0035] It should be understood that the various steps described in the method embodiments of the present invention may be performed in different orders and / or in parallel. In addition, the method embodiments may include additional steps and / or omit the steps shown. The scope of the present invention is not limited in this respect.

[0036] The term "including" and its variations used in this document are open inclusions, that is, "including but not limited to"; the term "based on" means "based at least in part on"; the term "one embodiment" means "at least one embodiment"; the term "another embodiment" means "at least one other embodiment"; the term "some embodiments" means "at least some embodiments"; the term "optionally" means "optional embodiments". The relevant definitions of other terms will be given in the following description. It should be noted that the concepts of "first", "second", etc. mentioned in the present invention are only used to distinguish different devices, modules or units, and are not used to limit the order or interdependence of the functions performed by these devices, modules or units.

[0037] It should be noted that the modifications of "one" and "plurality" mentioned in the present invention are illustrative rather than restrictive, and those skilled in the art should understand that, unless otherwise clearly indicated in the context, it should be understood as "one or more".

[0038] The names of the messages or information exchanged between multiple devices in the embodiments of the present invention are only used for illustrative purposes, and are not used to limit the scope of these messages or information.

[0039] In view of the problems existing in the above-mentioned related technologies, this embodiment provides a control method, device, electronic device and storage medium for a flexible robot.

[0040] like Figure 1 As shown, a control method of a flexible robot provided by an embodiment of the present invention includes: Step S100, determining a current dynamic model of a target flexible robot, wherein the target flexible robot includes a slider, an end effector, and a flexible airbag connecting the slider and the end effector, and the current dynamic model is determined based on a plurality of virtual spring parameters and a plurality of virtual damping parameters identified at a current moment, wherein the plurality of virtual spring parameters include spring parameters of a virtual connecting rod and spring parameters of a virtual universal joint in multiple directions, and the plurality of virtual damping parameters include damping parameters of a virtual connecting rod and damping parameters of a virtual universal joint in multiple directions, the virtual connecting rod is a virtual rod connecting the end effector and the slider, and the virtual universal joint is a virtual universal joint connected between the slider and the virtual connecting rod.

[0041] Specifically, Figure 2As shown, the target flexible robot includes an end effector and a slider, and a flexible airbag connecting the end effector and the slider. The flexible airbag can be deformed freely according to the pressure change of the internal gas or liquid to adapt to various shapes and space requirements. Simplify the dynamic model of the target flexible robot: establish a virtual rod from the end effector to the slider, that is, a virtual link, wherein the virtual link includes a virtual damper, and the damper has spring parameters and damping parameters, that is, the spring parameters and damping parameters of the virtual link. Define a virtual universal joint connected between the slider and the virtual link, that is, a virtual universal joint, wherein the virtual universal joint has different spring parameters and damping coefficients in different directions, that is, the spring parameters and damping coefficients of the virtual universal joint in multiple directions.

[0042] Step S200, obtaining the desired posture of the target flexible robot; Step S300, determining an expected output force and an expected torque vector according to the expected posture and the current dynamics model; Specifically, the expected posture that the target flexible robot needs to achieve is obtained, and based on the acquired expected posture and the current dynamic model of the target flexible robot, the expected output force and expected torque vector that need to be applied to the target flexible robot are calculated. The expected output force and expected torque vector are the control force and torque that need to be applied to make the target flexible robot move in the expected posture.

[0043] Step S400: controlling the movement of the target flexible robot according to the desired output force and the desired torque vector.

[0044] Specifically, according to the determined expected output force and expected torque vector, the motion control of the target flexible robot is realized through the control algorithm and the controller. According to the requirements of the expected output force and torque, the end effector of the target flexible robot is adjusted to realize the posture control and motion of the robot, so that the target flexible robot reaches the expected posture.

[0045] In this embodiment, the system of the target flexible robot is appropriately simplified by virtual connecting rods and virtual universal joints, so that a simplified dynamic model can be established. The spring parameters and damping parameters of the current virtual connecting rods and the spring parameters and damping coefficients of the virtual universal joints in multiple directions are estimated and corrected by parameter identification, and multiple virtual spring parameters and multiple virtual damping coefficients are obtained, which are brought into the simplified dynamic model to obtain the dynamic model corresponding to the target flexible robot at the current moment, that is, the current dynamic model. By simplifying the dynamic model of the flexible robot, the complexity and nonlinear effects of the dynamic model are reduced, and the current dynamic model is determined by identifying the current multiple virtual spring parameters and multiple virtual damping parameters, so that the parameters in the dynamic model are more accurate, the accuracy of the dynamic model is improved, and the control accuracy and stability of the flexible robot are improved.

[0046] In addition, based on the acquired desired posture and the current dynamic model of the target flexible robot, the expected output force and expected torque vector that need to be applied to the target flexible robot are calculated, and the end effector of the target flexible robot is adjusted to achieve the robot's posture control and movement, thereby enabling the target flexible robot to reach the desired posture.

[0047] Optionally, determining the current dynamic model of the target flexible robot includes: obtaining a dynamic relationship, wherein the dynamic relationship is used to represent the mechanical relationship between the slider and the end effector; generating a target thrust of a preset direction and a preset magnitude through the end effector, and measuring the force and torque on the slider to obtain a target force and a target torque; obtaining a virtual link length and a target angle set corresponding to the virtual link at the current moment, wherein the target angle set includes the angles between the virtual link and each plane in a reference coordinate system, and the reference coordinate system is the coordinate system corresponding to the slider; identifying unknown parameters in the mechanical relationship according to the target force, the target torque, the virtual link length and the target angle set to obtain a plurality of virtual spring parameters and a plurality of virtual damping parameters; determining the current dynamic model according to the plurality of virtual spring parameters and the plurality of virtual damping parameters.

[0048] Specifically, firstly, a pre-input or saved dynamic relationship is obtained, which describes the mechanical interaction between the various components of the target flexible robot. The dynamic relationship is obtained by analyzing and modeling the structure of the target flexible robot and the connection relationship between the various components. Specifically, according to the mass, inertia, and force conditions of the target flexible robot, combined with parameters such as the damping and spring coefficient of the target flexible robot, the dynamic characteristics of the target flexible robot are described, and the dynamic relationship representing the mechanical relationship between the slider and the end effector is obtained.

[0049] After obtaining the dynamic relationship, some specific parameters in the dynamic relationship need to be identified to determine the parameter values ​​in the dynamic relationship. Here, multiple virtual spring parameters and multiple virtual damping parameters need to be identified.

[0050] The end effector generates a controllable target thrust of a preset direction and magnitude, and measures the force and torque on the slider. Optionally, the end effector is a propeller thruster with vector propulsion capability, which can generate thrust in all directions.

[0051] The current virtual link length and target angle set are obtained, wherein the current virtual link length, i.e., the straight-line distance between the end effector and the slider, can be measured in real time by a laser transmitter and a receiver, i.e., a laser transmitter and a receiver are installed on the end effector and the slider, respectively, the laser transmitter is used to transmit laser, and the receiver is used to receive laser generated by the laser transmitter, the distance between the laser transmitter and the receiver is calculated according to the time of transmitting the laser and the time of receiving the laser, and the distance is determined as the current virtual link length.

[0052] The target angle set includes angles between the virtual connecting rod and each plane in the reference coordinate system. The reference coordinate system is fixed on the slider, that is, the coordinate system corresponding to the slider is the reference coordinate system.

[0053] According to the target force, target torque, virtual connecting rod length and target angle set, the unknown parameters in the dynamic relationship are identified, that is, multiple virtual spring parameters and virtual damping parameters in the dynamic relationship are identified, and the current dynamic model can be determined by bringing the identified multiple virtual spring parameters and multiple virtual damping parameters into the above dynamic relationship.

[0054] Optionally, obtaining the target angle set corresponding to the virtual connecting rod at the current moment includes: obtaining first angle data and second angle data collected by an inertial measurement unit; determining the target angle set according to the difference between the first angle data and the second angle data; wherein the difference between the first angle data and the second angle data is Represented by the following quaternion:

[0055] in, is the quaternion representation of the first angle data, is the quaternion representation of the second angle data, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient.

[0056] Specifically, an inertial measurement unit is installed on each of the end effector and the slider, and the two inertial units collect angle data respectively. The angle data collected by the inertial measurement unit on the slider is the first angle data, and the angle data collected by the inertial measurement unit on the end effector is the second angle data. According to the difference between the first angle data and the second angle data, the angle between the virtual link and each plane in the reference coordinate system can be determined to obtain a target angle set, wherein the target angle set includes three angles, namely , , , is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system.

[0057] The angle data collected by the inertial measurement unit is expressed in the form of a quaternion. A quaternion includes a real part and three imaginary parts. The difference between the first angle data and the second angle data is realized by the conjugate product of the two quaternions, that is, the difference between the first angle data and the second angle data It is expressed as:

[0058] in, is the quaternion representation of the first angle data, is the quaternion representation of the second angle data, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient, i, j and k are the three basic units of imaginary parts of the quaternion, i, j, k represent the components of the imaginary part in the directions of the three coordinate axes, which are used to describe the rotation or direction information of the quaternion.

[0059] Optionally, determining the target angle set according to the difference between the first angle data and the second angle data includes: determining each angle in the target angle set by using the following formula:

[0060]

[0061]

[0062] in, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient.

[0063] Specifically, by substituting the real part and the imaginary part of the quaternion corresponding to the difference between the first angle data and the second angle into the above three formulas, the sizes of each angle in the target angle set can be obtained.

[0064] Optionally, the kinetic relationship includes:

[0065]

[0066]

[0067]

[0068]

[0069]

[0070] Where, M is the mass of the end effector, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the displacement of the object, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are , and Elastic parameters in three directions, , , The virtual universal joints are , and Damping coefficients in three directions, , , The moment of inertia of the end effector rotating around the rotation axis is respectively along , and The components of the moment of inertia in the three directions, , , are the components of the force applied by the end effector to the slider along the x-axis, y-axis, and z-axis directions, respectively, , , are the moment components of the slider along the x, y, and z axes, respectively, is the gyro torque component.

[0071] Optionally, controlling the movement of the target flexible robot according to the expected output force and the expected torque vector includes: measuring the real-time angular acceleration and angular velocity of the end effector around each axis in the effector coordinate system to obtain multiple angular accelerations and multiple angular velocities; determining the real-time output force and real-time torque vector of the end effector according to the multiple angular accelerations and multiple angular velocities; and controlling the movement of the target flexible robot according to the expected output force and the expected torque vector, the real-time output force and the real-time torque vector.

[0072] When controlling the motion of the target flexible robot, the angular acceleration and angular velocity of the real-time end effector around each axis of the actuator coordinate system are measured to obtain multiple angular acceleration and angular velocity values, which reflect the rotational motion state of the actuator in space.

[0073] According to these multiple angular acceleration and angular velocity values, the real-time output force and real-time torque vector of the end effector are further determined. The real-time output force and real-time torque vector directly affect the motion and posture control of the flexible robot.

[0074] After the real-time output force and torque vectors are determined, they are compared with the expected output force and torque vectors. The expected output force and torque vectors are determined by the task requirements and represent the desired motion state and position of the flexible robot at a specific moment.

[0075] By comparing the difference between the real-time output force and torque vector and the expected output force and torque vector, the corresponding control strategy is used to adjust the output force and torque vector of the end effector. That is, by real-time monitoring the motion state and response of the end effector, the output force and torque vector are adjusted in time to achieve more precise and stable motion control.

[0076] In this embodiment, the motion accuracy and response speed of the flexible robot can be improved by a method based on real-time measurement and timely adjustment of control, so that the flexible robot can adapt to complex working environments and task requirements, thereby achieving efficient automated operation.

[0077] Optionally, the relationship between the multiple angular accelerations and the real-time output force is expressed by the following formula:

[0078]

[0079]

[0080] The relationship between the multiple angular velocities and the real-time torque vector is expressed by the following formula:

[0081]

[0082]

[0083] in, , , are the angular accelerations of the end effector around each axis in the effector coordinate system, , , are the real-time output forces of the end effector around each axis in the effector coordinate system, is the acceleration due to gravity, , , are the angular velocities of the real-time torque vector along each axis in the actuator coordinate system, , , are the torque vectors of the real-time torque vector along each axis in the actuator coordinate system, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are respectively , and Elastic parameters in three directions, , , The virtual universal joints are respectively , and Damping coefficients in three directions, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system.

[0084] Alternatively, the angular acceleration of the slider around each axis in the reference coordinate system can be expressed by the following formula:

[0085]

[0086]

[0087] in, , , are the angular accelerations of the slider around each axis in the reference coordinate system, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the change length of the virtual connecting rod, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual connecting rod and the XY plane in the reference coordinate system, and g is the gravitational acceleration; The force components of the end effector in each axis direction in the actuator can be expressed by the following formula:

[0088]

[0089]

[0090] in, , , are the components of the end effector in each axis direction in the actuator, M is the torque of the end effector, is the motor torque, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are respectively , and Elastic parameters in three directions, , , The virtual universal joints are respectively , and Damping coefficients in three directions, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual connecting rod and the YZ plane in the reference coordinate system, m is the mass of the slider, and G is the gyro torque.

[0091] like Figure 3 As shown, a control device 300 of a flexible robot provided by an embodiment of the present invention includes:

[0092] Optionally, the first determination module 310 is used to determine the current dynamic model of the target flexible robot in the following manner: obtaining a dynamic relationship, wherein the dynamic relationship is used to represent the mechanical relationship between the slider and the end effector; generating a target thrust of a preset direction and a preset magnitude through the end effector, and measuring the force and torque on the slider to obtain a target force and a target torque; obtaining a virtual link length and a target angle set corresponding to the virtual link at the current moment, wherein the target angle set includes the angles between the virtual link and each plane in a reference coordinate system, and the reference coordinate system is the coordinate system corresponding to the slider; identifying unknown parameters in the mechanical relationship according to the target force, the target torque, the virtual link length and the target angle set to obtain a plurality of virtual spring parameters and a plurality of virtual damping parameters; determining the current dynamic model according to the plurality of virtual spring parameters and the plurality of virtual damping parameters.

[0093] Optionally, the first determination module 310 is further configured to obtain the target angle set corresponding to the virtual connecting rod at the current moment by: obtaining first angle data and second angle data collected by an inertial measurement unit; determining the target angle set according to the difference between the first angle data and the second angle data; wherein the difference between the first angle data and the second angle data is Represented by the following quaternion:

[0094] in, is the quaternion representation of the first angle data, is the quaternion representation of the second angle data, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient.

[0095] Optionally, the first determination module 310 is used to determine the target angle set according to the difference between the first angle data and the second angle data in the following manner: determine each angle in the target angle set by the following formula:

[0096]

[0097]

[0098] in, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient.

[0099] Optionally, the kinetic relationship includes:

[0100]

[0101]

[0102]

[0103]

[0104]

[0105] Where, M is the mass of the end effector, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the displacement of the object, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are , and Elastic parameters in three directions, , , The virtual universal joints are , and Damping coefficients in three directions, , , The moment of inertia of the end effector rotating around the rotation axis is respectively along , and The components of the moment of inertia in the three directions, , , are the components of the force applied by the end effector to the slider along the x-axis, y-axis, and z-axis directions, respectively, , , are the moment components of the slider along the x, y, and z axes, respectively, is the gyro torque component.

[0106] Optionally, the control module 340 is used to control the movement of the target flexible robot according to the expected output force and the expected torque vector in the following manner: measuring the real-time angular acceleration and angular velocity of the end effector around each axis in the effector coordinate system to obtain multiple angular accelerations and multiple angular velocities; determining the real-time output force and real-time torque vector of the end effector according to the multiple angular accelerations and multiple angular velocities; and controlling the movement of the target flexible robot according to the expected output force and the expected torque vector, the real-time output force and the real-time torque vector.

[0107] Optionally, the relationship between the multiple angular accelerations and the real-time output force is expressed by the following formula:

[0108]

[0109]

[0110] The relationship between the multiple angular velocities and the real-time torque vector is expressed by the following formula:

[0111]

[0112]

[0113] in, , , are the angular accelerations of the end effector around each axis in the effector coordinate system, , , are the real-time output forces of the end effector around each axis in the effector coordinate system, is the acceleration due to gravity, , , are the angular velocities of the real-time torque vector along each axis in the actuator coordinate system, , , are the torque vectors of the real-time torque vector along each axis in the actuator coordinate system, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are respectively , and Elastic parameters in three directions, , , The virtual universal joints are respectively , and Damping coefficients in three directions, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system.

[0114] like Figure 4 As shown, an electronic device 400 provided by an embodiment of the present invention includes a memory 410 and a processor 420; the memory 410 is used to store a computer program; the processor 420 is used to implement the control method of the flexible robot as described above when executing the computer program.

[0115] In other words, an electronic device 400 includes a memory 410 and a processor 420 coupled to the memory 410; the memory 410 is configured to store a computer program; and the processor 420 is configured to perform the following operations when executing the computer program: Determine a current dynamic model of a target flexible robot, wherein the target flexible robot includes a slider, an end effector, and a flexible airbag connecting the slider and the end effector, and the current dynamic model is determined based on a plurality of virtual spring parameters and a plurality of virtual damping parameters identified at a current moment, wherein the plurality of virtual spring parameters include spring parameters of a virtual connecting rod and spring parameters of a virtual universal joint in multiple directions, and the plurality of virtual damping parameters include damping parameters of a virtual connecting rod and damping parameters of a virtual universal joint in multiple directions, wherein the virtual connecting rod is a virtual rod connecting the end effector and the slider, and the virtual universal joint is a virtual universal joint connected between the slider and the virtual connecting rod; Acquiring a desired position and posture of the target flexible robot; Determining a desired output force and a desired torque vector according to the desired posture and the current dynamics model; The target flexible robot is controlled to move according to the desired output force and the desired torque vector.

[0116] An embodiment of the present invention provides a computer-readable storage medium, on which a computer program is stored. When the computer program is executed by a processor, the control method of the flexible robot as described above is implemented.

[0117] In other words, a non-volatile computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor performs the following operations: Determine a current dynamic model of a target flexible robot, wherein the target flexible robot includes a slider, an end effector, and a flexible airbag connecting the slider and the end effector, and the current dynamic model is determined based on a plurality of virtual spring parameters and a plurality of virtual damping parameters identified at a current moment, wherein the plurality of virtual spring parameters include spring parameters of a virtual connecting rod and spring parameters of a virtual universal joint in multiple directions, and the plurality of virtual damping parameters include damping parameters of a virtual connecting rod and damping parameters of a virtual universal joint in multiple directions, wherein the virtual connecting rod is a virtual rod connecting the end effector and the slider, and the virtual universal joint is a virtual universal joint connected between the slider and the virtual connecting rod; Acquiring a desired position and posture of the target flexible robot; Determining a desired output force and a desired torque vector according to the desired posture and the current dynamics model; The target flexible robot is controlled to move according to the desired output force and the desired torque vector.

[0118] An electronic device 400 that can be used as a server or client of the present invention will now be described, which is an example of a hardware device that can be applied to various aspects of the present invention. The electronic device 400 is intended to represent various forms of digital electronic computer equipment, such as laptop computers, desktop computers, workbenches, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The electronic device 400 can also represent various forms of mobile devices, such as personal digital processing, cellular phones, smart phones, wearable devices, and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples, and are not intended to limit the implementation of the present invention described herein and / or required.

[0119] The electronic device 400 includes a computing unit, which can perform various appropriate actions and processes according to a computer program stored in a read-only memory (ROM) or a computer program loaded from a storage unit into a random access memory (RAM). In the RAM, various programs and data required for the operation of the device can also be stored. The computing unit, ROM, and RAM are connected to each other via a bus. An input / output (I / O) interface is also connected to the bus.

[0120] A person of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment method can be implemented by instructing the relevant hardware through a computer program, and the program can be stored in a computer-readable storage medium. When the program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, the storage medium can be a disk, an optical disk, a read-only memory (ROM) or a random access memory (RAM), etc. In the present application, the unit described as a separate component may or may not be physically separated, and the component displayed as a unit may or may not be a physical unit, that is, it may be located in one place, or it may be distributed on multiple network units. Some or all of the units can be selected according to actual needs to achieve the purpose of the embodiment of the present invention. In addition, each functional unit in each embodiment of the present invention can be integrated in a processing unit, or each unit can exist physically separately, or two or more units can be integrated in one unit. The above-mentioned integrated unit can be implemented in the form of hardware or in the form of a software functional unit.

[0121] Although the present invention is disclosed as above, the protection scope of the present invention is not limited thereto. Those skilled in the art may make various changes and modifications without departing from the spirit and scope of the present invention, and these changes and modifications will fall within the protection scope of the present invention.

Claims

1. A control method for a flexible robot, characterized in that: include: Determine a current dynamic model of a target flexible robot, wherein the target flexible robot includes a slider, an end effector, and a flexible airbag connecting the slider and the end effector, and the current dynamic model is determined based on a plurality of virtual spring parameters and a plurality of virtual damping parameters identified at a current moment, wherein the plurality of virtual spring parameters include spring parameters of a virtual connecting rod and spring parameters of a virtual universal joint in multiple directions, and the plurality of virtual damping parameters include damping parameters of a virtual connecting rod and damping parameters of a virtual universal joint in multiple directions, wherein the virtual connecting rod is a virtual rod connecting the end effector and the slider, and the virtual universal joint is a virtual universal joint connected between the slider and the virtual connecting rod; Acquiring a desired position and posture of the target flexible robot; Determining a desired output force and a desired torque vector according to the desired posture and the current dynamics model; The target flexible robot is controlled to move according to the desired output force and the desired torque vector.

2. The control method of the flexible robot according to claim 1, characterized in that: The step of determining the current dynamic model of the target flexible robot includes: Acquire a dynamic relationship, wherein the dynamic relationship is used to represent the mechanical relationship between the slider and the end effector; The end effector generates a target thrust with a preset direction and a preset magnitude, and measures the force and torque on the slider to obtain a target force and a target torque; Obtaining a virtual connecting rod length and a target angle set corresponding to the virtual connecting rod at the current moment, wherein the target angle set includes angles between the virtual connecting rod and each plane in a reference coordinate system, and the reference coordinate system is a coordinate system corresponding to the slider; Identifying unknown parameters in the mechanical relationship according to the target force, the target torque, the virtual connecting rod length and the target angle set to obtain a plurality of virtual spring parameters and a plurality of virtual damping parameters; The current dynamics model is determined according to a plurality of the virtual spring parameters and a plurality of the virtual damping parameters.

3. The control method of the flexible robot according to claim 2, characterized in that: The obtaining of the target angle set corresponding to the virtual connecting rod at the current moment includes: Acquire first angle data and second angle data collected by an inertial measurement unit; Determine the target angle set according to the difference between the first angle data and the second angle data; The difference between the first angle data and the second angle data is Represented by the following quaternion: in, is the quaternion representation of the first angle data, is the quaternion representation of the second angle data, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient.

4. The control method of the flexible robot according to claim 3, characterized in that: The determining the target angle set according to the difference between the first angle data and the second angle data includes: Each angle in the target angle set is determined by the following formula: in, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system, is the real coefficient, is the first imaginary coefficient, is the second imaginary coefficient, is the third imaginary coefficient.

5. The control method of the flexible robot according to claim 4, characterized in that: The kinetic relationship includes: Where, M is the mass of the end effector, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the displacement of the object, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are , and Elastic parameters in three directions, , , The virtual universal joints are , and Damping coefficients in three directions, , , The moment of inertia of the end effector rotating around the rotation axis is respectively along , and The components of the moment of inertia in the three directions, , , are the components of the force applied by the end effector to the slider along the x-axis, y-axis, and z-axis directions, respectively, , , are the moment components of the slider along the x, y, and z axes, respectively, is the gyro torque component.

6. The control method of the flexible robot according to claim 1, characterized in that: The step of controlling the movement of the target flexible robot according to the expected output force and the expected torque vector comprises: measuring in real time the angular acceleration and angular velocity of the end effector around each coordinate axis in the effector coordinate system to obtain a plurality of angular accelerations and a plurality of angular velocities; Determining a real-time output force and a real-time torque vector of the end effector according to the multiple angular accelerations and the multiple angular velocities; The target flexible robot is controlled to move according to the expected output force and the expected torque vector, the real-time output force and the real-time torque vector.

7. The control method of the flexible robot according to claim 6, characterized in that: The relationship between the multiple angular accelerations and the real-time output force is expressed by the following formula: The relationship between the multiple angular velocities and the real-time torque vector is expressed by the following formula: in, , , are the angular accelerations of the end effector around each coordinate axis in the effector coordinate system, , , are respectively the real-time output forces of the end effector around each coordinate axis in the effector coordinate system, is the acceleration due to gravity, , , are the angular velocities of the real-time torque vector along each coordinate axis in the actuator coordinate system, , , are the torque vectors of the real-time torque vector along each coordinate axis in the actuator coordinate system, CL is the damping coefficient of the virtual universal joint, is the spring parameter of the virtual universal joint, is the connecting rod length of the virtual connecting rod, , , The virtual universal joints are , and Elastic parameters in three directions, , , The virtual universal joints are , and Damping coefficients in three directions, is the angle between the virtual link and the XZ plane in the reference coordinate system, is the angle between the virtual link and the XY plane in the reference coordinate system, is the angle between the virtual link and the YZ plane in the reference coordinate system.

8. A control device for a flexible robot, characterized in that: include: A first determination module is used to determine a current dynamic model of a target flexible robot, wherein the target flexible robot includes a slider, an end effector, and a flexible airbag connecting the slider and the end effector, and the current dynamic model is determined based on a plurality of virtual spring parameters and a plurality of virtual damping parameters identified at a current moment, wherein the plurality of virtual spring parameters include spring parameters of a virtual connecting rod and spring parameters of a virtual universal joint in multiple directions, and the plurality of virtual damping parameters include damping parameters of a virtual connecting rod and damping parameters of a virtual universal joint in multiple directions, wherein the virtual connecting rod is a virtual rod connecting the end effector and the slider, and the virtual universal joint is a virtual universal joint connected between the slider and the virtual connecting rod; An acquisition module, used to acquire the desired position and posture of the target flexible robot; A second determination module, configured to determine an expected output force and an expected torque vector according to the expected posture and the current dynamics model; A control module is used to control the movement of the target flexible robot according to the expected output force and the expected torque vector.

9. An electronic device, characterized in that: including memory and processor; The memory is used to store computer programs; The processor is used to implement the control method of the flexible robot as described in any one of claims 1 to 7 when executing the computer program.

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