Attitude control method and system for double-wheel mobile robot

By building a dual-wheel mobile robot system model and perturbation observer, combining error feedback and sliding mode control, the problem of poor stability of the dual-wheel mobile robot in complex environments is solved, achieving higher robustness and precise control effects.

CN118981216APending Publication Date: 2024-11-19CHINA UNIV OF GEOSCIENCES (WUHAN)
View PDF 0 Cites 1 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

When facing ground friction, slope uncertainty, wind direction uncertainty, load uncertainty, motor aging model uncertainty, and median change of machinery, it is difficult to maintain steady state. The traditional control algorithm is not effective. Even the inability to maintain steady state leads to serious consequences.

Method used

The attitude control method of the two-wheeled mobile robot is adopted to build a system model by obtaining state information, designing the disturbance observer and control rate, using error feedback and sliding mode control methods, combined with the finite time disturbance observer, to achieve accurate estimation and compensation of disturbances, Improve the stability and robustness of robots in complex environments.

Benefits of technology

When facing various uncertainties, the robot can be maintained, the driving distance is shortened, the control cost is reduced, the resistance to unknown disturbances can be enhanced, and the accuracy and tracking rate of observation disturbances can be improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118981216A_ABST
    Figure CN118981216A_ABST
Patent Text Reader

Abstract

The invention discloses a double-wheel mobile robot attitude control method and a double-wheel mobile robot attitude control system, and relates to the field of robot control, and the double-wheel mobile robot attitude control method mainly comprises the following steps: constructing a double-wheel robot system model according to the state information of a double-wheel robot; constructing a disturbance observer according to the two-wheel robot system model; according to the disturbance observer and the two-wheel robot system model, the control rate of the two-wheel robot is obtained; and controlling the target double-wheel robot by using the double-wheel robot control rate. By implementing the attitude control method and system for the double-wheel mobile robot provided by the invention, the control accuracy and robustness of the double-wheel robot can be improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot control, and more specifically, to a two-wheel mobile robot posture control method and a two-wheel mobile robot posture control system. Background Art

[0002] The two-wheeled robot is a complex dynamic system that requires precise control algorithms to achieve balance. The research on two-wheeled robots faces technical challenges such as nonlinearity, multivariables, and strong coupling, and innovative control strategies need to be designed to solve these problems.

[0003] Two-wheeled mobile robots have broad application prospects in the fields of civil, military, and aerospace due to their simple structure, flexible movement, and suitability for working in small and dangerous spaces. For example, Ollie, a wheel-legged robot developed by Tencent, has demonstrated the ability to balance on two wheels, move in multiple modes, jump, and do 360-degree flips, showing extremely high mobility and flexibility. At the same time, its commercial value is also unlimited. In the field of smart homes, two-wheeled mobile robots can be regarded as an efficient sweeping robot, providing people with a clean and tidy home environment. In the field of warehousing and logistics, two-wheeled mobile robots can realize intelligent navigation and cargo handling, improving work efficiency. In the field of robot navigation, two-wheeled mobile robots can be used for autonomous navigation and environmental perception, and have intelligent robot characteristics.

[0004] Based on the advantages of two-wheeled mobile robots, many technology companies have developed two-wheeled mobile robots. In short, two-wheeled mobile robots can not only be used for theoretical research, but also can be sold as commodities and create certain economic benefits. Therefore, the research on two-wheeled mobile robots is very meaningful. However, the two-wheeled mobile robot is a strong disturbance system, and at the same time, it has high requirements for stability and adjustment time. The traditional control method has a poor effect on the suppression of disturbances. For example, it is difficult for a mobile robot to maintain a steady state when it encounters uncertain ground friction, uncertain slope, uncertain wind direction, uncertain load, uncertain motor aging model, and mechanical median changes. Especially when the load is dynamically changing, that is, the model is dynamically changing, the model uncertainty problem is generated, and the traditional control algorithm has limitations, the control effect is not good, and it is even impossible to maintain a steady state, which will have serious consequences. Summary of the invention

[0005] The object of the present invention is to provide a two-wheeled mobile robot posture control method and a two-wheeled mobile robot posture control system, which can improve the accuracy and robustness of the control of the two-wheeled robot.

[0006] The present invention provides a two-wheeled mobile robot posture control method, comprising the following steps:

[0007] S1: Obtain the state information of the two-wheeled robot, and build a two-wheeled robot system model based on the state information of the two-wheeled robot;

[0008] S2: Construct a disturbance observer based on the two-wheel robot system model;

[0009] S3: According to the disturbance observer and the two-wheel robot system model, the control rate of the two-wheel robot is obtained;

[0010] S4: Using the two-wheel robot control rate, control the target two-wheel robot.

[0011] Furthermore, step S1 of the above two-wheeled mobile robot posture control method specifically includes: obtaining the two-wheeled robot state information, and constructing a two-wheeled robot system model according to the two-wheeled robot state information, such as formula:

[0012]

[0013] Among them, x, y, v, θ, ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity, and posture angle. They represent the derivatives of the two-wheeled robot's state quantity, namely, the x-direction velocity, y-direction velocity, movement acceleration, rotation angular velocity, rotation angular acceleration, and attitude angular acceleration. a represents the distance between the two-wheeled robot's current position and the target position, and u l is the control input for the position of the two-wheeled robot, u a is the control input for the rotation of the two-wheeled robot, u se is the control input of the two-wheel robot’s posture, m is half of the two-wheel robot’s mass, and d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, I z is the moment of inertia of the two-wheeled robot, g is the acceleration due to gravity, and l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint.

[0014] Furthermore, step S2 of the above two-wheeled mobile robot posture control method specifically includes: constructing a disturbance observer according to the two-wheeled robot system model, such as formula:

[0015]

[0016] Among them, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate, Respectively The derivative of , l1, l2, l3 are the gains of the disturbance observer, and a, b, c are the observer adjustment parameters.

[0017] Furthermore, step S3 of the above two-wheeled mobile robot posture control method specifically includes: according to the disturbance observer and the two-wheeled robot system model, using the error feedback method, the two-wheeled robot control rate is obtained, such as the formula:

[0018]

[0019] Among them, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheeled robot’s posture, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , Estimates of x,y,v,θ,ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity and posture angle. k1, k2, k3, k4, k5 and k6 are the parameters of feedback control.

[0020] Furthermore, step S3 of the above two-wheeled mobile robot posture control method may also specifically include: according to the disturbance observer and the two-wheeled robot system model, using the sliding mode control method, obtaining the two-wheeled robot control rate, such as the formula:

[0021]

[0022] Among them, s, S are sliding surfaces, c1, c2, c3 are sliding surface parameters, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheel robot posture, ε1, ε2 are controller parameters, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate of ω, They represent the angular velocity and attitude angle of the two-wheeled robot, respectively; a represents the distance between the current position and the target position of the two-wheeled robot; g is the acceleration of gravity; l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint. Represents the attitude angular velocity of the two-wheeled robot.

[0023] The present invention also provides a two-wheeled mobile robot posture control system, comprising the following modules:

[0024] The system model building module is configured to: obtain the state information of the two-wheeled robot, and build a two-wheeled robot system model according to the state information of the two-wheeled robot;

[0025] The disturbance observer building module is configured as follows: constructing a disturbance observer according to a two-wheel robot system model;

[0026] The control rate building module is configured as follows: obtaining the control rate of the two-wheel robot according to the disturbance observer and the two-wheel robot system model;

[0027] The two-wheeled robot control module is configured to control the target two-wheeled robot using the two-wheeled robot control rate.

[0028] Furthermore, the system model building module of the above-mentioned two-wheeled mobile robot posture control system is specifically configured as follows: obtaining the state information of the two-wheeled robot, and building a two-wheeled robot system model according to the two-wheeled robot state information, such as the formula:

[0029]

[0030] Among them, x, y, v, θ, ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity, and posture angle. They represent the derivatives of the two-wheeled robot's state quantity, namely, the x-direction velocity, y-direction velocity, movement acceleration, rotation angular velocity, rotation angular acceleration, and attitude angular acceleration. a represents the distance between the two-wheeled robot's current position and the target position, and u l is the control input for the position of the two-wheeled robot, u a is the control input for the rotation of the two-wheeled robot, u se is the control input of the two-wheel robot’s posture, m is half of the two-wheel robot’s mass, and d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, I z is the moment of inertia of the two-wheeled robot, g is the acceleration due to gravity, and l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint.

[0031] Furthermore, the disturbance observer construction module of the above two-wheeled mobile robot posture control system is specifically configured as follows: according to the two-wheeled robot system model, a disturbance observer is constructed, such as the formula:

[0032]

[0033] Among them, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate, Respectively The derivative of , l1, l2, l3 are the gains of the disturbance observer, and a, b, c are the observer adjustment parameters.

[0034] Furthermore, the control rate building module of the above-mentioned two-wheeled mobile robot posture control system is specifically configured as follows: according to the disturbance observer and the two-wheeled robot system model, the error feedback method is used to obtain the two-wheeled robot control rate, such as the formula:

[0035]

[0036] Among them, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheeled robot’s posture, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , Estimates of x,y,v,θ,ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity and posture angle. k1, k2, k3, k4, k5 and k6 are the parameters of feedback control.

[0037] Furthermore, the control rate building module of the above-mentioned two-wheeled mobile robot posture control system can also be specifically configured as follows: according to the disturbance observer and the two-wheeled robot system model, the two-wheeled robot control rate is obtained by using the sliding mode control method, such as the formula:

[0038]

[0039] Among them, s, S are sliding surfaces, c1, c2, c3 are sliding surface parameters, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheel robot posture, ε1, ε2 are controller parameters, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate of ω, They represent the angular velocity and attitude angle of the two-wheeled robot, respectively; a represents the distance between the current position and the target position of the two-wheeled robot; g is the acceleration of gravity; l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint. Represents the attitude angular velocity of the two-wheeled robot.

[0040] The two-wheeled mobile robot posture control method and the two-wheeled mobile robot posture control system provided by the present invention have the following beneficial effects:

[0041] The present invention uses a disturbance observer to accurately estimate various disturbances and uncertainties of the two-wheeled robot, and uses feedforward control to compensate and correct, so as to ensure that the robot can maintain a steady state when encountering uncertain ground friction, uncertain slope, uncertain wind direction, uncertain balance vehicle load, uncertain motor aging model, mechanical median change, etc.; on this basis, using the Extended State Observer (ESO) and Disturbance Observer (DOB) methods, combined with the finite time theorem, a finite-time Disturbance Observer (FDO) is constructed, which can speed up the observer's tracking disturbance rate and sensitivity, improve the accuracy of observing disturbances, and roughly estimate the time from tracking disturbances to convergence in theory;

[0042] The present invention designs a sliding mode control based on the system model, optimizes the performance of the disturbance observer, and replaces the simple error feedback control with a more robust active anti-disturbance sliding mode control, which can enable the robot to travel a shorter distance and consume less cost while completing the specified goal. At the same time, it can adapt to complex operating environments and has a more outstanding ability to resist unknown disturbances. BRIEF DESCRIPTION OF THE DRAWINGS

[0043] The present invention will be further described below with reference to the accompanying drawings and embodiments, in which:

[0044] Figure 1 is a flow chart of the posture control method of a two-wheeled mobile robot provided by the present invention;

[0045] Figure 2 is a schematic diagram of a two-wheeled robot model provided by the present invention;

[0046] Figure 3 It is a two-dimensional trajectory diagram of SMC+FDO motion provided by the present invention;

[0047] Figure 4 It is a three-dimensional structural diagram of the mobile robot provided by the present invention;

[0048] Figure 5 It is a disturbance estimation and tracking diagram of FDO provided by the present invention;

[0049] Figure 6 is a swing angle variation diagram of the sliding mode control provided by the present invention;

[0050] Figure 7 It is the feedback control + DOB motion trajectory diagram provided by the present invention;

[0051] Figure 8 It is a DOB disturbance estimation and tracking diagram provided by the present invention;

[0052] Fig. 9 It is a swing angle variation diagram of the error feedback control provided by the present invention. DETAILED DESCRIPTION

[0053] In order to have a clearer understanding of the technical features, purposes and effects of the present invention, specific embodiments of the present invention are now described in detail with reference to the accompanying drawings.

[0054] Figure 1 A schematic diagram of a two-wheeled mobile robot posture control method of this embodiment is shown. In this embodiment, the two-wheeled mobile robot posture control method includes the following steps:

[0055] S1: Obtain the state information of the two-wheeled robot, and build a two-wheeled robot system model based on the state information of the two-wheeled robot;

[0056] Specifically, step S1 of the above two-wheeled mobile robot posture control method specifically includes: obtaining the two-wheeled robot state information, and constructing a two-wheeled robot system model according to the two-wheeled robot state information, such as the formula:

[0057]

[0058] Among them, x, y, v, θ, ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity, and posture angle. They represent the derivatives of the two-wheeled robot's state quantity, namely, the x-direction velocity, y-direction velocity, movement acceleration, rotation angular velocity, rotation angular acceleration, and attitude angular acceleration. a represents the distance between the two-wheeled robot's current position and the target position, and u l is the control input for the position of the two-wheeled robot, u a is the control input for the rotation of the two-wheeled robot, u se is the control input of the two-wheel robot’s posture, m is half of the two-wheel robot’s mass, and d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, I z is the moment of inertia of the two-wheeled robot, g is the acceleration due to gravity, and l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint;

[0059] S2: Construct a disturbance observer based on the two-wheel robot system model;

[0060] Specifically, step S2 of the above two-wheeled mobile robot posture control method specifically includes: constructing a disturbance observer according to the two-wheeled robot system model, such as formula:

[0061]

[0062] Among them, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate, Respectively The derivative of , l1, l2, l3 are the gains of the disturbance observer, a, b, c are the observer adjustment parameters;

[0063] S3: According to the disturbance observer and the two-wheel robot system model, the control rate of the two-wheel robot is obtained;

[0064] Specifically, step S3 of the above two-wheeled mobile robot posture control method specifically includes: according to the disturbance observer and the two-wheeled robot system model, using the error feedback method, the two-wheeled robot control rate is obtained, such as the formula:

[0065]

[0066] Among them, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheeled robot’s posture, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , Estimates of x,y,v,θ,ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity and posture angle. k1, k2, k3, k4, k5 and k6 are the parameters of feedback control.

[0067] Preferably, step S3 of the above two-wheeled mobile robot posture control method may also specifically include: according to the disturbance observer and the two-wheeled robot system model, using the sliding mode control method, obtaining the two-wheeled robot control rate, such as the formula:

[0068]

[0069] Among them, s, S are sliding surfaces, c1, c2, c3 are sliding surface parameters, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheel robot posture, ε1, ε2 are controller parameters, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate of ω, They represent the angular velocity and attitude angle of the two-wheeled robot, respectively; a represents the distance between the current position and the target position of the two-wheeled robot; g is the acceleration of gravity; l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint. Represents the attitude angular velocity of the two-wheeled robot;

[0070] S4: Using the two-wheel robot control rate, control the target two-wheel robot.

[0071] This embodiment provides a two-wheeled mobile robot posture control system, including the following modules:

[0072] The system model building module is configured to: obtain the state information of the two-wheeled robot, and build a two-wheeled robot system model according to the state information of the two-wheeled robot;

[0073] Specifically, the system model building module of the above system is specifically configured as follows: obtaining the state information of the two-wheeled robot, and building a two-wheeled robot system model according to the state information of the two-wheeled robot, such as the formula:

[0074]

[0075] Among them, x, y, v, θ, ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity, and posture angle. They represent the derivatives of the two-wheeled robot's state quantity, namely, the x-direction velocity, y-direction velocity, movement acceleration, rotation angular velocity, rotation angular acceleration, and attitude angular acceleration. a represents the distance between the two-wheeled robot's current position and the target position, and u l is the control input for the position of the two-wheeled robot, u a is the control input for the rotation of the two-wheeled robot, u se is the control input of the two-wheel robot’s posture, m is half of the two-wheel robot’s mass, and d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, I z is the moment of inertia of the two-wheeled robot, g is the acceleration due to gravity, and l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint;

[0076] The disturbance observer building module is configured as follows: constructing a disturbance observer according to a two-wheel robot system model;

[0077] Specifically, the disturbance observer construction module of the above two-wheeled mobile robot posture control system is specifically configured as follows: according to the two-wheeled robot system model, a disturbance observer is constructed, such as the formula:

[0078]

[0079] Among them, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate, Respectively The derivative of , l1, l2, l3 are the gains of the disturbance observer, a, b, c are the observer adjustment parameters;

[0080] The control rate building module is configured as follows: obtaining the control rate of the two-wheel robot according to the disturbance observer and the two-wheel robot system model;

[0081] Specifically, the control rate building module of the above-mentioned two-wheel mobile robot posture control system is specifically configured as follows: according to the disturbance observer and the two-wheel robot system model, the error feedback method is used to obtain the two-wheel robot control rate, such as the formula:

[0082]

[0083] Among them, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheeled robot’s posture, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , Estimates of x,y,v,θ,ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity and posture angle. k1, k2, k3, k4, k5 and k6 are the parameters of feedback control.

[0084] Preferably, the control rate building module of the above-mentioned two-wheeled mobile robot posture control system can also be specifically configured as follows: according to the disturbance observer and the two-wheeled robot system model, the two-wheeled robot control rate is obtained by using the sliding mode control method, such as the formula:

[0085]

[0086] Among them, s, S are sliding surfaces, c1, c2, c3 are sliding surface parameters, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheel robot posture, ε1, ε2 are controller parameters, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate of ω, They represent the angular velocity and attitude angle of the two-wheeled robot, respectively; a represents the distance between the current position and the target position of the two-wheeled robot; g is the acceleration of gravity; l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint. Represents the attitude angular velocity of the two-wheeled robot;

[0087] The two-wheeled robot control module is configured to control the target two-wheeled robot using the two-wheeled robot control rate.

[0088] In some embodiments, the above-mentioned two-wheeled mobile robot posture control method can also be implemented in the following manner.

[0089] In this embodiment, the two-wheeled mobile robot posture control method includes the following steps:

[0090] Step 1: Two-wheeled robot system modeling: A two-wheeled robot can usually be compared to a two-wheeled vehicle model containing an inverted pendulum model, such as Figure 2 As shown in the figure, the physical quantities in the model are: the mass of the car is 2m, the mass of the pendulum is m (considered as the mass of the rod, the ball is only displayed and the mass is not considered), and the distance from the center of gravity of the pendulum to the joint is l2 / 2; the mathematical model of the two-wheeled mobile robot can be written as:

[0091]

[0092] Where g is the acceleration due to gravity; u l ,u a ,u se is the control input of the robot; d v ,d ω , The disturbance of the robot does not match the modeling. The moment of inertia of the car is I z , the angle between the pendulum and the vertical downward direction The rotation angle of the robot is θ, the angular velocity of the robot is ω, the linear velocity of the robot is v, and a is the distance between the robot and the specified destination;

[0093] Step 2: Design of disturbance observer: Based on the design idea of ​​observing ESO and disturbance observer DOB using extended state observer:

[0094] make so Therefore, the observer is able to converge; therefore, a disturbance observer is designed:

[0095]

[0096] in, is the disturbance d v ,d ω , Estimates of , l1, l2, l3 are the gains of the disturbance observer, which are generally positive real numbers;

[0097] In order to further improve the observation accuracy of the observer and accelerate the convergence speed of the observer, the design ideas of the high-order synovial disturbance observer and the finite-time disturbance observer are referred to, and improvements are made on the basis of the original disturbance observer theory; the improved disturbance observer:

[0098]

[0099] Where a, b, c are observer adjustment parameters and 0 <a,b,c<1;;

[0100] Since the design of the disturbance observer is:

[0101]

[0102] By separating variables:

[0103]

[0104] By calculation, we can:

[0105]

[0106] Therefore, the convergence time T can be obtained:

[0107]

[0108] Where e(0) is the initial estimation error, k,a are the adjustable parameters of the observer and k>0,0 <a<1;

[0109] Step 3, control rate design: The control goal is to make the robot reach the target location from the initial position, which not only controls the distance, but also includes the robot's own posture control (inverted pendulum, direction angle, angular velocity, angular acceleration, etc.);

[0110] The first consideration is to design the control rate based on error feedback. This control rate design is also the simplest. Combined with the disturbance observer, it has a certain anti-disturbance ability and a certain robustness.

[0111]

[0112] Considering the control cost, the price paid to reach the destination also needs to be considered. If the destination is reached directly in a straight line, the feedback control has poor anti-disturbance performance. Even with the compensation of the disturbance observer, the disturbance observer's observation, estimation and compensation of the disturbance have time lag and tracking static error, which leads to the instability of the control quantity. As a result, the car cannot move straight from the initial point to the target point during the movement, thus increasing the cost. Therefore, in order to further optimize the control cost, a composite control formed by a sliding mode control with certain robustness and a finite-time disturbance observer is proposed.

[0113]

[0114] Among them, c1, c2, c3 are sliding surface parameters, s, S are sliding surfaces designed according to actual conditions, ε1, ε2 are controller parameters, which are generally positive real numbers;

[0115] Among them, the controller stability is proved as follows:

[0116] Assume a Lyapunov function:

[0117]

[0118] Taking the derivative of this Lyapunov function, we get:

[0119]

[0120] Design for control rate:

[0121]

[0122] The final Lyapunov function can be obtained:

[0123]

[0124] The proof is complete.

[0125] Finally, the simulation experiment of this embodiment is as follows: the Simulink simulation parameters of the mobile robot control based on sliding mode and finite time disturbance observer are shown in Table 1;

[0126] Table 1 Simulation parameters of control method

[0127]

[0128] In addition, the initial state of the system is x0=20, y0=20, v0=9, ω0=0, The target state is x t =0,y t =0,v t =0, or 0,ω t =0,

[0129] According to the controller parameters in Table 1, the simulation results of the two-wheeled robot controlled by SMC+FDO are as follows: Figure 3 , Figure 4 , Figure 5 and Figure 6 As shown; the total simulation time is 20 seconds, and the initial angle of the robot's moving direction is The target angle can converge to 0 or remain unchanged (determined by the designed sliding surface); the initial state of the robot's own swing angle is π, and it converges to 0 after 6 seconds. The finite time disturbance observer (FDO) can quickly track the disturbance, and the convergence time of the disturbance estimation can be calculated by the formula. The simulation results also prove the correctness of the theory (according to the initial disturbance estimation error, the theoretically calculated disturbance convergence time is: 0.207 seconds, 0 seconds, and 2.5 seconds). The above simulation results show that the controller can make the entire system stable and convergent;

[0130] According to the controller parameters in Table 1, the simulation results of the two-wheeled robot controlled by the compound control of error feedback + DOB are as follows: Figure 7 , Figure 8 and Fig. 9 As shown; the total simulation time is 20 seconds, and the initial angle of the robot's moving direction is The target angle converges to 0, and the initial state of the robot's own swing angle is π, which converges to 0 after 10 seconds. Due to the performance difference of the controller, the control cost of feedback control is higher than that of sliding mode control. Since the observation performance of DOB is worse than that of FDO, the disturbance estimation and disturbance compensation effects are worse, and the convergence time is slower. In order to achieve better observation performance, the observer gain can only be increased (paying more observation costs).

[0131] The embodiments of the present invention are described above in conjunction with the accompanying drawings, but the present invention is not limited to the above-mentioned specific implementation methods. The above-mentioned specific implementation methods are merely illustrative and not restrictive. Under the enlightenment of the present invention, ordinary technicians in this field can also make many forms without departing from the scope of protection of the purpose of the present invention and the claims, which all fall within the protection of the present invention.

Claims

1. A two-wheeled mobile robot posture control method, characterized in that: The following steps are involved: S1: Acquire state information of the two-wheeled robot, and construct a two-wheeled robot system model according to the state information of the two-wheeled robot; S2: constructing a disturbance observer according to the two-wheel robot system model; S3: obtaining a control rate of the two-wheel robot according to the disturbance observer and the two-wheel robot system model; S4: Using the two-wheeled robot control rate, the target two-wheeled robot is controlled.

2. The two-wheeled mobile robot posture control method according to claim 1, characterized in that: Step S1 specifically includes: obtaining the state information of the two-wheeled robot, and constructing a two-wheeled robot system model according to the state information of the two-wheeled robot, such as the formula: Among them, x, y, v, θ, ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity, and posture angle. They represent the derivatives of the two-wheeled robot's state quantity, namely, the x-direction velocity, y-direction velocity, movement acceleration, rotation angular velocity, rotation angular acceleration, and attitude angular acceleration. a represents the distance between the two-wheeled robot's current position and the target position, and u l is the control input for the position of the two-wheeled robot, u a is the control input for the rotation of the two-wheeled robot, u se is the control input of the two-wheel robot’s posture, m is half of the two-wheel robot’s mass, and d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, I z is the moment of inertia of the two-wheeled robot, g is the acceleration due to gravity, and l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint.

3. The two-wheeled mobile robot posture control method according to claim 1, characterized in that: Step S2 specifically includes: constructing a disturbance observer according to the two-wheel robot system model, such as formula: Among them, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate, Respectively The derivative of , l1, l2, l3 are the gains of the disturbance observer, and a, b, c are the observer adjustment parameters.

4. The two-wheeled mobile robot posture control method according to claim 1, characterized in that: Step S3 specifically includes: according to the disturbance observer and the two-wheel robot system model, using the error feedback method, obtaining the two-wheel robot control rate, such as formula: Among them, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheeled robot’s posture, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , Estimates of x,y,v,θ,ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity and posture angle. k1, k2, k3, k4, k5 and k6 are the parameters of feedback control.

5. The two-wheeled mobile robot posture control method according to claim 1, characterized in that: Step S3 specifically includes: according to the disturbance observer and the two-wheel robot system model, using the sliding mode control method, obtaining the control rate of the two-wheel robot, such as formula: Among them, s, S are sliding surfaces, c1, c2, c3 are sliding surface parameters, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheel robot posture, ε1, ε2 are controller parameters, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate of ω, They represent the angular velocity and attitude angle of the two-wheeled robot, respectively; a represents the distance between the current position and the target position of the two-wheeled robot; g is the acceleration of gravity; l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint. Represents the attitude angular velocity of the two-wheeled robot.

6. A two-wheeled mobile robot posture control system, characterized in that: The two-wheeled mobile robot posture control system includes the following modules: The system model building module is configured to: obtain state information of the two-wheeled robot, and build a two-wheeled robot system model according to the state information of the two-wheeled robot; A disturbance observer building module is configured to: build a disturbance observer according to the two-wheel robot system model; A control rate building module is configured to: obtain a control rate of the two-wheel robot according to the disturbance observer and the two-wheel robot system model; The two-wheeled robot control module is configured to control the target two-wheeled robot using the two-wheeled robot control rate.

7. The two-wheeled mobile robot posture control system according to claim 6, characterized in that: The system model building module is specifically configured to: obtain the state information of the two-wheeled robot, and build a two-wheeled robot system model according to the two-wheeled robot state information, such as the formula: Among them, x, y, v, θ, ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity, and posture angle. They represent the derivatives of the two-wheeled robot's state quantity, namely, the x-direction velocity, y-direction velocity, movement acceleration, rotation angular velocity, rotation angular acceleration, and attitude angular acceleration. a represents the distance between the two-wheeled robot's current position and the target position, and u l is the control input for the position of the two-wheeled robot, u a is the control input for the rotation of the two-wheeled robot, u se is the control input of the two-wheel robot’s posture, m is half of the two-wheel robot’s mass, and d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, I z is the moment of inertia of the two-wheeled robot, g is the acceleration due to gravity, and l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint.

8. The two-wheeled mobile robot posture control system according to claim 6, characterized in that: The disturbance observer construction module is specifically configured as follows: according to the two-wheel robot system model, a disturbance observer is constructed, such as formula: Among them, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate, Respectively The derivative of , l1, l2, l3 are the gains of the disturbance observer, and a, b, c are the observer adjustment parameters.

9. The two-wheeled mobile robot posture control system according to claim 6, characterized in that: The control rate building module is specifically configured as follows: according to the disturbance observer and the two-wheel robot system model, the control rate of the two-wheel robot is obtained by using the error feedback method, such as the formula: Among them, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheeled robot’s posture, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , Estimates of x,y,v,θ,ω, They represent the six state quantities of the two-wheeled robot, namely, displacement in the x-direction, displacement in the y-direction, moving speed, rotation angle, rotation angular velocity and posture angle. k1, k2, k3, k4, k5 and k6 are the parameters of feedback control.

10. The two-wheeled mobile robot posture control system according to claim 6, characterized in that: The control rate building module is specifically configured as follows: according to the disturbance observer and the two-wheel robot system model, the control rate of the two-wheel robot is obtained by using a sliding mode control method, such as the formula: Among them, s, S are sliding surfaces, c1, c2, c3 are sliding surface parameters, u l is the control rate of the two-wheel robot position, u a is the control rate of the two-wheel robot’s rotation, u se is the control rate of the two-wheel robot posture, ε1, ε2 are controller parameters, d v is the disturbance of the moving speed of the two-wheeled robot, d ω is the disturbance of the angular velocity of the two-wheeled robot, is the disturbance of the two-wheeled robot’s posture, are the disturbance d v ,d ω , The estimate of ω, They represent the angular velocity and attitude angle of the two-wheeled robot, respectively; a represents the distance between the current position and the target position of the two-wheeled robot; g is the acceleration of gravity; l2 is twice the distance from the center of gravity of the two-wheeled robot's pendulum to its joint. Represents the attitude angular velocity of the two-wheeled robot.

Citation Information

Cited By

  • Multi-mode wheel-leg separation type lower limb of humanoid robot and deformation method of multi-mode wheel-leg separation type lower limb

    CN120171665A