CN112947442A - Finite time convergence vehicle formation controller and design method - Google Patents

Finite time convergence vehicle formation controller and design method Download PDF

Info

Publication number
CN112947442A
CN112947442A CN202110169806.3A CN202110169806A CN112947442A CN 112947442 A CN112947442 A CN 112947442A CN 202110169806 A CN202110169806 A CN 202110169806A CN 112947442 A CN112947442 A CN 112947442A
Authority
CN
China
Prior art keywords
vehicle
pose
error
virtual
virtual target
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.)
Granted
Application number
CN202110169806.3A
Other languages
Chinese (zh)
Other versions
CN112947442B (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.)
Liaoning University of Technology
Original Assignee
Liaoning 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 Liaoning University of Technology filed Critical Liaoning University of Technology
Priority to CN202110169806.3A priority Critical patent/CN112947442B/en
Publication of CN112947442A publication Critical patent/CN112947442A/en
Application granted granted Critical
Publication of CN112947442B publication Critical patent/CN112947442B/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)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

The invention discloses a finite time convergence vehicle formation controller and a design method, wherein the current pose of a leading vehicle and the reference pose of a virtual target vehicle to be tracked by a following vehicle are given, an error system is obtained through a control problem conversion module to obtain an error pose, the converted error system is combined with a backstepping recursion technology to obtain an intermediate control law with fractional power parameters, the converted error system is combined with the intermediate control law to obtain a finite time actual control law with fractional power, and finally the actual control law is returned to the converted error system, so that the error system is stable in finite time, the following vehicle and the leading vehicle synchronously move, and the effective control of a vehicle formation system is realized.

Description

Finite time convergence vehicle formation controller and design method
Technical Field
The invention relates to the technical field of vehicle formation control, in particular to a limited time convergence vehicle formation controller and a design method.
Background
Vehicle formation control can improve the efficiency of vehicle travel on the road by improving the flexibility and agility of the vehicle formation. Meanwhile, the vehicle formation can also increase the capacity of the road by improving the density of the vehicles on the road, so that the traffic safety and the road smoothness are improved to a certain extent. In addition, from the energy consumption perspective, the vehicle passing through the formation can reduce the resistance of the air encountered during the driving process, so that the oil consumption of the vehicle is effectively reduced.
Currently, there are several common approaches to the study of vehicle formation control: a following navigator method, a behavior-based method, a virtual structure method, an artificial potential field method, and the like. The behavior-based formation method is simple to implement and suitable for uncertain environments, but the formation precision is poor and accurate mathematical analysis is difficult to perform; the virtual structure method and the piloting following method both need the full state information of the virtual structure and the piloting robot respectively; the artificial potential field method is a method for converting complex environment information into a repulsive field model and a gravitational field model and finding a path from an initial point to a target point through the models. The following navigator method has the following problems:
firstly, the problem of convergence speed of a system is not basically considered in the conventional vehicle formation control method. From a practical point of view, people hope to reach the control target as soon as possible, but due to the limitation of technologies and the like, the conventional vehicle formation control scheme can not realize the desired formation effect within the expected time.
And secondly, although the existing formation control method can realize the control of the vehicle, the safety and the reliability of the vehicle system in a large speed range can not be ensured when the vehicle system is in a complex road condition, such as the condition of limiting the driving time and the like.
Disclosure of Invention
The invention provides a limited time convergence vehicle formation controller and a design method thereof, which aim to overcome the technical problems.
The invention relates to a design method of a limited time convergence vehicle formation controller, which comprises the following steps:
establishing a formation vehicle motion model; obtaining vehicle pose information through the formation vehicle motion model; the vehicle pose information includes: position and attitude information of a pilot vehicle, a following vehicle and a virtual target vehicle;
obtaining the pose of the virtual target vehicle according to the pose information of the virtual target vehicle and the pilot vehicle; calculating errors of the virtual target vehicle pose and the pilot vehicle pose, and combining a coordinate system of the following vehicle to obtain a converted error system;
designing a virtual error surface according to the pose of the virtual target vehicle; calculating an intermediate control variable by the error system and a virtual error surface;
obtaining a control law of finite time convergence according to the virtual target vehicle pose and the intermediate control quantity;
substituting the control law into the error system to enable the error system to be stable within a limited time, and therefore enabling the following vehicle and the pilot vehicle to move synchronously.
Further, establishing a formation vehicle motion model, comprising:
the motion model of any vehicle in the formation is expressed as:
Figure BDA0002938635450000021
setting the gravity center of any vehicle as x, y, and the gravity center x of the rear wheel of the vehicle1,y1Distance to center of gravity of vehicle and center of gravity x of front wheel of vehicle2,y2Equal distances to the center of gravity of the vehicle, each half of the inter-axle distance of the vehicle, are expressed as:
X=b1x+b2y+c1 cosθ-c2 sinθ (2)
wherein X is ═ X1,x2,y1,y2]T,b1=[1,1,0,0]T,b2=[0,0,1,1]T,c1=[-l/2,l/2,0,0]T,c2=[0,0,l/2,l/2]T
And (3) calculating the formula (2) to obtain a vehicle constraint relation:
Figure BDA0002938635450000022
in the formula, the pose of the vehicle is represented by a vector
Figure BDA0002938635450000023
In which x and y represent the position coordinates of the vehicle in the coordinate system, theta is the inclination angle of the vehicle body to the x-axis,
Figure BDA0002938635450000024
the steering angle of the front wheel to the vehicle body; v. of1Is the forward speed, v, of the rear wheel of the vehicle2Is the side steering angular velocity of the front wheel, and l represents the interaxial distance between the front wheel and the rear wheel.
Further, the pose of the virtual target vehicle is obtained according to the pose information of the virtual target vehicle and the pilot vehicle; calculating the error between the virtual target vehicle pose and the pilot vehicle pose, and combining the coordinate system of the following vehicle to obtain a converted error system, wherein the error system comprises:
establishing a vehicle formation pose error equation as follows:
Figure BDA0002938635450000031
wherein the current pose of the lead vehicle is
Figure BDA0002938635450000032
Control input is [ u ]1,u2]ΤThe reference pose of the virtual target vehicle to be followed by the following vehicle is
Figure BDA0002938635450000033
Control input is [ u ]v1,uv2]ΤPose error of
Figure BDA0002938635450000034
The transformed error system is described as:
Figure BDA0002938635450000035
in the formula uv1Is the forward speed, u, of the rear wheel of the virtual target vehiclev2Is the side steering angular velocity of the front wheels of the virtual target vehicle,
Figure BDA0002938635450000036
for the steering angle of the front wheels of the lead vehicle to the vehicle body,
Figure BDA0002938635450000037
steering angle, u, of virtual target vehicle front wheel to vehicle body1,u2Is the control rate.
Further, the designing a virtual error surface according to the virtual target vehicle pose comprises:
according to the position and posture error coordinate x of the rear wheel of the vehicle in the coordinate systemeAnd yePose error inclination angle theta of vehicle body to x-axis coordinateeSteering angle of front wheel to vehicle body
Figure BDA0002938635450000038
The virtual error surface is designed as follows:
Figure BDA0002938635450000039
wherein alpha is an introduced intermediate control variable;
said calculating intermediate control variables by said error system and virtual error plane comprising:
and (3) solving the derivative of the virtual error surface through a quadratic Lyapunov equation, wherein the form of the intermediate control variable alpha is as follows:
Figure BDA00029386354500000310
in the formula, k2,k3Is a positive design parameter, ρ is a positive fractional power parameter, and 1/2 < ρ < 1;
obtaining a derivative of a virtual error surface from the error system and the virtual error surface, expressed as:
Figure BDA00029386354500000311
in the formula (I), the compound is shown in the specification,
Figure BDA0002938635450000041
g1(·)=uv1cosζ3+αζ2-u1,g2(·)=uv1 sinζ3-αζ1
Figure BDA0002938635450000042
h1(·)=ζ2,h2(·)=-ζ1,h3(·)=-1;
order to
Figure BDA0002938635450000043
For the intermediate control variable, the intermediate control variable β is designed according to the lyapunov stability theory, and is expressed as:
Figure BDA0002938635450000044
wherein k is4Is a positive design parameter.
Further, the obtaining of the control law of finite time convergence according to the virtual target vehicle pose and the intermediate control quantity includes:
obtaining a control law u that the error system converges in a limited time according to the formula (5), the formula (7) and the formula (9)1And u2Expressed as:
Figure BDA0002938635450000045
in the formula, k1Is a positive design parameter, sgn (·) is a sign function.
A limited time convergence vehicle formation controller comprising: the control problem conversion module, the virtual control input solving module and the actual control input solving module;
the control problem conversion module is used for obtaining the pose of the virtual target vehicle according to the pose information of the virtual target vehicle and the pilot vehicle; calculating errors of the virtual target vehicle pose and the pilot vehicle pose, and combining a coordinate system of the following vehicle to obtain a converted error system;
the virtual control input solving module is used for designing a virtual error surface according to the pose of the virtual target vehicle; calculating an intermediate control variable by the error system and a virtual error surface;
the actual control input solving module is used for obtaining a control law of finite time convergence according to the virtual target vehicle pose and the intermediate control quantity; substituting the control law into the error system to enable the error system to be stable within a limited time, and therefore enabling the following vehicle and the pilot vehicle to move synchronously.
According to the invention, the formation control problem is converted into the problem of track tracking of the following vehicle to the leading vehicle by combining with the limited time control, so that the dynamic vehicle formation control method under the complex road condition can be realized, and the reliability and the anti-interference performance of the vehicle formation control are effectively improved. Meanwhile, under the condition of considering the convergence rate, the system can still be controlled by introducing control input based on the fractional power parameter to the control law, and the method has better robustness and faster convergence.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings needed to be used in the description of the embodiments or the prior art will be briefly introduced below, and it is obvious that the drawings in the following description are some embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to these drawings without creative efforts.
FIG. 1 is a flow chart of a method of designing a limited time convergence vehicle formation controller;
FIG. 2 is a schematic diagram of a finite time convergence vehicle formation controller;
FIG. 3 is a diagram showing the effect of controlling the forward speed of the rear wheels of the vehicle in a simulation experiment according to the present invention;
FIG. 4 is a diagram showing the effect of controlling the steering angular velocity of the front wheels of the vehicle in a simulation experiment according to the present invention;
fig. 5 is a diagram showing the steering angle control effect of the front wheels of the vehicle on the vehicle body in the simulation experiment of the invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are some, but not all, embodiments of the present invention. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
As shown in fig. 1, the present embodiment provides a method for designing a limited-time convergence vehicle formation controller, including:
101. establishing a formation vehicle motion model; obtaining vehicle pose information through a formation vehicle motion model; vehicle pose information, including: position and attitude information of a pilot vehicle, a following vehicle and a virtual target vehicle;
specifically, the motion model of any vehicle in formation is represented as:
Figure BDA0002938635450000051
setting the gravity center of any vehicle as x, y, and the gravity center x of the rear wheel of the vehicle1,y1Distance to center of gravity of vehicle and center of gravity x of front wheel of vehicle2,y2Go to the carThe vehicle center of gravity distances are equal and are half of the axle distance of the vehicle, and are expressed as:
X=b1x+b2y+c1 cosθ-c2 sinθ (2)
wherein X is ═ X1,x2,y1,y2]T,b1=[1,1,0,0]T,b2=[0,0,1,1]T,c1=[-l/2,l/2,0,0]T,c2=[0,0,l/2,l/2]T
And (3) calculating the formula (2) to obtain a vehicle constraint relation:
Figure BDA0002938635450000061
in the formula, the pose of the vehicle is represented by a vector
Figure BDA0002938635450000062
In which x and y represent the position coordinates of the vehicle in the coordinate system, theta is the inclination angle of the vehicle body to the x-axis,
Figure BDA0002938635450000063
the steering angle of the front wheel to the vehicle body; v. of1Is the forward speed, v, of the rear wheel of the vehicle2Is the side steering angular velocity of the front wheel, and l represents the interaxial distance between the front wheel and the rear wheel.
102. Obtaining the pose of the virtual target vehicle according to the pose information of the virtual target vehicle and the pilot vehicle; calculating errors of the positions of the virtual target vehicle and the position of the pilot vehicle, and combining a coordinate system of the following vehicle to obtain a converted error system;
specifically, an error equation of the vehicle formation pose is established as follows:
Figure BDA0002938635450000064
in the formula, the current pose of the lead vehicle is
Figure BDA0002938635450000065
Control input is [ u ]1,u2]ΤThe reference pose of the virtual target vehicle to be followed by the following vehicle is
Figure BDA0002938635450000066
Control input is [ u ]v1,uv2]ΤPose error of
Figure BDA0002938635450000067
For a pilot following formation system, the primary trajectory of the formation is typically determined by the pilot vehicle occupant, and the reference trajectory of the following vehicle is determined by the virtual vehicle trajectory generated by the pilot vehicle and the structural parameters.
The transformed error system is described as:
Figure BDA0002938635450000068
in the formula uv1Is the forward speed, u, of the rear wheel of the virtual target vehiclev2Is the side steering angular velocity of the front wheels of the virtual target vehicle,
Figure BDA0002938635450000069
for the steering angle of the front wheels of the lead vehicle to the vehicle body,
Figure BDA00029386354500000610
steering angle, u, of virtual target vehicle front wheel to vehicle body1,u2Is the control rate.
The method mainly comprises the steps of firstly determining the distance and the angle between a virtual target vehicle and the expected position and attitude of a pilot vehicle so as to obtain the reference position and attitude of the virtual target vehicle
Figure BDA00029386354500000611
Secondly, the position and pose of the pilot vehicle are subtracted from the position and pose of the virtual target vehicle to obtain position and pose errors
Figure BDA00029386354500000612
Through coordinate transformation, a pose error equation (4) of the pose error in a coordinate system of the following vehicle can be obtained; and finally, obtaining an error system of the converted formula (5) by deriving the formula (4) and combining the vehicle formation motion model. The converted error system completes the problem of changing the formation control problem into the problem of tracking the track of the leading vehicle by the following vehicle, and the proper control law u is searched1And u2The converted error system can be stabilized in a limited time.
103. Designing a virtual error surface according to the pose of the virtual target vehicle; calculating an intermediate control variable through the error system and the virtual error surface;
specifically, the position and orientation error coordinate x of the rear wheel of the vehicle in the coordinate systemeAnd yePose error inclination angle theta of vehicle body to x-axis coordinateeSteering angle of front wheel to vehicle body
Figure BDA0002938635450000071
The virtual error surface is designed as follows:
Figure BDA0002938635450000072
wherein alpha is an introduced intermediate control variable;
and (3) solving the derivative of the virtual error surface through a quadratic Lyapunov equation, wherein the form of the intermediate control variable alpha is as follows:
Figure BDA0002938635450000073
in the formula, k2,k3Is a positive design parameter, ρ is a positive fractional power parameter, and 1/2 < ρ < 1;
obtaining a derivative of the virtual error surface by the error system and the virtual error surface, expressed as:
Figure BDA0002938635450000074
in the formula (I), the compound is shown in the specification,
Figure BDA0002938635450000075
g1(·)=uv1cosζ3+αζ2-u1,g2(·)=uv1 sinζ3-αζ1
Figure BDA0002938635450000076
h1(·)=ζ2,h2(·)=-ζ1,h3(·)=-1;
order to
Figure BDA0002938635450000077
For the intermediate control variable, the intermediate control variable β is designed according to the lyapunov stability theory, and is expressed as:
Figure BDA0002938635450000078
wherein k is4Is a positive design parameter.
104. Obtaining a control law of finite time convergence according to the virtual target vehicle pose and the intermediate control quantity;
specifically, a control law u in which the error system converges in a finite time is obtained from equations (5), (7) and (9)1And u2Expressed as:
Figure BDA0002938635450000081
in the formula, k1Is a positive design parameter, sgn (·) is a sign function.
105. Substituting the control law into the error system to stabilize the error system within a limited time, so that the following vehicle and the pilot vehicle synchronously move.
Specifically, the control law is substituted into the error system, so that the error system is stable in limited time, the stability of the error system in limited time indicates that the converted error system is stable, the stability of the error system indicates that the vehicle follows a pilot vehicle, and the formation of the vehicle formation can be kept after the vehicle follows the pilot vehicle.
As shown in fig. 2, the present embodiment provides a limited-time convergence vehicle formation controller, including: the control problem conversion module, the virtual control input solving module and the actual control input solving module;
the control problem conversion module is used for obtaining the pose of the virtual target vehicle according to the pose information of the virtual target vehicle and the pilot vehicle; calculating errors of the positions of the virtual target vehicle and the position of the pilot vehicle, and combining a coordinate system of the following vehicle to obtain a converted error system; the input end of the control problem conversion module is connected with the vehicle pose information (pose information of the lead vehicle, the following vehicle and the virtual target vehicle) and the output end of the actual control solving module.
The virtual control input solving module is used for designing a virtual error surface according to the pose of the virtual target vehicle; calculating an intermediate control variable through the error system and the virtual error surface; the input end of the virtual control input solving module is connected with the output end of the control problem conversion module and the virtual target vehicle pose calculated and output by the vehicle motion model.
The actual control input solving module is used for obtaining a control law of finite time convergence according to the virtual target vehicle pose and the intermediate control quantity; substituting the control law into the error system to stabilize the error system within a limited time, so that the following vehicle and the pilot vehicle synchronously move. The input end of the actual control input solving module is connected with the output end of the virtual control input solving module and the virtual target vehicle pose calculated and output by the vehicle motion model.
In the simulation experiment, through fig. 3, 4 and 5, it can be seen that the following vehicle can track the piloting vehicle in a limited time.
Finally, it should be noted that: the above embodiments are only used to illustrate the technical solution of the present invention, and not to limit the same; while the invention has been described in detail and with reference to the foregoing embodiments, it will be understood by those skilled in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some or all of the technical features may be equivalently replaced; and the modifications or the substitutions do not make the essence of the corresponding technical solutions depart from the scope of the technical solutions of the embodiments of the present invention.

Claims (6)

1. A method of designing a limited time convergence vehicle formation controller, comprising:
establishing a formation vehicle motion model; obtaining vehicle pose information through the formation vehicle motion model; the vehicle pose information includes: position and attitude information of a pilot vehicle, a following vehicle and a virtual target vehicle;
obtaining the pose of the virtual target vehicle according to the pose information of the virtual target vehicle and the pilot vehicle; calculating errors of the virtual target vehicle pose and the pilot vehicle pose, and combining a coordinate system of the following vehicle to obtain a converted error system;
designing a virtual error surface according to the pose of the virtual target vehicle; calculating an intermediate control variable by the error system and a virtual error surface;
obtaining a control law of finite time convergence according to the virtual target vehicle pose and the intermediate control quantity;
substituting the control law into the error system to enable the error system to be stable within a limited time, and therefore enabling the following vehicle and the pilot vehicle to move synchronously.
2. The method of claim 1, wherein the establishing a formation vehicle motion model comprises:
the motion model of any vehicle in the formation is expressed as:
Figure FDA0002938635440000011
setting the center of gravity of any vehicleX, y, the center of gravity x of the rear wheel of the vehicle1,y1Distance to center of gravity of vehicle and center of gravity x of front wheel of vehicle2,y2Equal distances to the center of gravity of the vehicle, each half of the inter-axle distance of the vehicle, are expressed as:
X=b1x+b2y+c1cosθ-c2sinθ (2)
wherein X is ═ X1,x2,y1,y2]T,b1=[1,1,0,0]T,b2=[0,0,1,1]T,c1=[-l/2,l/2,0,0]T,c2=[0,0,l/2,l/2]T
And (3) calculating the formula (2) to obtain a vehicle constraint relation:
Figure FDA0002938635440000012
in the formula, the pose of the vehicle is represented by a vector
Figure FDA0002938635440000013
In which x and y represent the position coordinates of the vehicle in the coordinate system, theta is the inclination angle of the vehicle body to the x-axis,
Figure FDA0002938635440000014
the steering angle of the front wheel to the vehicle body; v. of1Is the forward speed, v, of the rear wheel of the vehicle2Is the side steering angular velocity of the front wheel, and l represents the interaxial distance between the front wheel and the rear wheel.
3. The method of claim 2, wherein the virtual target vehicle pose is obtained according to pose information of the virtual target vehicle and the pilot vehicle; calculating the error between the virtual target vehicle pose and the pilot vehicle pose, and combining the coordinate system of the following vehicle to obtain a converted error system, wherein the error system comprises:
establishing a vehicle formation pose error equation as follows:
Figure FDA0002938635440000021
wherein the current pose of the lead vehicle is
Figure FDA0002938635440000022
Control input is [ u ]1,u2]ΤThe reference pose of the virtual target vehicle to be followed by the following vehicle is
Figure FDA0002938635440000023
Control input is [ u ]v1,uv2]ΤPose error of
Figure FDA0002938635440000024
The transformed error system is described as:
Figure FDA0002938635440000025
in the formula uv1Is the forward speed, u, of the rear wheel of the virtual target vehiclev2Is the side steering angular velocity of the front wheels of the virtual target vehicle,
Figure FDA0002938635440000026
for the steering angle of the front wheels of the lead vehicle to the vehicle body,
Figure FDA0002938635440000027
steering angle, u, of virtual target vehicle front wheel to vehicle body1,u2Is the control rate.
4. The method for designing a limited-time convergence vehicle formation controller according to claim 3, wherein the designing a virtual error surface according to the virtual target vehicle pose comprises:
according to the position and posture error coordinate x of the rear wheel of the vehicle in the coordinate systemeAnd yePose error inclination angle theta of vehicle body to x-axis coordinateeSteering angle of front wheel to vehicle body
Figure FDA0002938635440000029
The virtual error surface is designed as follows:
Figure FDA0002938635440000028
wherein alpha is an introduced intermediate control variable;
said calculating intermediate control variables by said error system and virtual error plane comprising:
and (3) solving the derivative of the virtual error surface through a quadratic Lyapunov equation, wherein the form of the intermediate control variable alpha is as follows:
Figure FDA0002938635440000031
in the formula, k2,k3Is a positive design parameter, ρ is a positive fractional power parameter, and 1/2 < ρ < 1;
obtaining a derivative of a virtual error surface from the error system and the virtual error surface, expressed as:
Figure FDA0002938635440000032
in the formula (I), the compound is shown in the specification,
Figure FDA0002938635440000033
g1(·)=uv1cosζ3+αζ2-u1,g2(·)=uv1sinζ3-αζ1
Figure FDA0002938635440000034
h1(·)=ζ2,h2(·)=-ζ1,h3(·)=-1;
order to
Figure FDA0002938635440000035
For the intermediate control variable, the intermediate control variable β is designed according to the lyapunov stability theory, and is expressed as:
Figure FDA0002938635440000036
wherein k is4Is a positive design parameter.
5. The method for designing the limited-time convergence vehicle formation controller according to claim 4, wherein the obtaining of the control law of the limited-time convergence according to the virtual target vehicle pose and the intermediate control quantity comprises:
obtaining a control law u that the error system converges in a limited time according to the formula (5), the formula (7) and the formula (9)1And u2Expressed as:
Figure FDA0002938635440000037
in the formula, k1Is a positive design parameter, sgn (·) is a sign function.
6. A limited time convergence vehicle formation controller, comprising:
the control problem conversion module, the virtual control input solving module and the actual control input solving module;
the control problem conversion module is used for obtaining the pose of the virtual target vehicle according to the pose information of the virtual target vehicle and the pilot vehicle; calculating errors of the virtual target vehicle pose and the pilot vehicle pose, and combining a coordinate system of the following vehicle to obtain a converted error system;
the virtual control input solving module is used for designing a virtual error surface according to the pose of the virtual target vehicle; calculating an intermediate control variable by the error system and a virtual error surface;
the actual control input solving module is used for obtaining a control law of finite time convergence according to the virtual target vehicle pose and the intermediate control quantity; substituting the control law into the error system to enable the error system to be stable within a limited time, and therefore enabling the following vehicle and the pilot vehicle to move synchronously.
CN202110169806.3A 2021-02-08 2021-02-08 Finite time convergence vehicle formation controller and design method Active CN112947442B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110169806.3A CN112947442B (en) 2021-02-08 2021-02-08 Finite time convergence vehicle formation controller and design method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110169806.3A CN112947442B (en) 2021-02-08 2021-02-08 Finite time convergence vehicle formation controller and design method

Publications (2)

Publication Number Publication Date
CN112947442A true CN112947442A (en) 2021-06-11
CN112947442B CN112947442B (en) 2024-03-15

Family

ID=76243290

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110169806.3A Active CN112947442B (en) 2021-02-08 2021-02-08 Finite time convergence vehicle formation controller and design method

Country Status (1)

Country Link
CN (1) CN112947442B (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107168369A (en) * 2017-06-13 2017-09-15 中国科学院声学研究所 The formation control method and system of a kind of drive lacking unmanned vehicle
CN109144047A (en) * 2018-06-12 2019-01-04 南京理工大学 A kind of finite time formation control method based on multi-agent system
CN110109351A (en) * 2019-04-08 2019-08-09 广东工业大学 A kind of multiple agent consistency control method based on specified performance
CN110879599A (en) * 2019-12-12 2020-03-13 大连海事大学 Fixed time formation control method based on finite time disturbance observer
CN110928310A (en) * 2019-12-12 2020-03-27 大连海事大学 Unmanned ship navigation following fixed time formation control method
CN111665855A (en) * 2020-08-03 2020-09-15 陕西理工大学 Robot presetting formation control method

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107168369A (en) * 2017-06-13 2017-09-15 中国科学院声学研究所 The formation control method and system of a kind of drive lacking unmanned vehicle
CN109144047A (en) * 2018-06-12 2019-01-04 南京理工大学 A kind of finite time formation control method based on multi-agent system
CN110109351A (en) * 2019-04-08 2019-08-09 广东工业大学 A kind of multiple agent consistency control method based on specified performance
CN110879599A (en) * 2019-12-12 2020-03-13 大连海事大学 Fixed time formation control method based on finite time disturbance observer
CN110928310A (en) * 2019-12-12 2020-03-27 大连海事大学 Unmanned ship navigation following fixed time formation control method
CN111665855A (en) * 2020-08-03 2020-09-15 陕西理工大学 Robot presetting formation control method

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
LINGLING YU;MINGYU FU: "A Robust Finite-Time Output Feedback Control Scheme for Marine Surface Vehicles Formation", 《IEEE ACCESS》, pages 41291 - 41301 *
李孟杰: "基于滑模控制的移动机器人轨迹跟踪与链式编队控制", 《中国优秀硕士学位论文全文数据库信息科技辑》, pages 140 - 740 *
李科志: "车联网环境下基于反馈的智能车辆编队控制研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》, pages 035 - 109 *
高振宇: "自主水下航行器的轨迹跟踪及编队控制", 《中国博士学位论文全文数据库工程科技Ⅱ辑》, pages 036 - 15 *

Also Published As

Publication number Publication date
CN112947442B (en) 2024-03-15

Similar Documents

Publication Publication Date Title
CN111845774B (en) Automatic driving automobile dynamic trajectory planning and tracking method based on transverse and longitudinal coordination
CN110377039B (en) Vehicle obstacle avoidance track planning and tracking control method
CN107831761B (en) Path tracking control method of intelligent vehicle
Altché et al. High-speed trajectory planning for autonomous vehicles using a simple dynamic model
CN107867290B (en) A kind of automobile emergency collision avoidance layer-stepping control method considering moving obstacle
CN108227491B (en) Intelligent vehicle track tracking control method based on sliding mode neural network
CN108646763A (en) A kind of autonomous driving trace tracking and controlling method
Hernandez et al. Steering control of automated vehicles using absolute positioning GPS and magnetic markers
CN107092266B (en) A kind of locomotive Trajectory Tracking Control method
CN111806467A (en) Variable speed dynamic track changing planning method based on vehicle driving rule
CN103121451A (en) Tracking and controlling method for lane changing trajectories in crooked road
CN109799828B (en) Transverse and longitudinal coordination control method for automatic driving vehicle
CN108710294B (en) Unmanned vehicle path tracking feedforward control method
CN105867377A (en) Automatic navigation control method of agricultural machine
Peicheng et al. Intelligent vehicle path tracking control based on improved MPC and hybrid PID
CN107168369A (en) The formation control method and system of a kind of drive lacking unmanned vehicle
CN109739094A (en) A kind of mobile robot trace tracking new method based on adaptive sliding-mode observer
CN114779785B (en) PSO parameter setting-based mobile robot smooth track planning method
CN110641465A (en) Lane keeping system and method based on vehicle speed
CN109292018A (en) Four-wheel steering Trajectory Tracking Control method based on coaxial-type wheel leg structure
Shen et al. A lateral control method for wheel-footed robot based on sliding mode control and steering prediction
Chen et al. Nonlinear model predictive control of autonomous vehicles considering dynamic stability constraints
CN107856733A (en) It is a kind of to hide dynamic barrier control method towards man-machine harmonious automobile
CN115525054B (en) Method and system for controlling tracking of edge path of unmanned sweeper in large industrial park
CN112947442A (en) Finite time convergence vehicle formation controller and design method

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