Method and device for controlling jumping and somersaulting actions of double-wheel foot type robot
By constructing a dynamic model and optimizing trajectory, combined with controller design, the problems of balance and trajectory tracking in jumping and flips of the two-wheeled foot robot are solved, efficient jump control is achieved, and the motion performance and applicability of the robot are improved.
Patent Information
- Application Number
- CN202411234115.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-04
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2044-09-04
AI Technical Summary
The jumping and flip action control of the two-wheeled foot robot is difficult to achieve balance and trajectory tracking in complex environments, and the existing technology has failed to effectively solve the comprehensive optimization problem of dynamics and moment constraints.
By constructing a dynamic model of a two-wheeled foot robot, determining critical state variables, optimizing the trajectory of the takeoff and flight stages, the controller is designed to track the trajectory to ensure balance and attitude adjustment.
It realizes robust balance control and accurate trajectory tracking of the two-wheeled foot robot in jumping and flip action, improving motion performance and applicability, and is suitable for task execution in complex environments.
Smart Images

Figure CN119036451A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of machine control, and in particular to a method and device for controlling a jumping and somersaulting action of a two-wheeled and footed robot. Background Art
[0002] The wheeled-legged robot (WBR) is a robot with great movement potential. It combines the efficient movement ability of wheeled robots on flat terrain and the excellent obstacle-crossing ability of legged-legged robots on rugged terrain. Therefore, it has broad application prospects in modern trade logistics, community services, reconnaissance and rescue, etc. At present, jumping actions are very common in various application scenarios of robots. It can help robots overcome obstacles and improve travel efficiency. At the same time, complex jumping actions also bring new challenges to the planning and control of robot actions. Summary of the invention
[0003] In view of the above technical problems, the technical solution adopted by the present invention is: According to a first aspect of the present invention, a method for controlling a jumping and somersaulting action of a two-wheeled legged robot is provided, the method comprising the following steps: S100, simplifying the two-wheeled legged robot into a structure including a base, legs and wheels as a target structure, and constructing a dynamic model of the target structure in a standing phase and a dynamic model of the target structure in a flying phase, respectively, to describe the basic physical characteristics of the two-wheeled legged robot.
[0004] S200, determining critical state variables corresponding to the target structure at the moment of lifting off the ground and the moment of landing according to the target jumping height and the target jumping distance, and using them as the first setting state variable and the second setting state variable, respectively.
[0005] S300, determining the optimization problem of the target structure in the take-off phase as the first optimization problem based on dynamic constraints, torque constraints, joint restrictions, the dynamic model in the standing phase and the first set state variables, and determining the optimization problem of the target structure in the flight phase as the second optimization problem based on dynamic constraints, torque constraints, joint restrictions, the dynamic model in the flight phase and the second set state variables.
[0006] S400, solving the first optimization problem and the second optimization problem respectively to obtain corresponding first expected trajectory and second expected trajectory.
[0007] S500, in the take-off phase, based on the first desired trajectory, the trajectory of the two-wheeled legged robot is tracked by using the first controller, and in the jumping phase, based on the second desired trajectory, the trajectory of the two-wheeled legged robot is tracked by using the second controller, so that the two-wheeled legged robot completes a jumping and somersault action.
[0008] According to a second aspect of the present invention, there is provided a device for controlling a jumping and somersaulting action of a two-wheeled legged robot, the device comprising: The dynamic model building module is used to simplify the two-wheeled legged robot into a structure including a base, legs and wheels as a target structure, and to respectively build a dynamic model of the target structure in a standing phase and a dynamic model of the target structure in a flying phase to describe the basic physical characteristics of the two-wheeled legged robot.
[0009] The critical state determination module is used to determine the critical state variables corresponding to the target structure at the moment of lifting off the ground and the moment of landing according to the target jumping height and the target jumping distance, and use them as the first setting state variable and the second setting state variable respectively.
[0010] The expected trajectory acquisition module is used to determine the optimization problem of the target structure in the take-off stage according to the dynamic constraints, torque constraints, joint restrictions, the dynamic model in the standing stage and the first set state variables, as the first optimization problem, and to determine the optimization problem of the target structure in the flight stage according to the dynamic constraints, torque constraints, joint restrictions, the dynamic model in the flight stage and the second set state variables, as the second optimization problem, and to solve the first optimization problem and the second optimization problem respectively to obtain the corresponding first expected trajectory and second expected trajectory.
[0011] The control module is used to track the trajectory of the two-wheeled legged robot using a first controller based on a first expected trajectory during a take-off phase, and to track the trajectory of the two-wheeled legged robot using a second controller based on a second expected trajectory during a jumping phase, so that the two-wheeled legged robot can complete a jumping and somersault action.
[0012] The present invention has at least the following beneficial effects: The jumping and somersaulting control method and device of the two-wheeled legged robot provided by the embodiment of the present invention comprehensively considers the system dynamics, joint restrictions and torque constraints in trajectory planning to ensure the rationality and feasibility of the planned trajectory; at the same time, an efficient controller is designed to ensure robust balance control and accurate trajectory tracking in the take-off phase, smooth attitude adjustment in the flight phase, and stable landing in the recovery phase. In addition, the scheme is based on a generalized WBR model and has good applicability and scalability.
[0013] It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS
[0014] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0015] Figure 1 A flow chart of a method for controlling a jumping and somersaulting action of a two-wheeled legged robot provided by an embodiment of the present invention; Figure 2 A simplified structural diagram of a two-wheeled legged robot provided in an embodiment of the present invention; Figure 3 A schematic diagram of a two-wheeled legged robot performing a somersault provided in an embodiment of the present invention. DETAILED DESCRIPTION
[0016] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of the present invention.
[0017] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art of the present invention. The terms used herein in the specification of the present invention are only for the purpose of describing specific embodiments and are not intended to limit the present invention. The term "and / or" used herein includes any and all combinations of one or more related listed items.
[0018] It should be noted that some exemplary embodiments are described as processes or methods depicted as flow charts. Although the flow charts describe the steps as sequential processes, many of the steps can be implemented in parallel, concurrently or simultaneously. In addition, the order of the steps can be rearranged. The process can be terminated when its operation is completed, but it can also have additional steps not included in the accompanying drawings. The process can correspond to a method, function, procedure, subroutine, subprogram, etc.
[0019] The embodiment of the present invention provides a method for controlling a jumping and somersaulting action of a two-wheeled legged robot. Figure 1 As shown, the method comprises the following steps: S100, simplifying the two-wheeled legged robot into a structure including a base, legs and wheels as a target structure, and constructing a dynamic model of the target structure in a standing phase and a dynamic model of the target structure in a flying phase, respectively, to describe the basic physical characteristics of the two-wheeled legged robot.
[0020] In an embodiment of the present invention, the structure of a two-wheeled legged robot (hereinafter also referred to as WBR) may be an existing structure, for example, including a base, two hip joints, left and right legs, and onboard hardware devices, wherein each hip joint is provided with three joint motors, one motor for controlling the leg to swing forward and backward, one motor for controlling the leg to swing left and right, and one motor for controlling the angle of the knee joint. A hub motor and a wheel are installed at the foot end of each leg, and the hub motor is used to control the movement of the wheel. The onboard hardware devices may include an IMU and an onboard computing unit, etc.
[0021] In the embodiment of the present invention, Figure 2 As shown, the two-wheeled legged robot can be simplified into a structure including a base 1, legs 2 and wheels 3, wherein the legs 2 are virtual legs and can be formed by a line connecting the center of the base 1 and the center of the wheels 3.
[0022] In the embodiment of the present invention, the Lagrangian method is used to establish the dynamic model of WBR in different stages of the whole action. Specifically, the dynamic model in the standing stage satisfies the following conditions: M s q 2 +C s q 1 +G s =u Wherein, q is the state variable of the target structure, q 1 is the first-order derivative of q, q 2 is the second-order derivative of q, q=(θ w , L, θ p ,θ h ), θ w is the rotation angle of the wheels of the target structure, L is the leg length of the target structure, θ h is the angle of the hip joint, that is, the angle between the straight line where the leg is and the hip joint, θ p is the angle between the straight line where the legs are and the vertical direction, M s is the inertia matrix of the stance phase, , J w is the moment of inertia of the wheels of the two-wheeled legged robot, m w is the mass of the wheel of the target structure, R w is the radius of the wheel of the target structure, m b is the mass of the base of the target structure, J b is the moment of inertia of the base of the target structure; C s is the Coriolis force matrix during the stance phase, ,θ 1 p is θ p The first derivative of L1 is the first derivative of L, G s is the gravity vector in the stance phase, , g is the gravitational acceleration, u is the control input variable of the target structure, , τ w is the wheel torque of the target structure, τ h is the moment of the hip joint of the target structure, F L It is the generalized force on the leg of the target structure, which can be calculated using the principle of virtual work according to the angle of the knee joint or the leg length and the torque of the motor controlling the knee joint.
[0023] Furthermore, the dynamic model in the flight phase satisfies the following conditions: M f q 2 +C f q 1 +G f =u Among them, M f is the inertia matrix of the flight phase, C f is the Coriolis matrix of the flight phase, G f is the gravity vector during the flight phase, , m 0 is the intermediate variable, m 0 = (1-m b / (m w +m b ) 2 ×m b + (m b / (m w +m b ) 2 ×m w ; , .
[0024] S200, determining critical state variables corresponding to the target structure at the moment of lifting off the ground and the moment of landing according to the target jumping height and the target jumping distance, and using them as the first setting state variable and the second setting state variable, respectively.
[0025] In the embodiment of the present invention, with reference to the jumping and somersaulting action of a human, the jumping process of the robot is divided into stages, namely, the jump preparation stage, the flight stage and the landing recovery stage, wherein the critical state between the jump preparation stage and the flight stage is the moment of liftoff, and the critical state between the flight stage and the landing recovery stage is the moment of landing. The user first selects a set of expected jumping height and jumping distance, and then calculates the expected critical state variables during the action according to the corresponding height and distance.
[0026] In the embodiment of the present invention, the critical state variables may include (L, L 1 , L 2 ,θ w ,θ w 1 ,θ w 2 ,θ p ,θ p 1 ,θ p 2 ,θ h ,θ h 1 ,θ h 2 ), where L is the leg length of the target structure, L 1 is the first derivative of L, L 2 is the second-order derivative of L, θ w is the rotation angle of the wheels of the target structure, θ w 1 is θ w The first derivative of θ w 2 is θ w The second derivative, θ p is the angle between the straight line where the legs of the target structure are located and the vertical direction, θ p 1 is θ p The first derivative of θ p 2 is θ p The second derivative, θ h is the angle of the hip joint of the two-wheeled legged robot, θ h 1 is θ h The first derivative of θ h 2 is θ h The second derivative of .
[0027] In the embodiment of the present invention, the first derivative of L represents the speed of leg length change, and the second derivative of L represents the acceleration of leg length change. w The first derivative of represents the angular velocity of the wheel, θ w The second derivative of represents the angular acceleration of the wheel, θ h The first derivative of represents the angular velocity of the hip joint, θ h The second derivative of represents the angular acceleration of the hip joint, θ p The first-order derivative of represents the angular velocity of the two-wheeled legged robot relative to the world coordinate system, θ p The second derivative of represents the angular acceleration of the two-wheeled legged robot relative to the world coordinate system.
[0028] Among them, the critical state variables at the moment of leaving the ground can be obtained through the following steps: S1, according to the target jumping height, the flight time of the center of mass of the two-wheeled legged robot flying in the air is calculated using the oblique projectile motion law.
[0029] In the embodiment of the present invention, the flight time t=2×(2×H / g) 1 / 2 , H is the target jumping height.
[0030] S2, calculating the horizontal take-off speed required for the two-wheeled legged robot at the moment of leaving the ground according to the flight time and the target jumping distance, and determining the vertical take-off speed required at the moment of leaving the ground according to the target jumping height.
[0031] Those skilled in the art are aware that any method for calculating the horizontal take-off speed required for a two-wheeled legged robot at the moment of leaving the ground based on the flight time and the target jumping distance, and any method for determining the vertical take-off speed required at the moment of leaving the ground based on the target jumping height, falls within the scope of protection of the present invention.
[0032] S3, determining the first-order derivative of L and the first-order derivative of θw at the moment of leaving the ground according to the horizontal take-off speed and the vertical take-off speed.
[0033] Those skilled in the art know that any method for determining the first-order derivative of L and the first-order derivative of θw at the moment of liftoff based on the horizontal takeoff speed and the vertical takeoff speed falls within the protection scope of the present invention.
[0034] θw, L, θp, and θh corresponding to the moment of liftoff can be set based on actual needs and can be empirical values. Among them, in the state variables corresponding to the moment of liftoff, except for the second-order derivative of leg length, the second-order derivatives of θw, θp, and θh are all set to 0 for more stable considerations. The second-order derivative of L can be obtained based on the mechanical analysis of the moment of liftoff.
[0035] In an embodiment of the present invention, θw in the state corresponding to the landing moment can be determined based on the conservation of angular momentum in the air. L corresponding to the landing moment can be set to a value close to the maximum leg length, for example, 90% of the maximum leg length, θh corresponding to the landing moment can be set to 0, and θw corresponding to the landing moment can be set to 0.
[0036] In the embodiment of the present invention, the somersault action of the two-wheeled legged robot can be described as the θp of the system in the air increasing by one circle, and the θp corresponding to the landing moment can be set to be equal to 2π, or set to satisfy (2π-θ p )≤△θ, △θ is the preset angle difference. △θ can be set to a number infinitely close to 0.
[0037] The first-order derivative of L corresponding to the moment of landing can be set to a negative number close to 0, the first-order derivatives of θw, θp and θh corresponding to the moment of landing can be set to 0, and the second-order derivatives of L, θw, θp and θh corresponding to the moment of landing can be set to 0.
[0038] S300, determining the optimization problem of the target structure in the take-off phase as the first optimization problem according to the dynamic constraints, torque constraints, joint restrictions, the dynamic model in the standing phase and the state corresponding to the moment of lifting off the ground, and determining the optimization problem of the target structure in the flight phase as the second optimization problem according to the dynamic constraints, torque constraints, joint restrictions, the dynamic model in the flight phase and the state corresponding to the moment of landing.
[0039] In the embodiment of the present invention, the trajectory planning problem of the robot jumping can be regarded as a nonlinear optimization problem, which comprehensively considers the torque constraints, joint restrictions, dynamic models and critical state variables of the system.
[0040] Specifically, in the embodiment of the present invention, the first optimization problem satisfies the following conditions:
[0041] The constraints include: (1) M s q 2 +C s q 1 +G s =u; (2) q belongs to Q, u belongs to N; (3) [q 1 (0), q(0)] = [q 1 0 ,q 0 ], that is, q 1 (0) = q 1 0 , q(0)=q.
[0042] Among them, q(T1) is the state variable of the take-off moment planned in the first optimization problem, q 1 (T1) is the first-order derivative of q(T1), q 2 (T1) is the second derivative of q(T1).
[0043] φ1 F () is the expected deviation in the first optimization problem, φ1 F (q 2 (T1),q 1 (T1),q(T1))=||q 2 (T1)-q 2 T1 || K1 +||q1 (T1)-q 1 T1 || K2 +||q(T1)-q T1 || K3 ,q T1 For the first setting of state variables, q 1 T1 for q T1 The first derivative of q 2 T1 for q T1 The second-order derivative of || || represents the norm, K1, K2 and K3 are the first weight, second weight and third weight respectively, and T1 is the time corresponding to the standing stage. That is, φ1 F () are the weighted sum of the deviations between state variables, the deviations between the first-order derivatives of state variables, and the deviations between the second-order derivatives of state variables, respectively.
[0044] Γ1(u) is the energy consumption corresponding to the standing phase, Γ1(u)=||τ w || K4 +||τ k || K5 +||τ h || K6 , τ k is the knee joint torque, K4, K5 and K6 are the fourth, fifth and sixth weights respectively.
[0045] Q is the constraint range of the state variable, and N is the constraint range of the control input variable, which can be set based on actual needs.
[0046] q(0) is the initial state variable planned in the first optimization problem, q 1 (0) is the first-order derivative of q(0), q 0 is the initial state in the desired trajectory of the stance phase, q 1 0 for q 0 The first derivative of t1. t1 is any moment in the stance phase, the value of t1 ranges from 0 to T1, and dt1 represents the integration of t1.
[0047] In the embodiment of the present invention, the values of the first to sixth weights can be set based on actual needs. Generally, the weights corresponding to the first-order derivative and the second-order derivative are greater than the weights of the corresponding state variables themselves. For example, L 1 and L 2 The corresponding weight is greater than the weight corresponding to L. Furthermore, the second optimization problem satisfies the following conditions: minφ2 F (q 2 (T2),q 1(T2),q(T2))+∫ T2 T1 Γ2(u)dt2 The constraints include: (1) M f q 2 +C f q 1 +G f =u; (2) q belongs to Q, u belongs to N; (3) [q 1 (T1),q(T1)]=[q 1 T1 ,q T1 ], that is, q 1 (T1) = q 1 T1 ,q(T1)=q T1 .
[0048] Among them, q(T2) is the state variable of the moment of liftoff planned in the second optimization problem, q 1 (T2) is the first-order derivative of q(T2), q 2 (T2) is the second derivative of q(T2).
[0049] φ2 F () is the expected deviation in the second optimization problem, φ2 F (q 2 (T2),q 1 (T2),q(T2))=||q 2 (T2)-q 2 T2 || K1 +||q 1 (T2)-q 1 T2 || K2 +||q(T2)-q T2 || K3 ,q T2 Set the state variable for the second, q 1 T2 for q T2 The first derivative of q 2 T2 for q T2 The second derivative of T2 is the time corresponding to the flight phase.
[0050] Γ2(u) is the energy consumption corresponding to the flight phase, Γ2(u)=||τ w || K4 +||τ k || K5 +||τ h ||K6 , τ k is the knee joint torque. q(T1) is the final state variable planned in the first optimization problem, q 1 (T1) is the first-order derivative of q(T1), t2 is any moment in the flight phase, the value of t2 is from T1 to T2, and dt2 represents the integration of t2.
[0051] In the embodiment of the present invention, the constraint (1) in the first optimization problem and the second optimization problem is a dynamic model constraint, the constraint (2) is a joint limit and a torque constraint, and the constraint (3) is an initial state constraint. The optimization problem to be optimized includes the deviation between the final state of the system and the expected state and the energy consumption in the process. The first optimization problem is to minimize the deviation between the planned state variables at the moment of liftoff and the set state variables at the moment of liftoff. The second optimization problem is to minimize the deviation between the planned state variables at the moment of landing and the set state variables at the moment of takeoff.
[0052] S400, solving the first optimization problem and the second optimization problem respectively to obtain corresponding first expected trajectory and second expected trajectory.
[0053] In an embodiment of the present invention, the CasADi solver is used to find the expected trajectory. The first expected trajectory is the expected trajectory corresponding to the standing stage, including the values of the state variables corresponding to each moment of the standing stage, and the second expected trajectory is the expected trajectory corresponding to the flight stage, including the values of the state variables corresponding to each moment of the flight stage.
[0054] S500, in the take-off phase, based on the first desired trajectory, the trajectory of the two-wheeled legged robot is tracked by using the first controller, and in the jumping phase, based on the second desired trajectory, the trajectory of the two-wheeled legged robot is tracked by using the second controller, so that the two-wheeled legged robot completes a jumping and somersault action.
[0055] In the embodiment of the present invention, the expected trajectory is the center of mass trajectory of the two-wheeled legged robot when performing work.
[0056] During the take-off phase, the controller is used to track the reference trajectory and maintain the system balance. By controlling the position and speed of the leg joints and wheels, the WBR is ensured to take off smoothly. In an embodiment of the present invention, the control algorithm can be a linear quadratic regulator, that is, the first controller is a linear quadratic regulator. The state space equation of the system corresponding to the robot is as follows: x 1 s =Ax s +Bu s ,y s =x s ; xs =[θ w , L, θ h ,θ p ,θ 1 w , L 1 ,θ 1 h ,θ 1 p ] Among them, x s represents the state variable of the system, u s represents the input of the system, y s represents the output of the system, A and B are based on x s The matrix obtained by the relationship between s 1 For x s The first derivative of represents the velocity corresponding to the state variable.
[0057] In the embodiment of the present invention, the target structure can be regarded as a system. The control law of the corresponding linear quadratic regulator can be obtained by solving the Riccati algebraic equation.
[0058] During the flight phase, the present invention uses an attitude adjustment controller based on wheel speed regulation, that is, the second controller is an attitude adjustment controller. The attitude of the WBR is adjusted by adjusting the wheel speed to ensure the stability of the aerial rotation process. The specific control algorithm is as follows: θ w 2 =K w (θ w 1 -θ w 1c )+K p1 (θ p -θ p c )+K p2 (θ p 1 -θ p 1c ); θ h 2 =K h1 (θ h -θ h c )+K h2 (θ h 1 -θ h 1c ); L 2 =K L1 (LL c)+K L2 (L 1 -L 1c ) Among them, K w is θ w The corresponding adjustable parameter, K p1 is θ p The corresponding adjustable parameter, K p2 is θ p 1 The corresponding adjustable parameter, K h1 is θ h The corresponding adjustable parameter, K h2 is θ h 1 The corresponding adjustable parameter, K L1 is the adjustable parameter corresponding to L, K L2 For L 1 The corresponding adjustable parameter. w 1 ,θ w 2 ,θ p ,θ p 1 ,θ h ,θ h 1 , L and L 1 is the value input into the attitude adjustment controller according to the second desired trajectory, θ w 1c ,θ w 2c ,θ p c ,θ p 1c ,θ h c ,θ h 1c , L c and L 1c It is the value measured by the sensor on the two-wheeled legged robot.
[0059] In the embodiment of the present invention, the operation of the two-wheeled legged robot in the landing recovery stage can be controlled according to the state variable corresponding to the landing moment, or can be set to a reasonable fixed value for control according to the actual situation, and the present invention does not make any special restrictions. The first controller is also used to track the trajectory in the landing recovery stage to maintain balance.
[0060] The method for controlling the jumping and somersaulting action of a two-wheeled legged robot provided by the embodiment of the present invention can be used as follows in an actual application scenario to control the two-wheeled legged robot to perform the somersaulting action. Figure 3 As shown. Figure 3 It can be seen that the robot can perform a somersault and land smoothly.
[0061] The jumping and somersault action control method of the two-wheeled legged robot provided by the embodiment of the present invention comprehensively considers the system dynamics, joint restrictions and torque constraints in trajectory planning to ensure the rationality and feasibility of the planned trajectory. By designing the state variables at the moment of lifting off the ground and the moment of landing, the dynamic balance during the jumping process is guaranteed. In addition, a linear quadratic regulator is used for trajectory tracking in the take-off stage, and a posture adjustment controller is used for trajectory tracking in the flight stage, which can maintain the robustness of the system in the face of external interference and internal uncertainty. Whether in the take-off stage or the flight and recovery stage, the controller can effectively track the trajectory and adjust the posture to ensure the smooth completion of the action. The present invention can not only improve the motion performance of the WBR, but also expand its application scenarios, so that it has the ability to perform tasks in more complex environments.
[0062] Based on the same inventive concept, an embodiment of the present invention further provides a jumping and somersaulting motion control device for a two-wheeled legged robot, the device comprising: The dynamic model building module is used to simplify the two-wheeled legged robot into a structure including a base, legs and wheels as a target structure, and to respectively build a dynamic model of the target structure in a standing phase and a dynamic model of the target structure in a flying phase to describe the basic physical characteristics of the two-wheeled legged robot.
[0063] The critical state determination module is used to determine the critical state variables corresponding to the target structure at the moment of lifting off the ground and the moment of landing according to the target jumping height and the target jumping distance, and use them as the first setting state variable and the second setting state variable respectively.
[0064] The expected trajectory acquisition module is used to determine the optimization problem of the target structure in the take-off stage as the first optimization problem according to the dynamic constraints, torque constraints, joint restrictions, the dynamic model in the standing stage and the first set state variables, and to determine the optimization problem of the target structure in the flight stage as the second optimization problem according to the dynamic constraints, torque constraints, joint restrictions, the dynamic model in the flight stage and the second set state variables, and to solve the first optimization problem and the second optimization problem respectively to obtain the corresponding first expected trajectory and second expected trajectory.
[0065] The control module is used to track the trajectory of the two-wheeled legged robot using a first controller based on a first expected trajectory during a take-off phase, and to track the trajectory of the two-wheeled legged robot using a second controller based on a second expected trajectory during a jumping phase, so that the two-wheeled legged robot can complete a jumping and somersault action.
[0066] The device can be used to perform Figure 1Therefore, for the functions that can be realized by each functional module of the device, please refer to Figure 1 The description of the illustrated embodiment is not repeated in detail.
[0067] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the present invention can be executed in parallel, sequentially or in different orders, as long as the desired results of the technical solution disclosed in the present invention can be achieved, and this document does not limit this.
[0068] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A method for controlling the jumping and somersaulting movements of a two-wheeled and footed robot. It is characterized in that The method comprises the following steps: S100, simplifying the two-wheeled legged robot into a structure including a base, legs and wheels as a target structure, and constructing a dynamic model of the target structure in a standing phase and a dynamic model of the target structure in a flying phase, respectively, to describe basic physical characteristics of the two-wheeled legged robot; S200, determining, according to a target jumping height and a target jumping distance, critical state variables corresponding to the target structure at the moment of lifting off the ground and the moment of landing, as first setting state variables and second setting state variables, respectively; S300, determining an optimization problem of the target structure in the take-off phase as the first optimization problem according to the dynamic constraints, the torque constraints, the joint restrictions, the dynamic model in the stance phase and the first set state variables, and determining an optimization problem of the target structure in the flight phase as the second optimization problem according to the dynamic constraints, the torque constraints, the joint restrictions, the dynamic model in the flight phase and the second set state variables; S400, solving the first optimization problem and the second optimization problem respectively to obtain corresponding first expected trajectory and second expected trajectory; S500, in the take-off phase, based on the first desired trajectory, the trajectory of the two-wheeled legged robot is tracked by using the first controller, and in the jumping phase, based on the second desired trajectory, the trajectory of the two-wheeled legged robot is tracked by using the second controller, so that the two-wheeled legged robot completes a jumping and somersault action.
2. The method according to claim 1, It is characterized in that The dynamic model in the stance phase satisfies the following conditions: M s q 2 +C s q 1 +G s =u Among them, q 1 is the first-order derivative of the state variable q of the target structure, q 2 is the second-order derivative of q, q=(θ w , L, θ p ,θ h ), θ w is the rotation angle of the wheel of the target structure, L is the leg length of the target structure, θ h The angle of the hip joint of the two-wheeled legged robot, θ p is the angle between the straight line where the legs of the target structure are located and the vertical direction, M s is the inertia matrix of the stance phase, , J w is the moment of inertia of the wheels of the two-wheeled legged robot, m w is the mass of the wheel of the target structure, R w is the radius of the wheel of the target structure, m b is the mass of the base of the target structure, J b is the moment of inertia of the base of the target structure; C s is the Coriolis force matrix during the stance phase, ,θ 1 p is θ p The first derivative of L 1 is the first derivative of L, G s is the gravity vector in the stance phase, , g is the gravitational acceleration, u is the control input variable of the target structure, , τ w is the wheel torque of the target structure, τ h is the moment of the hip joint of the target structure, F L is the generalized force on the legs of the target structure; The dynamic model in the flight phase meets the following conditions: M f q 2 +C f q 1 +G f =u Among them, M f is the inertia matrix of the flight phase, C f is the Coriolis matrix of the flight phase, G f is the gravity vector during the flight phase, , m 0 is the intermediate variable, m 0 = (1-m b / (m w +m b ) 2 ×m b + (m b / (m w +m b ) 2 ×m w ; , .
3. The method according to claim 2, It is characterized in that The first optimization problem satisfies the following conditions:
4. Constraints include: (1)M s q 2 +C s q 1 +G s =u; (2) q belongs to Q, u belongs to N; (3)[q 1 (0),q(0)]=[q 1 0 ,q 0 ]; Among them, q(T1) is the state variable of the take-off moment planned in the first optimization problem, q 1 (T1) is the first-order derivative of q(T1), q 2 (T1) is the second-order derivative of q(T1), φ1 F () is the expected deviation in the first optimization problem, φ1 F (q 2 (T1),q 1 (T1),q(T1))=||q 2 (T1)-q 2 T1 || K1 +||q 1 (T1)-q 1 T1 || K2 +||q(T1)-q T1 || K3 ,q T1 For the first setting of state variables, q 1 T1 Q T1 The first derivative of q 2 T1 Q T1 The second-order derivative of, K1, K2 and K3 are the first weight, the second weight and the third weight respectively, T1 is the time corresponding to the standing stage, Γ1(u) is the energy consumption corresponding to the standing stage, Γ1(u) = ||τ w || K4 +||τ k || K5 +||τ h || K6 , τ k is the knee joint torque, K4, K5 and K6 are the fourth, fifth and sixth weights respectively; || || represents the norm, Q is the constraint range of the state variable, N is the constraint range of the control input variable, q(0) is the initial state variable planned in the first optimization problem, q 1 (0) is the first-order derivative of q(0), q 0 is the initial state in the desired trajectory of the stance phase, q 1 0 Q 0 The first-order derivative of , t1 is any moment in the stance phase, the value of t1 ranges from 0 to T1, and dt1 represents the integration of t1.
5. The method according to claim 3, It is characterized in that The second optimization problem satisfies the following conditions: minφ2 F (q 2 (T2),q 1 (T2),q(T2))+∫ T2 T1 Γ2(u)dt2 The constraints include: (1)M f q 2 +C f q 1 +G f =u; (2) q belongs to Q, u belongs to N; (3)[q 1 (T1), q(T1)]=[q 1 T1 ,q T1 ]; Among them, q(T2) is the state variable of the moment of liftoff planned in the second optimization problem, q 1 (T2) is the first-order derivative of q(T2), q 2 (T2) is the second-order derivative of q(T2), φ2 F () is the expected deviation in the second optimization problem, φ2 F (q 2 (T2),q 1 (T2),q(T2))=||q 2 (T2)-q 2 T2 || K1 +||q 1 (T2)-q 1 T2 || K2 +||q(T2)-q T2 || K3 ,q T2 Set the state variable for the second, q 1 T2 Q T2 The first derivative of q 2 T2 Q T2 The second-order derivative T2 is the time corresponding to the flight phase, Γ2(u) is the energy consumption corresponding to the flight phase, Γ2(u)=||τ w || K4 +||τ k || K5 +||τ h || K6 , τ k is the knee joint torque; || || represents the norm, Q is the constraint range of the state variable, N is the constraint range of the control input variable, q(T1) is the final state variable planned in the first optimization problem, q 1 (T1) is the first-order derivative of q(T1), t2 is any moment in the flight phase, the value of t2 is from T1 to T2, and dt2 represents the integration of t2.
6. The method according to claim 1, It is characterized in that The first controller is a linear quadratic regulator, and the second controller is an attitude adjustment controller.
7. The method according to claim 1, It is characterized in that The critical state variables include (L, L 1 , L 2 ,θ w ,θ w 1 ,θ w 2 ,θ p ,θ p 1 ,θ p 2 ,θ h ,θ h 1 ,θ h 2 ), where L is the leg length of the target structure, L 1 is the first derivative of L, L 2 is the second-order derivative of L, θ w is the rotation angle of the wheels of the target structure, θ w 1 is θ w The first derivative of θ w 2 is θ w The second derivative, θ p is the angle between the straight line where the legs of the target structure are located and the vertical direction, θ p 1 is θ p The first derivative of θ p 2 is θ p The second derivative, θ h is the angle of the hip joint of the two-wheeled legged robot, θ h 1 is θ h The first derivative of θ h 2 is θ h The second derivative of Among them, θ in the state variable at the moment of landing is p is set equal to 2π, or is set to satisfy (2π-θ p )≤△θ, △θ is the preset angle difference.
8. A jumping and somersault control device for a two-wheeled and footed robot. It is characterized in that The device comprises: A dynamic model building module is used to simplify the two-wheeled legged robot into a structure including a base, legs and wheels as a target structure, and to respectively build a dynamic model of the target structure in a standing phase and a dynamic model of the target structure in a flying phase to describe the basic physical characteristics of the two-wheeled legged robot; A critical state determination module, used to determine the critical state variables corresponding to the target structure at the moment of lifting off the ground and the moment of landing according to the target jumping height and the target jumping distance, as the first setting state variable and the second setting state variable respectively; an expected trajectory acquisition module, for determining an optimization problem of the target structure in a take-off phase as a first optimization problem according to dynamic constraints, torque constraints, joint restrictions, a dynamic model in a stance phase, and a first set state variable, and for determining an optimization problem of the target structure in a flight phase as a second optimization problem according to dynamic constraints, torque constraints, joint restrictions, a dynamic model in a flight phase, and a second set state variable, and for solving the first optimization problem and the second optimization problem, respectively, to obtain corresponding first expected trajectories and second expected trajectories; The control module is used to track the trajectory of the two-wheeled legged robot using a first controller based on a first expected trajectory during a take-off phase, and to track the trajectory of the two-wheeled legged robot using a second controller based on a second expected trajectory during a jumping phase, so that the two-wheeled legged robot can complete a jumping and somersault action.
9. The device according to claim 7, It is characterized in that The dynamic model in the stance phase satisfies the following conditions: M s q 2 +C s q 1 +G s =u Wherein, q is the state variable of the target structure, q 1 is the first-order derivative of q, q 2 is the second-order derivative of q, q=(θ w , L, θ p ,θ h ), θ w is the rotation angle of the wheel of the target structure, L is the leg length of the target structure, θ h The angle of the hip joint of the two-wheeled legged robot, θ p is the angle between the straight line where the legs of the target structure are located and the vertical direction, M s is the inertia matrix of the stance phase, , J w is the moment of inertia of the wheels of the two-wheeled legged robot, m w is the mass of the wheel of the target structure, R w is the radius of the wheel of the target structure, m b is the mass of the base of the target structure, J b is the moment of inertia of the base of the target structure; C s is the Coriolis force matrix during the stance phase, ,θ 1 p is θ p The first derivative of L 1 is the first derivative of L, G s is the gravity vector in the stance phase, , u is the control input variable of the target structure, , τ w is the wheel torque of the target structure, τ h is the moment of the hip joint of the target structure, F L is the generalized force on the legs of the target structure; The dynamic model in the flight phase meets the following conditions: M f q 2 +C f q 1 +G f =u Among them, M f is the inertia matrix of the flight phase, C f is the Coriolis matrix of the flight phase, G f is the gravity vector during the flight phase, , m 0 is the intermediate variable, m 0 = (1-m b / (m w +m b ) 2 ×m b + (m b / (m w +m b ) 2 ×m w ; , .
Citation Information
Patent Citations
Single-side obstacle crossing control method for double-wheel-foot robot
CN114564010A
Double-wheel-leg robot, control method and device thereof and storage medium
CN116573075A
Mechanical analysis and constraint method for jumping posture of two-wheeled robot
CN116738739A
Interference determination device and leg wheel type robot
JP2009050936A
Legged robot continuous hopping control method and legged robot and computer readable storage medium using the same
US20210221455A1
Cited By
Jumping flying posture adjusting device and wheel-legged vehicle
CN119568299A
A jumping control system and method for a wheel-legged robot based on support force reconstruction and contact state interlocking
CN123089388A
