CN111949036B - Trajectory tracking control method and system and two-wheeled differential mobile robot - Google Patents

Trajectory tracking control method and system and two-wheeled differential mobile robot Download PDF

Info

Publication number
CN111949036B
CN111949036B CN202010864372.4A CN202010864372A CN111949036B CN 111949036 B CN111949036 B CN 111949036B CN 202010864372 A CN202010864372 A CN 202010864372A CN 111949036 B CN111949036 B CN 111949036B
Authority
CN
China
Prior art keywords
mobile robot
differential
differential mobile
wheeled
wheeled differential
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
CN202010864372.4A
Other languages
Chinese (zh)
Other versions
CN111949036A (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.)
Chongqing University of Post and Telecommunications
Original Assignee
Chongqing University of Post and Telecommunications
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 Chongqing University of Post and Telecommunications filed Critical Chongqing University of Post and Telecommunications
Priority to CN202010864372.4A priority Critical patent/CN111949036B/en
Publication of CN111949036A publication Critical patent/CN111949036A/en
Application granted granted Critical
Publication of CN111949036B publication Critical patent/CN111949036B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a track tracking control method, a track tracking control system and a two-wheeled differential mobile robot, wherein the tracking method comprises the following steps: rewriting a motion model of the differential mobile robot according to a differential flat theory to obtain a kinematics model based on the differential flat theory; designing a reduced-order generalized proportional-integral observer based on a kinematics model of a differential flat theory to obtain time-varying disturbance and speed estimation; and according to the estimation of the speed and the time-varying disturbance, combining the measurement position of the differential mobile robot and a given reference track to obtain the output control quantity of the track tracking controller, and converting the output control quantity to act on the kinematic model of the differential mobile robot. The system is based on a track tracking control method, and the system is integrated in the two-wheeled differential mobile robot. The invention can lead the differential mobile robot to stably track the given reference track and realize higher tracking precision.

Description

Trajectory tracking control method and system and two-wheeled differential mobile robot
Technical Field
The invention relates to the field of track tracking control methods of two-wheeled differential mobile robot systems, in particular to a track tracking control method and system and a two-wheeled differential mobile robot.
Background
More and more mobile robots are applied to industrial fields, such as food and beverage services, storage, logistics and the like. The two-wheeled differential mobile robot has the advantages of simple structure, low cost, convenient control and the like, and is widely adopted in the fields. In practical applications, two-wheeled differential mobile robots typically perform trajectory tracking tasks.
In order to make a two-Wheeled Differential Mobile robot run along a predetermined trajectory, many control algorithms are proposed, and general PDs (c.p.tang, p.t.miller, v.n.krovi, j.ryutand s.k.agrawal, "Differential-flexible-Based Planning and control of wheel Mobile Manipulator-Theory and Experiment," in IEEE/ASME Transactions on mechanics, vol.16, No.4, pp.768-773, aug.2011, doi:10.1109/tmech.2010.2066282.) are favored by many engineers because of their simple control structure. However, in an actual control system, various time-varying disturbances, such as parameter variations, wheel slip, and road surface irregularities, exist, and when the time-varying disturbances are encountered, the tracking performance of a general PD control algorithm is degraded. In order to inhibit interference, the tracking precision of the two-wheeled differential mobile robot in a track tracking task is improved.
Disclosure of Invention
In view of the above, the present invention provides a trajectory tracking control method, which enables a two-wheeled differential mobile robot to stably track a given reference trajectory and achieve a higher tracking accuracy; the other purpose is to provide a track tracking control system based on the method; the three-wheel differential mobile robot internally integrated with the track tracking control system is provided.
The purpose of the invention is realized by the following technical scheme:
a method for controlling the tracking of a track,
rewriting a motion model of the differential mobile robot according to a differential flat theory to obtain a kinematics model based on the differential flat theory;
designing a reduced-order generalized proportional-integral observer based on a kinematics model of a differential flat theory to obtain time-varying disturbance and speed estimation;
and according to the estimation of the speed and the time-varying disturbance, combining the measured positions of the two-wheeled differential mobile robot and a given reference track to obtain the output control quantity of the track tracking controller, and applying the output control quantity to the kinematic model of the differential mobile robot.
Further, the motion model of the differential mobile robot is as follows:
Figure BDA0002649242070000021
Figure BDA0002649242070000022
Figure BDA0002649242070000023
wherein: x represents the position in the X-axis direction of the inertial reference frame, Y represents the position in the Y-axis direction of the inertial reference frame, [ phi ] represents the direction angle of the body coordinate system of the differential mobile robot relative to the inertial reference frame, [ v ] represents the linear velocity of the differential mobile robot, [ omega ] represents the angular velocity of the differential mobile robot, [ v ] represents the angular velocity of the differential mobile robot s 、v t 、ω s Respectively representing the longitudinal sliding speed, the transverse sliding speed and the sliding angular speed of the differential mobile robot.
Further, the kinematic model based on the differential flat theory is as follows:
Figure BDA0002649242070000024
wherein
Figure BDA0002649242070000025
Figure BDA0002649242070000026
Figure BDA0002649242070000027
Figure BDA0002649242070000028
Define the flat output variable as:
Figure BDA0002649242070000029
wherein, a 1 、a 2 Is the centralized disturbance received by the system;
u 1 、u 2 is the middle term.
Further, the design method of the reduced-order generalized proportional-integral observer is as follows:
based on the differential flat theory based kinematic model, the following state variables are defined:
Figure BDA00026492420700000210
from the state variables, the following form of the state space is obtained:
Figure BDA0002649242070000031
based on the above formula, a reduced generalized proportional-integral observer is designed as follows:
Figure BDA0002649242070000032
the following variables are defined:
Figure BDA0002649242070000033
further, it is possible to obtain:
Figure BDA0002649242070000034
Figure BDA0002649242070000035
Figure BDA0002649242070000036
the respective states can be obtained as follows:
Figure BDA0002649242070000037
wherein:
Figure BDA0002649242070000038
represents the velocity estimation of the mobile robot in the direction of the axis of the inertial coordinate system X (i: 1) or Y (i: 2),
Figure BDA0002649242070000039
an estimate of the time-varying disturbance is represented,
Figure BDA00026492420700000310
estimate of the first derivative, λ, representing a time-varying disturbance 1i 、λ 2i 、λ 3i Are the coefficients of the observer.
Further, said λ 1i 、λ 2i 、λ 3i The values of (a) are such that the roots of the following formula all fall in the left half plane of the complex plane,
p(s)=s 31i s 22i s+λ 3i
further, the method for designing the output control quantity for the trajectory tracking control specifically includes:
substituting the time-varying disturbance estimation and the speed estimation into the following formula to obtain u 1 And u 2
Figure BDA0002649242070000041
Subjecting said u to 1 And u 2 Substituting the following formula to obtain the control input actually applied to the system,
Figure BDA0002649242070000042
wherein the content of the first and second substances,
Figure BDA0002649242070000043
e x =x mes -x r ,e y =y mes -y r
Figure BDA0002649242070000044
representing the second derivative of a given reference trajectory,
Figure BDA0002649242070000045
representing the first derivative, x, of a given reference trajectory r ,y r Representing a given reference trajectory, x mes ,y mes Indicating the position of the differentially-moved robot, measured at the present moment, phi mes ,v mes Indicating the linear and angular velocities, L, of the differentially-moved robot measured at the present time 1 ,L 0 In order to control the gain of the laws,
Figure BDA0002649242070000046
ω * is the control input actually applied to the system.
Further, L is 1 ,L 0 Such that the roots of the following all fall in the left half plane of the complex plane,
p(s)=s 2 +L 1 s+L 0
the trajectory tracking control system based on the trajectory tracking control method comprises
The sensor is used for measuring the position of the differential mobile robot in the X-axis direction under an inertial coordinate system at the current moment, the position, the linear speed and the direction angle of the differential mobile robot in the Y-axis direction under the inertial coordinate system;
the reduced-order generalized proportional-integral observer module is used for outputting a speed estimation and a time-varying disturbance estimation;
a position control module for receiving the velocity estimate and the time-varying disturbance estimate and outputting u 1 And u 2
Input conversion module receiving u 1 And u 2 The output is the control input actually applied to the system.
A two-wheeled differential mobile robot is integrated with a track tracking control system.
The beneficial effects of the invention are:
1. the order-reduced generalized proportional-integral observer can estimate time-varying interference, and the order of the observer is lower than that of a common generalized proportional-integral observer, so that the requirement on the computing capacity of hardware is reduced.
2. The reduced-order generalized proportional-integral observer can estimate the speed, so that the use of a speed sensor is reduced, and the development cost is reduced.
3. The track tracking controller with the active interference suppression capability is insensitive to interference and system parameter change thereof, can effectively reduce steady-state errors, can suppress various time-varying interferences, and has good robustness.
4. The invention can lead the two-wheeled differential mobile robot to stably track the given reference track and realize higher tracking precision.
Additional advantages, objects, and features of the invention will be set forth in part in the description which follows and in part will become apparent to those having ordinary skill in the art upon examination of the following or may be learned from practice of the invention. The objectives and other advantages of the invention may be realized and attained by the means of the instrumentalities and combinations particularly pointed out hereinafter.
Drawings
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention will be further described in detail with reference to the accompanying drawings, in which:
FIG. 1 is a block diagram of a two-wheeled differential mobile robot trajectory tracking control system under the recommended control method;
fig. 2 is a trace tracking comparison of the method of the present invention with a general PD control method, assuming that the system is not disturbed,
wherein (a) is a tracking track under a general PD controller, wherein (a1) is a position tracking result under the PD controller, and (a2) is e under the PD controller x As a function of time, (a3) is e under the PD controller y A change over time;
(b) tracking the track under the method of the present invention, wherein (b1) is the position tracking result under the method of the present invention, and (b2) is e under the method of the present invention x As a function of time, (b3) is e under the process of the invention y A change over time;
fig. 3 is a trace tracking diagram of the method of the present invention compared to a general PD control method, assuming that the system is disturbed,
wherein (a) is a tracking track under a general PD controller, (a1) is a position tracking result under the PD controller, and (a2) is e under the PD controller x Time dependent change, (a3) is e under PD controller y A change over time;
(b) is the tracking track under the method of the present invention, (b1) is the position tracking result under the method of the present invention, and (b2) is the e under the method of the present invention x At any timeIn (b3) is (e) in the process of the invention y A change over time;
FIG. 4 is a control law output curve for the method of the present invention assuming the system is perturbed, where (a) is η v Control curve, (b) is the control curve of ω;
FIG. 5 is an estimate of velocity and disturbance by a reduced-order generalized proportional-integral observer assuming that the system is disturbed,
wherein (a) the reduced generalized proportional integral observer estimates the velocity, (a1) is the velocity estimate in the X-axis direction under the inertial frame, and (a2) is the velocity estimate in the Y-axis direction under the inertial frame;
(b) the disturbance estimation of the reduced generalized proportional integral observer is (b1) the disturbance estimation of the X axis in the inertial coordinate system, and (b2) the disturbance estimation of the Y axis in the relational coordinate system.
Detailed Description
Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings. It should be understood that the preferred embodiments are illustrative of the invention only and are not limiting upon the scope of the invention.
Example 1
The embodiment provides a trajectory tracking control method, which includes measuring the position of a two-wheeled differential robot in the X-axis direction under an inertial coordinate system, the position of the two-wheeled differential robot in the Y-axis direction under the inertial coordinate system, the linear velocity and the direction angle by a sensor, inputting variable information into a reduced-order generalized proportional-integral observer for operation, outputting time-varying disturbance and speed, obtaining output control quantity by the data, and further performing tracking control on a trajectory. Specifically, the method comprises the following steps:
and (4) rewriting the motion model of the two-wheeled differential mobile robot according to the differential flat theory to obtain a kinematic model based on the differential flat theory.
The motion model of the two-wheeled differential mobile robot is as follows:
Figure BDA0002649242070000061
wherein: x represents the position in the X-axis direction of the inertial reference frame, Y represents the position in the Y-axis direction of the inertial reference frame, [ phi ] represents the direction angle of the body coordinate system of the two-wheeled differential mobile robot with respect to the inertial reference frame, [ v ] represents the linear velocity of the two-wheeled differential mobile robot, [ omega ] represents the angular velocity of the two-wheeled differential mobile robot, and [ v ] represents the angular velocity of the two-wheeled differential mobile robot s 、v t 、ω s Respectively representing the longitudinal sliding speed, the transverse sliding speed and the sliding angular speed of the two-wheel differential mobile robot.
The kinematic model is rewritten into a kinematic model based on a differential flat theory, and the derivation process is as follows:
output (define) the flat variable:
Figure BDA0002649242070000062
the first derivative of equation (2) is expressed as:
Figure BDA0002649242070000063
since the mapping between the system inputs (v, ω) and the system outputs (x, y) is singular, an auxiliary input variable η is introduced v Then, the formula (1) may be changed to the following form:
Figure BDA0002649242070000064
Figure BDA0002649242070000071
the derivation of formula (4) yields formula (5).
Figure BDA0002649242070000072
Wherein:
Figure BDA0002649242070000073
when v ≠ 0, the mapping relationship between the input variable and the output variable of equation (5) is invertible, making it possible to identify the output variable as a function of the output variable
Figure BDA0002649242070000074
The formula (6) is substituted into the formula (5), and a kinematic model based on the differential flat theory is obtained, as shown in the formula (7).
Figure BDA0002649242070000075
Wherein
Figure BDA0002649242070000076
Wherein, a 1 、a 2 Is the centralized disturbance received by the system;
u 1 、u 2 is the middle term.
A reduced-order generalized proportional-integral observer is designed based on a kinematic model of a differential flat theory to obtain time-varying disturbance and speed estimation. Specifically, the design method of the reduced-order generalized proportional-integral observer is as follows:
a kinematic model based on differential flat theory (equation (7)) defines the following state variables:
Figure BDA0002649242070000081
from the state variables, the following form of the state space is obtained:
Figure BDA0002649242070000082
the reduced-order generalized proportional-integral observer can be implemented as follows:
Figure BDA0002649242070000083
normally, state x 2i Is not easily accurately measured, however, state x 1i The method can be relatively easily and accurately measured, and in order to enable the reduced-order generalized PID observer to normally work, the following variables are defined:
Figure BDA0002649242070000084
further, it is possible to obtain:
Figure BDA0002649242070000085
the respective states can be obtained in the manner of equation (14):
Figure BDA0002649242070000091
wherein:
Figure BDA0002649242070000092
represents the velocity estimation of the mobile robot in the direction of the axis of the inertial coordinate system X (i-1) or Y (i-2),
Figure BDA0002649242070000093
an estimate of the time-varying disturbance is represented,
Figure BDA0002649242070000094
estimate of the first derivative, λ, representing a time-varying disturbance 1i 、λ 2i 、λ 3i Is a coefficient of the observer, λ 1i 、λ 2i 、λ 3i The value of (A) should be such that the root of the following formula falls entirely on the left half plane of the complex plane, and the designed reduced generalized proportional productThe sub-observer can estimate the speed, disturbance and first derivative information of the disturbance with the exponential convergence speed.
p(s)=s 31i s 22i s+λ 3i
According to the estimation of the speed and the time-varying disturbance, combining the measurement position of the two-wheeled differential mobile robot and a given reference track, acquiring an output control quantity for track tracking control, specifically:
the estimation and velocity estimation of the time-varying disturbance are substituted into formula (15) to obtain u 1 And u 2
Figure BDA0002649242070000095
Will u 1 And u 2 Substitution formula (16) for obtaining the control input actually applied to the system through transformation,
Figure BDA0002649242070000096
wherein the content of the first and second substances,
Figure BDA0002649242070000097
e x =x mes -x r ,e y =y mes -y r
Figure BDA0002649242070000098
representing the second derivative of a given reference trajectory,
Figure BDA0002649242070000099
representing the first derivative, x, of a given reference trajectory r ,y r Representing a given reference trajectory, x mes ,y mes Indicating the position of the differentially-moved robot, measured at the present moment, phi mes ,v mes Indicating the linear and angular velocities, L, of the differentially-moved robot measured at the present time 1 ,L 0 In order to control the gain of the laws,
Figure BDA00026492420700000910
ω * for control input actually applied to the system, wherein L 1 ,L 0 The values of the two-wheel differential motion robot are determined so that the roots of the formula (17) all fall on the left half plane of the complex plane, and the two-wheel differential motion robot can track the given reference track gradually at an exponential convergence speed.
p(s)=s 2 +L 1 s+L 0 Formula (17)
The embodiment also provides a track tracking control system based on the method, which comprises
And the sensor is used for measuring the position of the two-wheeled differential mobile robot at the current moment in the X-axis direction under an inertial coordinate system, the position of the two-wheeled differential mobile robot in the Y-axis direction under the coordinate system, the linear speed and the direction angle.
The reduced-order generalized proportional-integral observer module is used for outputting speed estimation and time-varying disturbance estimation, and is integrated with a reduced-order generalized proportional-integral observer, and the design method of the reduced-order generalized proportional-integral observer module is shown in the formulas (9) to (14).
A position control module for receiving the velocity estimate and the time-varying disturbance estimate and outputting u 1 And u 2 And a position controller is integrated, and the implementation logic of the position controller is shown as a formula (15).
Input conversion module receiving u 1 And u 2 The output is actually applied to the control input of the system, and the logic of the implementation is shown as a formula (16).
An embodiment of the trajectory tracking control system is shown in fig. 1, and outputs a signal representing a position x of the differentially moving robot measured at the present time based on the kinematic model mes ,y mes To a reduced-order generalized integral proportional observer, phi mes ,v mes Inputting the time-varying disturbance and speed to an input transform module, inputting the time-varying disturbance and speed to a position controller by a reduced-order generalized integral proportional observer, and outputting u by the position controller 1 、u 2 To an input transformation module and a reduced-order generalized integral proportion observer, the input transformation module outputs control input actually acting on the system and inputs the control input into a kinematic model so as to perform trajectoryAnd (6) tracking.
The embodiment also provides a two-wheeled differential mobile robot integrated with the trajectory tracking control system.
Example 2
In this embodiment, a comparison between the trajectory tracking control method (hereinafter referred to as the present method) provided by the present invention and a general PD control method is tested, and as shown in fig. 2, when the two-wheeled differential mobile robot does not generate disturbance, both the general PD control method and the present method can well track the reference trajectory, and meet the control requirement.
When the initial state of the system deviates from a given reference track and a sinusoidal longitudinal sliding speed (amplitude: 0.15m/s, frequency: 2rad/s) and a sinusoidal transverse sliding speed (amplitude: 0.1m/s, frequency: 1rad/s) are applied after 5 seconds, as shown in fig. 3, it can be found by observing a tracking error that the method has better tracking performance, better anti-interference capability and strong robustness than a general PD control method. As shown in fig. 4, under the deviation, the output curve of the control law applying the method is in a reasonable range, and as shown in fig. 5, the reduced-order generalized proportional-integral observer can well estimate the speed and the disturbance.
Finally, the above embodiments are only intended to illustrate the technical solutions of the present invention and not to limit the present invention, and although the present invention has been described in detail with reference to the preferred embodiments, it will be understood by those skilled in the art that modifications or equivalent substitutions may be made on the technical solutions of the present invention without departing from the spirit and scope of the technical solutions, and all of them should be covered by the claims of the present invention.

Claims (6)

1. A trajectory tracking control method is characterized in that:
rewriting a motion model of the two-wheeled differential mobile robot according to a differential flat theory to obtain a kinematics model based on the differential flat theory;
designing a reduced-order generalized proportional-integral observer based on a kinematics model of a differential flat theory to obtain time-varying disturbance and speed estimation;
according to the estimation of time-varying disturbance and speed, combining the measured position of the two-wheeled differential mobile robot and a given reference track to obtain the output control quantity of the track tracking controller, and converting the output control quantity to act on a kinematic model of the two-wheeled differential mobile robot;
the design method of the reduced-order generalized proportional-integral observer comprises the following steps:
based on the differential flat theory based kinematic model, the following state variables are defined:
Figure FDA0003666190960000011
from the state variables, the following form of the state space is obtained:
Figure FDA0003666190960000012
based on the above formula, a reduced generalized proportional-integral observer is designed as follows:
Figure FDA0003666190960000013
the following variables are defined:
Figure FDA0003666190960000014
further, it is possible to obtain:
Figure FDA0003666190960000021
Figure FDA0003666190960000022
Figure FDA0003666190960000023
the respective states can be obtained as follows:
Figure FDA0003666190960000024
wherein:
Figure FDA0003666190960000025
the speed estimation of the two-wheeled differential mobile robot in the X-axis direction of the inertial coordinate system when i is 1 and the speed estimation of the two-wheeled differential mobile robot in the Y-axis direction of the inertial coordinate system when i is 2 are shown;
Figure FDA0003666190960000026
an estimate of the time-varying disturbance is represented,
Figure FDA0003666190960000027
estimation of the first derivative, λ, representing a time-varying disturbance 1i 、λ 2i 、λ 3i Is the coefficient of the observer;
said lambda 1i 、λ 2i 、λ 3i The values of (a) are such that the roots of the following formula all fall in the left half plane of the complex plane,
p(s)=s 31i s 22i s+λ 3i
the design method of the output control quantity for the trajectory tracking control specifically comprises the following steps:
substituting the time-varying disturbance estimation and the speed estimation into the following formula to obtain u 1 And u 2
Figure FDA0003666190960000028
Subjecting said u to 1 And u 2 Substituting the formula into the mixture, and converting the mixture,the control input actually applied to the system is obtained,
Figure FDA0003666190960000029
wherein the content of the first and second substances,
Figure FDA00036661909600000210
e x =x mes -x r ,e y =y mes -y r
Figure FDA00036661909600000211
representing the second derivative of a given reference trajectory,
Figure FDA00036661909600000212
representing the first derivative, x, of a given reference trajectory r ,y r Representing a given reference trajectory, x mes ,y mes Indicates the position of the two-wheeled differential mobile robot measured at the current moment, phi mes ,v mes Represents the linear velocity and the angular velocity, L, of the two-wheeled differential mobile robot measured at the current moment 1 ,L 0 In order to control the gain of the laws,
Figure FDA0003666190960000031
ω * is the control input actually applied to the system.
2. The trajectory tracking control method according to claim 1, characterized in that: the motion model of the two-wheeled differential mobile robot is as follows:
Figure FDA0003666190960000032
Figure FDA0003666190960000033
Figure FDA0003666190960000034
wherein: x represents the position in the X-axis direction of the inertial reference frame, Y represents the position in the Y-axis direction of the inertial reference frame, [ phi ] represents the direction angle of the body coordinate system of the two-wheeled differential mobile robot with respect to the inertial reference frame, [ v ] represents the linear velocity of the two-wheeled differential mobile robot, [ omega ] represents the angular velocity of the two-wheeled differential mobile robot, and [ v ] represents the angular velocity of the two-wheeled differential mobile robot s 、v t 、ω s Respectively shows the longitudinal sliding speed and the transverse sliding speed of the two-wheeled differential mobile robot
And sliding angular velocity.
3. The trajectory tracking control method according to claim 2, characterized in that: the kinematic model based on the differential flat theory is as follows:
Figure FDA0003666190960000035
wherein
Figure FDA0003666190960000036
Figure FDA0003666190960000037
Define the flat output variable as:
Figure FDA0003666190960000041
wherein, a 1 、a 2 Is the centralized disturbance received by the system;
u 1 、u 2 is the middle term.
4. According to claimThe trajectory tracking control method according to claim 3, characterized in that: said L 1 ,L 0 Such that the roots of the following all fall in the left half plane of the complex plane,
p(s)=s 2 +L 1 s+L 0
5. the trajectory tracking control system based on the trajectory tracking control method according to any one of claims 1 to 4, characterized in that: comprises that
The sensor is used for measuring the position of the two-wheeled differential mobile robot in the X-axis direction under an inertial coordinate system, the position of the two-wheeled differential mobile robot in the Y-axis direction under the inertial coordinate system, the linear speed and the direction angle at the current moment;
the reduced-order generalized proportional-integral observer module is used for outputting a speed estimation and a time-varying disturbance estimation;
a position control module for receiving the velocity estimate and the time-varying disturbance estimate and outputting u 1 And u 2
Input conversion module receiving u 1 And u 2 The output is the control input actually applied to the system.
6. A two-wheeled differential mobile robot which is characterized in that: a trajectory tracking control system according to claim 5 integrated.
CN202010864372.4A 2020-08-25 2020-08-25 Trajectory tracking control method and system and two-wheeled differential mobile robot Active CN111949036B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010864372.4A CN111949036B (en) 2020-08-25 2020-08-25 Trajectory tracking control method and system and two-wheeled differential mobile robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010864372.4A CN111949036B (en) 2020-08-25 2020-08-25 Trajectory tracking control method and system and two-wheeled differential mobile robot

Publications (2)

Publication Number Publication Date
CN111949036A CN111949036A (en) 2020-11-17
CN111949036B true CN111949036B (en) 2022-08-02

Family

ID=73366654

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010864372.4A Active CN111949036B (en) 2020-08-25 2020-08-25 Trajectory tracking control method and system and two-wheeled differential mobile robot

Country Status (1)

Country Link
CN (1) CN111949036B (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114003030B (en) * 2021-10-09 2023-08-08 北京科技大学 Path tracking control method of two-wheel differential mobile robot considering centroid change
CN113759983B (en) * 2021-10-20 2023-05-30 中山大学 Anti-interference unmanned aerial vehicle collision prevention method based on differential flatness
CN114879658B (en) * 2022-03-28 2023-03-03 北京理工大学 Hovercraft track tracking control method

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102096415A (en) * 2010-12-31 2011-06-15 重庆邮电大学 Multi-robot formation method based on Ad-Hoc network and leader-follower algorithm
CN103970138A (en) * 2014-05-08 2014-08-06 北京理工大学 ALV transverse control method based on active disturbance rejection and differential smoothing
CN104317299A (en) * 2014-11-11 2015-01-28 东南大学 Mixed control method based on trace tracking of wheeled mobile robot
CN108445898A (en) * 2018-05-14 2018-08-24 南开大学 Quadrotor unmanned vehicle system motion planing method based on differential flat characteristic
CN108646748A (en) * 2018-06-05 2018-10-12 北京联合大学 A kind of place unmanned vehicle trace tracking method and system
CN108710302A (en) * 2018-06-20 2018-10-26 天津大学 Passivity all directionally movable robot track following Auto-disturbance-rejection Control
CN110109343A (en) * 2019-04-30 2019-08-09 东南大学 A kind of photoelectric follow-up vision measurement time lag compensation method
CN111251288A (en) * 2020-04-01 2020-06-09 重庆邮电大学 Flexible robot cascade control system and method based on time-varying interference compensation

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102354104B (en) * 2005-09-19 2015-05-27 克利夫兰州立大学 Controllers, observers, and applications thereof
US10665115B2 (en) * 2016-01-05 2020-05-26 California Institute Of Technology Controlling unmanned aerial vehicles to avoid obstacle collision
US11866198B2 (en) * 2018-10-29 2024-01-09 California Institute Of Technology Long-duration, fully autonomous operation of rotorcraft unmanned aerial systems including energy replenishment
US11693373B2 (en) * 2018-12-10 2023-07-04 California Institute Of Technology Systems and methods for robust learning-based control during forward and landing flight under uncertain conditions
CN109597310B (en) * 2019-02-01 2021-09-07 东南大学 Wheeled mobile robot track tracking method based on disturbance observer

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102096415A (en) * 2010-12-31 2011-06-15 重庆邮电大学 Multi-robot formation method based on Ad-Hoc network and leader-follower algorithm
CN103970138A (en) * 2014-05-08 2014-08-06 北京理工大学 ALV transverse control method based on active disturbance rejection and differential smoothing
CN104317299A (en) * 2014-11-11 2015-01-28 东南大学 Mixed control method based on trace tracking of wheeled mobile robot
CN108445898A (en) * 2018-05-14 2018-08-24 南开大学 Quadrotor unmanned vehicle system motion planing method based on differential flat characteristic
CN108646748A (en) * 2018-06-05 2018-10-12 北京联合大学 A kind of place unmanned vehicle trace tracking method and system
CN108710302A (en) * 2018-06-20 2018-10-26 天津大学 Passivity all directionally movable robot track following Auto-disturbance-rejection Control
CN110109343A (en) * 2019-04-30 2019-08-09 东南大学 A kind of photoelectric follow-up vision measurement time lag compensation method
CN111251288A (en) * 2020-04-01 2020-06-09 重庆邮电大学 Flexible robot cascade control system and method based on time-varying interference compensation

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
《Robust Sliding Mode Control for Robots Driven by Compliant Actuators》;Wang, Huiming,Pan, Yongping,Li, Shihua,Yu, Haoyong;《IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY》;20190531;第27卷(第3期);全文 *
Differential flatness-based robust control of a two-wheeled mobile robot in the presence of slip;Ji-Chul Ryu,Sunil K. Agrawal;《PROCEEDINGS OF THE ASME DYNAMIC SYSTEMS AND CONTROL CONFERENCE 2008, PTS A AND B》;20081022;全文 *
Reduced-order GPIO based dynamic event-triggered tracking control of a networked one-DOF link manipulator without velocity measurement;Sun, Jiankun,Yang, Jun,Li, Shihua;《IEEE-CAA JOURNAL OF AUTOMATICA SINICA》;20200522;第7卷(第3期);全文 *
Robust output feedback control for the trajectory tracking of robotic wheelchairs;J. A. Chocoteco;《Robotica》;20150131;第33卷(第1期);全文 *
给定速度需求的移动机器人路径跟踪控制与实验;顾万里等;《农业机械学报》;20170821;第48卷(第10期);全文 *
轮式移动机器人的有限时间自适应轨迹跟踪控制;黄译等;《广西科学》;20170522;第24卷(第3期);全文 *
运动控制系统的抗干扰控制理论与应用研究;王会明;《中国优秀博硕士学位论文全文数据库(博士)信息科技辑》;20171215(第12期);全文 *

Also Published As

Publication number Publication date
CN111949036A (en) 2020-11-17

Similar Documents

Publication Publication Date Title
CN111949036B (en) Trajectory tracking control method and system and two-wheeled differential mobile robot
Low et al. GPS-based path following control for a car-like wheeled mobile robot with skidding and slipping
Janot et al. A generic instrumental variable approach for industrial robot identification
CN108958032B (en) Total amount cooperative and consistent control method of nonlinear multi-agent system
JP4673326B2 (en) Rotary shaft position control device
Low et al. GPS-based tracking control for a car-like wheeled mobile robot with skidding and slipping
CN111650929B (en) Self-adaptive sliding mode control method and system and mobile robot controller
CN111983926B (en) Maximum co-entropy extended ellipsoid collective filtering method
CN112286229A (en) Moving robot finite time trajectory tracking control method based on recursive sliding mode
Cossette et al. The complex-step derivative approximation on matrix lie groups
Lu et al. Adaptive backstepping control of tracked robot running trajectory based on real-time slip parameter estimation
Li et al. Contouring compensation control based on high accuracy contour error estimation for multi-axis motion systems
Liu et al. Velocity estimation of robot manipulators: An experimental comparison
CN112051736B (en) Trajectory tracking control system based on single controller
CN114147713B (en) Track tracking control method based on adaptive neural network high-order dynamic sliding mode
CN111736598B (en) Harvester path tracking control method and system based on adaptive neural network
CN112947072B (en) Mobile robot driving control method, system and equipment based on sliding mode variable structure
CN111152213B (en) Mechanical arm vibration compensation method and device based on hybrid control
Yuan et al. Robot position realization based on multi-sensor information fusion algorithm
CN111045387B (en) Real-time estimation method for third-order contour error
CN113009828B (en) Anti-interference calibration method for dynamic parameters of complex mechanical system
Tarani et al. Prescribed performance output feedback controller design for MEMS gyroscopes using adaptive integral terminal SMC and high-order sliding mode observer
CN117057159B (en) Tricycle motion model-based state estimation method under periodic scheduling protocol
CN109986555B (en) Momentum-based parameter identification method for space robot system
Zhu et al. Trajectory Tracking Control Strategy Based on Model-Free Adaptive Sliding Mode Control Approach for Robot Manipulator

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