Balance control method, device and equipment for wheel-legged robot and storage medium

By simplifying the wheeled-legged robot into an nth-order inverted pendulum model, and using sliding surfaces and dynamic equations to control joint torques, the balance robustness problem of the wheeled-legged robot under different motion states is solved, enabling rapid adjustment and stable recovery, and improving the versatility of the controller.

CN119024875AActive Publication Date: 2024-11-26TENCENT TECHNOLOGY (SHENZHEN) CO LTD

Patent Information

Application Number
CN202310872666.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-07-14
Publication Date
2024-11-26
Estimated Expiration
2043-07-14

AI Technical Summary

Technical Problem

In the existing technology, the balance control methods for wheeled and legged robots are not robust enough under different motion states, have limited application scenarios, and are difficult to effectively maintain the stability of the robot.

Method used

The wheeled robot is simplified into an nth-order inverted pendulum model. By acquiring the actual state variables, processing them into equivalent state variables, establishing a sliding surface, and determining the force and torque commands of the joints throughout the body according to the dynamic equations, the rotating joints are controlled to achieve balance.

Benefits of technology

It enhances the robot's ability to adjust its posture and balance, improves its ability to recover balance under different disturbances, increases the robustness of balance control, and eliminates the need to adjust control parameters when switching motion modes, thus improving the controller's versatility.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119024875A_ABST
    Figure CN119024875A_ABST
Patent Text Reader

Abstract

The invention discloses a balance control method, device and equipment of a wheel-legged robot and a storage medium, and relates to the technical field of robots. The wheel-legged robot is simplified into an n-order inverted pendulum model, the n-order inverted pendulum model comprises wheels, n connecting rods and n rotating joints, the first connecting rod is an equivalent connecting rod corresponding to at least two leg mechanisms of the wheel-legged robot, and the wheels are equivalent moving wheels corresponding to moving wheels connected with the at least two leg mechanisms respectively; the method comprises the following steps: acquiring an actual state quantity of the wheel-legged robot at a first moment; processing the actual state quantity at the first moment to obtain an equivalent state quantity at the first moment; establishing a sliding mode surface according to the equivalent state quantity at the first moment; according to the sliding mode surface, the equivalent state quantity at the first moment and the kinetic equation, determining a force and moment instruction about the wheel-legged robot; and at the second moment, the n rotating joints are controlled according to the force and torque instructions. The posture of the n connecting rods can be adjusted, and the robustness of balance control can be improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of artificial intelligence technology, and in particular to a balance control method, device, equipment and storage medium for a wheel-legged robot. Background Art

[0002] With the continuous development of robot technology, a wheel-legged robot has emerged in which mobile wheels are connected to leg mechanisms through joints. This wheel-legged robot has the mobility advantages of both wheeled robots and footed robots, and has a movement mode of moving forward by alternating steps through leg mechanisms.

[0003] In the related technology, in order to improve the balance ability of the wheel-legged robot during movement, the leg mechanism and the trunk mechanism of the wheel-legged robot are regarded as a whole, the rotational torque of the joint motor between the moving wheel and the leg mechanism is calculated, and the angle between the moving wheel and the leg mechanism is changed by rotating the joint motor to maintain the balance ability of the wheel-legged robot.

[0004] However, the use scenarios of the balance control process in the related technology are relatively few, and the robustness of the balance control method of the wheel-legged robot under different motion states needs to be further improved. Summary of the invention

[0005] The present application provides a balance control method, device, equipment and storage medium for a wheel-legged robot. The technical solution is as follows:

[0006] According to one aspect of an embodiment of the present application, a balance control method for a wheel-legged robot is provided, wherein the wheel-legged robot is simplified to an n-order inverted pendulum model, wherein the n-order inverted pendulum model comprises: a wheel, n connecting rods and n revolute joints, wherein the wheel and a first connecting rod among the n connecting rods are connected through a first revolute joint among the n revolute joints, wherein the n connecting rods are connected in series through n-1 revolute joints other than the first revolute joint, wherein the first connecting rod is an equivalent connecting rod corresponding to at least two leg mechanisms of the wheel-legged robot, wherein the wheel is an equivalent moving wheel corresponding to moving wheels respectively connected to the at least two leg mechanisms, and n is a positive integer greater than or equal to 2; wherein the method comprises:

[0007] Acquire an actual state quantity of the wheel-legged robot at a first moment, wherein the actual state quantity is used to characterize the motion state of n-1 connecting rods, the at least two leg mechanisms and the at least two moving wheels, wherein the n-1 connecting rods are other connecting rods among the n connecting rods except the first connecting rod;

[0008] Processing the actual state quantity at the first moment to obtain an equivalent state quantity at the first moment, wherein the equivalent state quantity is used to characterize the motion state of the n connecting rods and the wheel;

[0009] According to the equivalent state quantity at the first moment, a sliding surface is established, and the equivalent state quantity gradually tends to 0 on the sliding surface;

[0010] Determine force and torque instructions for whole-body joints of the wheel-legged robot according to the sliding surface, the equivalent state quantity at the first moment and the dynamic equation of the wheel-legged robot, wherein the whole-body joints include the n revolute joints, and the dynamic equation is established based on the n-th order inverted pendulum model;

[0011] At the second moment, the n rotational joints are controlled according to the force and torque instructions of the whole body joints.

[0012] According to one aspect of an embodiment of the present application, a balance control device for a wheel-legged robot is provided, wherein the wheel-legged robot is simplified to an n-order inverted pendulum model, wherein the n-order inverted pendulum model comprises: a wheel, n connecting rods and n revolute joints, wherein the wheel and a first connecting rod among the n connecting rods are connected through a first revolute joint among the n revolute joints, wherein the n connecting rods are connected in series through n-1 revolute joints other than the first revolute joint, wherein the first connecting rod is an equivalent connecting rod corresponding to at least two leg mechanisms of the wheel-legged robot, wherein the wheel is an equivalent moving wheel corresponding to moving wheels respectively connected to the at least two leg mechanisms, and n is a positive integer greater than or equal to 2; wherein the method comprises:

[0013] a state quantity acquisition module, used for acquiring the actual state quantity of the wheel-legged robot at a first moment, wherein the actual state quantity is used for characterizing the motion state of n-1 connecting rods, the at least two leg mechanisms and the at least two moving wheels, wherein the n-1 connecting rods are the other connecting rods among the n connecting rods except the first connecting rod;

[0014] a state quantity processing module, used for processing the actual state quantity at the first moment to obtain an equivalent state quantity at the first moment, wherein the equivalent state quantity is used for characterizing the motion state of the n connecting rods and the wheel;

[0015] A sliding surface establishing module, used to establish a sliding surface according to the equivalent state quantity at the first moment, wherein the equivalent state quantity gradually tends to 0 on the sliding surface;

[0016] an instruction determination module, for determining force and torque instructions about whole-body joints of the wheel-legged robot according to the sliding surface, the equivalent state quantity at the first moment and the dynamic equation of the wheel-legged robot, wherein the whole-body joints include the n revolute joints, and the dynamic equation is established based on the n-th order inverted pendulum model;

[0017] The joint control module is used to control the n rotational joints according to the force and torque instructions of the whole body joints at the second moment.

[0018] According to one aspect of an embodiment of the present application, a computer device is provided, which includes a processor and a memory, wherein a computer program is stored in the memory, and the computer program is loaded and executed by the processor to implement the above-mentioned balance control method of the wheel-legged robot.

[0019] According to one aspect of an embodiment of the present application, a computer-readable storage medium is provided, in which a computer program is stored. The computer program is loaded and executed by a processor to implement the above-mentioned balance control method of the wheel-legged robot.

[0020] According to one aspect of an embodiment of the present application, a computer program product is provided, wherein the computer program product comprises a computer program, and the computer program is loaded and executed by a processor to implement the above-mentioned balance control method of the wheel-legged robot.

[0021] The technical solution provided in the embodiments of the present application can bring the following beneficial effects:

[0022] On the one hand, by abstracting the wheel-legged robot into an n-order inverted pendulum model, balance control under multi-wheel motion modes can be achieved. During the balance control process, the deflection angles of multiple connecting rods in the wheel-legged robot are adjusted to change the posture of the wheel-legged robot; the postures of multiple connecting rods in the wheel-legged robot are made variable during the balance adjustment process, which greatly enriches the robot posture, helps to quickly adjust the robot to a balanced state, and also helps to improve the robot's ability to recover to a balanced state under different disturbance forces, thereby improving the robustness of the robot's balance control process.

[0023] On the other hand, the method provided by the present application is used to determine the equivalent state quantity according to the actual state quantity, so that the balance control under the multi-wheel motion mode can share a set of control parameters with the balance control under the two-wheel motion mode. After the wheel-legged robot switches the motion mode, there is no need to adjust the control parameters in the controller (such as a robust controller) used for balance control, which helps to improve the versatility of the controller. BRIEF DESCRIPTION OF THE DRAWINGS

[0024] Figure 1 It is a schematic diagram of an implementation environment of a solution provided by an embodiment of the present application;

[0025] Figure 2 is a schematic diagram of a quadruped wheel-legged robot provided by an embodiment of the present application;

[0026] Figure 3is a schematic diagram of a quadruped wheel-legged robot provided by an embodiment of the present application;

[0027] Figure 4 is a schematic diagram of a quadruped wheel-legged robot in a two-wheel mode provided by an embodiment of the present application;

[0028] Figure 5 is a schematic diagram of a quadruped wheel-legged robot climbing stairs provided by an embodiment of the present application;

[0029] Figure 6 This is a schematic diagram of a robot's planar motion when climbing stairs provided by an embodiment of the present application;

[0030] Figure 7 is a schematic diagram of an action sequence of a robot going up and down stairs provided by an embodiment of the present application;

[0031] Figure 8 is a block diagram of a robot control system provided by an embodiment of the present application;

[0032] Fig. 9 is a schematic diagram of a four-wheel motion mode of a wheel-legged robot provided by an embodiment of the present application;

[0033] Fig.10 is a schematic diagram of a simplified kinetic model provided in one embodiment of the present application;

[0034] Fig.11 is a schematic diagram of a second-order inverted pendulum provided by an embodiment of the present application;

[0035] Fig.12 is a schematic diagram of a second-order inverted pendulum provided by an embodiment of the present application;

[0036] Fig.13 is a flow chart of a balance control method of a wheel-legged robot provided by an embodiment of the present application;

[0037] Fig.14 is a schematic diagram of an inverted pendulum with center of mass correlation provided by one embodiment of the present application;

[0038] Fig.15 is a simulation schematic diagram of a multi-wheel balancing control method provided by an embodiment of the present application;

[0039] Fig.16 is a block diagram of a balance control device for a wheel-legged robot provided by an embodiment of the present application;

[0040] Fig.17 It is a structural block diagram of a computer device provided by an embodiment of the present application. DETAILED DESCRIPTION

[0041] In order to make the objectives, technical solutions and advantages of the present application clearer, the implementation methods of the present application will be further described in detail below with reference to the accompanying drawings.

[0042] In order to make the objectives, technical solutions and advantages of the present application clearer, the implementation methods of the present application will be further described in detail below with reference to the accompanying drawings.

[0043] Artificial Intelligence (AI) is the theory, method, technology and application system that uses digital computers or machines controlled by digital computers to simulate, extend and expand human intelligence, perceive the environment, acquire knowledge and use knowledge to obtain the best results. In other words, artificial intelligence is a comprehensive technology in computer science that attempts to understand the essence of intelligence and produce a new intelligent machine that can respond in a similar way to human intelligence. Artificial intelligence is to study the design principles and implementation methods of various intelligent machines so that machines have the functions of perception, reasoning and decision-making.

[0044] Artificial intelligence technology is a comprehensive discipline that covers a wide range of fields, including both hardware-level and software-level technologies. The basic technologies of artificial intelligence generally include sensors, dedicated artificial intelligence chips, cloud computing, distributed storage, big data processing technology, operation / interaction systems, mechatronics and other technologies. Artificial intelligence software technology mainly includes computer vision technology, speech processing technology, natural language processing technology, and machine learning / deep learning.

[0045] The technical solution of this application mainly involves the robot technology in artificial intelligence technology, mainly involving robot intelligent control. Robots are mechanical and electronic devices that can imitate certain human skills by combining mechanical transmission and modern microelectronics technology. Robots are developed on the basis of electronic, mechanical and information technology. Robots do not necessarily have to look like humans. As long as they can independently complete the tasks and commands assigned to them by humans, they are members of the robot family. A robot is an automated machine that has some intelligent abilities similar to those of humans or organisms, such as perception, planning, movement and coordination. It is an automated machine with high flexibility. With the development of computer technology and artificial intelligence technology, robots have been greatly improved in terms of function and technical level. Mobile robots and robot vision and touch technologies are typical representatives.

[0046] In the technical solution provided in the embodiment of the present application, the executor of each step may be a computer device, which refers to an electronic device with data calculation, processing and storage capabilities.

[0047] Optionally, the computer device may be a PC (Personal Computer) device such as a desktop computer or a laptop computer for controlling the robot; or a server for controlling the robot. The server may be an independent physical server, a server cluster or a distributed system composed of multiple physical servers, or a cloud server providing cloud computing services. The computer device and the robot may be connected via a physical line, a network, or the like. For example, refer to Figure 1 The computer device 101 can determine the equivalent state quantity corresponding to the n-order inverted pendulum model obtained based on the robot abstraction according to the current actual state quantity of the robot 103, and gradually calculate the force and torque instructions of the robot's whole body joints according to the equivalent state quantity, and control the n rotational joints included in the robot 103 according to the force and torque instructions of the robot's whole body joints, so that the robot 103 maintains or restores the balance state.

[0048] Optionally, the computer device may also be the robot itself, that is, the execution subject of each step in the technical solution provided in the embodiment of the present application is a robot or other device that is in communication connection with the robot. Figure 1 The computer device 101 can send the state quantity of the robot 103 at the first moment to the robot 103 through the network 102. The robot 103 gradually calculates the force and torque instructions of the robot's whole body joints according to the equivalent state quantity at the first moment, and controls the movement of the rotational motors of the n rotational joints through the force and torque instructions of the robot's whole body joints, adjusts the posture of the robot 103, and thus changes the balance state of the robot.

[0049] The robot in the embodiments of the present application may refer to a wheel-legged robot, a leg-footed robot, etc. A wheel-legged robot refers to a robot with both a wheel structure and a leg mechanism, and a leg-footed robot refers to a robot with feet as its feet. The embodiments of the present application do not limit this.

[0050] In one example, the robot 103 may include at least 2 moving wheels. Optionally, the balance control method provided in the present application is applicable to the release of j moving wheels from the contact surface, and when observed from the side of the wheel-legged robot, the j moving wheels do not overlap. For the specific content of the process, please refer to the introduction below. For each of the at least 2 moving wheels, the moving wheel is connected to its corresponding leg mechanism through a first rotation joint. For example, the robot 103 has 2 moving wheels, and the robot 103 moves by rolling on the 2 moving wheels. For another example, the robot 103 has four moving wheels. Exemplarily, each moving wheel is connected to its corresponding leg mechanism through a first rotation joint. Exemplarily, different moving wheels are respectively connected to different leg mechanisms.

[0051] In some embodiments, the robot in the embodiments of the present application includes a moving wheel and at least two connecting rods, and the wheel-legged robot is composed of at least one mechanism part, and each mechanism part can be simplified into a connecting rod. The above-mentioned at least two connecting rods can be equivalent to the connecting rod in the n-order inverted pendulum model; that is, in the method provided in the present application, during the balance control process, the wheel-legged robot is simplified into an n-stage inverted pendulum model, and the n-order inverted pendulum model includes wheels and n connecting rods, and the n connecting rods are connected in series through n-1 rotation joints, and the first connecting rod in the n mechanisms is connected to the moving wheel through the first rotation joint, wherein the wheel refers to the equivalent moving wheel obtained based on at least two moving wheels, and the first connecting rod refers to the equivalent leg mechanism obtained by equivalently obtaining at least two leg mechanisms in the wheel-legged robot.

[0052] The wheel-legged robot includes at least two leg mechanisms, and any one of at least one leg mechanism has a corresponding moving wheel. For example, leg mechanism 1 corresponds to moving wheel 1, and leg mechanism 1 is connected to moving wheel 1 through real revolute joint 1. That is, the number of leg mechanisms of the wheel-legged robot is equal to the number of moving wheels.

[0053] Optionally, at least two leg mechanisms may be divided into an outer leg group and an inner leg group, the outer leg group including at least two leg mechanisms and the inner leg group including at least one leg mechanism.

[0054] Exemplarily, a wheel-legged robot is taken as an example to illustrate the robot in the embodiments of the present application.

[0055] At least one leg mechanism is divided into: an outer leg mechanism and an inner leg mechanism; wherein, the outer leg mechanism includes: at least two leg mechanisms, and the inner leg mechanism may also include at least two leg mechanisms, the outer leg mechanism includes at least two leg mechanisms respectively located on both sides of the central axis (i.e., the sagittal plane) of the wheel-legged robot, and the inner leg mechanism includes at least two leg mechanisms respectively located on both sides of the central axis of the wheel-legged robot, the outer leg mechanism and the inner leg mechanism, that is, the rotation center of the hip joint corresponding to the outer leg and the inner leg mechanism and the rotation center of the hip joint corresponding to the inner leg mechanism are located in the same vertical plane.

[0056] Exemplarily, the wheel-legged robot is a four-legged wheel-legged robot, that is, the wheel-legged robot includes two outer leg mechanisms and two inner leg mechanisms; the wheel-legged robot is also a three-legged wheel-legged robot, that is, the wheel-legged robot includes two outer leg mechanisms and one inner leg mechanism. Among them, the hip joint corresponding to at least one inner leg mechanism in the inner leg mechanism group is located between the hip joints corresponding to the two outer leg mechanisms in the outer leg mechanism group, and the rotation center of the hip joint corresponding to the outer leg mechanism and the rotation center of the hip joint corresponding to the inner leg mechanism are located in the same vertical plane. The wheel-legged robot can stand on the support surface through the outer leg mechanism or the inner leg mechanism, and the wheel-legged robot can also slide on the support surface through the foot wheels on the outer leg mechanism or the foot wheels on the inner leg mechanism, and can also move (i.e. walk) on the support surface by controlling the outer leg mechanism group and the inner leg mechanism group to swing alternately.

[0057] For example, Figure 2 As shown, it exemplarily shows a structural schematic diagram of a quadruped wheel-legged robot. The quadruped wheel-legged robot 200 may include: a trunk structure, a leg mechanism and moving wheels.

[0058] The quadruped wheeled legged robot 200 has four leg mechanisms: two outer leg mechanisms 201 (i.e., the first leg mechanism group) and two inner leg mechanisms 202 (i.e., the second leg mechanism group), the two inner leg mechanisms 202 are located between the two outer leg mechanisms 201, and the four leg mechanisms can be extended and retracted individually along the direction shown in the figure. A wheel 203 is installed at the end of each of the four leg mechanisms, and each wheel 203 can be driven individually. The quadruped wheeled legged robot 200 can stand up through the two inner leg mechanisms 202 or the two outer leg mechanisms 201 to be in a double-wheeled support state; the quadruped wheeled legged robot 200 can stand up through the two inner leg mechanisms 202 and the two outer leg mechanisms 201 at the same time to be in a quadruped wheeled support state, which is not limited in the embodiments of the present application.

[0059] Optionally, the two inner leg mechanisms 202 may be implemented as a whole, that is, the quadruped wheel-legged robot 200 may be implemented as a tripod wheel-legged robot having only one inner leg mechanism.

[0060] The other ends of the four leg mechanisms are each connected to a hip joint 204, and each leg mechanism can rotate around its own hip joint 204 and maintain linkage. In the embodiment of the present application, the rotation centers of the hip joints 204 corresponding to the quadruped wheeled leg robot 200 are located in the same vertical plane 205, and the rotation planes of the leg mechanisms corresponding to the quadruped wheeled leg robot 200 are parallel. The hip joints 204 corresponding to the two inner leg mechanisms 202 are located between the hip joints 204 corresponding to the two outer leg mechanisms 201.

[0061] Optionally, the hip joints 204 corresponding to the quadruped wheel-legged robot 200 may be coaxial, that is, the rotation centers of the hip joints 204 are located in the same straight line. The hip joints 204 corresponding to the quadruped wheel-legged robot 200 may also be non-coaxial, such as the hip joints 204 corresponding to the two inner leg mechanisms 202 are coaxial, and the hip joints 204 corresponding to the two outer leg mechanisms 201 are coaxial, but the hip joints 204 corresponding to the two inner leg mechanisms 202 are not coaxial with the hip joints 204 corresponding to the two outer leg mechanisms 201. The hip joint 204 can be used as a revolute joint connected to the first connecting rod among the n revolute joints in the embodiment of the present application, one end of the first connecting rod is connected to the real revolute joint, and the other end is connected to the hip joint 204.

[0062] Optionally, the hip joints 204 corresponding to the two outer leg mechanisms 201 share a driving motor so that the two outer leg mechanisms 201 move synchronously; the hip joints 204 corresponding to the two inner leg mechanisms 202 share a driving motor so that the two inner leg mechanisms 202 move synchronously. In a feasible example, each hip joint 204 corresponding to the quadruped wheel-legged robot 200 can also be independently driven by its own corresponding driving motor, which is not limited in the embodiment of the present application.

[0063] The body of the quadruped wheeled-legged robot 200 may include a waist 206 , a trunk 207 , upper limbs 208 and a head 209 .

[0064] The hip joints 204 corresponding to the quadruped wheeled leg robot 200 are connected to the same end of the waist 206, and the other end of the waist 206 is connected to one end of the trunk (trunk mechanism) 207. The waist 206 has two rotation centers: a pitch rotation center that can make the trunk 207 pitch, and a sway rotation center that can make the trunk 207 sway sideways. The sway rotation center is designed in series with the pitch rotation center, and is located at the upper end of the pitch rotation center and connected to the trunk 207.

[0065] For example, if Figure 2 The body 207 in the robot rotates 90 degrees along the side swing rotation center. Figure 2 Convert to Figure 3 The robot shown.

[0066] The other end of the torso 207 is connected to the upper limb (robot arm connecting rod) 208 and the head 209, and the upper limb 208 can be a multi-degree-of-freedom upper limb. In some embodiments, an end effector, such as a robot gripper, a suction cup, etc., is deployed on the upper limb 208. A data acquisition device can be deployed in the head 209 to perceive the real environment, such as an image acquisition device, a video shooting device, an IMU (Inertial Measurement Unit), etc. Among them, the IMU can be placed at the geometric center of the torso 207, the center point of the hip joint (i.e., the rotation center of the hip joint), etc., which can be used to measure the actual acceleration, actual attitude angular velocity, actual Euler angle, etc. of the torso 207.

[0067] In the technical solution provided in the embodiment of the present application, the moving wheels, leg mechanisms, hip joints, waist and trunk mechanisms (including IMU) of the quadruped wheeled-legged robot 200 are necessary hardware for the control algorithm, and the rest are non-essential hardware.

[0068] Compared with the two-legged wheel-legged robot, the four-legged wheel-legged robot has a more stable structure and a stronger ability to resist external impact disturbances. Compared with the six-legged wheel-legged robot, it has fewer redundant joints and a lower design complexity. It can not only bear large loads, but also pass through narrow spaces and perform tasks on objects of different heights. The four-legged wheel-legged robot has a strong ability to adapt to the environment.

[0069] The balance control method of the wheel-legged robot provided in the embodiment of the present application can be applied to a variety of scenarios, such as the balance of the wheel-legged robot during movement, the balance of the wheel-legged robot under external force disturbance, etc. The balance control method of the wheel-legged robot provided in the embodiment of the present application can flexibly control the rotation of multiple joints of the wheel-legged robot during the balance control process, enrich the posture of the robot during the balance control process, and help control the robot to quickly be in a balanced state.

[0070] When moving on flat ground, the robot can maintain Figure 2 The four-wheel motion pattern shown can also be formed through the rotation center of the hip joint as shown in Figure 4 The two-wheel dynamic smooth motion mode shown. In the four-wheel motion mode, the robot is always in a stable state (does not fall), which makes it easier for the upper limbs to follow the operation instructions to perform some operation tasks. However, when moving on flat ground, switching from the four-wheel motion mode to the two-wheel motion mode can reduce the robot's footprint and match it with a bipedal robot. When moving on non-flat ground, such as when the robot goes up stairs or crosses a threshold, the robot can be moved by Figure 5 The dual-wheel alternating pattern shown enables dynamic obstacle traversal.

[0071] In some embodiments, reference Figure 5When the wheel-legged robot 501 needs to climb stairs, it can first construct an objective function corresponding to the stair climbing task according to the stair climbing task to be performed, and then control the outer leg mechanism group 502 (i.e., the first leg mechanism group) and the inner leg mechanism group 503 (i.e., the second leg mechanism group) of the robot 501 to swing alternately according to the joint torque information of the robot 501 when the value of the objective function is minimized, so as to perform the stair climbing task. For example, the outer leg mechanism group 502 is first used as the supporting leg mechanism group, and the inner leg mechanism group 503 is used as the swinging leg mechanism group, so that the robot 501 climbs the first step, and then the inner leg mechanism group 503 is used as the supporting leg mechanism group, and the outer leg mechanism group 502 is used as the swinging leg mechanism group, so that the robot 501 climbs the second step, and the outer leg mechanism group 502 and the inner leg mechanism group 503 swing alternately in sequence to complete the stair climbing task.

[0072] Figure 6 This is a schematic diagram of the planar movements of a robot climbing stairs provided by an exemplary embodiment of the present application. Figure 6 The left leg mechanism and the right leg mechanism of the robot completely overlap, so Figure 6 The leg mechanisms connected to the two wheels of the robot respectively represent the first leg mechanism and the second leg mechanism of the robot. Considering the specific form of the stair climbing process, Figure 6 The robot shown in the figure will not touch the same support surface at the same time when the wheels are on the ground, so as to conform to the actual motion state of the stairs. The motion phase of the robot during the entire motion process can also be divided into a single support phase (Single Support Phase, SSP) and a double support phase (Double Support Phase, DSP).

[0073] Figure 6The first state shown is the single-leg support stage, in which the first leg mechanism 601 of the robot is in contact with the support surface, and the second leg mechanism 602 is not in contact with the support surface. The first leg mechanism 601 uses the wheels and the joints of the fuselage to coordinate control to maintain the balance of the robot. In the first stage, the robot swings the second leg mechanism 602, gradually lifting it up from the vertical downward gravity direction at the beginning until it rests on the upper step, and enters the second state, which is the double-leg support stage. During the first stage, the first leg mechanism 601 is a supporting wheel leg, and the second leg mechanism 602 is a swinging wheel leg. In the second stage, the robot always keeps two contact points between the wheel and the support surface in the plane. During this process, the robot changes the angles of each joint of the fuselage, and on the premise of keeping the contact points of the two wheels with the support surface unchanged, gradually moves the projection of the center of mass of the fuselage on the support surface from the vicinity of the center of the rear wheel on the next step to the vicinity of the center of the front wheel on the previous step, and enters the third state, which is the double-leg support stage. In the third stage, the robot lifts the first leg mechanism 601 from the lower step and uses the second leg mechanism 602 to maintain the balance of the robot until the first leg mechanism 601 and the second leg mechanism 602 overlap in the vertical direction, entering the fourth state, which is the single-leg support stage. During the third stage, the second leg mechanism 602 is a supporting wheel leg, and the first leg mechanism 601 is a swinging wheel leg.

[0074] When the robot moves up one step, the supporting leg mechanism and the swinging leg mechanism will be interchanged. In the periodic movement of climbing stairs, the supporting leg mechanism and the swinging leg mechanism will be periodically interchanged. Similarly, the stage division of the robot's task of going down stairs is the same as the stage division of the task of climbing stairs, except that the movement direction of each leg mechanism is opposite to that of each leg mechanism in the task of climbing stairs. Therefore, the task of the robot going down stairs will not be described here. The specific process can be referred to Figure 7 The schematic diagram of the robot's action sequence of going up and down stairs is shown, which will not be described in detail.

[0075] Please refer to Figure 8 , which shows a block diagram of a robot control system provided by an embodiment of the present application. The robot body can refer to Figure 2 The four moving wheels of the robot are driven individually by four rotary motors, and the lengths of the four moving leg mechanisms are driven individually by four linear motors. Normally, the driving modes of the linear motors of the two outer moving legs are the same, and the driving modes of the linear motors of the two inner moving legs are the same.

[0076] Optionally, the lengths of the two outer moving legs are equal, and the lengths of the two inner moving legs are equal. The lengths of the two outer moving legs change at the same speed, and the lengths of the two inner moving legs change at the same speed.

[0077] The two outer moving legs are driven by the same rotary motor, which is used to adjust the angle between the outer moving legs and the straight line L1 perpendicular to the contact surface direction, that is, the angles between the two outer moving legs and the straight line L1 are equal. The two inner moving legs are driven by the same rotary motor, which is used to adjust the angle between the inner moving legs and L1, that is, the angles between the two inner moving legs and the straight line L1 are equal.

[0078] In addition, each joint of the trunk mechanism of the wheel-legged robot is respectively provided with a rotary motor, and the rotation of each joint can be actively driven by the rotary motor.

[0079] For all the rotating motors mentioned above, the rotating motors can receive rotation angle instructions, rotation speed instructions, rotation torque instructions, etc.; among them, the rotation angle instruction is used to indicate the rotation angle of the rotating motor, the rotation speed instruction is used to indicate the rotation speed and rotation direction of the rotating motor, and the rotation torque is used to indicate the torque that needs to be achieved during the rotation process of the rotating motor.

[0080] After the rotating motor receives any one of the above-mentioned rotation angle instructions, rotation speed instructions, and rotation torque instructions, the bottom driving board of the rotating motor will drive the motor to rotate according to the received instruction signal, thereby driving each joint to move.

[0081] For all the linear motors mentioned above, the linear motors can receive linear movement position instructions, linear movement speed instructions, driving force instructions, etc. The underlying driving board of the linear motor will drive the motor to move linearly according to the received command signal, thereby driving the leg mechanism to telescopically move.

[0082] The rotation and movement of the rotary motor and linear motor change the robot's posture and position in three-dimensional space, achieving balance control of the wheel-legged robot. Rapidly changing joint angle commands can also cause the robot's posture to change in high dynamics to change the robot's contact with the environment.

[0083] Since the posture and state (such as motion state) of the wheel-legged robot are different at different times, it is necessary to collect the posture information and motion state information of the wheel-legged robot through sensors set on the wheel-legged robot in order to generate command signals and realize the balance control and motion state of the wheel-legged robot.

[0084] Optionally, the state of the wheel-legged robot can be acquired by different sensors installed on the wheel-legged robot body. The sensor type includes at least one of the following:

[0085] The IMU sensor is used to determine the current posture of the wheel-legged robot, including the position information and posture information of the wheel-legged robot.

[0086] The motor encoder is used to determine the rotation speed of each joint of the wheel-legged robot in the current state, the position information related to the movement, and the speed information of the rotation and movement.

[0087] The force / torque sensor is used to determine the magnitude of the force at the joint where the force / torque sensor is located at the current moment, as well as the magnitude and direction of the torque.

[0088] The tactile sensor is used to determine the contact position between the moving wheels of the wheel-legged robot and the contact surface, the pressure on the body surface, the inside of the hand, the fingertips and other body parts, and the changing characteristics of the pressure over a period of time.

[0089] Visual sensors (such as cameras, infrared sensors) are used to identify obstacles that appear within the field of view of the wheel-legged robot, and are also used to determine the position information of the center of mass of the wheel-legged robot and the speed information corresponding to the center of mass of the wheel-legged robot.

[0090] Optionally, the control system of the wheel-legged robot includes the following control modules:

[0091] 1. The State Estimation module is used to fuse the posture information and state information obtained by the wheel-legged robot. For example, the current posture of the wheel-legged robot obtained by the IMU sensor, the mileage information obtained by the rotation of the mobile wheel, and the visual positioning information can be integrated to obtain the position of the wheel-legged robot in the world coordinate system; the information obtained by the force / torque sensor and the tactile sensor can be integrated to obtain the contact between the robot and the external environment; the current posture of the wheel-legged robot obtained by the IMU sensor and the angle information of each motor joint encoder can be integrated, and combined with the model parameters of the wheel-legged robot itself, the center of mass position of the wheel-legged robot can be estimated. These integrated wheel-legged robot state information will be used as feedback for the motion generation, planning and control of the wheel-legged robot.

[0092] 2. Motion Generation module, used to adopt the motion generation strategy corresponding to the working mode according to the working mode of the wheel-legged robot when completing the action. The working modes of the robot include but are not limited to: four-wheel motion mode, two-wheel motion mode, four-wheel to two-wheel conversion mode, stair climbing mode, four-wheel active suspension mode (the four-wheel active suspension mode means that the contact surface is uneven during the four-wheel mode, and the robot relies on the four wheels to adjust the upper body posture, thereby maintaining a relatively stable upper body posture), folding mode, etc. Considering the complexity of the upper body, it can be used to complete a variety of tasks. The robot can contain more motion modes, which are not listed here one by one.

[0093] In different modes, the way of action generation is different. In these modes, some common basic technologies and algorithm modules will be called, including but not limited to: model-free controller, model-based controller, etc., model-based controller, such as: LQR (Linear Quadratic Regulator), MPC (Model Predictive Control), adaptive controller, robust controller, etc. Optionally, the robust controller in the embodiment of the present application is implemented based on sliding mode control, and the robust controller can also be called a sliding mode controller.

[0094] For example, when the wheel-legged robot is in the dual-wheel mode and needs to control the balance of the moving wheels, the PID control (Proportional Integral Derivative Control) of the model-free controller can be used to generate the reference trajectory of the foot wheel and the robot's center of mass. Exemplarily, the specific method is to call one or more of the model-free controller, the model-based controller (LQR, MPC, etc.), the adaptive controller, and the robust controller.

[0095] For example, in the two-wheel control stage when the wheel-legged robot is in the four-wheel turning two-wheel mode, a model-free controller, a model-based controller (LQR, MPC, etc.), an adaptive controller, and a robust controller can also be used to control the balance of the moving wheels.

[0096] For another example, when the wheel-legged robot is in the four-wheel mode, if the leg mechanism of the wheel-legged robot extending forward and the leg mechanism extending backward are made equivalent, an equivalent leg mechanism is obtained, and the equivalent first connecting rod and other mechanisms in the wheel-legged robot can be simplified into an n-order inverted pendulum model, the control trajectory obtained by this method can maintain the balance of the robot in the four-wheel state. In this way, the wheel-legged robot can maintain the relative stability of the wheel-legged robot body when the contact surface is uneven, potholes or obstacles appear. Exemplarily, when the wheel-legged robot is in the four-wheel active suspension mode, the above module can also be used to control the relative stability of the wheel-legged robot body.

[0097] The input of the action generation module is a series of task information of the wheel-legged robot. The types of task information include but are not limited to: center of mass tasks, supporting leg tasks, swinging leg tasks, waist tasks, etc. Similarly, considering the complexity of the upper body of the wheel-legged robot, the upper body can independently complete a variety of actions and tasks. There are more types of task information, which are not listed here one by one.

[0098] Exemplarily, these tasks can also be used as inputs to the Whole Body Controller (WBC) (also called the Whole Body Dynamics Controller). In the Whole Body Motion Control Module, the wheel-legged robot will be modeled in detail (to obtain the whole body dynamics model of the wheel-legged robot) and calibrated, and the whole body dynamics model of the wheel-legged robot and the external force conditions will be used as optimization constraints. After the optimization process, the target joint angle command, target joint angular velocity command, target joint torque command, etc. of the target shutdown in at least one rotating joint of the wheel-legged robot will be calculated. Finally, the whole body motion control module will send the above-determined target joint angle command, target joint angular velocity command, target joint torque command, etc. to the drivers of each joint of the robot, thereby completing the control closed loop of the wheel-legged robot.

[0099] The balance control method of the wheel-legged robot provided in this application is mainly composed of Figure 8 The robust controller in the control system is used to complete the balance control method. Optionally, the balance control method is completed by the robust controller and the whole body motion control module. For details of the process, please refer to the following embodiments.

[0100] Before introducing the specific steps of the balance control method provided in the present application, in order to facilitate understanding of the structure of the wheel-legged robot, the methods related to balance control in the wheel-legged robot are first introduced and explained.

[0101] Please refer to Fig. 9 , which shows a schematic diagram of the four-wheel motion mode of the wheel-legged robot provided by an embodiment of the present application. Observing from the side of the wheel-legged robot (i.e., the yoz plane in the world coordinate system), there are at least two moving wheels in the wheel-legged robot that do not overlap in the yoz plane, and the leg mechanisms respectively connected to the at least two moving wheels do not overlap in the yoz plane. In other words, along the forward direction of the wheel-legged robot, there are at least two moving wheels that are in contact with the contact surface and do not overlap.

[0102] Optionally, the external leg mechanism included in the external leg group of the wheel-legged robot and the internal leg mechanism included in the internal leg group do not overlap in the yoz plane, at least two external leg mechanisms included in the external leg group overlap in the yoz plane, and at least one internal leg mechanism included in the internal leg group overlaps in the yoz plane.

[0103] The wheel-legged robot also includes several parts that can be simplified into connecting rods, such as Fig. 9 The n-1 links shown are connected in series via revolute joints.

[0104] Please refer to Fig.10, which shows a schematic diagram of a simplified kinetic model provided by one embodiment of the present application. Fig.10 As described, by making equivalents to at least two non-overlapping moving wheels 1012 and 1014 along the forward direction, the wheel 1016 in the n-order inverted pendulum model is obtained, and by making equivalents to at least two non-overlapping leg mechanisms 1022 and 1024 along the forward direction, the first link 1026 in the n-order inverted pendulum model is obtained, so that the wheel-legged robot in a multi-wheel motion mode can be simplified into an n-order inverted pendulum model, and the balance of the wheel-legged robot can be controlled based on the n-order inverted pendulum model.

[0105] In some embodiments, the equivalent contact point between the wheel 1016 and the contact surface is located between the contact points between the at least two non-overlapping moving wheels 1012 and 1014 and the contact surface. Exemplarily, the equivalent contact point between the wheel 1016 and the contact surface is the midpoint of the line connecting the contact points between the at least two non-overlapping moving wheels 1012 and 1014 and the contact surface, and the at least two non-overlapping moving wheels 1012 and 1014 are two moving wheels distributed on the same side of the axis of the wheel-legged robot.

[0106] Fig.10 In the text, only the case where two moving wheels do not overlap in the forward direction is taken as an example, and a method for obtaining the wheels and the first connecting rod equivalently and establishing an n-order inverted pendulum model corresponding to the wheel-legged robot in this posture is shown; when there are multiple moving wheels in the wheel-legged robot that do not overlap in the forward direction, the multiple moving wheels can also be equivalent to obtain wheels; multiple leg mechanisms are equivalent to obtain the first connecting rod, so as to simplify the wheel-legged robot into an n-order inverted pendulum model and perform balance control on the wheel-legged robot.

[0107] Before introducing the specific steps of the balance control method provided by the present application, the method for establishing the dynamic model corresponding to the balance control method provided by the present application is first introduced. In order to facilitate the understanding of the principle of the n-order inverted pendulum model involved in the present application, the second-order inverted pendulum model, which is easier to understand, is first introduced.

[0108] Please refer to Fig.11 , which shows a schematic diagram of a second-order inverted pendulum provided by an embodiment of the present application. From the above introduction, it can be seen that by making the non-overlapping moving wheels and non-overlapping leg mechanisms of the wheel-legged robot equivalent, the wheel-legged robot can be simplified into an n-order inverted pendulum model for balance control. On this basis, the dynamic equation of the wheel-legged robot can be derived based on the n-order inverted pendulum model, which is convenient for the subsequent realization of balance control of the wheel-legged robot.

[0109] For the sake of clarity, brevity and ease of understanding, the case where n is equal to 2 is introduced and explained. After at least two leg mechanisms and at least two moving wheels are equivalent, the wheel-legged robot is simplified into an n-order inverted pendulum model.

[0110] The world coordinate system is established with the forward direction of the wheel-legged robot as the positive direction of the x-axis, the rightward direction as the positive direction of the y-axis, and the upward direction perpendicular to the contact surface as the positive direction of the z-axis.

[0111] like Fig.11 As shown in the two-dimensional model, the direction in which the moving wheel rotates to the left of the contact surface is taken as the positive direction, the travel distance is x, and the angle of rotation of the wheel relative to the world coordinate system is defined as The counterclockwise direction is taken as the positive direction of the wheel rotation angle. The angle of rotation of the first link 1110 obtained by equivalently rotating at least two leg mechanisms relative to the world coordinate system is defined as α, and the counterclockwise direction is positive. The angle of rotation of the second link (another link among the n links except the first link) 1130 corresponding to the trunk mechanism relative to the world coordinate system is defined as β, and the counterclockwise direction is taken as the positive direction of the wheel rotation angle. In the following, the first link is referred to as link B, and the second link is referred to as link P.

[0112] definition They are The derivatives of α, β with respect to time; where, represents the rotation speed of the wheel (also called the angle of the wheel), represents the angular velocity of the first link, represents the angular velocity of the second link; define They are The second-order derivatives of α and β with respect to time; is the angular acceleration of the wheel, is the angular acceleration of the first link, represents the angular acceleration of the second link.

[0113] The wheel rotates relative to the world coordinate system by the angle of the first revolute joint (equivalent to Fig.11 The joint motor drive on 1120) in the figure, the rotational torque of the first rotational joint is represented by τ1, and the clockwise direction is taken as the positive direction of the rotational torque of the first rotational joint.

[0114] The second link rotates relative to the world coordinate system by the angle of the second revolute joint (equivalent to Fig.11 The joint motor drive of the second revolute joint is 1140, and the rotational torque of the second revolute joint is represented by τ2, and the counterclockwise direction is taken as the positive direction of the rotational torque of the second revolute joint. Since the trunk mechanism directly corresponds to the second connecting rod, the trunk mechanism and the second connecting rod have the same meaning in the derivation process of the dynamic equation.

[0115] The masses of the wheels, connecting rod B (equivalent to at least two non-overlapping leg mechanisms), and connecting rod P (equivalent to the trunk mechanism) are expressed as m W , m B , m P ; The moments of inertia of the wheel, connecting rod B, and connecting rod P are expressed as: J W , J B , J P The radius of the wheel is represented by r, and the length of the connecting rod B is represented by L B The length of the line from the intersection of connecting rod B and the wheel to the geometric center of connecting rod B is represented by l B The length of the line from the intersection of connecting rod B and the wheel to the geometric center of connecting rod P is represented by l P express.

[0116] (1) Based on the definitions of the above physical quantities, derive the total kinetic energy T of the wheel. W , the total kinetic energy of connecting rod B is T B and the total kinetic energy T of the connecting rod P P The total kinetic energy T of the wheel-legged robot is obtained by using the expression of W , the total kinetic energy of connecting rod B is T B and the total kinetic energy T of the connecting rod P P The calculation of kinetic energy includes both translational kinetic energy and rotational kinetic energy.

[0117]

[0118]

[0119]

[0120] T=T W +T B +T P

[0121] (2) Calculate the total kinetic energy T of the system for each degree of freedom (α, β, ), and the derivative of each degree of freedom is derived separately, and the results of the partial derivative of each degree of freedom are derived with respect to time. The specific process is as follows:

[0122] The total kinetic energy T of the system is proportional to the angular velocity of the wheel The partial derivative of It is expressed as:

[0123]

[0124] Partial derivatives Derivative with respect to time It is expressed as:

[0125]

[0126] The total kinetic energy T of the system is proportional to the angular velocity of the first connecting rod. The partial derivative of It is expressed as:

[0127]

[0128] Partial derivatives Derivative with respect to time It is expressed as:

[0129]

[0130]

[0131] The total kinetic energy T of the system is proportional to the angular velocity of the second connecting rod. The partial derivative of It is expressed as:

[0132]

[0133] Partial derivatives The derivative with respect to time is expressed as:

[0134]

[0135] The total kinetic energy T of the system is the deflection angle of the wheel The partial derivative of It is expressed as:

[0136]

[0137] The partial derivative of the total kinetic energy T of the system with respect to the deflection angle α of the first link It is expressed as:

[0138]

[0139] The partial derivative of the total kinetic energy T of the system with respect to the deflection angle β of the second connecting rod It is expressed as:

[0140]

[0141] (3) Calculate the total potential energy U of the system:

[0142] U=m B gl B cosα+m P g(L B cosα+l P cosβ)

[0143] It should be noted that in the above formula, the plane where the moving wheel is located is regarded as the zero potential energy surface, that is, the potential energy of the moving wheel is considered to be 0, so the potential energy of the wheel does not appear in the formula of the total potential energy U of the above system. Of course, other potential energy surfaces can also be selected, which will not affect the implementation of the balancing control method. This application does not limit the potential energy surface used in the process of calculating the total potential energy of the system.

[0144] (4) Calculate the total potential energy U of the system and find the partial derivative of each degree of freedom in the generalized coordinates:

[0145] The total potential energy U of the system is proportional to the deflection angle of the moving wheel The partial derivative of It is expressed as:

[0146]

[0147] The partial derivative of the total potential energy U of the system with respect to the deflection angle α of the first link It is expressed as:

[0148]

[0149] The partial derivative of the total potential energy U of the system with respect to the deflection angle β of the second link It is expressed as:

[0150]

[0151] (5) Using the above formulas, based on the Euler-Lagrange equation, the dynamic equation of the wheeled-legged robot under the second-order inverted pendulum model can be derived:

[0152]

[0153]

[0154]

[0155] m αα =(m B l B 2 +J B +m P L B 2 +J P )

[0156] m αβ =m P L B l P cosαcosβ+m P L B l P sinαsinβ+JP

[0157] m ββ =(m P l P 2 +J P )

[0158]

[0159]

[0160]

[0161]

[0162] g α =-(m B gl B +m P g B )sinα

[0163] g β =-m P gl P sinβ

[0164] The dynamic equations can be written in polynomial form:

[0165]

[0166]

[0167]

[0168] The polynomial form of the dynamic equation is written as a matrix form:

[0169]

[0170] Among them, M(α,β) is a 3*3 inertia matrix; specifically includes

[0171] Each element in M(α,β) It is the elements in the inertia matrix, which are used to characterize the mass and moment of inertia of the joint rigid bodies that make up the wheel-legged robot, as well as the equivalent inertial physical quantities of each link under mutual influence when the deflection angle of the first link is α and the deflection angle of the second link is β. It is a 3*1 deflection force matrix, which can also be called a deflection force vector, including: It is used to characterize the Coriolis force and centripetal force on each link of the wheel-legged robot; G(α,β) represents the 3*1 gravity matrix, which can also be called the gravity vector. Specifically, it includes [0g α g β ] T τ1 represents the rotational torque of the first revolute joint, and τ2 represents the rotational torque of the second revolute joint.

[0172] After the matrix-form dynamic equation is derived through the above process, the subsequent balance control process can directly use the matrix-form dynamic equation without repeating the above derivation process in the balance control process.

[0173] Next, the nth-order inverted pendulum model is introduced and explained.

[0174] The world coordinate system used in this example is Fig.11 The corresponding parts of the embodiment content use the same definition of the world coordinate system. Of course, the world coordinate system can also be defined in other ways, and this application does not limit this.

[0175] like Fig.12 The n-order inverted pendulum shown is composed of n connecting rods, n rotating joints and moving wheels; wherein the moving wheel is connected to the first connecting rod among the n connecting rods, and the n connecting rods are connected in series, and n is a positive integer greater than or equal to 2. Exemplarily, the moving wheel in the n-order inverted pendulum corresponds to the moving wheel of the wheel-legged robot. In the case where the wheel-legged robot has multiple moving wheels, the multiple moving wheels can be equivalent to the wheels in the n-order inverted pendulum model, and the rotation angle of the wheel is expressed as

[0176] Two adjacent links of the n-order inverted pendulum model are connected by a revolute joint, and the deflection angles of the n links are: q1, q2, ..., q n ; where q1 is the deflection angle of the first connecting rod, q2 is the deflection angle of the second connecting rod, and so on. n is the deflection angle of the nth connecting rod. Taking the first connecting rod as an example, the deflection angle of the connecting rod is explained as follows: Fig.12 As shown, in this derivation process, the deflection angle of the first connecting rod refers to the deflection angle of the first connecting rod relative to the z-axis in the world coordinate system. Of course, the deflection angle of the first connecting rod can also be defined in other ways. In this case, the derivation process of the dynamic equation of the n-th order inverted pendulum model is similar to that of this embodiment and will not be described in detail.

[0177] For example, when the wheel-legged robot is in a standing posture, the distance l1 between the first connecting rod and the contact surface is less than the distance l2 between the second connecting rod and the contact surface, and the distance l2 between the nth connecting rod and the contact surface is less than the distance l1 between the nth connecting rod and the contact surface. nThe leg mechanism is connected to the corresponding moving wheel through a real rotation joint. Optionally, the connecting rod refers to a simplified model of each mechanism included in the wheel-legged robot. The wheel-legged robot can have multiple components, each component can be called a "mechanism", and each mechanism can be simplified as a connecting rod, wherein the first connecting rod is a connecting rod obtained by equivalently combining at least two non-overlapping leg structures.

[0178] In some cases, the wheel-legged robot is in a posture where multiple moving wheels are in contact with the contact surface, and the multiple moving wheels are connected to respective leg mechanisms; for any one of the multiple moving wheels, the rotational joint connecting the moving wheel and its corresponding leg mechanism is called a real rotational joint, and at least two real rotational joints are equivalent to a first rotational joint.

[0179] After understanding the n-order inverted pendulum model, the dynamic equation of the n-order inverted pendulum model is constructed in a similar way to constructing the dynamic equation corresponding to the second-order inverted pendulum model.

[0180] Specifically, determine the total kinetic energy (total kinetic energy includes translational kinetic energy and rotational kinetic energy) and potential energy corresponding to the n connecting rods and wheels respectively, add the kinetic energy of the n connecting rods and wheels to obtain the total system kinetic energy of the wheel-legged robot, and add the potential energy of the n connecting rods and wheels to obtain the total system potential energy of the wheel-legged robot.

[0181] For any one of the multiple degrees of freedom in the generalized coordinate system (including the deflection angle of each connecting rod, the angular velocity of each connecting rod, the rotation angle of the wheel and the angular velocity of the wheel), determine the partial derivative of the total kinetic energy of the system with respect to the degree of freedom, and determine the derivative of the partial derivative of the degree of freedom with respect to time.

[0182] For any of the multiple degrees of freedom in the generalized coordinate system, determine the partial derivative of the system's total kinetic energy with respect to that degree of freedom. Based on the partial derivatives of the system's kinetic energy with respect to each degree of freedom, the derivatives of the partial derivatives of each degree of freedom with respect to time, and the derivatives of the partial derivatives of each degree of freedom with respect to time, the system dynamics equation of the n-order inverted pendulum is determined by the Euler-Lagrange equation:

[0183]

[0184] in, It refers to the inertia matrix, including the mass and moment of inertia of the n revolving joints (regarding the revolving joints as joint rigid bodies) of the wheel-legged robot involved in the n-order inverted pendulum model. q is a vector, and the transposed vector q of q T =[q1 q2…q n ], is the angular velocity of the wheel, is the angular acceleration of the wheel, represents the angular velocity of the n connecting rods, is a vector, The transposed vector of represents the angular acceleration of the n connecting rods, is a vector, The transposed matrix of It refers to the deflection force matrix, which is used to characterize the angle of the wheel-legged robot at The deflection angles of the n connecting rods are q1, q2, ..., q n When the vehicle is in the correct posture, each connecting rod is subjected to a deflection force, which includes centripetal force and Coriolis force. is the gravity matrix, which is used to characterize the angle of the wheel-legged robot at the wheel. The deflection angles of the n connecting rods are q1, q2, ..., q n When the n connecting rods are in the posture, they are respectively subjected to gravity.

[0185] Since the plane where the moving wheel is located is determined as the zero potential energy surface, the first item in the G matrix is ​​0, indicating that the gravity corresponding to the moving wheel on the zero potential energy surface is zero. Of course, other zero potential energy surfaces can also be selected, and this application does not limit this. n represents the n×n identity matrix, τ T =[τ1τ2…τ n ], which represents the rotational torque corresponding to n revolute joints.

[0186] The following is an introduction to the balance control method of the wheel-legged robot after abstracting it into an n-th order inverted pendulum. The method is mainly implemented by the cooperation of other modules such as the robust controller and the whole body dynamics controller in the control system. For details, please refer to the following embodiments.

[0187] Please refer to Fig.13 , which shows a flow chart of a balance control method for a wheel-legged robot provided by an embodiment of the present application. The execution subject of each step of the method can be a computer device. The wheel-legged robot is simplified to an n-order inverted pendulum model, and the n-order inverted pendulum model includes: wheels, n connecting rods and n revolving joints, the wheels and the first connecting rod of the n connecting rods are connected through the first revolving joint of the n revolving joints, the n connecting rods are connected in series through n-1 revolving joints other than the first revolving joint, the first connecting rod is an equivalent connecting rod corresponding to at least two leg mechanisms of the wheel-legged robot, and the wheels are equivalent moving wheels corresponding to the moving wheels respectively connected to at least two leg mechanisms, and n is a positive integer greater than or equal to 2; the method may include at least one of the following steps (1310 to 1350):

[0188] Step 1310, obtaining the actual state quantity of the wheel-legged robot at the first moment, the actual state quantity is used to characterize the motion state of n-1 links, at least two leg mechanisms and at least two moving wheels, and the n-1 links are the other links among the n links except the first link.

[0189] In some embodiments, the moving wheel is used to contact the contact surface, the revolute joint refers to a joint driven by a joint motor, and the n connecting rods refer to connecting rods connected to at least one of the n revolute joints. Optionally, the n revolute joints connect the n connecting rods in series into a linear shape.

[0190] In some embodiments, for any one of the at least two moving wheels, the leg mechanism is connected to the moving wheel through a real rotation joint, and different moving wheels correspond to different real rotation joints. Optionally, the number of moving wheels included in the wheel-legged robot is equal to the number of real rotation joints. Optionally, the number of moving wheels included in the wheel-legged robot is equal to the number of leg mechanisms.

[0191] Optionally, at least two moving wheels do not overlap in the yoz plane in the world coordinate system, and at least two leg mechanisms do not overlap in the yoz plane in the world coordinate system. For a detailed introduction to this content, please refer to the above embodiment, which will not be repeated here. By equating at least two moving wheels to wheels, at least two leg mechanisms to a first connecting rod, and combining the wheels, the first connecting rod and the n-1 connecting rods in the wheel-legged robot, the wheel-legged robot can be abstracted into the n-order inverted pendulum model introduced above. The balance control method provided in the embodiment of the present application is designed based on the n-order inverted pendulum model.

[0192] For example, the wheel-legged robot includes multiple components, each of which (excluding active joints) can be called a mechanism, and the mechanism can be simplified as a connecting rod. The n rotating joints can be revolute joints. Under ideal conditions, the connecting rod will not bend or deform.

[0193] In some embodiments, any one of the n links is an independent link (for example, in a wheel-legged robot, the leg mechanism is a link and the trunk mechanism is a link).

[0194] Exemplarily, the n links include at least one combined link composed of m independent links connected by joints, where m is a positive integer greater than 1. In this case, the joints used to connect the m independent links do not rotate or move linearly during the balance control process, for example, these joints are locked during the balance control, so that the link combination composed of the m independent links can be regarded as one link among the n links.

[0195] In some embodiments, the first link refers to a link connected to the wheel through the first revolute joint in the n-order inverted pendulum model. Optionally, in the direction perpendicular to the contact surface (i.e., the z-axis direction in the world coordinate system), the distance between the first link and the wheel is the smallest among the n links. It can be known from the above that the first link is equivalently obtained by at least two non-overlapping leg mechanisms.

[0196] Optionally, if the leg mechanism of the wheel-legged robot is a straight leg, the first connecting rod is obtained by at least two non-overlapping leg mechanisms of the wheel-legged robot; if the leg mechanism of the wheel-legged robot is an articulated leg, that is, the leg mechanism includes two sub-mechanisms connected by a knee joint, and the knee joint is used to control the joint angle between the two sub-structures, then the first connecting rod is equivalently obtained by the sub-mechanism in the leg mechanism that is directly connected to the first joint.

[0197] In the present application, n is a positive integer greater than 1, for example, n is equal to 2, 3, 4, 5... The maximum value of n is related to the structure of the wheel-legged robot, and the present application does not limit it here.

[0198] Exemplarily, when n is equal to 2, the n connecting rods correspond to the leg mechanism and the trunk mechanism of the wheel-legged robot respectively. Exemplarily, when n is equal to 3, the n connecting rods correspond to the leg mechanism (the leg mechanism is a straight leg), the trunk mechanism and the head mechanism of the wheel-legged robot respectively. Exemplarily, when n is equal to 3, the n connecting rods correspond to the leg mechanism (the leg mechanism is a straight leg), the trunk mechanism and the mechanical arm mechanism of the wheel-legged robot respectively. Exemplarily, when n is equal to 4, the n connecting rods correspond to the leg mechanism (the leg mechanism is a straight leg), the trunk mechanism, the first mechanical arm connecting rod connected to the trunk mechanism and the second mechanical arm connecting rod connected to the first mechanical arm, or the mechanical hand of the wheel-legged robot respectively. Exemplarily, when n is equal to 4, the n connecting rods correspond to the first sub-mechanism of the leg mechanism (the leg mechanism is a straight leg), the second sub-mechanism connected to the first sub-mechanism through the knee joint, the trunk mechanism, and the first mechanical arm connecting rod connected to the trunk mechanism. The first link among the n links corresponds to the leg mechanism, which means that the first link is equivalent to a plurality of non-overlapping leg mechanisms.

[0199] Optionally, n revolute joints are used to connect n connecting rods in series. Exemplarily, any of the n revolute joints respectively correspond to the same type of real revolute joints. For example, in the case where the wheel-legged robot includes multiple moving wheels, there are multiple real revolute joints respectively used to connect each moving wheel with its corresponding leg mechanism, and the multiple real revolute joints collectively correspond to the first revolute joint among the n revolute joints. In other words, the first revolute joint in the n-order inverted pendulum model is equivalent to at least two real revolute joints, and the at least two real revolute joints refer to the revolute joints respectively connected to the at least two moving wheels that do not overlap in the forward direction.

[0200] It should be noted that the value of n is related to the actual requirements such as the configuration of the wheel-legged robot, the computing power of the computer, and power consumption, and this application does not limit it here. The larger the number of n, the more connecting rods can adjust the posture during the balance control process, making the posture of the wheel-legged robot richer during the balance adjustment process, which helps to improve the balance ability of the wheel-legged robot to deal with external disturbances.

[0201] In some embodiments, the first moment is any moment in the movement process of the wheel-legged robot.

[0202] Optionally, at the first moment, the posture of the wheel-legged robot is: at least two moving wheels in contact with the contact surface (such as moving wheel A and moving wheel B) do not overlap in the forward direction of the wheel-legged robot (the x-axis direction in the world coordinate system), and at least two leg mechanisms (such as leg mechanism 1 connected to moving wheel A, and leg mechanism 2 connected to moving wheel B) do not overlap in the forward direction of the wheel-legged robot. Exemplarily, the wheel-legged robot has four moving wheels, and at the first moment the wheel-legged robot is in a four-wheel balancing mode and a two-wheel-four-wheel switching mode. Exemplarily, leg mechanism 1 belongs to the outer leg mechanism group, and leg mechanism 2 belongs to the inner leg mechanism group.

[0203] In some embodiments, the actual state quantity is used to describe the motion state of the wheel-legged robot at the first moment. The posture and motion state of the wheel-legged robot at the first moment can be determined according to the actual state quantity at the first moment. Optionally, the actual state quantity at the first moment is observed by a sensor of the wheel-legged robot.

[0204] Optionally, the actual state quantity at the first moment includes at least one of the following: the deflection angle of at least two leg mechanisms; ..., the deflection angles of (n-1) connecting rods are q2, ..., q n , the angular velocities of at least two moving wheels are ..., the angular velocities of at least two leg mechanisms ...and the angular velocities of the (n-1) links

[0205] For example, the actual state quantity includes various physical quantities observed in the world coordinate system; wherein the deflection angle of the leg mechanism refers to the deflection angle of the leg mechanism relative to the z-axis in the world coordinate system, and the deflection angle q of the i-th connecting rod among the n-1 connecting rods is i (i∈[2,n]) refers to: the deflection angle of the i-th link relative to the z-axis in the world coordinate system; the angular velocity of the moving wheel It refers to: the clockwise rotation speed of the moving wheel about the x-axis in the world coordinate system; the angular velocity of the leg mechanism refers to the change speed of the deflection angle of the leg mechanism relative to the z-axis in the world coordinate system; the angular velocity of the i-th connecting rod It is used to characterize the angular velocity of the i-th connecting rod, that is, the speed at which the deflection angle of the i-th connecting rod changes.

[0206] It should be noted that each physical quantity in the state quantity can also be represented by the relative position between each link of the wheel-legged robot. For example, the deflection angle q of the jth link j ′(i∈[2,n]) means: the deflection angle of the jth connecting rod relative to the j-1th connecting rod; wherein the j-1th connecting rod is connected to the jth connecting rod through a revolute joint. Optionally, the distance between the jth connecting rod and the contact surface is greater than the distance between the j-1th connecting rod and the contact surface. It should be noted that the observation coordinate system corresponding to each physical quantity in the actual state quantity can be determined according to actual needs, and this application does not limit it here.

[0207] The physical quantities in each formula in the present application are obtained based on observations in the world coordinate system. Of course, the physical quantities determined using other observation coordinate systems can also realize the present balance control method. The relevant formulas can be obtained by making equal substitutions based on the formulas provided in the present application, and they are not mentioned one by one in the text.

[0208] Optionally, obtaining the actual state quantity of the wheel-legged robot at the first moment includes: determining the deflection angles of at least two leg mechanisms through an IMU sensor and a motor encoder ..., and the deflection angles q2, ..., q of the n-1 connecting rods n ; Determine the angular velocity of the moving wheel through the motor encoder Angular velocities of at least two leg mechanisms ...and the angular velocities of the n links

[0209] For example, the clock cycles of the IMU sensors and motor encoders in the wheel-legged robot are the same, or in multiples, so that the physical quantities included in the actual state quantity are all physical quantities at the first moment. For the specific contents of the IMU encoder and the motor encoder, please refer to the above introduction and will not be repeated.

[0210] In some embodiments, the robust controller uses the actual state quantity at the first moment as input information and performs a balancing control process through the actual state quantity at the first moment.

[0211] Step 1320, processing the actual state quantity at the first moment to obtain the equivalent state quantity at the first moment, the equivalent state quantity is used to characterize the motion state of the n connecting rods and the wheels.

[0212] In some embodiments, the equivalent state quantity refers to the state quantity required for performing a balance control process, and at least one physical quantity included in the equivalent state quantity is related to an n-order inverted pendulum model.

[0213] Optionally, the equivalent state quantity at the first moment includes at least one of the following: the deflection angles q1, q2, ..., q n , the angular velocity of the wheel Angular velocities of n connecting rods

[0214] For example, the equivalent state quantity is: the deflection angles q1, q2, ..., q n , the angular velocity of the wheel Angular velocities of n connecting rods The equivalent state quantity can be represented by the symbol ξ, and the state quantity ξ can be expressed as:

[0215]

[0216] Among them, q T represents the transposed vector of vector q, q T =[q1 q2…q n ], Representation vector The transposed vector of

[0217] Optionally, the computer device performs equivalence on the physical quantities related to the at least two leg mechanisms to obtain the physical quantities related to the first connecting rod, and performs equivalence based on the state quantities related to the at least two moving wheels to obtain the physical quantities related to the wheels in the equivalent state quantities. For the specific content of the process, please refer to the following embodiments, which will not be described in detail here.

[0218] It should be noted that, in the balancing control process, the state parameters in the equivalent state quantity are used to participate in the calculation, and the "state quantity" except the "actual state quantity" in the following text can represent the "equivalent state quantity".

[0219] Step 1330: establish a sliding surface according to the equivalent state quantity at the first moment, and the equivalent state quantity gradually tends to 0 on the sliding surface.

[0220] In some embodiments, the sliding surface can be understood as an imaginary vector plane in the sliding mode control, and the state quantity of the wheel-legged robot gradually tends to 0 on the sliding surface, that is, the state of the wheel-legged robot can gradually tend to equilibrium on the sliding surface. The sliding surface can be represented by the symbol s. Optionally, the sliding surface is a rational number, and the value of the sliding surface can be greater than 0, equal to 0, or less than 0.

[0221] Optionally, the sliding surface is a linear sliding surface having a linear relationship with the state quantity, or the sliding surface belongs to a sliding surface having a high-order mapping relationship between the state quantities. Considering the purposes of reducing the calculation pressure of the robust controller and reducing the energy consumption of the wheel-legged robot in the actual application process, this paper mainly takes the creation of a linear sliding surface as an example to introduce and explain the method of determining the sliding surface according to the state quantity.

[0222] In some embodiments, the number of sliding surfaces that the robust controller needs to establish is related to the number of rotational torques to be determined. Optionally, the number of sliding surfaces that the robust controller needs to establish is equal to the number of rotational torques to be determined. In the present application, the wheel-legged robot is abstracted into an n-order inverted pendulum model, involving a total of n rotational joints, and the n rotational joints have independent rotational torques. Therefore, the rotational torque at the second moment includes: the rotational torque of the n rotational joints, then n sliding surfaces need to be established; wherein, any two sliding surfaces among the n sliding surfaces are different sliding surfaces. For the specific steps of establishing sliding surfaces, please refer to the following embodiments.

[0223] Step 1340, based on the sliding surface, the equivalent state quantity at the first moment and the dynamic equation of the wheel-legged robot, determine the force and torque instructions for the whole body joints of the wheel-legged robot, the whole body joints include n rotational joints, and the dynamic equation is established based on the nth-order inverted pendulum model.

[0224] Optionally, the whole body joints include active joints in the wheel-legged robot. Exemplarily, the whole body joints include n revolute joints and other active joints in the wheel-legged robot except the n revolute joints.

[0225] In some embodiments, a computer device determines force and torque instructions for the whole-body joints of the wheel-legged robot based on a sliding surface, an equivalent state quantity at a first moment, and the dynamic equations of the wheel-legged robot, including: determining the rotational torque of n rotational joints based on the sliding surface, the equivalent state quantity at a first moment, and the dynamic equations of the wheel-legged robot; calculating the task acceleration of the wheel-legged robot through the rotational torque of the n rotational joints; and calculating the force and torque instructions for the whole-body joints of the wheel-legged robot based on the task acceleration of the wheel-legged robot by a whole-body dynamics controller in the control system of the wheel-legged robot.

[0226] Optionally, this step is completed by multiple controllers in the wheel-legged robot, wherein the robust controller participates in the calculation process of the rotational torque of the n rotational joints, and the whole body dynamics controller calculates the force and torque instructions of the whole body joints of the wheel-legged robot according to the task acceleration. In some cases, the robust controller and the whole body dynamics controller cannot interact directly, so step 1340 also requires the participation of the observation module.

[0227] Exemplarily, the step of calculating the task acceleration of the wheel-legged robot through the rotational torque of n rotational joints is performed by an observation module in the control system of the wheel-legged robot, the observation module is connected to the robust controller, the observation module is connected to the whole body dynamics controller, the observation module obtains the rotational torque of n rotational joints from the robust controller, calculates the task acceleration according to the rotational torque of the rotational joints, and transmits the task acceleration to the whole body dynamics controller; the whole body dynamics controller determines the forces and torques corresponding to the motors of the whole body joints according to the task acceleration. For the specific process of this step, please refer to the following embodiment.

[0228] By associating the control results of the robust controller (the two rotational torques mentioned above) with the whole-body dynamics controller, the whole-body dynamics controller can receive information related to balance control, which helps the whole-body dynamics controller to perform reasonable optimization based on the various input information it receives, generate optimized joint commands (i.e., force and torque commands), and send these joint commands to the corresponding joints, so that more connecting rods in the wheel-legged robot can rotate during the balance control process, which helps to improve the balance control ability of the wheel-legged robot during movement.

[0229] For a detailed description of this step, please refer to the following examples.

[0230] Step 1350, at the second moment, according to the force and torque instructions of the whole body joints, the n-1 rotational joints and the real rotational joints corresponding to the first rotational joint are controlled.

[0231] In some embodiments, the second moment refers to any moment after the first moment. Optionally, the second moment refers to the moment after the force and torque instructions of the joints of the whole body are calculated.

[0232] In some embodiments, the n-1 rotational joints can be understood as the other rotational joints included in the n-order inverted pendulum model except the first rotational joint. Since these rotational joints correspond one-to-one to the rotational joints in the wheel-legged robot, unlike the first rotational joint which corresponds to multiple real rotational joints, the force and torque instructions of the n-1 rotational joints can be directly used to control the corresponding rotational joints in the wheel-legged robot.

[0233] Optionally, this step is completed by the whole-body dynamics controller in the wheel-legged robot. After the whole-body dynamics controller determines the force and torque instructions of the whole-body joints, the force and torque instructions corresponding to n rotational joints are determined from the force and torque instructions of the whole-body joints, and these force and torque instructions are sent to the joint motors corresponding to each rotational joint, respectively, to control the joint motors to rotate according to the force and torque instructions, thereby changing the posture of the wheel-legged robot.

[0234] In some embodiments, for the linear motors in at least two leg mechanisms, the linear motors are controlled to move according to the force and torque instructions of the whole body joints, and the linear motors in the leg mechanisms control the length of the leg mechanisms. For details, please refer to the following embodiments.

[0235] To summarize, based on abstracting the wheel-legged robot into a multi-order inverted pendulum model, during the balance control process, the deflection angles of multiple connecting rods in the wheel-legged robot can be adjusted to change the posture of the wheel-legged robot; compared with the related technology that can only adjust the angle between the moving wheel and the leg mechanism during the balance control process, this scheme makes the postures of multiple connecting rods in the wheel-legged robot variable during the balance adjustment process, greatly enriches the robot posture, helps to quickly adjust the robot to a balanced state, and also helps to improve the robot's ability to recover to a balanced state under different disturbance forces, thereby improving the robustness of the robot's balance control process.

[0236] On the other hand, the method provided by the present application is used to determine the equivalent state quantity according to the actual state quantity, so that the balance control under the multi-wheel motion mode can share a set of control parameters with the balance control under the two-wheel motion mode. After the wheel-legged robot switches the motion mode, there is no need to adjust the control parameters in the controller (such as a robust controller) used for balance control, which helps to improve the versatility of the controller.

[0237] The following describes a method for obtaining the equivalent state quantity at the first moment through several embodiments.

[0238] In some embodiments, step 1320 includes the following sub-steps (not shown in the drawings):

[0239] Sub-step 1321, superimposing the angular velocities of at least two moving wheels in the actual state quantity to obtain the angular velocity of the wheel.

[0240] In some embodiments, since the angular velocities of the non-overlapping moving wheels in the forward direction are not equal, the angular velocity of the wheel is obtained by vector superposition of the angular velocities of at least two moving wheels. For example, the at least two moving wheels include moving wheel 1 and moving wheel 2, the angular velocity of moving wheel 1 is v1, and the angular velocity of moving wheel 2 is v2, then the angular velocity of the wheel is equal to (v1+v2) / 2.

[0241] Sub-step 1322, determining a geometric relationship between at least two leg mechanisms based on the lengths and deflection angles of the at least two leg mechanisms.

[0242] In some embodiments, the geometric relationship between the at least two leg mechanisms is used to characterize the positional relationship between the at least two leg mechanisms. Since one end of the at least two leg mechanisms is connected to the same joint, the other ends of the at least two leg mechanisms are respectively connected to the corresponding moving wheel vectors. Optionally, the ends of the at least two leg mechanisms have the same height, and the other ends have the same height. After determining the length of the at least two leg mechanisms, the angle between the at least two leg mechanisms can be determined according to the deflection angle of the at least two leg mechanisms.

[0243] Sub-step 1323, determining the deflection angle of the first link and the angular velocity of the first link according to the geometric relationship, the deflection angle of at least two leg mechanisms and the angular velocity of at least two leg mechanisms. Through the geometric joint, the positional relationship between the first link and the at least two leg mechanisms can be determined, and the relationship between the deflection angles of the two leg mechanisms and the deflection angle of the first link can be determined according to the positional relationship, so that the method for determining the deflection angle of the first link and the angular velocity of the first link is similar to this, which will not be repeated here.

[0244] Sub-step 1324, taking the deflection angles of the n-1 connecting rods in the actual state quantity as the deflection angles of the n-1 connecting rods in the equivalent state quantity.

[0245] Sub-step 1325, taking the angular velocities of the n-1 connecting rods in the actual state quantity as the angular velocities of the n-1 connecting rods in the equivalent state quantity.

[0246] By processing the actual state quantity to obtain the equivalent state quantity, the physical quantity corresponding to the virtual first connecting rod can be obtained, so that the balance control method can be set based on the n-th order inverted pendulum model.

[0247] The method for determining the sliding surface is introduced and explained below through several embodiments.

[0248] The sliding surface includes n sliding surfaces, and the n sliding surfaces are used to constrain the rotational torque of the n revolute joints. Optionally, there is no identical sliding surface among the n sliding surfaces, and the n sliding surfaces are used to jointly participate in the calculation process of the rotational torque.

[0249] Step 1330 in the above embodiment also includes the following sub-steps (not shown in the drawings of the specification):

[0250] Sub-step 1333: for the i-th sliding surface among the n sliding surfaces, determine at least two sliding parameters, where i is a positive integer equivalent number less than or equal to n.

[0251] In some embodiments, the sliding surface is related to at least one element in the state quantity, and the element in the state quantity can also be called a state parameter, such as an equivalent state quantity The q1, q2, ..., q n , They are all state parameters.

[0252] For example, a certain sliding surface is related to the deflection angle of the first connecting rod and the acceleration of the first connecting rod in the equivalent state quantity. For another example, a certain sliding surface is related to the deflection angle of the i-th connecting rod and the acceleration of the i-th connecting rod. Optionally, the n sliding surfaces are respectively related to the first state parameter in the state quantity. For example, the first state parameter is the angular velocity of the moving wheel, that is, the n sliding surfaces are all related to the angular velocity of the moving wheel.

[0253] Optionally, the sliding mode parameter is a real number. The sliding mode parameter is used to characterize the proportional relationship between the state parameter in the state quantity and the sliding mode surface. Exemplarily, the sliding mode parameters between different sliding mode surfaces are not shared, that is, there are at least two sliding mode surfaces among the n sliding mode surfaces, and the sliding mode parameters corresponding to the at least two sliding mode surfaces are not equal.

[0254] In some embodiments, the number of state parameters used in creating the sliding surface is greater than the number of sliding parameters. Optionally, for any one of the n sliding surfaces, the number of state parameters used in the creation of the sliding surface is greater than the number of sliding parameters used, and this method helps to ensure that a determined rotational torque can be calculated based on the sliding surface and the dynamic model parameters.

[0255] For example, when establishing a sliding surface, 3 state parameters in the state quantity and 2 sliding parameters need to be used. For another example, when creating a sliding surface, 4 state parameters in the state quantity and 3 sliding parameters need to be used.

[0256] Since the number of sliding parameters used in the process of creating the sliding surface is less than the number of state parameters, the coefficient of at least one state parameter in the sliding surface is equal to 1, that is, these sliding parameters do not have corresponding state parameters, and the remaining state parameters required to create a sliding surface correspond one-to-one to the sliding parameters.

[0257] In some embodiments, for the i-th sliding surface among the n sliding surfaces, the i-th sliding surface includes at least two sliding parameters. Optionally, the state parameters included in different sliding surfaces are not completely the same, and the number of state parameters required to create each sliding surface is equal. For example, the number of sliding parameters included in the n sliding surfaces is equal. It is assumed that 3 state parameters are used to create the i-th sliding surface, and 3 state parameters are also used to create the i+k-th sliding surface, k is a positive integer, and i+k is less than or equal to n.

[0258] In some embodiments, the number of sliding parameters included in the i-th sliding surface is related to the number of state parameters used to establish the i-th sliding surface. Optionally, the number of state parameters used to create the i-th sliding surface is one more than the number of sliding parameters used to create the i-th sliding surface. In order to ensure that a definite solution for the rotational torque of n revolving joints can be calculated by the sliding surface and the dynamic model parameters, the i-th sliding surface is related to at least 3 state parameters in the equivalent state quantity at the first moment. Optionally, at least 3 state parameters associated with the i-th sliding surface are not completely the same as at least 3 state parameters associated with the l-th sliding surface, and l is a positive integer less than or equal to n.

[0259] In order to improve the reliability of the determined rotational torque, the sliding mode parameters need to meet the system stability conditions. For the specific content of this part, please refer to the following embodiments.

[0260] Optionally, the number of state parameters used to create the n sliding surfaces is equal. For example, any one of the n sliding surfaces includes 3 state parameters.

[0261] The following takes the creation of the i-th sliding surface as an example to introduce the method of creating the sliding surface.

[0262] Generally speaking, the more state parameters related to a certain sliding surface in the equivalent state quantity at the first moment, the more reference information is used in the process of calculating the rotational torque of n rotational joints; the mutual constraints between the various state parameters help to improve the accuracy of the rotational torque of the n rotational joints determined according to the n sliding surfaces and dynamic model parameters, and help to improve the effect of balance adjustment.

[0263] Optionally, at least 3 state parameters and at least 2 sliding parameters are used to create the i-th sliding surface.

[0264] Exemplarily, the state parameters used to create the i-th sliding surface include: the deflection angle of the i-th connecting rod, the angular velocity of the moving wheel, and the angular velocity of the i-th connecting rod; in this case, the two sliding parameters used to create the i-th sliding surface are: the sliding parameter corresponding to the deflection angle of the i-th connecting rod, and the sliding parameter corresponding to the angular velocity of the moving wheel. Exemplarily, the i-th sliding surface is related to the four state parameters in the state quantity, and the i-th sliding surface is related to the deflection angle of the i-th connecting rod, the angular velocity of the moving wheel, the angular velocity of the i-th connecting rod, and the deflection angle of the (i+m)%n-th connecting rod included in the state quantity, where m is a positive integer that cannot divide n, and "%" represents the remainder of division. In this case, the i-th sliding surface includes at least 3 sliding parameters, respectively: the sliding parameter corresponding to the deflection angle of the i-th connecting rod, the sliding parameter corresponding to the angular velocity of the moving wheel, and the sliding parameter corresponding to the deflection angle of the (i+m)%n-th connecting rod. It should be noted that the number of state parameters related to the sliding surface and the number of sliding parameters are designed according to actual needs, and this application does not limit them here.

[0265] In some embodiments, multiple sliding surface creation schemes are designed in the robust controller, and in different sliding surface creation schemes, the number of sliding parameters and the number of state parameters used to create the i-th sliding surface are not exactly the same. For example, in the first sliding surface creation scheme, 2 sliding parameters and 3 state parameters are required to create the i-th sliding surface; in the second sliding surface creation scheme, 5 sliding parameters and 6 state parameters are required to create the i-th sliding surface; that is, the number of sliding parameters used to create the sliding surface in the first sliding surface creation scheme is not equal to the number of sliding parameters required to create the sliding surface in the second sliding surface creation scheme; the number of state parameters used to create the sliding surface in the first sliding surface creation scheme is not equal to the number of state parameters required to create the sliding surface in the second sliding surface creation scheme.

[0266] Optionally, during the balancing control process, the robust controller selects a target creation scheme from multiple sets of sliding surface creation schemes according to actual conditions, and determines the number of sliding parameters required to create the i-th sliding surface according to the target creation scheme.

[0267] Exemplarily, when the computing performance of the robust controller is high, the robust controller selects from multiple sets of sliding surface establishment schemes: a sliding surface creation scheme involving more sliding parameters is used as a target creation scheme. Exemplarily, the robust controller determines the target creation scheme according to the task currently performed by the wheel-legged robot; if the task currently performed by the wheel-legged robot has high requirements for balance and the robust controller has good computing power, the robust controller selects a sliding surface creation scheme involving more sliding parameters from multiple sets of sliding surface establishment schemes as the target creation scheme. Exemplarily, when the computing performance of the robust controller is average or there is a power consumption requirement, the robust controller selects a sliding surface creation scheme including fewer sliding parameters from at least one set of sliding surface establishment schemes as the target creation scheme. Exemplarily, the robust controller receives a control instruction from a remote controller, and the control instruction is used to indicate the target creation scheme selected from multiple sliding surface creation schemes.

[0268] Sub-step 1336: establishing the i-th sliding surface according to the at least two sliding mode parameters and the equivalent state quantity at the first moment.

[0269] In some embodiments, the equivalent state quantities include the deflection angles of the n connecting rods, the angular velocities of the moving wheels, and the angular velocities of the n connecting rods. Optionally, the robust controller creates the i-th sliding mode surface according to at least three state parameters and at least two sliding mode parameters in the equivalent state quantities at the first moment.

[0270] Optionally, step 1336: establishing the i-th sliding surface according to at least two sliding mode parameters and the equivalent state quantity at the first moment, includes the following sub-steps:

[0271] Sub-step 1336-a, processing the deflection angle of the i-th connecting rod according to the first sliding mode parameter of at least two sliding mode parameters to obtain the processing result of the i-th connecting rod.

[0272] Optionally, the first sliding mode parameter is a coefficient corresponding to the deflection angle of the i-th connecting rod, and the second sliding mode parameter is a coefficient corresponding to the angular velocity of the moving wheel connecting rod.

[0273] Optionally, the processing result of the ith connecting rod refers to the result obtained by processing the deflection angle of the ith connecting rod using the first sliding mode parameter in the process of constructing the ith sliding mode surface. Exemplarily, the method of processing the deflection angle of the ith connecting rod using the first sliding mode parameter includes but is not limited to: using the first sliding mode parameter and the deflection angle of the ith mechanism to perform basic operations (such as addition, subtraction, multiplication and division) to obtain the processing result of the ith connecting rod. For example, the first sliding mode parameter is multiplied by the angular velocity of the ith connecting rod to obtain the processing result of the first connecting rod.

[0274] Sub-step 1336-b, according to the second sliding mode parameter of at least two sliding mode parameters, the angular velocity of the moving wheel is processed to obtain the processing result of the moving wheel. Optionally, in the process of establishing the i-th sliding mode surface, the processing result of the moving wheel refers to the result obtained by processing the angular velocity of the moving wheel using the second sliding mode parameter. Exemplarily, the method of processing the angular velocity of the moving wheel using the second sliding mode parameter includes but is not limited to: performing basic operations using the second sliding mode parameter and the angular velocity of the moving wheel. For example, the second sliding mode parameter is multiplied by the angular velocity of the moving wheel to obtain the processing result of the moving wheel.

[0275] It should be noted that different sliding surfaces correspond to different second sliding mode parameters, that is, for the creation process of different sliding mode surfaces, the angular velocity of the moving wheel is processed using the second sliding mode parameters, and the processing results of the moving wheel are different.

[0276] Sub-step 1336-c, establishing the i-th sliding surface according to the processing result of the i-th connecting rod, the processing result of the moving wheel and the angular velocity of the i-th connecting rod.

[0277] In some embodiments, the i-th sliding surface is proportional to the processing result of the i-th connecting rod, the i-th sliding surface is proportional to the processing result of the moving wheel, and the first sliding surface is proportional to the angular velocity of the i-th connecting rod. Exemplarily, the robust controller adds the processing result of the i-th connecting rod, the processing result of the moving wheel, and the angular velocity of the i-th connecting rod to obtain the i-th sliding surface.

[0278] Optionally, the robust controller establishes an i-th sliding surface according to the processing result of the i-th connecting rod, the processing result of the moving wheel, the angular velocity of the i-th connecting rod and the sliding mode constant, and the sliding mode constant may be a preset value. Exemplarily, the robust controller adds the processing result of the i-th connecting rod, the processing result of the moving wheel, the angular velocity of the i-th connecting rod and the sliding mode constant to obtain the i-th sliding surface.

[0279] The robust controller determines n sliding surfaces respectively by the above method of creating the i-th sliding surface.

[0280] The n sliding surfaces can be expressed by the following formula:

[0281]

[0282] Wherein, s represents a sliding surface matrix including n sliding surfaces; Including the first sliding mode parameters corresponding to the deflection angles of the n connecting rods, Including the second sliding mode parameters corresponding to the angular velocity of the moving wheel in the n sliding mode surfaces respectively. For the explanation of other parameters, please refer to the above introduction and will not be repeated here.

[0283] By establishing n sliding surfaces in this way, while ensuring that the rotational torque of the n rotational joints can be calculated based on the sliding surfaces and the dynamic model parameters, the number of sliding parameters and state parameters used in the process of creating the surface is controlled, which helps to control the computational overhead of calculating the rotational torque of the n rotational joints, helps to speed up the speed of determining the rotational torque, reduce power consumption and achieve balance control of the robot.

[0284] The following describes a method for determining force and torque instructions for joints throughout the body through several embodiments. The execution subject of each step of the process may be a computer device.

[0285] Step 1340 in the above embodiment may include sub-step 1343 (not shown in the accompanying drawings):

[0286] First, a method for determining the rotational torque of n rotational joints is introduced.

[0287] Sub-step 1343, calculating the rotational torque at the second moment according to the dynamic equation and the sliding surface, the rotational torque at the second moment includes: the rotational torque of n revolute joints.

[0288] In some embodiments, the rotational torque at the second moment is calculated according to the dynamic equation and the sliding surface, including: determining the dynamic model parameters according to the dynamic equation of the wheel-legged robot and the equivalent state quantity at the first moment, the dynamic model parameters are used to define the mapping relationship between the angular acceleration at the first moment and the rotational torque at the second moment; the angular acceleration at the first moment includes the angular acceleration of n connecting rods; and calculating the rotational torque at the second moment according to the dynamic parameters and the sliding surface.

[0289] The following describes the method for determining the parameters of the kinetic model through several embodiments.

[0290] In some embodiments, the angular acceleration at the first moment refers to the rotational acceleration of the n connecting rods after the wheel-legged robot is abstracted into an n-order inverted pendulum model (it can also be understood as the angular acceleration of the joint motors corresponding to the n rotating joints). The angular acceleration at the first moment can be expressed as express.

[0291] From the above content, we can know that after abstracting the wheel-legged robot into an n-order inverted pendulum model, we can get the dynamic equation in matrix form:

[0292]

[0293] In an embodiment of the present method, a robust controller in the control system of the wheel-legged robot is designed based on the equation, so that the robust controller can perform the balance control method provided in the embodiment of the present application.

[0294] Based on the physical relationship between acceleration, velocity and position, the acceleration at the first moment can be used to predict the angular velocity of the n connecting rods at the next moment after the first moment, as well as the posture of the wheel-legged robot at the subsequent moment. The rotational torque of the joint can change the speed and posture of the wheel-legged robot; in the design of the robust controller of this scheme, the focus is on the dynamic equation based on the matrix form, and the mapping relationship between the acceleration of the wheel-legged robot and the rotational torque of the joint is established.

[0295] Exemplarily, the matrix-form dynamic equation is partially feedback linearized so that the acceleration-related matrix of the wheel-legged robot is on one side of the dynamic equation and the other side of the matrix formula related to the rotational torque of the rotational joint, and the mapping relationship between the acceleration and the rotational torque at the first moment is determined, and the mapping relationship between the acceleration at the first moment and the rotational torque of the rotational joint is represented by the dynamic parameters. This process is completed in the design process of the robust controller, and the relevant formulas do not need to be repeatedly derived when the actual balance control is performed.

[0296] In some embodiments, the dynamic model parameters are used to characterize the linear mapping relationship between the acceleration and the torque at the first moment. That is, the dynamic model parameters are used to make the acceleration and the torque at the first moment satisfy the equivalent relationship in the formula obtained by conversion based on the dynamic formula. Since there is more than one acceleration and torque at the first moment, the dynamic model parameters can be expressed in matrix form.

[0297] Exemplarily, the dynamic model parameters include: a proportional parameter matrix g[] and an offset parameter matrix f[]; wherein the proportional parameter matrix g[] is used to characterize the proportional relationship between the acceleration and the torque at the first moment, and the offset parameter matrix f[] is used to characterize the offset between the acceleration and the torque at the first moment. For the calculation method of the above two dynamic model parameter matrices, please refer to the following embodiment.

[0298] Optionally, in the design process of the robust controller, the representation form of the dynamic model parameters is predetermined. After obtaining the state quantity at the first moment, the robust controller brings the state quantity at the first moment into the representation form of the dynamic model parameters to determine the numerical values ​​of each element included in the dynamic model parameters.

[0299] In some embodiments, determining the dynamic model parameters according to the dynamic equation of the wheel-legged robot and the equivalent state quantity at the first moment includes the following steps:

[0300] Step 10 (not shown in the figure), substitute the equivalent state quantity at the first moment into the dynamic equation to determine the inertia matrix, deflection force matrix and gravity matrix at the first moment, the inertia matrix is ​​used to characterize the mass and moment of inertia of the n revolute joints at the first moment, the deflection force matrix is ​​used to characterize the deflection force of the wheel-legged robot at the first moment, and the gravity matrix is ​​used to characterize the gravity of the wheel-legged robot at the first moment;

[0301] In some embodiments, the inertia matrix is ​​used to characterize the inertia of the joint rigid bodies corresponding to the n rotating joints constituting the wheel-legged robot at the first moment, and the inertia includes at least one of the following: mass and moment of inertia. Optionally, the inertia matrix can be calculated according to the dynamic equation. When the wheel-legged robot is abstracted into an n-order inverted pendulum model, the inertia matrix is ​​a (n+1)*(n+1) size matrix.

[0302] In some embodiments, the deflection force matrix is ​​used to characterize the Coriolis force and the centripetal force on each link. Optionally, the deflection force matrix includes the deflection force caused by the deflection angle of the wheel and the deflection force caused by the deflection angle of the n-link.

[0303] In some embodiments, the gravity matrix is ​​used to characterize the gravity received by each connecting rod. Optionally, the gravity matrix includes the gravity received by the wheel and the gravity received by each of the n connecting rods. Optionally, the wheel is always in contact with the contact surface, and the height of the moving wheel remains unchanged during the balancing control process. The plane where the center of mass of the wheel is located is taken as the zero potential energy surface, and the gravity received by the wheel is 0, so as to reduce the computational overhead of the balancing control process.

[0304] For more information about inertia matrix, deflection matrix, and gravity matrix, please refer to Fig.11 , 12 The corresponding contents of the specification are not repeated here. The expressions of the elements in the above-mentioned inertia matrix, deflection force matrix and gravity matrix are also derived in advance by the dynamic formula; after determining the equivalent state quantity at the first moment, the robust controller calculates the specific values ​​of the elements included in the inertia matrix, deflection force matrix and gravity matrix at the first moment according to the equivalent state quantity at the first moment and the representation form of each element in the inertia matrix, deflection force matrix and gravity matrix; and then obtains the inertia matrix, deflection force matrix and gravity matrix at the first moment.

[0305] Step 20 (not shown in the figure), determining the dynamic model parameters according to the inertia matrix, the deflection force matrix and the gravity matrix.

[0306] In some embodiments, the dynamic model parameters include: a proportional parameter matrix and an offset parameter matrix, the proportional parameter matrix is ​​used to characterize the proportional relationship between the angular acceleration at a first moment and the rotational torque of the n rotating joints, and the offset parameter matrix is ​​used to characterize the offset relationship between the angular acceleration at a first moment and the rotational torque of the n rotating joints; optionally, the robust controller calculates the offset parameter matrix based on the inertia matrix, the deflection force matrix and the gravity matrix; and calculates the proportional parameter matrix based on the inertia matrix.

[0307] The rotational relationship between the acceleration of the wheel-legged robot and the rotational torque of n rotational joints can be determined through the dynamic model parameters. Subsequently, the rotational torque of the n rotational joints can be determined relatively quickly according to the dynamic model parameters and the sliding surface, which helps to reduce unnecessary conversions in the process of determining the rotational torque of the rotational joints and alleviates the calculation pressure of computer equipment.

[0308] In some embodiments, step 20 further includes the following sub-steps:

[0309] Sub-step 20-a (not shown in the figure) uses the selection matrix to process the product between the inverse matrix of the inertia matrix and the deviatoric force matrix, and the product between the inverse matrix of the inertia matrix and the gravity matrix, respectively, to obtain the offset parameter matrix. The selection matrix is ​​used to extract the rotational torque of the n rotational joints from the dynamic equation.

[0310] Optionally, the elements in the selection matrix include three values ​​(0, 1, -1). The selection matrix is ​​used to make each rotational torque in τ exist independently in the dynamic equation, that is, the dynamic equation is processed using the selection matrix so that the coefficients of the rotational torque of each rotational joint in the dynamic equation have the same sign, and the dynamic equation does not include basic operations between the rotation matrices of any two rotational joints (such as τ1-τ2, etc.).

[0311] Sub-step 20-b (not shown in the figure) uses the selection matrix to process the inverse matrix of the inertia matrix to obtain the scale parameter matrix.

[0312] The derivation process of the dynamic model parameters is introduced below.

[0313] After partial feedback linearization of the matrix form dynamic equation, we get formula 1:

[0314]

[0315] Among them, M -1 (q) is the inverse matrix of the inertia matrix, M -1 (q)*M(q)=E, where E is the unit matrix. The physical meanings of other parameters in Formula 1 can be found in the above embodiment and will not be elaborated here.

[0316] Furthermore, in order to simplify the execution logic in the balancing control process and reduce the calculation amount of the robust controller, the above formula 1 needs to be adjusted in the design process of the robust controller. Formula 1 is processed using the selection matrix to obtain formula 2:

[0317]

[0318] in, represents the offset parameter matrix, represents the scale parameter matrix, S T is the selection matrix.

[0319] Optionally, Formula 2 is derived after the wheel-legged robot is abstracted as an n-order inverted pendulum model. During the balance control process, after obtaining the state quantity at the first moment, the robust controller can calculate the proportional parameter matrix and the dynamic model parameter matrix according to Formula 2 and the expressions of each element in the inertia matrix, deflection force matrix and gravity matrix obtained in the process of derivation of the dynamic equation of the n-order inverted pendulum model.

[0320] In some embodiments, the dynamic equation of the robot is derived based on the Euler-Lagrange equation by abstracting the wheel-legged robot into an n-order inverted pendulum model, and the moving wheels of the wheel-legged robot correspond to the wheels in the n-order inverted pendulum model. Please refer to the above embodiments for the derivation process of the dynamic equation, which will not be repeated here. Abstracting the wheel-legged robot into an n-order inverted pendulum model for balance control helps to adapt to the balance control requirements in different scenarios and improve the robustness of the balance control method.

[0321] The following is an introduction to the process of calculating the rotational torque at the second moment based on the dynamic parameters and the sliding surface by the robust controller.

[0322] After explaining the design method of the dynamic model parameters and n sliding surfaces in the robust controller, the design of the corresponding robust controller for calculating the rotational torque of n rotating joints based on the sliding surface and the dynamic model parameters is introduced:

[0323] After establishing n sliding surfaces according to the state equivalent state, the robust controller determines the first-order derivative formulas of the n sliding surfaces with respect to time, and uses the torque to represent the angular acceleration of the n connecting rods according to the dynamic equation (Formula 2), and the following Formula 3 is obtained:

[0324]

[0325] in, represents the first-order derivative of n sliding surfaces with respect to time, is the offset parameter matrix f[] in formula 2 above f q is the offset parameter matrix f[] in formula 2 above is the proportional parameter matrix g[] in formula 2 above g q In the above formula 2, the proportional parameter matrix g[] For other parameters, please refer to the above introduction and will not be described in detail.

[0326] By transposing the terms in formula 3, we can obtain formula 4:

[0327]

[0328]

[0329]

[0330] Among them, sgn() is the symbol function, is a constant matrix, s T is the transposed matrix of the sliding matrix s including n sliding surfaces, |s| represents the absolute value of n sliding surfaces, Represents the first-order derivative of n sliding surfaces with respect to time. For other parameters, please refer to the above introduction and will not be elaborated on here.

[0331] Optionally, Formula 3 and Formula 4 are calculated in real time by the robust controller during the balancing control process.

[0332] Using the properties of the sliding surface, when the sliding surface is controlled to be equal to 0, the state parameters related to the sliding surface will gradually tend to 0 along the sliding surface, that is, the wheel-legged robot returns to a balanced state. The state quantity (state parameters in) satisfies on the sliding surface:

[0333]

[0334] The above formula can be used to inversely express the angular velocity of the n connecting rods:

[0335]

[0336] The robust controller determines the angular velocity of the n connecting rods and takes the first-order derivative with respect to time, and obtains Formula 5 which can represent the angular acceleration of the n connecting rods:

[0337]

[0338] Since q is a vector of the deflection angles of n connecting rods, q is split: let α represent q1 (the deflection angle of the first connecting rod), let β represent That is, β includes the deflection angles of the other links except the first link among the n links, and the dynamic equation based on the n-order inverted pendulum model is written as:

[0339]

[0340]

[0341]

[0342] Among them, in this formula represents the angular acceleration of the first link; represents the angular accelerations of the n connecting rods except the first connecting rod; Represents the inertia related to the moving wheel in the inertia matrix M; Represents the inertia matrix M Among them is the inertia related to the first connecting rod; It refers to the inertia matrix M The inertia that is not related to the first connecting rod; m αα represents the m in the inertia matrix M qq The inertia associated with the first connecting rod; m ββ represents the m in the inertia matrix M qq The inertia that is not related to the first connecting rod; c α represents the deflection force received by the first connecting rod; c β g represents the eccentric force on the other connecting rods except the first connecting rod among the n connecting rods; α Indicates the gravity acting on the first mechanism; g β represents the gravity exerted on the other links except the first link among the n links; τ1 represents the rotational torque of the first rotational joint; τ2 represents the rotational torque corresponding to the other rotational joints except the first rotational joint among the n rotational joints.

[0343] Adding the three formulas included in the above kinetic equations can obtain Formula 6:

[0344]

[0345] In formula 6 Merge into We get formula 7:

[0346]

[0347] Using Formula 5 to Formula 7 By making equal substitutions, we obtain Formula 8:

[0348]

[0349] Formula 8 is used to express Formula 9:

[0350]

[0351] Formulas 5 and 9 are used to express Formula 10:

[0352]

[0353] right The state equation is obtained by combining the matrix form:

[0354]

[0355] in,

[0356] I is the identity matrix.

[0357] Optionally, the system stability criterion is related to the state equation determined according to the dynamic equation and the sliding surface. Exemplarily, the stability criterion is related to the coefficient matrix in the state equation. In order to ensure that the system stability criterion is met, the sliding mode parameters need to satisfy the coefficient matrix of the state equation:

[0358] The characteristic roots of are distributed in the left half plane of the complex plane. This state equation can be used as a matrix inequality constraint, that is, the values ​​of the sliding mode parameters are distributed in the left half plane of the complex plane of the coefficient matrix.

[0359] Optionally, in the balancing control process of the present application, the robust controller determines the rotational torque of the n rotational joints according to Formula 4 and the state equation. In the process of balancing control, the robust controller calculates the rotational torque τ of the n rotational joints according to Formula 4. Formula 4 involves n sliding surfaces forming a sliding surface matrix s, the dynamic model parameters in Formula 2, and also involves sliding parameters.

[0360] The robust controller obtains the state quantity at the first moment, and substitutes the state quantity at the first moment into the corresponding formula to determine the dynamic model parameters and create n sliding surfaces. The sliding mode parameters in the sliding mode surfaces meet the system stability conditions. Then, the robust controller ensures that the sliding mode parameters meet the matrix inequality constraints formed by the above state equations, and calculates the rotational torque τ of the n rotational joints based on Formula 4.

[0361] Exemplarily, in the balancing control method provided in the present application, the sliding mode parameters satisfying the matrix inequality constraints are first determined, and then n sliding surfaces are constructed through the sliding mode parameters. The robust controller determines the state equation according to the representation of the dynamic equation and the sliding surface (the sliding mode parameters in the sliding surface are unknown at this time); the robust controller determines the value or value range of the sliding mode parameter under the system stability condition that the characteristic root of the coefficient matrix satisfying the state equation is in the left half plane, and obtains the actual value of the sliding mode parameter required in the process of creating the sliding surface; the robust controller brings the sliding mode parameters into the sliding surface, and calculates the rotational torque of the n rotational joints according to the sliding surface and the dynamic model parameters.

[0362] Exemplarily, the balancing control method provided in the present application first selects the sliding mode parameters corresponding to n sliding mode surfaces in a certain numerical range, constructs n sliding mode surfaces using these sliding mode parameters, and calculates the rotational torque τ of n rotational joints by formula 4; then the robust controller verifies whether the four sliding mode parameters satisfy the above matrix inequality constraints. If the four sliding mode parameters all satisfy the above matrix inequality constraints, the rotational torque τ of the n rotational joints can be used to control the n rotational joints; if the n sliding mode parameters do not satisfy the above matrix inequality constraints, the determined rotational torque τ of the n rotational joints cannot be used.

[0363] The method for determining sliding mode parameters is described below through several embodiments.

[0364] In some embodiments, for the i-th sliding surface among the n sliding surfaces, the robust controller determines at least two sliding mode parameters, including: determining a first sliding mode parameter among at least one sliding mode parameter from the (2i-1)-th prediction parameter set, and determining a second sliding mode parameter among at least one sliding mode parameter from the 2i-th prediction parameter set; wherein the sliding mode parameters respectively included in the (2i-1)-th prediction parameter set and the 2i-th prediction parameter set satisfy the constraints of the stability criterion.

[0365] In this embodiment, after determining the state at the first moment, the computer device first uses the state equation as a matrix inequality constraint to determine the solution sets corresponding to the sliding mode parameters required to be used by the n sliding surfaces, and obtains 2n prediction parameter sets. That is, for any one of the 2n prediction parameter sets, the sliding mode parameters in the prediction parameter set meet the system stability principle.

[0366] In the process of creating the i-th sliding surface, a first sliding parameter among at least two sliding parameters is determined from the (2i-1)-th prediction parameter set, and a second sliding parameter among at least two sliding parameters is determined from the 2i-th prediction parameter set. The i-th sliding surface is created according to the state quantity at the first moment and the above-mentioned at least two sliding parameters, and then the robust controller calculates the rotational torque of the n rotational joints according to the above formula 4.

[0367] It should be noted that, in this embodiment, the method for determining the sliding mode parameters is introduced by taking the use of two sliding mode parameters to create a sliding mode surface as an example. If k sliding mode parameters are required to create a sliding mode surface, then in the process of creating the i-th sliding mode surface, it is necessary to obtain a sliding mode parameter from each of the k prediction parameter sets corresponding to the i-th sliding mode surface, and obtain k sliding mode parameters. When k is equal to 2, the method described in the above embodiment is used. k is a positive integer greater than or equal to 2, and the maximum value of k is set according to actual needs, and this application does not limit it here.

[0368] This method helps to avoid selecting sliding mode parameters that do not satisfy the system stability, which results in the rotational torque of the n revolving joints calculated using these sliding mode parameters being unable to control the balance of the wheel-legged robot. It improves the availability of the determined rotational torque of the revolving joints, helps to avoid calculations required by computer equipment to redetermine the rotational torque, and helps to shorten the time spent on determining the rotational torque of the n revolving joints.

[0369] The calculation process of the force and torque instructions of the joints of the whole body is introduced and explained through several embodiments below.

[0370] In some embodiments, step 1340 further includes sub-step 1346: Sub-step 1346, calculating force and torque instructions of joints throughout the body according to the rotational torque at the second moment.

[0371] In some embodiments, sub-step 1346 includes: calculating the task acceleration of the wheel-legged robot at the second moment based on the rotational torque of the n rotational joints, the task acceleration including the acceleration related to the center of mass of the wheel-legged robot.

[0372] Optionally, the center of mass of the wheel-legged robot refers to an imaginary point where all the mass of the wheel-legged robot is concentrated. The center of mass of the wheel-legged robot is related to factors such as the mass distribution of various mechanisms of the wheel-legged robot and the posture of the wheel-legged robot.

[0373] Optionally, the task acceleration includes but is not limited to at least one of the following: the acceleration of the center of mass of the wheel-legged robot on the x-axis, the acceleration of the center of mass of the wheel-legged robot on the y-axis, the acceleration of the center of mass of the wheel-legged robot on the z-axis, the angular acceleration of the center of mass of the wheel-legged robot rotating around the x-axis, the angular acceleration of the center of mass of the wheel-legged robot rotating around the y-axis, and the angular acceleration of the center of mass of the wheel-legged robot rotating around the z-axis. Exemplarily, the task acceleration is observed in the operating space or in the joint space.

[0374] The operation space refers to the space related to the operation task of the wheel-legged robot, in which the physical quantities in the operation are observed in the Cartesian coordinate system (world coordinates), and the joint space refers to the coordinate system for observing the motion state of the joint. For example, the physical quantities in the operation space and the physical quantities in the task space can be converted. The position information of a mechanism in the operation space and the position in the joint space can be converted through kinematic formulas, and the speed in the operation space and the speed in the joint space are converted through the Jacobian matrix; wherein the Jacobian matrix refers to a matrix in which the first-order partial derivatives are arranged in a certain way.

[0375] In some embodiments, the task acceleration includes: the acceleration related to the center of mass of the wheel-legged robot during the wheel-legged robot's execution of the operation space task. Optionally, the task acceleration is related to the position of the wheel-legged robot's center of mass relative to the wheel-legged robot. Please refer to the following for the method of determining the task acceleration.

[0376] The operation space task can be understood as the task that the wheel-legged robot needs to perform in the operation space. At a certain moment, the operation task that the wheel-legged robot needs to perform is determined according to the movement scene of the wheel-legged robot. Optionally, there can be multiple operation space tasks performed by the wheel-legged robot at the first moment.

[0377] Exemplarily, the types of operating space tasks include but are not limited to at least one of the following: supporting wheel tasks, trunk vertical direction tasks, trunk posture tasks, swinging wheel tasks, center of mass tasks, etc.; wherein, the supporting wheel task refers to the task related to the moving wheel of at least one moving wheel of the wheel-legged robot that is in contact with the contact surface, the trunk vertical direction task refers to the task of the trunk mechanism (also referred to as the body mechanism) of the wheel-legged robot in the z-axis direction of the world coordinate system, the trunk posture task refers to the task related to the Euler angles of the trunk mechanism of the wheel-legged robot, and the Euler angles include roll angle, pitch angle and yaw angle; the swinging wheel task refers to the task related to the moving wheel of at least one moving wheel of the wheel-legged robot that is not in contact with the contact surface; the center of mass task refers to the task related to the center of mass of the wheel-legged robot.

[0378] In some embodiments, sub-step 1346 also includes: the whole body dynamics controller determines the force and torque instructions of the whole body joints of the wheel-legged robot at the second moment according to the task acceleration, and the whole body joints include n rotational joints.

[0379] In some embodiments, the whole body joint refers to the active joint in the wheel-legged robot. Optionally, the types of whole body joints include: rotational joints and linear joints. Exemplarily, the rotational joint corresponds to a rotary motor, and the deflection angle, angular velocity, etc. of the connecting rod connected to the rotational joint are changed by rotating the rotary motor. The linear joint corresponds to a linear motor, and the linear motor is used to change the length of the mechanism. For example, the leg mechanism (first connecting rod) of the wheel-legged robot includes a linear motor, and the length of the leg mechanism can be adjusted by the linear motor.

[0380] In some embodiments, after determining the task acceleration, the observation module sends the task acceleration to the whole body dynamics controller; the whole body dynamics controller determines the force and torque instructions corresponding to the whole body joints according to the task acceleration. Optionally, if the wheel-legged robot performs multiple operation space tasks at the first moment, in addition to determining the task acceleration related to the center of mass of the wheel-legged robot, it is also necessary to calculate other task accelerations corresponding to other operation space tasks. For the specific content of this process, please refer to the following embodiment.

[0381] Optionally, the whole body dynamics controller is designed with a whole body dynamics equation of the wheel-legged robot, and the whole body dynamics equation is used to characterize the relationship between the posture of the wheel-legged robot and the whole body state variables. The whole body dynamics equation is obtained by establishing a whole body dynamics model of the wheel-legged robot and deriving it through kinematics.

[0382] Alternatively, the whole body dynamics model can be expressed by the following formula:

[0383]

[0384] in, represents the joint space inertia matrix, and the joint space inertia matrix H includes the inertia of the joint rigid bodies of the whole body joints; It represents the offset forces received by the joints of the whole body in the joint space. The C matrix includes the sum of the Coriolis force, centripetal force, and gravity received by the complete wheel-legged robot. represents the selection matrix; represents the contact point Jacobian matrix; represents the contact force vector, including at least one contact force on the wheel-legged robot; q, They represent generalized position, generalized velocity, and generalized acceleration respectively; N GRepresents the total degree of freedom of the robot, N G =N f +N J , N f is the floating degree of freedom, N J is the degree of freedom of the active joint. The active joint refers to the joint that can move automatically. N C Represents the number of contact forces, N C Equal to the number of contact points n C With the dimension N of a single contact force D It should be noted that τ is the vector of force and torque commands for all joints of the whole body, and τ is the vector of rotational torques of n rotational joints, and the two have different meanings.

[0385] Optionally, the whole-body dynamics equation is constructed based on the rigid body dynamics of the whole-body dynamics model of the wheel-legged robot, and the whole-body dynamics equation is used to describe the relationship between the posture of the complete wheel-legged robot and the motion state of each active joint and the external force it is subjected to.

[0386] In some embodiments, the force and torque instructions include at least one of the following instructions: a force instruction and a torque instruction. Optionally, the force and torque instructions of the rotary motor include a torque instruction, and the torque instruction is used to control the rotary motor to rotate according to the torque instruction; the force and torque instructions of the linear motor include a force instruction, and the force instruction is used to control the linear motor to perform linear motion.

[0387] The whole body dynamics controller controls the joints of the whole body according to the force and torque instructions of the joints of the whole body.

[0388] After determining the force and torque instructions of the joints of the whole body, the whole body dynamics controller sends the force and torque instructions to the joint motors corresponding to the joints of the whole body. The joint motors corresponding to the joints of the whole body perform linear motion or rotation according to the received force and torque instructions, so that the posture of the wheel-legged robot changes, thereby adjusting the balance state of the wheel-legged robot.

[0389] Optionally, after the rotating motors corresponding to the n rotating motors respectively receive force and torque instructions, the rotating motors rotate so that the deflection angle, angular velocity, and angular acceleration of at least one wheel-legged robot corresponding to the n-order inverted pendulum model change; for the active joints not considered in the n-order inverted pendulum (i.e., other active joints other than the n joints), these active joints start to move after receiving the force and torque instructions.

[0390] Exemplarily, after the linear motor in the leg mechanism receives the force and torque command, the linear motor moves to change the length of the leg mechanism, change the height of the wheel-legged robot, and change the position of the center of mass of the wheel-legged robot in the z-axis direction. Exemplarily, for the other rotating motors except the n rotating motors, the other rotating motors rotate according to the received force and torque command.

[0391] It should be noted that the rotational torque of the n rotational joints and the numbers of force and torque instructions corresponding to the n rotational joints may be different. In the process of determining the force and torque instructions of the whole body joints by the whole body dynamics controller, state quantities related to the operating space tasks of the wheel-legged robot are used, and more rotational joints are involved.

[0392] The force and torque instructions generated by the whole-body dynamics controller are used for balance control, so that more links (more than n links) can participate in balance control, enriching the posture of the wheel-legged robot during the balance adjustment process, and realizing the combination of balance adjustment and the operational space tasks of the motion process. The balance adjustment is completed by combining the robust controller and the whole-body dynamics controller, providing a new idea for balance control.

[0393] The following describes a method for determining task acceleration through several embodiments.

[0394] In some embodiments, the observation module calculates the task acceleration of the wheel-legged robot at the second moment according to the rotational torque of the n rotational joints. Optionally, the observation module is designed with a method for converting the rotational torque of the n rotational joints into task acceleration.

[0395] Optionally, the process may include the following sub-steps:

[0396] The observation module determines the angular acceleration at the second moment according to the dynamic equation and the rotational torque of the n rotational joints.

[0397] The dynamic equation refers to a dynamic equation obtained based on an n-th order inverted pendulum model, and the dynamic equation is related to the motion states of n mechanisms and the rotational torques of n rotating joints.

[0398] Optionally, after the robust controller of the wheel-legged robot determines the rotational torques of the n rotational joints according to the state quantity at the first moment, the rotational torques of the n rotational joints are sent to an observation module in the control system. The observation module determines the rotational torques of the n rotational joints according to Formula 2 above:

[0399]

[0400] Calculate the angular acceleration of the wheel-legged robot at the second moment.

[0401] Optionally, the angular acceleration at the second moment refers to the angular acceleration related to the n-th order inverted pendulum model. Exemplarily, the angular acceleration at the second moment includes the angular accelerations of the n connecting rods at the second moment and the angular acceleration of the moving wheel at the second moment.

[0402] The whole-body dynamics controller determines the expected incremental position and expected incremental speed of the center of mass of the wheel-legged robot at the second moment based on the state quantity at the first moment and the angular acceleration at the second moment. The expected incremental position is used to characterize the distance between the projection of the center of mass of the wheel-legged robot on the contact surface and the virtual contact point in the first direction. The expected incremental speed is used to characterize the changing speed of the distance in the first direction. The virtual contact point refers to the center of each contact point of the wheel-legged robot with the contact surface.

[0403] In some embodiments, when at least two moving wheels of a wheel-legged robot are in contact with a contact surface, the virtual contact point refers to the center of a line connecting the contact points of the at least two moving wheels with the contact surface.

[0404] In some embodiments, the expected position increment is used to characterize the position of the center of mass of the wheel-legged robot relative to the wheel-legged robot. The expected incremental speed is the first-order derivative of the expected position increment with respect to time, that is, the expected position increment is used to characterize the speed of position change of the center of mass of the legged robot relative to the wheel-legged robot.

[0405] Optionally, the expected position increment and the expected speed increment refer to the relative position and relative speed of the center of mass of the wheel-legged robot in the first direction, respectively. The first direction refers to the forward direction of the wheel-legged robot (i.e., the x-axis direction in the world coordinate system). If the wheel-legged robot involves movement in the left and right directions (i.e., the y-axis direction in the world coordinate system), the expected speed increment refers to the component of the relative speed of the center of mass of the wheel-legged robot in the first direction.

[0406] In some embodiments, after determining the angular acceleration at the second moment, the observation module uses the forward kinematics method to determine the expected incremental position and expected incremental velocity of the center of mass of the wheel-legged robot at the second moment based on the acceleration at the second moment, the deflection angle of the n links, the rotation angle of the moving wheels, the angular velocity of the n links, the configuration, model, and parameters of the wheel-legged robot.

[0407] Optionally, when the acceleration at the second moment, the deflection angles of n mechanisms, the rotation angles of the moving wheels, the angular velocities of n mechanisms and other state quantities are known, the position and velocity of the end of the wheel-legged robot are calculated according to forward kinematics, that is, the posture of the wheel-legged robot at the second moment is determined; based on the position of the wheel-legged robot in the operating space and the posture of the wheel-legged robot, the position of the center of mass of the wheel-legged robot in the operating space can be calculated, thereby obtaining the expected incremental position and the expected incremental velocity.

[0408] The whole-body dynamics controller determines the task acceleration of the wheel-legged robot at the second moment according to the expected incremental position and the expected incremental speed.

[0409] In some embodiments, the observation module determines a reference state variable group of the center of mass of the wheel-legged robot based on the expected incremental position and the expected incremental speed; the observation module determines the task acceleration based on the reference state variable group and the actual state variable group of the center of mass of the legged robot.

[0410] The reference state variable group is used to characterize: the state variable of the center of mass of the wheel-legged robot at the second moment inferred by kinematics. Optionally, the reference state variable group includes: the expected incremental position Δx r , expected incremental speed Desired location Expected speed The expected position refers to the operation space position of the center of mass of the wheel-legged robot at the second moment, or the joint space position at the second moment, and the expected velocity refers to the first-order derivative of the expected position with respect to time.

[0411] The actual state variable group is used to characterize: the state variables of the wheel-legged robot observed by the sensor. Optionally, the actual state variable group includes: the actual incremental position Δx a , Actual incremental speed Physical location Actual speed The actual position refers to the position of the center of mass of the wheel-legged robot in the operating space, and the actual speed refers to the first-order derivative of the actual position with respect to time.

[0412] Optionally, the task acceleration of the wheel-legged robot at the second moment is It can be calculated by the following formula:

[0413]

[0414] Wherein, K represents the feedback gain matrix. Exemplarily, LQR is used to construct the objective function of the inverted pendulum dynamics equation, and then the feedback gain matrix of the inverted pendulum dynamics equation is iteratively obtained with the goal of minimizing the objective function. LQR is constructed based on the quadratic programming optimization method, and its essence is: under linear constraints, find a multidimensional vector so that the quadratic objective function of the multidimensional vector is minimized (or maximized).

[0415] In some embodiments, the observation module sends the calculated task acceleration of the wheel-legged robot to the whole-body dynamics controller. The whole-body dynamics controller generates force and torque instructions for the whole-body joints of the wheel-legged robot according to the task acceleration. The whole-body dynamics controller sends the force and torque instructions for the whole-body joints to the joint motors corresponding to each active joint to control the movement of the whole-body joints, thereby adjusting the posture of the wheel-legged robot so that the wheel-legged robot maintains a balanced state.

[0416] In some embodiments, the observation module generates force and torque instructions for the whole-body joints of the wheel-legged robot based on the task acceleration, including the following steps: the whole-body dynamics controller determines the expected operation space task of the wheel-legged robot at the second moment, and the expected operation space task includes at least one task acceleration corresponding to the operation space task; the whole-body dynamics controller performs spatial transformation on the expected operation space task to obtain the expected joint space task; the whole-body dynamics controller brings the expected joint space task into the whole-body dynamics equation of the wheel-legged robot to obtain force and torque instructions for the whole-body joints.

[0417] Optionally, the expected operation space task includes a task acceleration at the second moment. It can be expressed as:

[0418]

[0419] in, Refers to the first acceleration corresponding to the support wheel task, It refers to the second acceleration corresponding to the task in the vertical direction of the trunk, It refers to the third acceleration corresponding to the trunk posture task, The fourth acceleration corresponding to the swing wheel task, It refers to the task acceleration corresponding to the center of mass task. Optionally, the operation space tasks of the wheel-legged robot are different at different times, that is, the values ​​of some accelerations included in the expected operation space tasks can be 0.

[0420] Optionally, the relationship between the acceleration in the operation space included in the desired operation space task and the joint space velocity and acceleration in the joint space task is:

[0421]

[0422] Among them, J t represents the Jacobian matrix of the action space task, The derivative of the Jacobian matrix representing the task in the action space.

[0423] According to the whole body dynamics equation: Joint space task with expectation Can calculate Among them, τ represents the force and torque commands of the joints of the whole body.

[0424] In order to improve the rationality of the force and torque instructions of the whole body joints, at least one constraint condition is added in the process of solving the whole body dynamic equation. The constraint condition includes but is not limited to at least one of the following: joint physical constraint and friction constraint.

[0425] Optionally, the joint physical constraint is used to limit the force and torque instructions according to the characteristics of the joint motors corresponding to the joints of the wheel-legged robot. The joint physical constraint can be expressed as:

[0426] τ lb ≤τ≤τ ub

[0427] Among them, τ represents the matrix of force and torque instructions of the joints of the whole body, τ lb represents the matrix including the minimum values ​​of the force and torque commands corresponding to each active joint, τ ub Represents a matrix including the maximum values ​​of the force and torque commands corresponding to each active joint.

[0428] Optionally, the friction constraint is to set the contact force f at the i-th contact point i The friction cone constraint should be satisfied. To reduce nonlinearity, the friction cone can be approximated as a friction angle cone, and the friction inequality constraint can be expressed as:

[0429]

[0430] Among them, n x 、n y 、n z They represent the unit orthogonal basis of the contact surface along the operating space system, μ i represents the friction coefficient, f i,zlb 、f i,zub They respectively represent the minimum and maximum values ​​of the non-negative positive pressure perpendicular to the contact surface.

[0431] The following is an introduction to the process of solving the whole-body dynamics equation. Optionally, the process can be completed by an optimizer: the whole-body dynamics equation is expressed as a polynomial solution in the form of AX=B.

[0432] in, Use the quadratic programming optimizer to construct the objective function, which can be expressed as: J = min (AX-B) T Q(AX-B)+X T RX; where Q and R are weight matrices, the minimum value of the objective function is calculated by the quadratic programming optimizer, and the result is The various variables in , that is, the force and torque instructions τ of the joints of the whole body are obtained.

[0433] This method can independently determine the force and torque instructions corresponding to each joint of the body. In a scenario where multiple real wheels of the wheel-legged robot do not overlap in the first direction, control of at least one real wheel and at least one real first rotational joint can also be achieved.

[0434] The following describes a method for determining each expected acceleration in the expected operation space task, and the method for determining each element in the expected operation space task is preset. Optionally, the expected acceleration is determined based on the actual acceleration and the reference acceleration.

[0435] 1. The first acceleration corresponding to the support wheel task method of determination.

[0436] Since the support wheel rolls on the contact surface and there is no relative sliding between the support wheel and the contact surface, the expected acceleration of the support wheel is is always equal to 0; the expected acceleration of the support wheel can be expressed as If the wheel-legged robot works in the four-wheel mode, there are four support wheels, each of which has a task in the x-direction. Assuming that the support wheels do not leave the ground, the height of the support wheels in the z-axis direction of the world coordinate system is constant, so the tasks of the four support wheels in the z-axis direction are not considered for the time being. Assuming that the wheel-legged robot does not perform left and right turns in the four-wheel mode and the wheel-legged robot does not perform translational actions along the y-axis direction of the world coordinate system, the tasks of the four support wheels in the y-axis direction are not considered for the time being.

[0437] If the wheel-legged robot works in the two-wheel balancing mode, there are two support wheels, and the other two moving wheels are swing wheels. The tasks of the support wheels are not considered for the time being. The tasks related to the two supports have been included in the introduction related to the "center of mass task" below. At the same time, the tasks of the two swing wheels include two dimensions, the x-axis direction and the z-axis direction. If the left and right turning actions of the wheel-legged robot in the two-wheel balancing mode and the translational actions of the wheel-legged robot along the y-axis are not considered, the tasks of the two swing wheels in the y direction are not considered for the time being.

[0438] 2. Second acceleration corresponding to the task in the vertical direction of the trunk method of determination.

[0439] The camera in the wheel-legged robot obtains the position information of the supporting wheels at multiple future moments by capturing the height changes of the contact surface in the field of view. The expression formula of the position information at multiple future moments is determined through planning methods such as spline curve interpolation, and the vertical reference position of the trunk mechanism is determined based on the expression formula. speed Acceleration According to the IMU sensor and the deflection angle (joint angle) and angular velocity of the mechanism, the actual vertical position of the trunk mechanism is calculated by forward kinematics. speed Construct a PD (Proportional Derivative) feedback controller corresponding to the trunk vertical direction task and calculate the expected acceleration in the trunk vertical direction, i.e. the second acceleration

[0440]

[0441] 3. The third acceleration corresponding to the trunk posture task method of determination.

[0442] In some scenarios (such as going up stairs), the trunk of the wheel-legged robot needs to be kept vertical as much as possible, and the trunk will not rotate, that is, the Euler angle reference trajectory composed of the roll angle, pitch angle, and yaw angle of the trunk is zero, that is, The wheel-legged robot calculates the actual Euler angle based on the observation results of the IMU sensor according to the forward kinematics formula Angular velocity The desired angular acceleration of the trunk can be calculated by the PD feedback controller corresponding to the trunk posture task: that is, the third acceleration

[0443]

[0444] 4. The fourth acceleration corresponding to the swing wheel task method of determination.

[0445] In the scenario of two-wheel balance, for example, when the two-wheel balance is driving on the ground, the two swinging wheels are required to present specific postures and movements, or when the two wheels are walking forward on the ground, the supporting wheel leg and the swinging wheel leg are switched, or when walking up and down stairs, the supporting wheel leg and the swinging wheel leg are switched, etc., there are corresponding fourth accelerations.

[0446] The reference position of the swing wheel in the operating space is planned by spline curve interpolation method speed Acceleration Based on the observation results of the IMU sensor, joint angle and angular velocity information, the actual position of the swing wheel is calculated according to positive kinematics speed By constructing the PD feedback controller corresponding to the swing wheel task, the expected acceleration of the swing wheel can be calculated: that is, the third acceleration The PD feedback controller calculates the third acceleration The formula is as follows:

[0447]

[0448] 5. Task acceleration corresponding to the center of mass task method of determination.

[0449] Optionally, a reference position of the center of mass along the forward direction is planned using a heuristic or model-based approach speed During the movement of the wheel-legged robot, the execution center of mass of the wheel-legged robot not only needs to move continuously along the forward direction, but also needs to be within the range of the wheel-legged robot to maintain dynamic balance. Based on this, a method for determining the expected acceleration of the center of mass (also known as the task acceleration) is designed.

[0450] Assume that the mass of the wheel-legged robot is concentrated at the center of mass of the wheel-legged robot, set the center of the line connecting at least two supporting wheels as the virtual contact point between the inverted pendulum related to the center of mass and the contact surface, connect the center of mass and the virtual contact point, and construct an inverted pendulum model of the center of mass.

[0451] Fig.14 Schematic diagram of a mass-center related inverted pendulum provided by an exemplary embodiment of the present application.

[0452] The center of mass of the wheel-legged robot 1410 and the virtual contact point 1420. According to the inverted pendulum model related to the center of mass, the dynamic equation related to the center of mass is determined:

[0453]

[0454] Using the linear quadratic programming regulator, determine the feedback gain matrix K. Based on the LQR controller, the input of the state equation can be obtained:

[0455] in, represents the actual state variable group, Represents the actual state variable group. For other parameters, please refer to the above introduction and will not be repeated here.

[0456] In some embodiments, the balance control method provided in the present application is continuously executed during the operation of the wheel-legged robot, that is, the robust controller continuously obtains the state quantity at the current moment, determines the dynamic model parameters based on the state quantity at the current moment, establishes the sliding surface, and determines the rotational torque of n rotational joints based on the dynamic model parameters and the sliding surface control.

[0457] In other embodiments, when the IMU sensor detects a dramatic change in the deflection angle of some links in the wheel-legged robot, the robust controller executes the balance control method starting from step 1310. For example, at a certain moment, the IMU sensor detects that the deflection angle change of the first link is greater than the angle threshold, and the IMU sensor sends the detected state parameters to the robust controller, and the robust controller starts the balance adjustment process, and the angle threshold can be preset.

[0458] In other embodiments, when the moving wheel does not receive the control signal from the controller and the motor encoder detects that the moving wheel moves, the robust controller starts to execute the balancing control method starting from step 1310 .

[0459] Through this method, the balance control of the wheel-legged robot is intermittently performed through a robust controller, which helps to save the energy consumption of the wheel-legged robot and improve the wheel-legged robot's ability to resist external interference without greatly affecting the balance control effect.

[0460] The following is another example to illustrate the process of the balance control method:

[0461] In the balancing control process, step A10: the robust controller obtains the first moment t i The actual state quantity.

[0462] Step A20: Process the actual state quantity at the first moment to obtain the equivalent state quantity at the first moment. Optionally, this step is implemented by the following sub-steps: Process the actual state quantity at the first moment to obtain the equivalent state quantity at the first moment, including: superimposing the angular velocities of at least two moving wheels in the actual state quantity to obtain the angular velocity of the wheel; determining the geometric relationship between at least two leg mechanisms according to the length and deflection angle of at least two leg mechanisms; determining the deflection angle of the first connecting rod and the angular velocity of the first connecting rod according to the geometric relationship, the deflection angle of at least two leg mechanisms and the angular velocity of at least two leg mechanisms; using the deflection angle of n-1 connecting rods in the actual state quantity as the deflection angle of n-1 connecting rods in the equivalent state quantity; using the angular velocity of n-1 connecting rods in the actual state quantity as the angular velocity of n-1 connecting rods in the equivalent state quantity.

[0463] Step A30: The robust controller calculates the rotational torque at the second moment according to the dynamic equation and the sliding surface. The rotational torque at the second moment includes: the rotational torque of n rotational joints.

[0464] Step A40: Calculate the force and torque instructions of the joints of the whole body according to the rotational torque at the second moment.

[0465] Optionally, this step includes the following sub-steps: the robust controller sends the rotational torque of the n rotational joints to the observation module, and the observation module determines the task acceleration according to the rotational torque of the n rotational joints; the observation module sends the task acceleration to the whole-body dynamics controller, and the whole-body dynamics controller determines the force and torque instructions of the whole-body joints according to the task acceleration, and the whole-body dynamics controller sends corresponding force and torque instructions to each joint motor.

[0466] Step A50: At the second moment, the whole body dynamics controller controls the n-1 rotational joints and the real first joint corresponding to the first rotational joint according to the force and torque instructions of the whole body joints.

[0467] Step A60: At the second time t i+1 The wheel-legged robot controls the movement of motors corresponding to the joints of the whole body according to the force and torque instructions, and adjusts the posture of the wheel-legged robot.

[0468] Before the balance control process is completed, the above steps A10-A60 are repeatedly executed.

[0469] It should be noted that the various formulas used in this example are all formulas that appear in the above embodiments. For explanations of the parameters in these formulas, please refer to the above embodiments and will not be repeated here.

[0470] By abstracting the wheel-legged robot into an n-order inverted pendulum model, calculating the rotational torque of n rotational joints, and determining the task acceleration of the wheel-legged robot based on the rotational torque of the n rotational joints, the input of the whole-body dynamics controller in the balance control process is obtained, so that the whole-body dynamics controller can calculate the force and torque instructions of the whole-body joints, so that each mechanism in the wheel-legged robot can participate in the balance control process, further enriching the posture of the wheel-legged robot in the balance control process, and helping to improve the robustness of the balance control method.

[0471] Taking n equals 2 as an example, some steps in the balance control method are introduced and explained below.

[0472] First, the method for determining the parameters of the kinetic model is explained.

[0473] When n is equal to 2, after the wheel-legged robot is abstracted into a second-order inverted pendulum model, the dynamic equation used in the balance control process derived based on the Euler-Lagrange equation can be expressed as:

[0474]

[0475] Optionally, the dynamic model parameters are determined by derivation based on a second-order inverted pendulum model used for balance control; the dynamic model parameters include: a proportional parameter matrix and an offset parameter matrix.

[0476] In the design process of robust controller, the dynamic equation is:

[0477]

[0478] After partial linearization, we get formula a:

[0479]

[0480] Among them, M -1 (α, β) is the inverse matrix of the inertia matrix, M -1 (α, β)*M(α, β)=E, where E is the unit matrix. The physical meanings of other parameters in the equation can be found in the above embodiment and will not be elaborated on here.

[0481] Formula a is processed so that the rotational torque τ1 of the first rotational joint and the rotational torque τ2 of the second rotational joint are unified in formula a. Formula a is processed using a selection matrix to obtain formula b:

[0482]

[0483] in, That is, the offset parameter matrix f[], That is the scale parameter matrix g[], S T is the transposed matrix of matrix S, S T The matrix is ​​a 3*2 selection matrix, for example, S T The matrix is ​​specifically

[0484] Formula b can be pre-designed after the wheel-legged robot is abstracted as a second-order inverted pendulum model. During the balance control method, after the robust controller obtains the state quantity at the first moment, it substitutes the state quantity at the first moment into the dynamic equation to determine the inertia matrix, deflection force matrix and gravity matrix at the first moment; the dynamic model parameters are determined according to the inertia matrix, deflection force matrix and gravity matrix.

[0485] The robust controller uses the selection matrix to process the product between the inverse matrix of the inertia matrix and the deflection force matrix, and the product between the inverse matrix of the inertia matrix and the gravity matrix, respectively, to obtain the offset parameter matrix, and the selection matrix is ​​used to extract the rotational torque of the first joint and the rotational torque of the second joint from the dynamic equation; the robust controller uses the selection matrix to process the inverse matrix of the inertia matrix to obtain the proportional parameter matrix. For the specific content of this process, please refer to the above embodiment, which will not be repeated here.

[0486] The following is an introduction to the method of establishing the sliding surface under the second-order inverted pendulum model.

[0487] The robust controller establishes a sliding surface based on the equivalent state quantity at the first moment, and the state quantity of the wheel-legged robot gradually approaches 0 on the sliding surface.

[0488] When n is equal to 2, it is necessary to determine the rotational torque of the first rotational joint and the rotational torque of the second rotational joint, and the robust controller needs to establish two sliding surfaces. The two sliding surfaces include: 1. The sliding surface of the first rotational joint, that is, the state quantity related to the first rotational joint gradually tends to 0 on the sliding surface; 2. The sliding surface of the second rotational joint, that is, the state quantity related to the second rotational joint gradually tends to 0 on the sliding surface.

[0489] Optionally, the first sliding surface is different from the second sliding surface. The purpose of setting the first sliding surface and the second sliding surface is to calculate the turning torque of the first rotational joint and the turning torque of the second rotational joint. The first sliding surface and the second sliding surface jointly participate in the calculation process of the turning torque of the first rotational joint and the second rotational joint. The definition of the first sliding surface may not be limited to being the sliding surface corresponding to the first rotational joint. Similarly, the definition of the second sliding surface may not be limited to being the sliding surface corresponding to the second rotational joint. The first sliding surface and the second sliding surface may be defined according to actual needs, and this application does not limit this.

[0490] From the introduction of the n-order inverted pendulum model above, it can be seen that in order to ensure the calculation of a certain torque, the establishment of the sliding surface requires at least 3 state parameters and at least 2 sliding parameters in the state quantity; among them, the equivalent state quantity is written as Then α, β, These are all status parameters.

[0491] The robust controller determines at least four sliding mode parameters, and the sliding mode parameters are used to constrain the rotational torque of the first joint and the rotational torque of the second joint to meet the system stability conditions of the wheel-legged robot.

[0492] Optionally, different sliding surfaces are established using different state parameters and different sliding parameters. Exemplarily, establishing the first sliding surface requires at least the deflection angle of the leg mechanism, the angular velocity of the moving wheel, and the angular velocity of the leg mechanism in the equivalent state quantity; establishing the second sliding surface requires at least the deflection angle of the trunk mechanism, the angular velocity of the moving wheel, and the angular velocity of the trunk mechanism in the state quantity at the first moment; in this case, the at least two sliding parameters included in the first sliding surface are: the sliding parameter corresponding to the deflection angle of the leg mechanism, and the sliding parameter corresponding to the angular velocity of the moving wheel. The at least two sliding parameters included in the second sliding surface are: the sliding parameter corresponding to the deflection angle of the trunk mechanism, and the sliding parameter corresponding to the angular velocity of the moving wheel.

[0493] The robust controller establishes a first sliding surface and a second sliding surface according to an equivalent state quantity at a first moment and at least four sliding mode parameters.

[0494] Optionally, the robust controller establishes a first sliding surface based on the first sliding parameter, the second sliding parameter, the deflection angle of the leg mechanism, the angular velocity of the moving wheel and the angular velocity of the leg mechanism; and establishes a second sliding surface based on the third sliding parameter, the fourth sliding parameter, the deflection angle of the trunk mechanism, the angular velocity of the trunk mechanism and the angular acceleration of the leg mechanism.

[0495] Exemplarily, the robust controller processes the deflection angle of the leg mechanism through the first sliding mode parameter to obtain the processing result of the leg mechanism; processes the angular velocity of the moving wheel through the second sliding mode parameter to obtain the processing result of the moving wheel, and the robust controller determines the first sliding mode surface according to the processing result of the leg mechanism, the processing result of the moving wheel and the angular velocity of the leg mechanism. Optionally, the first sliding mode surface is proportional to the processing result of the leg mechanism, the first sliding mode surface is proportional to the processing result of the moving wheel, and the first sliding mode surface is proportional to the angular velocity of the leg mechanism.

[0496] For example, the robust controller adds the processing result of the leg mechanism, the processing result of the moving wheel and the angular velocity of the leg mechanism to obtain the first sliding surface.

[0497] Exemplarily, the robust controller processes the deflection angle of the trunk mechanism through the third sliding mode parameter to obtain the processing result of the trunk mechanism; processes the angular velocity of the moving wheel through the fourth sliding mode parameter to obtain the processing result of the moving wheel; and the robust controller determines the second sliding mode surface according to the processing result of the trunk mechanism, the processing result of the moving wheel and the angular velocity of the trunk mechanism. Optionally, the second sliding mode surface is proportional to the processing result of the trunk mechanism, the second sliding mode surface is proportional to the processing result of the moving wheel, and the second sliding mode surface is proportional to the angular velocity of the leg mechanism.

[0498] For example, the robust controller adds the processing result of the trunk mechanism, the processing result of the moving wheel and the angular velocity of the trunk mechanism to obtain the second sliding surface.

[0499] In some embodiments, during the balancing control process, the robust controller establishes the first sliding surface s1 and the second sliding surface s2 according to the following two formulas:

[0500] s1=λ1ξ1+λ2ξ3+ξ4

[0501] s2=λ3ξ2+λ4ξ3+ξ5

[0502] Among them, λ1 represents the first sliding mode parameter, λ2 represents the second sliding mode parameter, λ3 represents the third sliding mode parameter, λ4 represents the fourth sliding mode parameter, and ξ1 represents the equivalent state quantity The first element α, ξ2 in represents the equivalent state quantity The second element β,ξ3 in represents the equivalent state quantity The third element in ξ4 represents the equivalent state quantity The fourth element in ξ5 represents the equivalent state quantity The fifth element in

[0503] By establishing the first sliding surface and the second sliding surface in this way and controlling the number of sliding parameters in the first sliding surface and the second sliding surface, the rotational torque of the first joint and the rotational torque of the second joint that meet the system stability principle can be determined with a small computational overhead, which helps to improve the speed of determining the rotational torque and achieve balance control of the robot.

[0504] The following is an introduction to the method for determining the torque.

[0505] The robust controller calculates the rotational torque of the first rotational joint and the rotational torque of the second rotational joint according to the sliding surface and the dynamic model parameters.

[0506] After determining the first sliding surface and the second sliding surface, the robust controller calculates the first-order derivative formula of the first sliding surface s1 with respect to time and the first-order derivative function formula of the second sliding surface s2 with respect to time:

[0507]

[0508]

[0509] in, represents the first-order derivative of the first sliding surface s1 with respect to time, represents the first-order derivative of the second sliding surface s2 with respect to time, f k (k∈(1, 2, 3)) is the element in the offset parameter matrix f[] in formula 2 above, g mn (m∈(1, 2, 3), n∈(1, 2, 3)) are the elements in the scale parameter matrix g[] in formula 2 above.

[0510] The first-order derivative formula of the first sliding surface s1 with respect to time and the first-order derivative formula of the second sliding surface s2 with respect to time are arranged in matrix form to obtain formula c:

[0511]

[0512] By transposing the terms of formula c, we can obtain formula d:

[0513]

[0514] in, g s -1 g s The inverse matrix of , sgn() is the sign function,

[0515] Formula d can be further written as formula e:

[0516]

[0517] That is, when n=2 in the n-order inverted pendulum model, Formula 4 above is realized as Formula d, Formula 5

[0518] The realization is formula e. In the method for balancing control based on the second-order inverted pendulum model, the calculation process of the rotational torque of the first rotational joint and the rotational torque of the second rotational joint needs to use formula d and formula e.

[0519] Optionally, the robust controller needs to consider the system stability condition during the calculation of the torque. For the method of satisfying the system stability condition during the balance control of the second-order inverted pendulum model, please refer to the following embodiment.

[0520] For a detailed introduction to this content, please refer to the relevant content in the n-order inverted pendulum model above, which will not be repeated here.

[0521] To summarize, based on abstracting the wheel-legged robot into a second-order inverted pendulum model, during the balance control process, the angle between the moving wheel and the leg mechanism can be adjusted, as well as the angle between the trunk mechanism and the leg mechanism can be adaptively adjusted; the posture of the robot in the balance adjustment process is enriched, making the robot posture change more flexible, which helps to quickly adjust the robot to a balanced state, improve the robot's ability to recover to a balanced state under different disturbance forces, and improve the robustness of the robot's balance control process.

[0522] The following describes an embodiment of the process of satisfying the system stability criterion in the process of calculating the rotational torque of the first rotational joint and the rotational torque of the second rotational joint.

[0523] From the definition and properties of the sliding surface, it can be seen that the state parameters on the sliding surface satisfy:

[0524] s1=λ1ξ1+λ2ξ3+ξ4=0

[0525] s2=λ3ξ2+λ4ξ3+ξ5=0

[0526] The above two formulas can be used to inversely express ξ4 and ξ5:

[0527] ξ4=-λ1ξ1-λ2ξ3

[0528] ξ5=-λ3ξ2-λ4ξ3

[0529] Then the first-order derivative of ξ4 with respect to time is The first derivative of ξ5 with respect to time It can be expressed as:

[0530]

[0531]

[0532] Since ξ4 represents ξ1 represents α, ξ5 represents ξ2 represents β; therefore, ξ1, ξ2 can be expressed by the following formula:

[0533]

[0534]

[0535]

[0536] Review the dynamic equation of the second-order inverted pendulum model in polynomial form above:

[0537]

[0538]

[0539]

[0540] Adding the three formulas included in the polynomial form of the dynamic equation gives formula f:

[0541]

[0542] Replace the formula f Substitute and get formula g:

[0543]

[0544] Arrange formula g to get formula h:

[0545]

[0546] The inverse expression is expressed by the formula h get:

[0547]

[0548] Included The three formulas are combined to obtain equation group 1:

[0549]

[0550] Due to space constraints, Eq. The representation on the right side of the equation is somewhat distorted. The “[]” represents an algebraic expression, not a matrix or other meanings. Please refer to the above equation group 1. The expression can be used to understand the equation 1 The way of expressing.

[0551] The equation group 1 can be written as a state equation about the state variables (ξ1, ξ2, ξ3). Alternatively, the state equation refers to an equation related to the state quantity.

[0552] For ease of reading, a1 is used to represent m1 means m2 means m3 means The state equation can be written as:

[0553]

[0554] Optionally, the system stability criterion refers to that the characteristic roots of the coefficient matrix in the state equation determined according to the sliding surface and the dynamic equation are negative, that is, the characteristic roots are distributed in the left half plane of the phase plane.

[0555] In order to ensure that the system meets the stability criterion, the coefficient matrix needs to be satisfied The characteristic roots of are distributed in the left half plane of the complex plane. This state equation can be used as a matrix inequality constraint, that is, the value of the sliding mode parameter needs to make the characteristic root of the coefficient matrix negative.

[0556] Optionally, in the balancing control process of the present application, the robust controller determines the rotational torque of the first joint and the rotational torque of the second joint according to formula d and equation group 1.

[0557] In the process of balancing control, the robust controller calculates the turning torque τ1 of the first joint and the turning torque τ2 of the second joint according to formula d. Formula d involves the sliding surface s1, the second sliding surface s2, the dynamic model parameters and the sliding parameters in formula 2. The robust controller obtains the state quantity at the first moment from the sensor, and substitutes the state quantity at the first moment into the corresponding formula, determines the sliding surface s1, the second sliding surface s2 and the dynamic model parameters, and finds the sliding parameters that meet the system stability conditions, and then calculates the turning torque τ1 of the first joint and the turning torque τ2 of the second joint by formula d, while ensuring that the sliding parameters meet the matrix inequality constraints formed by the above state equations.

[0558] In the balancing control method provided in the present application, four sliding mode parameters satisfying the matrix inequality constraints may be determined first, and then the first sliding mode surface and the second sliding mode surface may be constructed by using the sliding mode parameters.

[0559] You can also first select any four sliding mode parameters within a certain numerical range, use the four sliding mode parameters to construct the first sliding surface and the second sliding surface, and calculate the rotational torque τ1 of the first joint and the rotational torque τ2 of the second joint through formula d, and then verify whether the four sliding mode parameters satisfy the above matrix inequality constraints.

[0560] Optionally, when the four sliding mode parameters satisfy the above-mentioned matrix inequality constraints, the determined rotational torque τ1 of the first joint and the rotational torque τ2 of the second joint can be used; when the four sliding mode parameters do not satisfy the above-mentioned matrix inequality constraints, the determined rotational torque τ1 of the first joint and the rotational torque τ2 of the second joint cannot be used.

[0561] The method for determining sliding mode parameters is described below through several embodiments.

[0562] In some embodiments, determining at least four sliding mode parameters includes: a computer device determines a first sliding mode parameter from a first prediction parameter set, determines a second sliding mode parameter from a second prediction parameter set, determines a third sliding mode parameter from a third prediction parameter set, and determines a fourth sliding mode parameter from a fourth prediction parameter set; wherein the sliding mode parameters respectively included in the first prediction parameter set, the second prediction parameter set, the third prediction parameter set, and the fourth prediction parameter set satisfy the constraints of the stability criterion.

[0563] In this embodiment, after determining the state at the first moment, the robust controller first uses the above state equation as a matrix inequality constraint to determine the solution sets corresponding to λ1, λ2, λ3, and λ4, respectively, that is, the first prediction parameter set, the second prediction parameter set, the third prediction parameter set, and the fourth prediction parameter set, and then selects the first sliding mode parameter, the second sliding mode parameter, the third sliding mode parameter, and the fourth sliding mode parameter from each parameter set, and establishes the first sliding mode surface and the second sliding mode surface through the first sliding mode parameter, the second sliding mode parameter, the third sliding mode parameter, the fourth sliding mode parameter and the state quantity at the first moment, and then calculates the rotational torque of the first joint and the rotational torque of the second joint according to the above formula d.

[0564] In some implementations, the process of determining any one of the four prediction solution sets is as follows: calculating the coefficient matrix The characteristic roots of the coefficient matrix are used as the prediction parameter set.

[0565] This method can avoid selecting sliding mode parameters that do not satisfy the system stability, which results in the rotational torque corresponding to the first joint and the rotational torque corresponding to the second joint calculated using these sliding mode parameters being unable to control the balance of the wheel-legged robot, avoiding invalid calculations by computer equipment, and helping to shorten the time required to determine the rotational torque corresponding to the first joint and the rotational torque corresponding to the second joint.

[0566] Next, the robustness control effect of the balance control of the wheel-legged robot under the balance control method provided in this embodiment is experimentally verified.

[0567] Fig.15 It is a simulation schematic diagram of a four-wheel balancing control method provided by an exemplary embodiment of the present application.

[0568] Fig.15 The wheel-legged robot has four moving wheels and four leg mechanisms. When the wheel-legged robot is in a four-wheel motion state, the four moving wheels are divided into two forward moving wheels and two backward moving wheels, and the four leg mechanisms are divided into two forward leg mechanisms and two backward leg mechanisms. Balance control is performed during the four-wheel driving process: in the process of adjusting the posture of the wheel-legged robot, after the robust controller determines the rotational torque of the n rotating joints, the task acceleration is calculated according to the rotational torque of the n rotating joints; the task acceleration is input into the whole body dynamics controller to obtain the force and torque instructions of the whole body joints output by the whole body dynamics controller; the whole body joints of the wheel-legged robot are driven by the force and torque instructions of the whole body joints. Optionally, the joint angles between the n mechanisms change, the lengths of the forward leg mechanism and the backward leg mechanism can change, and the speeds of the forward moving wheel and the backward moving wheel can be different. During the balancing control process, the distance between the forward moving wheel and the rearward moving wheel, that is, the size of the supporting footprint, is changed until the front and rear moving wheels allow the four wheels to move to a collinear position, and the wheel-legged robot changes to a state close to two-wheel balance.

[0569] The following is an embodiment of the device of the present application, which can be used to execute the embodiment of the method of the present application. For details not disclosed in the embodiment of the device of the present application, please refer to the embodiment of the method of the present application.

[0570] Please refer to Fig.16, which shows a block diagram of a balance control device for a wheel-legged robot provided by an embodiment of the present application. The device has the function of implementing the balance control method of the wheel-legged robot, and the function can be implemented by hardware or by hardware executing corresponding software. The device can be the computer device introduced above, or it can be set in a computer device. The wheel-legged robot is simplified to an n-order inverted pendulum model, which includes: wheels, n connecting rods and n revolving joints, the wheels and the first connecting rod among the n connecting rods are connected through the first revolving joint among the n revolving joints, the n connecting rods are connected in series through n-1 revolving joints other than the first revolving joint, the first connecting rod is an equivalent connecting rod corresponding to at least two leg mechanisms of the wheel-legged robot, the wheels are equivalent moving wheels corresponding to the moving wheels respectively connected to the at least two leg mechanisms, and n is a positive integer greater than or equal to 2; the wheel-legged robot includes: moving wheels, n connecting rods and n revolving joints, the moving wheels and the first connecting rod among the n connecting rods are connected through the first revolving joint among the n revolving joints, the n connecting rods are connected in series through n-1 revolving joints other than the first revolving joint, and n is a positive integer greater than or equal to 3;

[0571] like Fig.16 As shown, the device 1600 may include: a state quantity acquisition module 1610 , a state quantity processing module, a sliding surface establishment module 1630 , an instruction determination module 1640 and a joint control module 1650 .

[0572] The state quantity acquisition module 1610 is used to obtain the actual state quantity of the wheel-legged robot at the first moment, and the actual state quantity is used to characterize the motion state of n-1 connecting rods, the at least two leg mechanisms and the at least two moving wheels. The n-1 connecting rods are the other connecting rods among the n connecting rods except the first connecting rod.

[0573] The state quantity processing module 1620 is used to process the actual state quantity at the first moment to obtain the equivalent state quantity at the first moment, and the equivalent state quantity is used to characterize the motion state of the n connecting rods and the wheels.

[0574] The sliding surface establishing module 1630 is used to establish a sliding surface according to the equivalent state quantity at the first moment, and the equivalent state quantity gradually tends to 0 on the sliding surface.

[0575] The instruction determination module 1640 is used to determine the force and torque instructions about the whole body joints of the wheel-legged robot according to the sliding surface, the equivalent state quantity at the first moment and the dynamic equation of the wheel-legged robot, the whole body joints including the n rotational joints, and the dynamic equation is established based on the n-th order inverted pendulum model.

[0576] The joint control module 1650 is used to control the n rotational joints according to the force and torque instructions of the whole body joints at the second moment.

[0577] In some embodiments, the equivalent state quantity includes: the deflection velocity of the n connecting rods, the angular velocity of the n connecting rods and the angular velocity of the wheel; the state quantity processing module 1620 is used to superimpose the angular velocities of the at least two moving wheels in the actual state quantity to obtain the angular velocity of the wheel; determine the geometric relationship between the at least two leg mechanisms according to the lengths and deflection angles of the at least two leg mechanisms; determine the deflection angle of the first connecting rod and the angular velocity of the first connecting rod according to the geometric relationship, the deflection angle of the at least two leg mechanisms and the angular velocity of the at least two leg mechanisms; use the deflection angle of the n-1 connecting rods in the actual state quantity as the deflection angle of the n-1 connecting rods in the equivalent state quantity; use the angular velocity of the n-1 connecting rods in the actual state quantity as the angular velocity of the n-1 connecting rods in the equivalent state quantity.

[0578] In some embodiments, the instruction determination module 1640 includes: a torque determination unit, used to calculate the rotational torque at the second moment based on the dynamic equation and the sliding surface, the rotational torque at the second moment including: the rotational torque of the n rotational joints; an instruction calculation unit, used to calculate the force and torque instructions of the joints of the whole body based on the rotational torque at the second moment.

[0579] In some embodiments, the torque determination unit includes: a first speed subunit, used to determine the angular acceleration of the wheel-legged robot at the second moment based on the dynamic equation and the rotational torque at the second moment, the angular acceleration at the second moment including the angular acceleration of the n connecting rods at the second moment; a second speed subunit, used to determine the task acceleration of the wheel-legged robot at the second moment based on the angular acceleration at the second moment, the task acceleration is related to the acceleration of the center of mass of the wheel-legged robot; an instruction calculation subunit, used to calculate the force and torque instructions of the joints of the whole body based on the task acceleration.

[0580] In some embodiments, the second speed subunit is used to determine the expected incremental position and expected incremental speed of the center of mass of the wheel-legged robot at the second moment based on the equivalent state quantity at the first moment and the angular acceleration at the second moment, the expected incremental position is used to characterize the distance between the projection of the center of mass of the wheel-legged robot on the contact surface and the virtual contact point in the first direction, the expected incremental speed is used to characterize the changing speed of the distance in the first direction, and the virtual contact point refers to the center of each contact point of the wheel-legged robot with the contact surface; based on the expected incremental position and the expected incremental speed, the task acceleration of the wheel-legged robot at the second moment is determined.

[0581] In some embodiments, the torque determination unit includes: a parameter determination subunit, used to determine the dynamic model parameters according to the dynamic equation of the wheel-legged robot and the equivalent state quantity at the first moment, and the dynamic model parameters are used to define the mapping relationship between the angular acceleration at the first moment and the torque at the second moment; the angular acceleration at the first moment includes the angular acceleration of the n connecting rods; a torque determination subunit, used to calculate the torque at the second moment according to the dynamic parameters and the sliding surface.

[0582] In some embodiments, the parameter determination subunit is used to: substitute the equivalent state quantity at the first moment into the dynamic equation to determine the inertia matrix, deflection force matrix and gravity matrix at the first moment, the inertia matrix is ​​used to characterize the mass and moment of inertia of the n rotating joints at the first moment, the deflection force matrix is ​​used to characterize the deflection force of the wheel-legged robot at the first moment, and the gravity matrix is ​​used to characterize the gravity of the wheel-legged robot at the first moment; determine the dynamic model parameters based on the inertia matrix, the deflection force matrix and the gravity matrix.

[0583] In some embodiments, the dynamic model parameters include: a proportional parameter matrix and an offset parameter matrix, the proportional parameter matrix is ​​used to characterize the proportional relationship between the angular acceleration at the first moment and the turning torque at the second moment, and the offset parameter matrix is ​​used to characterize the offset relationship between the angular acceleration at the first moment and the turning torque at the second moment; the parameter determination subunit is used to use a selection matrix to process the product of the inverse matrix of the inertia matrix and the deflection force matrix, and the product of the inverse matrix of the inertia matrix and the gravity matrix, respectively, to obtain the offset parameter matrix, and the selection matrix is ​​used to extract the turning torque of the n rotating joints from the dynamic equation; the inverse matrix of the inertia matrix is ​​processed using the selection matrix to obtain the proportional parameter matrix.

[0584] In some embodiments, the sliding surface establishing module 1630 includes: a sliding mode determination unit, used to determine at least two sliding mode parameters for the i-th sliding mode surface among the n sliding modes, where i is a positive integer less than or equal to n; and a sliding mode establishment unit, used to establish the i-th sliding mode surface based on the at least two sliding mode parameters and the equivalent state quantity at the first moment.

[0585] In some embodiments, the sliding mode determination unit is used to determine a first sliding mode parameter among the at least two sliding mode parameters from a 2i-1th prediction parameter set, and to determine a second sliding mode parameter among the at least two sliding mode parameters from a 2i-th prediction parameter set; wherein the sliding mode parameters respectively included in the 2i-1th prediction parameter set and the 2i-th prediction parameter set satisfy the constraints of the stability criterion.

[0586] In some embodiments, the equivalent state quantity includes: the deflection angle of the n connecting rods, the angular velocity of the n connecting rods and the angular velocity of the wheel; the sliding mode establishment unit is used to process the deflection angle of the i-th connecting rod according to the first sliding mode parameter of the at least two sliding mode parameters to obtain the processing result of the i-th connecting rod; process the angular velocity of the wheel according to the second sliding mode parameter of the at least two sliding mode parameters to obtain the processing result of the wheel; establish the i-th sliding mode surface according to the processed processing result of the i-th connecting rod, the processing result of the wheel and the angular velocity of the i-th connecting rod.

[0587] In some embodiments, the device 1600 also includes: a motor control unit, which is used to: control the linear motors in the at least two leg mechanisms to move according to the force and torque instructions of the whole body joints, and the linear motors in the leg mechanisms control the length of the leg mechanisms.

[0588] In some embodiments, it is characterized in that the virtual contact point of the wheel on the contact surface is between the contact points of the at least two moving wheels on the contact surface.

[0589] It should be noted that the device provided in the above embodiment, when implementing its functions, is only illustrated by the division of the above functional modules. In actual applications, the above functions can be assigned to different functional modules as needed, that is, the content structure of the device is divided into different functional modules to complete all or part of the functions described above. In addition, the device and method embodiments provided in the above embodiment belong to the same concept, and the specific implementation process is detailed in the method embodiment, which will not be repeated here.

[0590] Please refer to Fig.16, which shows a block diagram of a computer device 1600 provided in one embodiment of the present application. The computer device 1600 may be any electronic device with data calculation, processing and storage functions. The computer device 1600 may be used to implement the balance control method of the wheel-legged robot provided in the above embodiment.

[0591] Typically, the computer device 1600 includes a processor 1601 and a memory 1602 .

[0592] Processor 1601 may include one or more processing cores, such as a 4-core processor, an 8-core processor, and the like. Processor 1601 may be implemented in at least one hardware form of DSP (Digital Signal Processing), FPGA (Field Programmable Gate Array), and PLA (Programmable Logic Array). Processor 1601 may also include a main processor and a coprocessor. The main processor is a processor for processing data in an awake state, also known as a CPU (Central Processing Unit); the coprocessor is a low-power processor for processing data in a standby state. In some embodiments, processor 1601 may be integrated with a GPU (Graphics Processing Unit), which is responsible for rendering and drawing the content to be displayed on the display screen. In some embodiments, processor 1601 may also include an AI processor for processing computing operations related to machine learning.

[0593] The memory 1602 may include one or more computer-readable storage media, which may be non-transitory. The memory 1602 may also include a high-speed random access memory and a non-volatile memory, such as one or more disk storage devices and flash memory storage devices. In some embodiments, the non-transitory computer-readable storage medium in the memory 1602 is used to store a computer program, which is configured to be executed by one or more processors to implement the above-mentioned balance control method of the wheel-legged robot.

[0594] Those skilled in the art will understand that Fig.16 The structure shown in the figure does not constitute a limitation on the computer device 1600, and the computer device 1600 may include more or less components than shown in the figure, or combine some components, or adopt a different arrangement of components.

[0595] In an exemplary embodiment, a computer-readable storage medium is also provided, wherein a computer program is stored in the storage medium, and when the computer program is executed by a processor of a computer device, the balance control method of the wheel-legged robot is implemented. Optionally, the computer-readable storage medium may be a ROM (Read-Only Memory), a RAM (Random Access Memory), a CD-ROM (Compact Disc Read-Only Memory), a magnetic tape, a floppy disk, an optical data storage device, etc.

[0596] In an exemplary embodiment, a computer program product is also provided, the computer program product comprising a computer program, the computer program being stored in a computer-readable storage medium. A processor of a computer device reads the computer program from the computer-readable storage medium, and the processor executes the computer program, so that the computer device executes the above-mentioned balance control method of a wheel-legged robot.

[0597] It should be understood that the "multiple" mentioned in this article refers to two or more. "And / or" describes the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B can represent: A exists alone, A and B exist at the same time, and B exists alone. The character " / " generally indicates that the objects associated before and after are in an "or" relationship. In addition, the step numbers described in this article only illustrate a possible execution sequence between the steps. In some other embodiments, the above steps may not be executed in the order of the numbers, such as two steps with different numbers are executed at the same time, or two steps with different numbers are executed in the opposite order to the diagram. The embodiments of the present application are not limited to this.

[0598] The above description is only an exemplary embodiment of the present application and is not intended to limit the present application. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present application shall be included in the protection scope of the present application.

Claims

1. A balance control method for a wheel-legged robot, characterized in that: The wheel-legged robot is simplified to an n-order inverted pendulum model, which includes: wheels, n connecting rods and n revolute joints, wherein the wheels and the first connecting rod of the n connecting rods are connected through the first revolute joint of the n revolute joints, and the n connecting rods are connected in series through n-1 revolute joints other than the first revolute joint, wherein the first connecting rod is an equivalent connecting rod corresponding to at least two leg mechanisms of the wheel-legged robot, and the wheels are equivalent moving wheels corresponding to the moving wheels respectively connected to the at least two leg mechanisms, and n is a positive integer greater than or equal to 2; the method includes: Acquire an actual state quantity of the wheel-legged robot at a first moment, wherein the actual state quantity is used to characterize the motion state of n-1 connecting rods, the at least two leg mechanisms and the at least two moving wheels, wherein the n-1 connecting rods are other connecting rods among the n connecting rods except the first connecting rod; Processing the actual state quantity at the first moment to obtain an equivalent state quantity at the first moment, wherein the equivalent state quantity is used to characterize the motion state of the n connecting rods and the wheel; According to the equivalent state quantity at the first moment, a sliding surface is established, wherein the equivalent state quantity gradually tends to 0 on the sliding surface; Determine force and torque instructions for whole-body joints of the wheel-legged robot according to the sliding surface, the equivalent state quantity at the first moment and the dynamic equation of the wheel-legged robot, wherein the whole-body joints include the n revolute joints, and the dynamic equation is established based on the n-th order inverted pendulum model; At the second moment, the n-1 rotational joints and the real rotational joint corresponding to the first rotational joint are controlled according to the force and torque instructions of the whole body joints.

2. The method according to claim 1, characterized in that The equivalent state quantities include: the deflection angles of the n connecting rods, the angular velocities of the n connecting rods and the angular velocities of the wheels; The processing of the actual state quantity at the first moment to obtain the equivalent state quantity at the first moment includes: Superimposing the angular velocities of the at least two moving wheels in the actual state quantity to obtain the angular velocity of the wheel; Determining a geometric relationship between the at least two leg mechanisms according to the lengths and deflection angles of the at least two leg mechanisms; Determining a deflection angle of the first connecting rod and an angular velocity of the first connecting rod according to the geometric relationship, the deflection angles of the at least two leg mechanisms, and the angular velocity of the at least two leg mechanisms; Using the deflection angles of the n-1 connecting rods in the actual state quantity as the deflection angles of the n-1 connecting rods in the equivalent state quantity; The angular velocities of the n-1 connecting rods in the actual state quantity are used as the angular velocities of the n-1 connecting rods in the equivalent state quantity.

3. The method according to claim 1, characterized in that: The step of determining force and torque instructions for whole body joints of the wheel-legged robot according to the sliding surface, the equivalent state quantity at the first moment and the dynamic equation of the wheel-legged robot comprises: Calculating the rotational torque at the second moment according to the dynamic equation and the sliding surface, wherein the rotational torque at the second moment includes: the rotational torque of the n rotational joints; The force and torque instructions of the joints of the whole body are calculated according to the rotational torque at the second moment.

4. The method according to claim 3, characterized in that The step of calculating the force and torque instructions of the joints of the whole body according to the rotational torque at the second moment comprises: Determine the angular acceleration of the wheel-legged robot at the second moment according to the dynamic equation and the rotational torque at the second moment, wherein the angular acceleration at the second moment includes the angular accelerations of the n connecting rods at the second moment; Determine, according to the angular acceleration at the second moment, a task acceleration of the wheel-legged robot at the second moment, wherein the task acceleration is related to the acceleration of the center of mass of the wheel-legged robot; The force and torque instructions of the joints of the whole body are calculated according to the task acceleration.

5. The method according to claim 4, characterized in that Determining the task acceleration of the wheel-legged robot at the second moment according to the angular acceleration at the second moment includes: Determine the expected incremental position and expected incremental speed of the center of mass of the wheel-legged robot at the second moment according to the equivalent state quantity at the first moment and the angular acceleration at the second moment, wherein the expected incremental position is used to characterize the distance in the first direction between the projection of the center of mass of the wheel-legged robot on the contact surface and the virtual contact point, and the expected incremental speed is used to characterize the speed of change of the distance in the first direction, and the virtual contact point refers to the center of each contact point between the wheel-legged robot and the contact surface; The task acceleration of the wheel-legged robot at the second moment is determined according to the expected incremental position and the expected incremental speed.

6. The method according to claim 3, characterized in that The calculating the rotational torque at the second moment according to the dynamic equation and the sliding surface includes: According to the dynamic equation of the wheel-legged robot and the equivalent state quantity at the first moment, determining the dynamic model parameters, the dynamic model parameters are used to define the mapping relationship between the angular acceleration at the first moment and the rotational torque at the second moment; the angular acceleration at the first moment includes the angular acceleration of the n connecting rods; The rotational torque at the second moment is calculated according to the dynamic parameters and the sliding surface.

7. The method according to claim 6, characterized in that Determining the dynamic model parameters according to the dynamic equation of the wheel-legged robot and the equivalent state quantity at the first moment includes: Substituting the equivalent state quantity at the first moment into the dynamic equation, determining the inertia matrix, deflection force matrix and gravity matrix at the first moment, wherein the inertia matrix is ​​used to characterize the mass and moment of inertia of the n revolute joints at the first moment, the deflection force matrix is ​​used to characterize the deflection force of the wheel-legged robot at the first moment, and the gravity matrix is ​​used to characterize the gravity of the wheel-legged robot at the first moment; The dynamic model parameters are determined according to the inertia matrix, the deflection force matrix and the gravity matrix.

8. The method according to claim 7, characterized in that The dynamic model parameters include: a proportional parameter matrix and an offset parameter matrix, wherein the proportional parameter matrix is ​​used to characterize the proportional relationship between the angular acceleration at the first moment and the rotational torque at the second moment, and the offset parameter matrix is ​​used to characterize the offset relationship between the angular acceleration at the first moment and the rotational torque at the second moment; Determining the dynamic model parameters according to the inertia matrix, the deflection force matrix and the gravity matrix includes: Using a selection matrix to process the product of the inverse matrix of the inertia matrix and the deflection force matrix, and the product of the inverse matrix of the inertia matrix and the gravity matrix, respectively, to obtain the offset parameter matrix, wherein the selection matrix is ​​used to extract the rotational torque of the n revolute joints from the dynamic equation; The inverse matrix of the inertia matrix is ​​processed using the selection matrix to obtain the scale parameter matrix.

9. The method according to claim 1, characterized in that: The sliding surface includes n sliding surfaces, and the n sliding surfaces are used to constrain the rotational torque of the n revolute joints; The step of establishing a sliding surface according to the equivalent state quantity at the first moment includes: For an i-th sliding surface among the n sliding surfaces, determining at least two sliding parameters, where i is a positive integer less than or equal to n; The i-th sliding mode surface is established according to the at least two sliding mode parameters and the equivalent state quantity at the first moment.

10. The method according to claim 9, characterized in that The step of determining at least two sliding mode parameters for the i-th sliding mode surface among the n sliding mode surfaces comprises: Determining a first sliding mode parameter among the at least two sliding mode parameters from a 2i-1th prediction parameter set, and determining a second sliding mode parameter among the at least two sliding mode parameters from a 2ith prediction parameter set; The sliding mode parameters respectively included in the 2i-1th prediction parameter set and the 2ith prediction parameter set satisfy the constraint conditions of the stability criterion.

11. The method according to claim 9, characterized in that The equivalent state quantities include: the deflection angles of the n connecting rods, the angular velocities of the n connecting rods and the angular velocities of the wheels; The establishing the i-th sliding mode surface according to the at least two sliding mode parameters and the equivalent state quantity at the first moment comprises: Processing the deflection angle of the i-th connecting rod according to the first sliding mode parameter of the at least two sliding mode parameters to obtain a processing result of the i-th connecting rod; Processing the angular velocity of the wheel according to a second sliding mode parameter of the at least two sliding mode parameters to obtain a processing result of the wheel; The i-th sliding surface is established according to the processing result of the i-th connecting rod, the processing result of the wheel and the angular velocity of the i-th connecting rod.

12. The method according to claim 1, characterized in that The method further comprises: The linear motors in the at least two leg mechanisms are controlled to move according to the force and torque instructions of the whole body joints, and the linear motors in the leg mechanisms control the lengths of the leg mechanisms.

13. The method according to any one of claims 1 to 12, characterized in that: The virtual contact point of the wheel on the contact surface is between the contact points of the at least two moving wheels on the contact surface.

14. A balance control device for a wheel-legged robot, characterized in that: The wheel-legged robot is simplified to an n-order inverted pendulum model, which includes: wheels, n connecting rods and n revolute joints, wherein the wheels and the first connecting rod of the n connecting rods are connected through the first revolute joint of the n revolute joints, and the n connecting rods are connected in series through n-1 revolute joints other than the first revolute joint, wherein the first connecting rod is an equivalent connecting rod corresponding to at least two leg mechanisms of the wheel-legged robot, and the wheels are equivalent moving wheels corresponding to the moving wheels respectively connected to the at least two leg mechanisms, and n is a positive integer greater than or equal to 2; the method includes: a state quantity acquisition module, used for acquiring the actual state quantity of the wheel-legged robot at a first moment, wherein the actual state quantity is used for characterizing the motion state of n-1 connecting rods, the at least two leg mechanisms and the at least two moving wheels, wherein the n-1 connecting rods are the other connecting rods among the n connecting rods except the first connecting rod; a state quantity processing module, used for processing the actual state quantity at the first moment to obtain an equivalent state quantity at the first moment, wherein the equivalent state quantity is used for characterizing the motion state of the n connecting rods and the wheel; A sliding surface establishing module, used for establishing a sliding surface according to the equivalent state quantity at the first moment, wherein the equivalent state quantity gradually tends to 0 on the sliding surface; an instruction determination module, for determining force and torque instructions about whole-body joints of the wheel-legged robot according to the sliding surface, the equivalent state quantity at the first moment and the dynamic equation of the wheel-legged robot, wherein the whole-body joints include the n revolute joints, and the dynamic equation is established based on the n-th order inverted pendulum model; The joint control module is used to control the n rotational joints according to the force and torque instructions of the whole body joints at a second moment.

15. A computer device, characterized in that: The computer device includes a processor and a memory, wherein a computer program is stored in the memory, and the computer program is loaded and executed by the processor to implement the balance control method of the wheel-legged robot as described in any one of claims 1 to 13.

16. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, which is loaded and executed by a processor to implement the balance control method of the wheel-legged robot as described in any one of claims 1 to 13.

17. A computer program product, characterized in that The computer program product comprises a computer program, which is loaded and executed by a processor to implement the balance control method of the wheel-legged robot according to any one of claims 1 to 13.

Citation Information

Patent Citations

  • Method for controlling somersault motion of robot and robot

    CN113753146A

  • Control method, device and equipment of wheel-legged robot and readable storage medium

    CN113753150A

  • Passive wheel type quadruped robot roller skating gait control method

    CN113934208A

  • Two-dimensional stable movement control method for multi-degree-of-freedom wheeled inverted pendulum type robot

    CN115291514A

  • Robot balance control method and device, readable storage medium and robot

    CN115903874A

Cited By

  • Waist and hip integration mechanism and humanoid robot

    CN119458416A

  • PID (Proportion Integration Differentiation) control and gait planning method of wheel-foot composite structure and electronic equipment

    CN120779708A

  • Balance control method and apparatus for wheel-legged robot, device, and storage medium

    EP4650887A1