[go: up one dir, main page]

CN115128949B - A mobile robot trajectory tracking method based on backstepping sliding mode - Google Patents

A mobile robot trajectory tracking method based on backstepping sliding mode Download PDF

Info

Publication number
CN115128949B
CN115128949B CN202210558029.6A CN202210558029A CN115128949B CN 115128949 B CN115128949 B CN 115128949B CN 202210558029 A CN202210558029 A CN 202210558029A CN 115128949 B CN115128949 B CN 115128949B
Authority
CN
China
Prior art keywords
mobile robot
formula
sliding mode
control
controller
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202210558029.6A
Other languages
Chinese (zh)
Other versions
CN115128949A (en
Inventor
樊刘流
唐昊
谭琦
王舒润
王彬
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hefei University of Technology
Original Assignee
Hefei University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hefei University of Technology filed Critical Hefei University of Technology
Priority to CN202210558029.6A priority Critical patent/CN115128949B/en
Publication of CN115128949A publication Critical patent/CN115128949A/en
Application granted granted Critical
Publication of CN115128949B publication Critical patent/CN115128949B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明属于机器控制领域,涉及轮式移动机器人轨迹跟踪控制技术,更具体地,是一种基于反步滑模的移动机器人轨迹跟踪方法。包括如下步骤:步骤1:建立移动机器人的运动学模型和动力学模型;步骤2:基于反步法设计移动机器人的运动学控制器;步骤3:基于组合趋近律的滑模变结构设计移动机器人的动力学控制器;步骤4:根据机器人的运动学模型,得到移动机器人的实际位姿和实际速度;将移动机器人的期望位姿和实际位姿输入反步法运动学控制器,得到虚拟控制变量,将虚拟控制变量和实际速度输入到动力学控制器,得到控制力矩,将控制力矩和外界扰动输入动力学模型,输出加速度,使得移动机器人的实际位姿达到期望位姿。

The present invention belongs to the field of machine control, and relates to a wheeled mobile robot trajectory tracking control technology, and more specifically, is a mobile robot trajectory tracking method based on backstepping sliding mode. The method comprises the following steps: step 1: establishing a kinematic model and a dynamic model of a mobile robot; step 2: designing a kinematic controller of a mobile robot based on backstepping method; step 3: designing a dynamic controller of a mobile robot based on a sliding mode variable structure of a combined reaching law; step 4: obtaining the actual posture and actual speed of the mobile robot according to the kinematic model of the robot; inputting the desired posture and actual posture of the mobile robot into the backstepping kinematic controller to obtain a virtual control variable, inputting the virtual control variable and the actual speed into the dynamic controller to obtain a control torque, inputting the control torque and external disturbance into the dynamic model, and outputting acceleration, so that the actual posture of the mobile robot reaches the desired posture.

Description

Mobile robot track tracking method based on backstepping sliding mode
Technical Field
The invention belongs to the field of machine control, relates to a wheeled mobile robot track tracking control technology, and in particular relates to a mobile robot track tracking method based on a backstepping sliding mode.
Background
The wheel type mobile robot is an intelligent mobile platform integrating multiple functions of environment sensing, dynamic decision and planning, behavior control and execution and the like, and has the characteristics of flexible movement, high bearing capacity, high working efficiency and the like compared with the traditional industrial robot, and is widely applied to the fields of service industry, aerospace, earthquake relief and the like in recent years.
Robotics is an important branch in the automation and control field, and has found wide application in industrial production and daily life. The wheeled mobile robot plays an important role in industry, military, civil use and scientific exploration, and can replace people to execute information acquisition and processing tasks in severe environments such as deep sea exploration, disaster exploration and the like. Currently, exploring the motion performance of mobile robots in complex environments is a hot topic of research.
The incomplete wheel type mobile robot is a typical multi-input multi-output nonlinear system, so that the trajectory tracking is the basis of motion control of the mobile robot, and the aim is to quickly and stably track a preset curve with time as a variable function by a reasonably designed control method. The conventional methods for solving the track tracking of the mobile robot comprise PID control, backstepping control, sliding mode control or self-adaptive control and the like, and the methods all achieve good tracking effects, but the motion of the method often cannot achieve ideal tracking effects under the conditions that uncertain factors exist in the system or inflection points exist in paths or initial errors are large and the like. In recent years, along with the development of artificial intelligence, the application technology of the fuzzy neural network has a good application prospect in the control field, and provides an effective way for solving the problems of high nonlinearity, coupling and unmodeled uncertainty existing in the robot control.
Disclosure of Invention
In order to overcome the defects of the prior art, the invention provides a moving robot track tracking method based on a backstepping sliding mode, which comprises the steps of firstly carrying out kinematics and dynamics modeling on a moving robot, then realizing track tracking of the moving robot by adopting the backstepping method, then designing a speed tracking control law by utilizing a sliding mode variable structure method based on a dynamics model of the moving robot, and finally realizing accurate track tracking of the moving robot according to the designed control law. The method can effectively weaken the buffeting phenomenon of the control system, improve the motion performance of the mobile robot when the expected path has an inflection point, and improve the anti-interference capability of the mobile robot and the motion precision of track tracking.
In order to achieve the above purpose, the invention adopts the following technical scheme:
a mobile robot track tracking method based on a backstepping sliding mode comprises the following steps:
Step 1, establishing a kinematic model and a dynamic model of a mobile robot;
Step 2, designing a kinematic controller of the mobile robot based on a backstepping method;
Step 3, designing a dynamic controller of the mobile robot based on a sliding mode variable structure of a combined approach law;
And 4, according to the kinematic model of the robot, obtaining the actual pose and the actual speed of the mobile robot, inputting the expected pose and the actual pose of the mobile robot into a backstepping kinematic controller to obtain a virtual control variable, inputting the virtual control variable and the actual speed into a dynamics controller to obtain a control moment, inputting the control moment and external disturbance into the dynamics model, and outputting acceleration so that the actual pose of the mobile robot reaches the expected pose.
The technical scheme is further optimized, and the kinematic model of the mobile robot is as follows:
the actual pose of the mobile robot at any moment is as follows:
x, y and in formula (1) Respectively representing the pose of the transverse direction, the longitudinal direction and the course angle of the mobile robot. The actual speed of the mobile robot at any moment is:
v=[v,ω]T (26)
v in the formula (2) is the linear velocity of the mobile robot, and ω is the angular velocity of the mobile robot.
When the contact surface of the wheels and the ground has no sliding or sideslip phenomenon, the motion model of the mobile robot can be expressed as follows:
in formula (3), a (q) is:
equation (4) is a jacobian matrix representing the relative relationship between pose and velocity.
According to the technical scheme, the dynamic model of the mobile robot is further optimized:
the mass m and moment of inertia I of the mobile robot, the kinetic model can be expressed as follows:
in the formula (5) of the present invention, For the acceleration vector, τ and τ d are input torque and disturbance, respectively, and M is:
according to further optimization of the technical scheme, the kinematic controller of the mobile robot is designed as follows:
The goal of the kinematic controller is to move the actual pose of the robot when the time t tends to infinity under the action of the control law v c Gradually converging to the expected pose, the expected speed v r=[vrr]T, and the expected poseWherein v r and ω r are the desired linear and angular speeds, x r,yr and ω r, respectively, of the mobile robotThe expected position and the expected position of the heading angle of the mobile robot are respectively;
the expected speed of the mobile robot in the global coordinate system is therefore:
The pose error is defined as:
wherein e x,ey and The pose error is respectively the error components along the X direction, the Y direction and the course angle direction, so that the pose error vector can be obtained as follows:
obtaining a pose error differential equation from the formula (8) and the formula (9):
Wherein the method comprises the steps of AndThe differential forms of pose errors in the transverse direction, the longitudinal direction and the course angle direction are respectively adopted, and a Liapunov function is constructed based on a backstepping method design idea in order to keep the system stable:
deriving the formula (11) and substituting the formula (10) into the formula to obtain:
to sum up, to ensure Designing a back-stepping method track tracking controller based on kinematics:
where v c and ω c are output virtual control amounts, and k 1,k2,k3 are both positive real numbers.
The technical scheme is further optimized, and the dynamics controller is as follows:
the speed tracking error of the mobile robot is defined as:
considering that the kinetic model of a wheeled mobile robot is a first order nonlinear function, here a proportional-integral slip-plane is chosen:
Where μ 1 and μ 2 are integral parameters of the slip plane and are both greater than 0, this can improve the robustness of the system when the system state moves to the slip plane at s=0:
Where μ=diag (μ 12) >0, so selecting an appropriate μ can lead to e v towards 0 when time goes to infinity, deriving equation (15), and combining equation (5) to get the following:
let equation (17) be 0, the resulting equivalent control law be:
the vector is therefore expressed as:
However, the actual mobile robot system generally has external interference, so that the switching control law τ sw is introduced to convert the formula (19) into the following form:
Where β=diag (β 12)>0,sgn(s)=[sgn(s1),sgn(s2) ].
(3) In the early stage of sliding mode movement, in order to ensure that the system state quickly approaches the sliding mode surface to weaken buffeting, the following exponential approach law is selected:
The control law is as follows:
Where η=diag (η 12)>0,q=diag(q1,q2) >0. The eta, q and epsilon are all adjustable parameters of an approach law, and the quality of an arrival process can be ensured and the buffeting phenomenon in a variable structure system can be weakened by reasonably adjusting the parameters;
(4) In the later and stable stages of the sliding mode movement, in order to weaken the buffeting phenomenon in the stable state, the following variable speed approach law is selected:
The control law is as follows:
Wherein the method comprises the steps of ε=diag(ε12)>0,vs(S,ε)=[ε1|ev|sgn(s1),-ε2|eω|sgn(s2)]T.
Compared with the prior art, the beneficial effects of the technical scheme are as follows:
The invention can realize the motion control of the mobile robot, effectively weaken buffeting phenomenon existing in the system, improve the track tracking and anti-interference capabilities of the mobile robot under the condition that the expected track has inflection points, and improve the motion precision of the track tracking of the mobile robot.
Drawings
FIG. 1 is a schematic diagram of a mobile robot model of the present invention;
FIG. 2 is a block diagram of the system architecture of the present invention;
FIG. 3 is a graph of the tracking effect of embodiments of the present invention on circular and polyline trajectories.
Detailed Description
In order to describe the technical content, constructional features, achieved objects and effects of the technical solution in detail, the following description is made in connection with the specific embodiments in conjunction with the accompanying drawings.
The invention discloses a mobile robot track tracking control method based on a back-stepping sliding mode method, wherein the mobile robot is a typical nonlinear system, has strong coupling, time-varying and nonlinear dynamics characteristics, and usually inevitably has uncertain factors such as parameter errors, unmodeled dynamics, observation noise, uncertain external interference and the like, so that a kinematic controller and a dynamics controller of the mobile robot are respectively designed based on the mobile robot, the problems are effectively solved, and the motion precision of track tracking of the mobile robot is improved.
The wheel type mobile robot is driven in a differential mode, and is simple in structure and flexible in steering. The invention aims at a differential-drive mobile robot, and solves the technical problems that when an inflection point exists in a motion path or an initial error of the motion path of the mobile robot is larger, the final track tracking effect of the mobile robot is poor due to the generated speed jump, and in addition, as a wheel type mobile robot system is a typical nonlinear system, the dynamic characteristics of strong coupling, time variation and nonlinearity are provided, uncertain factors such as parameter errors, unmodeled dynamics, observation noise, uncertain external interference and the like are inevitably present, and the performance of track tracking of the mobile robot is adversely affected. Thus, in the above state, how to control the motion state of the mobile robot so that it better tracks a predetermined time-varying path, thereby stably traveling according to the expected state.
A mobile robot track tracking control method based on a backstepping sliding mode method comprises the following steps:
Step 1, performing kinematic and dynamic modeling on a mobile robot;
referring to fig. 1, a simplified model diagram of a mobile robot is shown. The global coordinate system XOY is a Cartesian inertial coordinate system, allows the mobile robot to move in the Cartesian inertial coordinate system, is used for representing environmental information, and is characterized in that the center of mass of the mobile robot and the center of the axis of the driving wheel are coincided with a point P, the mass is m, the moment of inertia is I, the forward linear speed of the mass movement of the mobile robot is v, the rotation angle speed of the mass movement is omega, and the included angle between the movement direction of the mobile robot and the X-axis direction is formed Is a heading angle, and thus the centroid P of the mobile robot is physically analyzed.
Step 1.1, establishing a kinematic model of the mobile robot
The actual pose of the mobile robot at any moment is as follows:
x, y and in formula (1) Respectively representing the pose of the transverse direction, the longitudinal direction and the course angle of the mobile robot. The actual speed of the mobile robot at any moment is:
V=[v,ω]T (50)
v in the formula (2) is the linear velocity of the mobile robot, and ω is the angular velocity of the mobile robot.
When the contact surface of the wheels and the ground has no sliding or sideslip phenomenon, the motion model of the mobile robot can be expressed as follows:
in formula (3), a (q) is:
equation (4) is a jacobian matrix, representing the relative relationship between the actual pose and the actual velocity.
Step 1.2, establishing a dynamic model of the mobile robot
Considering the mass m and moment of inertia I of the mobile robot, the kinetic model can be expressed as follows:
in the formula (5) of the present invention, For the acceleration vector, τ and τ d are control moment and disturbance, respectively, and the mass and moment of inertia matrix M of the mobile robot is:
Step 2, designing a mobile robot kinematics controller based on a backstepping method
Referring to fig. 2, in the motion process of the mobile robot, the reference speed is used as input, the actual motion pose error of the mobile robot is obtained through a kinematic model, namely a formula (3), a feedback controller is obtained through recursively constructing a Lyapunov function of a closed-loop system by a backstepping method, a control law is selected to enable a derivative of the Lyapunov function along a track of the closed-loop system to have certain performance, the bounded nature and convergence of the track of the closed-loop system to be guaranteed, the selected control law is a solution of the track tracking problem, the method can decompose a complex nonlinear system into subsystems which do not exceed the system order, then a part of the Lyapunov function and an intermediate virtual control quantity are designed for each subsystem, the whole system is always 'backed-off', and the Lyapunov function and the intermediate virtual control quantity are integrated to complete the design of the whole control law, and the basic design method is that the design of a kernel of a high-order system is started. The method comprises the steps of designing a virtual control law to ensure certain performance of a kernel system, such as stability, and the like, then gradually correcting an algorithm for the obtained virtual control law, but ensuring the set performance, and further designing a real calm controller to realize global regulation or tracking of the system so as to enable the system to reach expected performance indexes. The back-step control method is suitable for an uncertain nonlinear system which can be linearized in a state or has strict parameter feedback, and has obvious superiority in the aspect of designing a robust or self-adaptive controller of the uncertain system, especially when interference or uncertainty does not meet a matching condition. The kinematic controller is therefore designed for the mobile robot based on this method.
The goal of the kinematic controller is to move the actual pose of the robot when the time t tends to infinity under the action of the control law v c Gradually converging to the expected pose, the expected speed v r=[vrr]T, and the expected poseWherein v r and ω r are the desired linear and angular speeds, x r,yr and ω r, respectively, of the mobile robotThe position and the orientation of the mobile robot are respectively a horizontal expected position and a longitudinal expected position and an orientation angle expected position of the mobile robot.
The expected speed of the mobile robot in the global coordinate system is therefore:
The pose error is defined as:
wherein e x,ey and The pose error is respectively the error components along the X direction, the Y direction and the course angle direction, so that the pose error vector can be obtained as follows:
obtaining a pose error differential equation from the formula (8) and the formula (9):
Wherein the method comprises the steps of AndThe differential forms of pose errors in the transverse direction, the longitudinal direction and the course angle direction are respectively adopted, and a Liapunov function is constructed based on a backstepping method design idea in order to keep the system stable:
deriving the formula (11) and substituting the formula (10) into the formula to obtain:
to sum up, to ensure Designing a back-stepping method track tracking controller based on kinematics:
Where v c and ω c are output virtual control amounts, and k 1,k2,k3 are both positive real numbers. Thereby ensuring that the actual pose q also converges to the expected pose q r when the time t approaches infinity under the action of the control law v c. It can be seen that v c is suddenly changed when the expected track has an inflection point or the initial moment tracking error is large, and a moment with a large value is required for the mobile robot, but the moment is difficult to realize in the control of the actual mobile robot. Therefore, in the actual track tracking control process, the speed tracking v-v r is the premise of q-q r, and only the kinematic controller is designed, so that the high-quality speed tracking cannot be ensured, and the dynamic controller is required to be designed.
And 3, a sliding mode variable structure control method based on a combined approach law.
The sliding mode variable structure control method is essentially a special nonlinear control, the nonlinearity of which is represented by control discontinuity, and the control method is different from other controls in that the structure of the system is not fixed, but the system can be purposefully and continuously changed in a dynamic process according to the current state of the system, such as deviation and various derivatives thereof, so that the system moves according to the state track of a preset sliding mode. The sliding mode control has the advantages of overcoming the uncertainty of the system, having strong robustness to disturbance and unmodeled dynamics, and particularly having good control effect on the control of a nonlinear system. The variable structure control system has simple algorithm, high response speed and robustness to external noise interference and parameter perturbation, so the variable structure control system is widely applied to related researches of mobile robots. However, the disadvantage of this method is that when the state trace reaches the sliding surface, it is difficult to slide along the sliding surface strictly toward the balance point, but the state trace passes back and forth on both sides of the sliding surface, so that chatter, i.e., a buffeting problem, is generated. Therefore, the sliding mode variable structure control does not need to establish an accurate model of a controlled object, has insensitivity to external bounded interference and parameter change, and is gradually applied to motion control of a mobile robot in recent years. However, the sliding mode variable structure control inevitably generates buffeting, and unstable system is caused when serious, so that the track tracking is failed. The invention provides a sliding mode control method based on a combined approach law based on a sliding mode variable structure, which can effectively weaken the buffeting phenomenon of a control system and improve the stability and track tracking performance of the control system. As shown in fig. 2, the sliding mode control uses the virtual output variable v c of the back-step control method in step 2 and the difference value of the actual speed v of the mobile robot as input, so as to make v converge to v c, and make the system reach the stability of speed tracking, thereby ensuring the accuracy of system track tracking. It is therefore necessary to design a dynamic controller based on a sliding mode variable structure.
First, the speed tracking error of the mobile robot is defined as:
considering that the kinetic model of a wheeled mobile robot is a first order nonlinear function, here a proportional-integral slip-plane is chosen:
Where μ 1 and μ 2 are integral parameters of the slip plane and are both greater than 0, this can improve the robustness of the system when the system state moves to the slip plane at s=0:
Where μ=diag (μ 12) >0, so selecting an appropriate μ can trend 0 when time goes to infinity, e v. Deriving the formula (15) and combining the formula (5) to obtain the following:
let equation (17) be 0, the resulting equivalent control law be:
the vector is therefore expressed as:
However, the actual mobile robot system generally has external disturbance in order to weaken the influence of the disturbance in the system, so that the switching control law τ sw is introduced to convert the formula (19) into the following form:
Wherein the adjustable parameter of the system β=diag (β 12)>0,sgn(s)=[sgn(s1),sgn(s2) ].
However, the discontinuous term sgn(s) in the control law τ may cause the system to toggle back and forth between different control logics, thereby causing the system to buffeting. Therefore, the combined approach law is introduced into the tracking problem of the mobile robot, the buffeting problem in the sliding mode movement is weakened by replacing the sign function sgn(s), the rapidity and the stability of the tracking process are ensured, namely, the system state can be ensured to quickly approach the sliding mode surface and weaken buffeting by adopting the exponential approach law in the early stage of the sliding mode movement, and the buffeting in the steady state is effectively reduced by adopting the variable speed approach law in the later stage and the steady stage of the sliding mode movement, so that the good steady state performance is ensured, and the specific implementation process comprises the following two stages:
(5) In the early stage of sliding mode movement, in order to ensure that the system state quickly approaches the sliding mode surface to weaken buffeting, the following exponential approach law is selected:
The control law is as follows:
Where η=diag (η 12)>0,q=diag(q1,q2) >0. The eta, q and epsilon are all adjustable parameters of the approach law, and the quality of the arrival process can be ensured and the buffeting phenomenon in the variable structure system can be weakened by reasonably adjusting the parameters.
(6) In the later and stable stages of the sliding mode movement, in order to weaken the buffeting phenomenon in the stable state, the following variable speed approach law is selected:
The control law is as follows:
Wherein the method comprises the steps of ε=diag(ε12)>0,vs(S,ε)=[ε1|ev|sgn(s1),-ε2|eω|sgn(s2)]T.
Stability analysis was then performed, using the lyapunov function to demonstrate the effectiveness of the proposed kinetic controller:
Differentiating the formula (25) and combining the formula (21) can obtain:
deriving equation (25) and combining equation (23) yields:
is available in the form of The dynamics control system is thus stable, ensuring a fast and stable convergence of the actual speed v to the virtual control speed v c.
Step 2 and step 3 finish the design of the kinematic and dynamic controllers of the mobile robot, are suitable for a typical complex system with strong coupling, time varying and nonlinearity such as a wheeled mobile robot system, and effectively reduce the buffeting problem in track tracking motion.
And 4, realizing accurate track tracking of the mobile robot by combining the designed control system according to the method. The final control system block diagram is shown in fig. 2.
According to this control method, the mobile robot trajectory tracking effect is shown in fig. 3.
According to the final algorithm detection result, the method for tracking the track of the mobile robot provided by the invention can realize accurate track tracking of the mobile robot with uncertain factors under the condition that the track has inflection points, has a good tracking effect, effectively weakens the buffeting phenomenon of a system, ensures the stability and rapidity of track tracking, and realizes the motion control of the mobile robot.
It is noted that relational terms such as first and second, and the like are used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions. Moreover, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or terminal that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or terminal. Without further limitation, elements defined by the phrases "including" or "comprising" do not exclude the presence of additional elements in a process, method, article, or terminal device that includes the elements. In addition, herein, "greater than", "less than", "exceeding" and the like are understood to exclude the present number, and "above", "below", "within" and the like are understood to include the present number.
While the embodiments have been described above, other variations and modifications will occur to those skilled in the art once the basic inventive concepts are known, and it is therefore intended that the foregoing description and drawings illustrate only embodiments of the invention and not limit the scope of the invention, and it is therefore intended that the invention not be limited to the specific embodiments described, but that the invention may be practiced with their equivalent structures or with their equivalent processes or with their use directly or indirectly in other related fields.

Claims (2)

1.一种基于反步滑模的移动机器人轨迹跟踪方法,其特征在于,包括如下步骤:1. A mobile robot trajectory tracking method based on backstepping sliding mode, characterized in that it includes the following steps: 步骤1:建立移动机器人的运动学模型和动力学模型;Step 1: Establish the kinematic model and dynamic model of the mobile robot; 步骤2:基于反步法设计移动机器人的运动学控制器;Step 2: Design the kinematic controller of the mobile robot based on the backstepping method; 步骤3:基于组合趋近律的滑模变结构设计移动机器人的动力学控制器;Step 3: Design the dynamic controller of the mobile robot based on the sliding mode variable structure of the combined reaching law; 步骤4:根据机器人的运动学模型,得到移动机器人的实际位姿和实际速度;将移动机器人的期望位姿和实际位姿输入反步法运动学控制器,得到虚拟控制变量,将虚拟控制变量和实际速度输入到动力学控制器,得到控制力矩,将控制力矩和外界扰动输入动力学模型,输出加速度,使得移动机器人的实际位姿达到期望位姿;Step 4: According to the kinematic model of the robot, the actual position and speed of the mobile robot are obtained; the desired position and actual position of the mobile robot are input into the backstepping kinematic controller to obtain virtual control variables, the virtual control variables and actual speed are input into the dynamic controller to obtain control torque, the control torque and external disturbance are input into the dynamic model, and the acceleration is output so that the actual position of the mobile robot reaches the desired position; 所述移动机器人的运动学模型:Kinematic model of the mobile robot: 移动机器人在任意时刻的实际位姿为:The actual position of the mobile robot at any time is: 公式(1)中的x,y和分别表示移动机器人横向、纵向以及航向角的位姿,移动机器人在任意时刻的实际速度为:In formula (1), x, y and They represent the lateral, longitudinal and heading angle positions of the mobile robot respectively. The actual speed of the mobile robot at any time is: v=[v,ω]T (2)v=[v,ω] T (2) 公式(2)中的v为移动机器人的线速度,ω为移动机器人的角速度;In formula (2), v is the linear velocity of the mobile robot, and ω is the angular velocity of the mobile robot; 当轮子与地面接触面无滑动或者无侧滑现象时,移动机器人的运动模型可表示为:When there is no sliding or side slipping between the wheels and the ground, the motion model of the mobile robot can be expressed as: 公式(3)中,A(q)为:In formula (3), A(q) is: 公式(4)为雅克比矩阵,表示位姿与速度之间的相对关系;Formula (4) is the Jacobian matrix, which represents the relative relationship between posture and velocity; 所述移动机器人的动力学模型:The dynamic model of the mobile robot: 移动机器人的质量m和转动惯量I,动力学模型表达如下式:The mass m and moment of inertia I of the mobile robot, the dynamic model is expressed as follows: 公式(5)中,为加速度矢量,τ和τd分别为输入力矩和扰动,M为:In formula (5), is the acceleration vector, τ and τ d are the input torque and disturbance respectively, and M is: 所述移动机器人的运动学控制器设计如下:The kinematic controller of the mobile robot is designed as follows: 运动学控制器的目标是在控制律vc的作用下,使得时间t趋于无穷大时,移动机器人的实际位姿也逐渐收敛于期望位姿,期望速度vr=[vr,ωr]T,期望位姿其中vr和ωr分别为移动机器人的期望线速度和期望角速度,xr,yr分别为移动机器人的横向期望位姿、纵向期望位姿以及航向角期望位姿;The goal of the kinematic controller is to make the actual position of the mobile robot as time t tends to infinity under the control law v c It also gradually converges to the desired posture, the expected speed v r = [v r , ω r ] T , the expected posture where v r and ω r are the desired linear velocity and angular velocity of the mobile robot, respectively, and x r , y r and They are the expected lateral position, longitudinal position and heading angle position of the mobile robot respectively; 因此移动机器人在全局坐标系下的期望速度为:Therefore, the expected speed of the mobile robot in the global coordinate system is: 位姿误差定义为:The pose error is defined as: 其中ex,ey分别为位姿误差沿X方向、Y方向以及航向角方向的误差分量,因此得到位姿误差矢量为:where ex , ey and are the error components of the posture error along the X direction, Y direction and heading angle direction, so the posture error vector is: 由公式(8)和公式(9)得到位姿误差微分方程:The posture error differential equation is obtained from formula (8) and formula (9): 其中分别为横向、纵向以及航向角方向上的位姿误差的微分形式,为保持系统稳定,基于反步法设计思想构造李亚普诺夫函数:in and are the differential forms of the posture errors in the lateral, longitudinal and heading directions respectively. To keep the system stable, the Lyapunov function is constructed based on the backstepping design idea: 将式(11)求导并将式(10)代入得到:Deriving equation (11) and substituting equation (10) into it, we get: 综上,为保证设计基于运动学的反步法轨迹跟踪控制器:In summary, to ensure Design a kinematics-based backstepping trajectory tracking controller: 其中vc和ωc为输出虚拟控制量,k1,k2,k3均为正实数。Where v c and ω c are output virtual control quantities, and k 1 , k 2 , and k 3 are all positive real numbers. 2.如权利要求1所述的基于反步滑模的移动机器人轨迹跟踪方法,其特征在于,所述动力学控制器:2. The mobile robot trajectory tracking method based on backstepping sliding mode according to claim 1, characterized in that the dynamic controller: 将移动机器人的速度跟踪误差定义为:The velocity tracking error of the mobile robot is defined as: 考虑到轮式移动机器人的动力学模型是一阶非线性函数,这里选择比例积分型滑模面:Considering that the dynamic model of the wheeled mobile robot is a first-order nonlinear function, the proportional integral sliding surface is selected here: 其中μ1和μ2是滑模面的积分参数,且均大于0,能提高系统的鲁棒性,当系统状态运动到在S=0的滑模面时:Where μ 1 and μ 2 are integral parameters of the sliding surface, and both are greater than 0, which can improve the robustness of the system. When the system state moves to the sliding surface at S = 0: 其中μ=diag(μ1,μ2)>0,因此选择合适的μ可在时间趋向于无穷时,ev趋向于0,对公式(15)求导,并结合公式(5),得到如下:Wherein μ=diag(μ 12 )>0, so by choosing a suitable μ, when time tends to infinity, ev tends to 0. By taking the derivative of formula (15) and combining it with formula (5), we get the following: 令公式(17)为0,得到等效控制律为:Let formula (17) be 0, and the equivalent control law is: 因此其矢量表达为:Therefore, its vector expression is: 而实际的移动机器人系统一般都存在着外界干扰,因此引入切换控制律τsw,将公式(19)转换为如下形式:However, actual mobile robot systems generally have external interference, so the switching control law τ sw is introduced to convert formula (19) into the following form: 其中β=diag(β1,β2)>0,sgn(s)=[sgn(s1),sgn(s2)];Where β=diag(β 1 , β 2 )>0, sgn(s)=[sgn(s 1 ), sgn(s 2 )]; (1)在滑模运动的前期,为保证系统状态快速趋近滑模面以削弱抖振,因此选取如下指数趋近律:(1) In the early stage of sliding mode motion, in order to ensure that the system state quickly approaches the sliding mode surface to weaken chattering, the following exponential approach law is selected: 其控制律为:Its control law is: 其中,η=diag(η1,η2)>0,q=diag(q1,q2)>0;上述η,q以及ε均为趋近律的可调参数,通过合理调节这些参数能保证到达过程的品质并减弱变结构系统中的抖振现象;Wherein, η=diag(η 12 )>0, q=diag(q 1 ,q 2 )>0; the above η, q and ε are all adjustable parameters of the reaching law. By reasonably adjusting these parameters, the quality of the reaching process can be guaranteed and the chattering phenomenon in the variable structure system can be weakened; (2)在滑模运动的后期和稳定段,为了削弱稳定状态时的抖振现象,这里选取如下变速趋近律:(2) In the late stage and stable stage of sliding mode motion, in order to weaken the chattering phenomenon in the stable state, the following speed reaching law is selected here: 其控制律为:Its control law is: 其中ε=diag(ε1,ε2)>0,vs(S,ε)=[ε1|ev|sgn(s1),-ε2|eω|sgn(s2)]TWhere ε=diag(ε 1 , ε 2 )>0, vs(S, ε)=[ε 1 |e v |sgn(s 1 ), -ε 2 |e ω |sgn(s 2 )] T .
CN202210558029.6A 2022-05-19 2022-05-19 A mobile robot trajectory tracking method based on backstepping sliding mode Active CN115128949B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210558029.6A CN115128949B (en) 2022-05-19 2022-05-19 A mobile robot trajectory tracking method based on backstepping sliding mode

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210558029.6A CN115128949B (en) 2022-05-19 2022-05-19 A mobile robot trajectory tracking method based on backstepping sliding mode

Publications (2)

Publication Number Publication Date
CN115128949A CN115128949A (en) 2022-09-30
CN115128949B true CN115128949B (en) 2025-02-07

Family

ID=83376957

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210558029.6A Active CN115128949B (en) 2022-05-19 2022-05-19 A mobile robot trajectory tracking method based on backstepping sliding mode

Country Status (1)

Country Link
CN (1) CN115128949B (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108319138A (en) * 2018-01-29 2018-07-24 哈尔滨工程大学 A kind of sliding formwork of drive lacking unmanned boat-contragradience double loop Trajectory Tracking Control method
CN110597268A (en) * 2019-09-30 2019-12-20 东南大学 A Trajectory Tracking Control Method for Wheeled Mobile Robots Based on Cascade System Theory

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2306581C1 (en) * 2006-04-07 2007-09-20 Владимир Романович Мамошин Method for multi-dimensional trajectory tracking of an object and device for realization of said method

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108319138A (en) * 2018-01-29 2018-07-24 哈尔滨工程大学 A kind of sliding formwork of drive lacking unmanned boat-contragradience double loop Trajectory Tracking Control method
CN110597268A (en) * 2019-09-30 2019-12-20 东南大学 A Trajectory Tracking Control Method for Wheeled Mobile Robots Based on Cascade System Theory

Also Published As

Publication number Publication date
CN115128949A (en) 2022-09-30

Similar Documents

Publication Publication Date Title
Liu et al. Adaptive sliding mode based disturbance attenuation tracking control for wheeled mobile robots
Wen et al. Elman fuzzy adaptive control for obstacle avoidance of mobile robots using hybrid force/position incorporation
CN108008720B (en) Fuzzy sliding mode trajectory tracking control and method for wheeled mobile robot
Dian et al. Modeling and trajectory tracking control for magnetic wheeled mobile robots based on improved dual-heuristic dynamic programming
CN105629729A (en) Network mobile robot locus tracking control method based on linearity auto-disturbance rejection
CN113848905B (en) Mobile robot track tracking method based on neural network and self-adaptive control
CN109857100B (en) Composite track tracking control algorithm based on inversion method and fast terminal sliding mode
Liu et al. Direction and trajectory tracking control for nonholonomic spherical robot by combining sliding mode controller and model prediction controller
Xie et al. Asynchronous H∞ continuous stabilization of mode-dependent switched mobile robot
Yue et al. Path tracking control of skid-steered mobile robot on the slope based on fuzzy system and model predictive control
CN115202349A (en) Multi-mobile robot cooperative formation control method, device, equipment and storage medium based on communication interference
CN112578671A (en) AGV track tracking control method based on U model optimization SMC
Ribeiro et al. Nonlinear model predictive visual path following control to autonomous mobile robots
Li et al. Observer-based multivariable fixed-time formation control of mobile robots
CN118131623A (en) Global fixed-time backstepping second-order sliding mode control method for industrial hybrid robots
Moudoud et al. Robust adaptive trajectory tracking control based on sliding mode of electrical wheeled mobile robot
Zijie et al. PID control of an omnidirectional mobile platform based on an RBF neural network controller
CN117193324A (en) Robot self-adaptive path tracking control method based on improved model predictive control
CN114625136B (en) A robot trajectory tracking control method based on deep learning
Wang et al. Trajectory tracking control based on adaptive neural dynamics for four-wheel drive omnidirectional mobile robots
CN115128949B (en) A mobile robot trajectory tracking method based on backstepping sliding mode
CN113954077A (en) Underwater swimming mechanical arm trajectory tracking control method and device with energy optimization function
Dong et al. Phase portrait analysis and drifting control of unmanned tracked vehicles
CN113377016B (en) Slip-considered multi-mobile-robot cooperative formation buffeting-free sliding mode control method
Li Research on robot motion control based on variable structure fuzzy neural network based on TS model

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant