CN115542925B - Deviation accurate estimation method for unmanned vehicle transverse control - Google Patents

Deviation accurate estimation method for unmanned vehicle transverse control Download PDF

Info

Publication number
CN115542925B
CN115542925B CN202211497585.3A CN202211497585A CN115542925B CN 115542925 B CN115542925 B CN 115542925B CN 202211497585 A CN202211497585 A CN 202211497585A CN 115542925 B CN115542925 B CN 115542925B
Authority
CN
China
Prior art keywords
point
deviation
estimation
heading
vehicle
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
CN202211497585.3A
Other languages
Chinese (zh)
Other versions
CN115542925A (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.)
Anhui Zhongke Xingchi Automatic Driving Technology Co ltd
Original Assignee
Anhui Zhongke Xingchi Automatic Driving Technology Co ltd
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 Anhui Zhongke Xingchi Automatic Driving Technology Co ltd filed Critical Anhui Zhongke Xingchi Automatic Driving Technology Co ltd
Priority to CN202211497585.3A priority Critical patent/CN115542925B/en
Publication of CN115542925A publication Critical patent/CN115542925A/en
Application granted granted Critical
Publication of CN115542925B publication Critical patent/CN115542925B/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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

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)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a deviation accurate estimation method for unmanned vehicle transverse control, which is realized through a transverse deviation accurate estimation module and a course deviation accurate estimation module. According to the method, according to the relative relation between an expected track and the current vehicle position, an optimal estimation point is generated according to three different categories of a first point, a last point and a path point, and the lateral deviation estimation and the course deviation estimation are calculated through the optimal estimation point; and taking the calculated lateral deviation estimation and the course deviation estimation as feedback control quantities to bring the tracking control rate into the tracking control rate, so that the precise tracking control of the unmanned vehicle is realized. The method can effectively estimate the transverse deviation and the course deviation of the vehicle control, well solves the problem of overlarge transverse position and course change between adjacent points on the expected track, and improves remarkably in the tasks with large curvature such as turning around or turning sharply, thereby effectively improving the tracking precision of the vehicle control.

Description

Deviation accurate estimation method for unmanned vehicle transverse control
Technical Field
The invention belongs to the field of unmanned vehicle motion control, and particularly relates to a deviation accurate estimation method for unmanned vehicle transverse control.
Background
The accurate track tracking technology is one of important components for realizing unmanned driving. The current track tracking technology mainly comprises two tracking methods based on a pre-aiming point and a nearest point, and aiming at the road conditions of large curvature road conditions such as turning around or turning sharply, the track tracking technology applying the pre-aiming point can generate the phenomena of turning in advance and turning in advance, and finally causes poor tracking precision or incapability of passing; the accurate tracking of the large-curvature road condition is realized by applying a nearest point tracking method, the most important feedback input is deviation, the current algorithm traverses the nearest point on the expected track through the current GPS position point, the transverse distance between the nearest point and the current point is transverse deviation, and the calculated transverse deviation is not accurate enough; the course difference between the closest point and the current point is taken as the course deviation, and the course change between the points on the expected track is larger in the large-curvature road condition, so that the accuracy of the course deviation calculated by the method is poor. The accuracy of the lateral deviation and heading deviation estimates is thus a direct impact on the unmanned vehicle tracking effect.
Disclosure of Invention
The invention provides a deviation accurate estimation method for unmanned vehicle transverse control, which aims to overcome the defects in the prior art. The transverse deviation and the course deviation in the running process of the unmanned vehicle are accurately estimated, and the feedback control of the vehicle is realized by utilizing the deviation, so that the accurate control of the unmanned vehicle is finally realized.
In order to achieve the aim of the invention, the invention adopts the following technical scheme:
a deviation accurate estimation method for unmanned vehicle transverse control realizes accurate estimation of deviation through a transverse deviation accurate estimation module and a course deviation accurate estimation module;
the input of the transverse deviation accurate estimation module is a desired track, the output is transverse deviation estimation, the desired track comprises longitude, latitude and heading information of a point through which the vehicle is expected to travel, an optimal estimation point is generated by comparing the spatial relationship between a point C with the minimum distance from an origin O of the current position of the vehicle in the desired track and the origin O of the current position of the vehicle according to three different categories of a first point, a last point and a path point, the position deviation between the optimal estimation point and the origin O of the current position of the vehicle is obtained, and the transverse deviation estimation laser_error is obtained by calculation;
the input of the course deviation accurate estimation module is a desired track, the output is course deviation estimation, and the course estimation at the optimal estimation point and the current course of the vehicle are obtained through calculation
Figure 780743DEST_PATH_IMAGE001
Comparing to obtain course deviation estimation
Figure 770696DEST_PATH_IMAGE002
The method comprises the steps of carrying out a first treatment on the surface of the Further, the method for calculating the lateral deviation estimate is as follows:
step 1: converting each point on the expected track into an expected path point under a vehicle coordinate system, wherein the vehicle coordinate system is a right-hand coordinate system taking the longitude and latitude of the current vehicle as an origin O (xo, yo) and the current vehicle heading as an X axis;
step 2: traversing the expected track, and selecting a point C (xc, yc) with the smallest distance from an origin O (xo, yo) of the current position of the vehicle in the expected track;
step 3: judging whether the point C is the first point on the expected track, if so, taking the point F to be equal to the point C, namely (xf, yf) = (xc, yc), wherein the min_0 is equal to a distance value |FO| between the point F and the point O; if not, taking the point F as the previous point of the point C on the expected track; judging whether the point C is the last point on the expected track, if so, taking the point B as the point C, namely (xb, yb) = (xc, yc), wherein min_1 is equal to the distance value |BO| between the point B and the point O, and if not, taking the point B as the point after the point C on the expected track; namely:
Figure 285991DEST_PATH_IMAGE003
step 4: if the point C is not the first point or the last point on the expected track, judging whether the cosine values of the angle BCO and the angle FCO are larger than 0; if COs & lt FCO is greater than 0, the angle FCO is an acute angle, which indicates that a point N which is closer to a connecting line FC between a point F and a point C than a distance |CO| between the point C and the point O exists, the value |ON| is equal to the distance between the point O and the FC, and the value is taken as an estimated value of min_0; if COs < FCO is smaller than 0, the COs < FCO is an obtuse angle, which means that a point which is closer to a distance |CO| between a point F and a point O does not exist on a connecting line FC between the point F and the point C, and the |CO| is used as an estimated value of min_0; namely:
Figure 536844DEST_PATH_IMAGE004
Figure 3860DEST_PATH_IMAGE005
in the same way, the processing method comprises the steps of,
Figure 340163DEST_PATH_IMAGE006
Figure 924728DEST_PATH_IMAGE007
step 5: comparing the sizes of the min_0 and the min_1 obtained in the step 3 or the step 4, and taking the smaller value as the absolute value of the lateral deviation estimation laser_error:
|lateral_error| = min( min_0, min_1);
step 6: if yc <0, the lateral deviation is estimated to be negative, and if yc >0, the lateral deviation is estimated to be positive.
The course deviation estimation calculation method comprises the following steps:
step 1: if the minimum lateral deviation estimated point is the point on the expected track, namely the point C, the heading of the point C is
Figure 171033DEST_PATH_IMAGE008
The current heading is +.>
Figure 182851DEST_PATH_IMAGE010
The heading bias estimate is derived according to the following formula:
Figure 865505DEST_PATH_IMAGE011
step 2: if the minimum lateral deviation estimation point is not a point on the expected track, an optimal estimation point N is obtained according to the lateral deviation accurate estimation module, and if the point N is a point between a point C and a point F, a distance |CN| between the point C and the point N and a distance |CF| between the point C and the point F are obtained through the following formula:
Figure 988182DEST_PATH_IMAGE012
according to the physical space continuity and smoothness of the running of the vehicle, the track between the point F and the point C is regarded as a section of circular arc, the circle center of the circular arc is the point S, and the course of the intersection point M of the SN extension line and the circular arc is calculated
Figure 948048DEST_PATH_IMAGE013
Heading estimation as Point N +.>
Figure 6134DEST_PATH_IMAGE014
The heading bias estimate is derived by:
Figure 582609DEST_PATH_IMAGE015
in the method, in the process of the invention,
Figure 132145DEST_PATH_IMAGE016
estimated heading for Point N, +.>
Figure 212097DEST_PATH_IMAGE017
For heading of point M, +.>
Figure 706663DEST_PATH_IMAGE018
For heading of point F, +.>
Figure 239276DEST_PATH_IMAGE019
Heading for point C, ++>
Figure 703755DEST_PATH_IMAGE020
For the current vehicle heading,/->
Figure 762847DEST_PATH_IMAGE021
And estimating the heading deviation.
If the point N is a point between the point C and the point B, the distance |BN| between the point B and the point N and the distance |CB| between the point C and the point B are obtained through the following formula:
Figure 552948DEST_PATH_IMAGE022
wherein, |CO| is the distance between point C and point O, and|ON| is the distance between point O and point N;
according to the physical space continuity and smoothness of the running of the vehicle, the track between the point B and the point C is regarded as a section of circular arc, the circle center of the circular arc is the point S, and the course of the intersection point M of the SN extension line and the circular arc is calculated
Figure 307278DEST_PATH_IMAGE023
Heading estimation as Point N +.>
Figure 716393DEST_PATH_IMAGE024
The heading bias estimate is derived by:
Figure 505358DEST_PATH_IMAGE025
in the method, in the process of the invention,
Figure 935202DEST_PATH_IMAGE026
estimated heading for Point N, +.>
Figure 334085DEST_PATH_IMAGE027
For heading of point M, +.>
Figure 140367DEST_PATH_IMAGE028
For heading of Point B, +.>
Figure 924783DEST_PATH_IMAGE029
Heading for point C, ++>
Figure 791108DEST_PATH_IMAGE030
For the current vehicle heading,/->
Figure 520029DEST_PATH_IMAGE031
And estimating the heading deviation.
Further, the lateral deviation estimation and the course deviation estimation are used as feedback control quantities to be brought into a track tracking control rate, so that accurate tracking control of the unmanned vehicle is achieved.
The beneficial effects are that:
the invention can accurately estimate the transverse deviation and the course deviation of the current vehicle relative to the expected track, reduces the input of systematic errors, and is particularly remarkable in the tasks of turning around or turning in sharp turns and other large curvatures; by the scheme, the transverse deviation and the course deviation of the vehicle control can be effectively estimated, the problem of overlarge transverse position and course change between adjacent points on the expected track is well solved, and therefore the tracking precision of the vehicle control is effectively improved. The estimation method provided by the invention has the advantages of simple calculation, high estimation precision and convenient use.
Drawings
Fig. 1 is an analysis chart of a lateral deviation accurate estimation of a deviation accurate estimation method for unmanned vehicle lateral control of the present invention;
FIG. 2 is a flow chart of a lateral deviation accurate estimation of the deviation accurate estimation method for unmanned vehicle lateral control of the present invention;
fig. 3 is a first analysis chart of the heading deviation accurate estimation of the deviation accurate estimation method for unmanned vehicle transverse direction control of the present invention.
Fig. 4 is a second analysis chart of the heading deviation accurate estimation of the deviation accurate estimation method for unmanned vehicle transverse direction control of the present invention.
Detailed Description
The present invention will be described in further detail with reference to the drawings and examples, in order to make the objects, technical solutions and advantages of the present invention more apparent. It should be understood that the specific embodiments described herein are for purposes of illustration only and are not intended to limit the scope of the invention. In addition, the technical features of the embodiments of the present invention described below may be combined with each other as long as they do not collide with each other.
In this embodiment, as shown in fig. 1, 2 and 3, the method for accurately estimating lateral deviation for controlling the lateral direction of an unmanned vehicle according to the present invention comprises the following steps:
step one, acquiring an expected track:
a GPS/IMU integrated navigation system is pre-applied to collect a desired track, wherein the desired track comprises longitude, latitude and heading information of a vehicle in real time. In the actual application process, the expected track can also be generated by a path planning mode.
Acquiring GPS position and heading information of a vehicle at the current moment through a GPS/IMU integrated navigation system, and converting a point of a pre-acquired expected track into an expected path point under a vehicle coordinate system taking the pose at the current moment as an origin:
Figure 785794DEST_PATH_IMAGE032
where R is the earth radius, PI is the circumference ratio, lat is the latitude of the desired waypoint, lng is the longitude of the desired waypoint, lat0 is the latitude of the vehicle at the current time, lng0 is the longitude of the vehicle at the current time, X, Y is the vertical projection of the desired waypoint on the current vehicle coordinate plane, az is the heading of the vehicle at the current time, and X, Y are the coordinates of the desired waypoint in the vehicle coordinate system.
Step three, traversing a point C (xc, yc) with the smallest distance from the current position O (xo, yo) of the vehicle in the expected track, and calculating the distance dis between the expected road point and the current vehicle:
Figure 814930DEST_PATH_IMAGE033
where x, y are coordinates of the desired waypoint in the vehicle coordinate system and dis is the distance between the desired waypoint and the current vehicle.
Judging whether the point C is the first point on the expected track, if so, taking the point F as the point C, (xf, yf) = (xc, yc), wherein min_0 is equal to a distance value |FO| between the point F and the point O, and if not, taking the point F as the previous point of the point C on the expected track; judging whether the point C is the last point on the expected track, if so, taking the point B as a point after the point C on the expected track, wherein (xb, yb) = (xc, yc), and min_1 as a distance |BO| between the point B and the point O;
Figure 461944DEST_PATH_IMAGE034
/>
fifthly, if the point C is not the first point or the last point on the expected track, judging whether the cosine values of the BCO and the FCO are larger than 0; if COs & lt FCO is greater than 0, the angle FCO is an acute angle, which indicates that a point N which is closer to a connecting line FC between a point F and a point C than a distance |CO| between the point C and the point O exists, the value |ON| is equal to the distance between the point O and the FC, and the value is taken as an estimated value of min_0; if COs < FCO is smaller than 0, the COs < FCO is an obtuse angle, which means that a point which is closer to a distance |CO| between a point F and a point O does not exist on a connecting line FC between the point F and the point C, and the |CO| is used as an estimated value of min_0; namely:
Figure 943740DEST_PATH_IMAGE035
Figure 91825DEST_PATH_IMAGE036
in the same way, the processing method comprises the steps of,
Figure 604496DEST_PATH_IMAGE037
Figure 547044DEST_PATH_IMAGE038
step six, comparing the sizes of the min_0 and the min_1, and taking the smaller value as the absolute value of the lateral deviation estimation:
|lateral_error| = min( min_0, min_1);
and step seven, judging whether the point C is positive or negative in the current vehicle coordinate system, if yc <0, estimating the lateral deviation to be negative, and if yc >0, estimating the lateral deviation to be positive.
Step eight, estimating the minimum transverse deviation and estimating the minimum transverse deviation point according to the minimum transverse deviation obtained in the step five and the step six, if the minimum transverse deviation estimated point is a point on the expected track, namely the point C, and the heading of the point C is that of the point C
Figure 516137DEST_PATH_IMAGE039
The current heading is +.>
Figure 343279DEST_PATH_IMAGE040
The heading bias estimate may be derived according to the following formula:
Figure 815848DEST_PATH_IMAGE041
step nine: if the minimum lateral deviation estimation point is not a point on the expected track, obtaining an optimal estimation point N according to the lateral deviation accurate estimation module, and if the point N is a point between a point C and a point F, obtaining a distance |CN| between the point C and the point N and a distance |CF| between the point C and the point F through the following formula as shown in FIG. 3:
Figure 460456DEST_PATH_IMAGE042
where |co| is the distance between point C and point O, and |on| is the distance between point O to point N.
According to the physical space continuity and smoothness of the running of the vehicle, the track between the point F and the point C is regarded as a section of circular arc, the circle center of the circular arc is the point S, and the course of the intersection point M of the SN extension line and the circular arc is calculated
Figure 775900DEST_PATH_IMAGE043
Heading estimation as Point N +.>
Figure 531366DEST_PATH_IMAGE044
The heading bias estimate is derived by: />
Figure 264967DEST_PATH_IMAGE045
In the method, in the process of the invention,
Figure 80476DEST_PATH_IMAGE047
estimated heading for Point N, +.>
Figure 493003DEST_PATH_IMAGE048
For heading of point M, +.>
Figure 412680DEST_PATH_IMAGE049
For heading of point F, +.>
Figure 859842DEST_PATH_IMAGE050
Heading for point C, ++>
Figure 846252DEST_PATH_IMAGE051
For the current vehicle heading,/->
Figure 887021DEST_PATH_IMAGE052
And estimating the heading deviation.
If the point N is a point between the point C and the point B, as shown in fig. 4, a distance |bn| between the point B and the point N, and a distance |cb| between the point C and the point B are calculated by the following formula:
Figure 984290DEST_PATH_IMAGE053
according to the physical space continuity and smoothness of the running of the vehicle, the track between the point B and the point C is regarded as a section of circular arc, the circle center of the circular arc is the point S, and the course of the intersection point M of the SN extension line and the circular arc is calculated
Figure 676171DEST_PATH_IMAGE023
Heading estimation as Point N +.>
Figure 567904DEST_PATH_IMAGE024
The heading bias estimate is derived by:
Figure 955023DEST_PATH_IMAGE025
in the method, in the process of the invention,
Figure 590403DEST_PATH_IMAGE026
estimated heading for Point N, +.>
Figure 887524DEST_PATH_IMAGE027
For heading of point M, +.>
Figure 950158DEST_PATH_IMAGE028
For heading of Point B, +.>
Figure 90152DEST_PATH_IMAGE029
Heading for point C, ++>
Figure 886813DEST_PATH_IMAGE030
For the current vehicle heading,/->
Figure 163074DEST_PATH_IMAGE054
And estimating the heading deviation.
Step ten: and (3) obtaining the expected steering curvature of the vehicle according to the obtained transverse deviation estimation and heading deviation estimation solution by using a track tracking controller as follows:
q0=tan(-1*(heading_error*PI/180)+arctan(k*lateral_error/(speed))/L
in the formula, head_error is heading deviation estimation, lateral_error is transverse deviation estimation, k is a proportional parameter required to be adjusted for track tracking realization, speed is the current speed of the unmanned vehicle, L is the wheelbase of the unmanned vehicle, and q0 is the desired steering curvature.
Step eleven: the desired steering angle is solved according to the vehicle characteristics. Taking a certain type of bergamot paqi vehicle as an example, the expected steering angle is obtained according to the relation between the steering size of the steering wheel of the vehicle and the steering curvature of the vehicle:
turn=-4857*q0*q0*q0+117.4*q0*q0+2753*q0+3266
where q0 is the desired steering curvature of the vehicle and turn is the desired steering angle of the vehicle.
It will be readily appreciated by those skilled in the art that the foregoing description is merely a preferred embodiment of the invention and is not intended to limit the invention, but any modifications, equivalents, improvements or alternatives falling within the spirit and principles of the invention are intended to be included within the scope of the invention.

Claims (3)

1. A deviation accurate estimation method for unmanned vehicle transverse control is characterized in that accurate estimation of deviation is achieved through a transverse deviation accurate estimation module and a course deviation accurate estimation module;
the input of the transverse deviation accurate estimation module is a desired track, the output is transverse deviation estimation, the desired track comprises longitude, latitude and heading information of a point through which the vehicle is expected to travel, an optimal estimation point is generated by comparing the spatial relationship between a point C with the minimum distance from an origin O of the current position of the vehicle in the desired track and the origin O of the current position of the vehicle according to three different categories of a first point, a last point and a path point, the position deviation between the optimal estimation point and the origin O of the current position of the vehicle is obtained, and the transverse deviation estimation laser_error is obtained by calculation;
the input of the course deviation accurate estimation module is a desired track, the output is course deviation estimation, and the course estimation at the optimal estimation point and the current course of the vehicle are obtained through calculation
Figure QLYQS_1
Comparing to obtain course deviation estimation
Figure QLYQS_2
The calculation method of the lateral deviation estimation is as follows:
step 1: converting each point on the expected track into an expected path point under a vehicle coordinate system, wherein the vehicle coordinate system is a right-hand coordinate system taking the longitude and latitude of the current vehicle as the origin point O (xo, yo) of the current position of the vehicle and the current vehicle heading as an X axis;
step 2: traversing the expected track, and selecting a point C (xc, yc) with the smallest distance from an origin O (xo, yo) of the current position of the vehicle in the expected track;
step 3: judging whether the point C is the first point on the expected track, if so, taking the point F to be equal to the point C, namely (xf, yf) = (xc, yc), wherein the min_0 is equal to a distance value |FO| between the point F and the point O; if not, taking the point F as the previous point of the point C on the expected track; judging whether the point C is the last point on the expected track, if so, taking the point B as the point C, namely (xb, yb) = (xc, yc), wherein min_1 is equal to the distance |BO| between the point B and the point O, and if not, taking the point B as the point after the point C on the expected track; namely:
Figure QLYQS_3
;
wherein, |CO| is the distance between point C and point O, and |FO| is the distance between point F and point O;
step 4: if the point C is not the first point on the expected track and the point C is not the last point on the expected track, judging whether the cosine values of the angle BCO and the angle FCO are larger than 0; if COs & lt FCO is greater than 0, the angle FCO is an acute angle, which indicates that a point N which is closer to a connecting line FC between a point F and a point C than a distance |CO| between the point C and the point O exists, the value |ON| is equal to the distance between the point O and the FC, and the value is taken as an estimated value of min_0; if COs < FCO is smaller than 0, the COs < FCO is an obtuse angle, which means that a point which is closer to a distance |CO| between a point F and a point O does not exist on a connecting line FC between the point F and the point C, and the |CO| is used as an estimated value of min_0; namely:
Figure QLYQS_4
;
Figure QLYQS_5
;
in the same way, the processing method comprises the steps of,
Figure QLYQS_6
;/>
Figure QLYQS_7
;
wherein, FC is the distance between point F and point C, BC is the distance between point B and point C;
step 5: comparing the sizes of the min_0 and the min_1 obtained in the step 3 or the step 4, and taking the smaller value as the absolute value of the lateral deviation estimation laser_error:
|lateral_error| = min( min_0, min_1);
step 6: if yc <0, the lateral deviation is estimated to be negative, and if yc >0, the lateral deviation is estimated to be positive.
2. The accurate estimation method of deviation for unmanned vehicle lateral control according to claim 1, wherein the calculation method of heading deviation estimation is as follows:
step 1: if the minimum lateral deviation estimated point is the point on the expected track, namely the point C, the heading of the point C is
Figure QLYQS_8
The current heading is +.>
Figure QLYQS_9
The heading bias estimate is derived according to the following formula:
Figure QLYQS_10
;
step 2: if the minimum lateral deviation estimation point is not the point on the expected track, obtaining an optimal estimation point according to a lateral deviation accurate estimation module, marking the optimal estimation point as a point N, and if the point N is a point between a point C and a point F, obtaining a distance |CN| between the point C and the point N and a distance |CF| between the point C and the point F through the following formula:
Figure QLYQS_11
;
wherein, |CO| is the distance between point C and point O, and|ON| is the distance between point O and point N;
according to the physical space continuity and smoothness of the running of the vehicle, the track between the point F and the point C is regarded as a section of circular arc, the circle center of the circular arc is the point S, and the course of the intersection point M of the SN extension line and the circular arc is calculated
Figure QLYQS_12
Heading estimation as point N
Figure QLYQS_13
Is obtained by the following formulaEstimating course deviation:
Figure QLYQS_14
;
in the method, in the process of the invention,
Figure QLYQS_15
estimated heading for Point N, +.>
Figure QLYQS_16
For heading of point M, +.>
Figure QLYQS_17
For heading of point F, +.>
Figure QLYQS_18
Heading for point C, ++>
Figure QLYQS_19
For the current vehicle heading,/->
Figure QLYQS_20
Estimating course deviation;
if the point N is a point between the point C and the point B, the distance |BN| between the point B and the point N and the distance |CB| between the point C and the point B are obtained through the following formula:
Figure QLYQS_21
;
according to the physical space continuity and smoothness of the running of the vehicle, the track between the point B and the point C is regarded as a section of circular arc, the circle center of the circular arc is the point S, and the course of the intersection point M of the SN extension line and the circular arc is calculated
Figure QLYQS_22
Heading estimation as point N
Figure QLYQS_23
By the followingDeriving a heading bias estimate:
Figure QLYQS_24
;
in the method, in the process of the invention,
Figure QLYQS_25
estimated heading for Point N, +.>
Figure QLYQS_26
For heading of point M, +.>
Figure QLYQS_27
For heading of Point B, +.>
Figure QLYQS_28
Heading for point C, ++>
Figure QLYQS_29
For the current vehicle heading,/->
Figure QLYQS_30
And estimating the heading deviation.
3. The deviation accurate estimation method for unmanned vehicle lateral control according to claim 2, wherein the lateral deviation estimation and the heading deviation estimation are taken as feedback control amounts into a tracking control rate, thereby realizing accurate tracking control of the unmanned vehicle.
CN202211497585.3A 2022-11-28 2022-11-28 Deviation accurate estimation method for unmanned vehicle transverse control Active CN115542925B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211497585.3A CN115542925B (en) 2022-11-28 2022-11-28 Deviation accurate estimation method for unmanned vehicle transverse control

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211497585.3A CN115542925B (en) 2022-11-28 2022-11-28 Deviation accurate estimation method for unmanned vehicle transverse control

Publications (2)

Publication Number Publication Date
CN115542925A CN115542925A (en) 2022-12-30
CN115542925B true CN115542925B (en) 2023-05-02

Family

ID=84722224

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211497585.3A Active CN115542925B (en) 2022-11-28 2022-11-28 Deviation accurate estimation method for unmanned vehicle transverse control

Country Status (1)

Country Link
CN (1) CN115542925B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116302010B (en) * 2023-05-22 2023-07-28 安徽中科星驰自动驾驶技术有限公司 Automatic driving system upgrade package generation method and device, computer equipment and medium

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IT201600109633A1 (en) * 2016-10-31 2018-05-01 Magneti Marelli Spa Process and adaptive control system in a land vehicle for tracking a route, particularly in an autonomous driving scenario.
CN106681327B (en) * 2017-01-11 2019-05-24 中南大学 A kind of the intelligent driving transverse and longitudinal decoupling control method and system of big inertial electrodynamic car
US20200114959A1 (en) * 2017-02-17 2020-04-16 Thyssenkrupp Presta Ag Vehicle lateral motion control
CN108646748A (en) * 2018-06-05 2018-10-12 北京联合大学 A kind of place unmanned vehicle trace tracking method and system
CN110502009B (en) * 2019-08-14 2022-04-01 南京理工大学 Unmanned vehicle path tracking control method based on course estimation
CN111158379B (en) * 2020-01-16 2022-11-29 合肥中科智驰科技有限公司 Steering wheel zero-bias self-learning unmanned vehicle track tracking method
CN111638712B (en) * 2020-05-26 2021-11-16 三一专用汽车有限责任公司 Transverse motion control method and device for automatic driving vehicle and automatic driving vehicle
CN112046504B (en) * 2020-09-21 2021-11-09 北京易控智驾科技有限公司 Unmanned vehicle, transverse control method thereof and electronic equipment
CN113336117B (en) * 2021-06-18 2022-08-16 湖南国天电子科技有限公司 Automatic deviation rectifying method and device for warm salt deep winch
CN114834484A (en) * 2022-05-13 2022-08-02 中汽创智科技有限公司 Vehicle track following control method and device, electronic equipment and storage medium

Also Published As

Publication number Publication date
CN115542925A (en) 2022-12-30

Similar Documents

Publication Publication Date Title
CN110001637B (en) Unmanned vehicle path tracking control device and control method based on multipoint tracking
CN107702716B (en) Unmanned driving path planning method, system and device
US9499197B2 (en) System and method for vehicle steering control
CN110109451B (en) Novel geometric path tracking algorithm considering path curvature
US10114378B2 (en) Automatic guidance system with stability control for an agricultural vehicle
CN107037818A (en) A kind of path following method of pilotless automobile
US11334083B2 (en) Route tracking method for mobile vehicle
CN109388140B (en) Improved pure tracking control method for ground vehicle path tracking
TWI564193B (en) System and method for vehicle steering control
CN115542925B (en) Deviation accurate estimation method for unmanned vehicle transverse control
AU2016253152A1 (en) System, apparatus, and method for controlling a vehicle
CN109656250A (en) A kind of path following method of laser fork truck
CN107608344A (en) Vehicle motion control method, apparatus and relevant device based on trajectory planning
CN112793585B (en) Automatic driving trajectory tracking control method
CN111158379B (en) Steering wheel zero-bias self-learning unmanned vehicle track tracking method
CN113625702B (en) Unmanned vehicle simultaneous path tracking and obstacle avoidance method based on quadratic programming
JP2010117804A (en) Unmanned vehicle of traveling wheel independent steering and travel control method therefor
CN113311845B (en) Pure tracking control error compensation method and device based on path curvature
CN112731932B (en) Path tracking method of mobile robot
CN112710301B (en) High-precision positioning method and system for automatic driving vehicle
CN111609866B (en) Intelligent driving path fitting tracking control method for park vehicles based on differential GPS
CN110362088B (en) Tracking control system and method suitable for unmanned straddle carrier
CN111674406A (en) Method for controlling vehicle transverse direction of automatic driving system
CN110968082B (en) Automatic driving vehicle path tracking method and device
CN113406960B (en) Real-time path planning and control method for ground steering of agricultural unmanned vehicle

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
CB02 Change of applicant information

Address after: 3201, Building A1, Phase I, Zhong'an Chuanggu Science Park, No. 900, Wangjiang West Road, High tech Zone, Hefei, Anhui Province, 230031

Applicant after: Anhui Zhongke Xingchi Automatic Driving Technology Co.,Ltd.

Address before: 3201, Building A1, Phase I, Zhong'an Chuanggu Science Park, No. 900, Wangjiang West Road, High tech Zone, Hefei, Anhui Province, 230031

Applicant before: Anhui Zhongke Xingchi Autonomous Driving Technology Co.,Ltd.

CB02 Change of applicant information
GR01 Patent grant
GR01 Patent grant