CN115542925A - Accurate deviation estimation method for transverse control of unmanned vehicle - Google Patents

Accurate deviation estimation method for transverse control of unmanned vehicle Download PDF

Info

Publication number
CN115542925A
CN115542925A CN202211497585.3A CN202211497585A CN115542925A CN 115542925 A CN115542925 A CN 115542925A CN 202211497585 A CN202211497585 A CN 202211497585A CN 115542925 A CN115542925 A CN 115542925A
Authority
CN
China
Prior art keywords
point
course
deviation
estimation
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.)
Granted
Application number
CN202211497585.3A
Other languages
Chinese (zh)
Other versions
CN115542925B (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 Autonomous Driving Technology Co ltd
Original Assignee
Anhui Zhongke Xingchi Autonomous 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 Autonomous Driving Technology Co ltd filed Critical Anhui Zhongke Xingchi Autonomous 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

Abstract

The invention discloses a deviation accurate estimation method for transverse control of an unmanned vehicle, which is realized by a transverse deviation accurate estimation module and a course deviation accurate estimation module. According to the relative relation between an expected track and the current vehicle position, judging and generating an optimal estimation point according to three different categories, namely a first point, a last point and a path point, and calculating the lateral deviation estimation and the course deviation estimation through the optimal estimation point; and taking the calculated transverse deviation estimation and course deviation estimation as feedback control quantities to be brought into the track tracking control rate, thereby realizing the accurate tracking control of the unmanned vehicle. The invention can effectively estimate the lateral deviation and the course deviation of vehicle control, well solves the problem of overlarge change of the lateral position and the course between adjacent points on an expected track, and is particularly obviously promoted in tasks with large curvature, such as turning around or sharp turning, and the like, thereby effectively improving the tracking precision of vehicle control.

Description

Accurate deviation estimation method for transverse control of unmanned vehicle
Technical Field
The invention belongs to the field of unmanned vehicle motion control, and particularly relates to an accurate deviation estimation method for unmanned vehicle transverse control.
Background
The accurate track tracking technology is one of important components for realizing unmanned driving. The conventional track tracking technology mainly comprises two tracking methods, namely a pre-aiming point tracking method and a nearest point tracking method, aiming at the road conditions of large-curvature road conditions such as turning around or sharp turning, the track tracking technology of the pre-aiming point can generate the phenomena of turning starting in advance and turning ending in advance, and finally the tracking precision is poor or the traffic cannot be realized; the method comprises the steps that a closest point tracking method is applied to achieve accurate tracking of the road condition with large curvature, the most important feedback input of the method is deviation, the existing algorithm is that the closest point is traversed on an expected track through a current GPS position point, the transverse distance between the closest point and the current point is transverse deviation, and the calculated transverse deviation is insufficient in accuracy; the heading difference between the nearest point and the current point is taken as the heading deviation, and the heading change between the points on the expected track is large in the road condition with large curvature, so that the heading deviation calculated by the method has poor accuracy. Therefore, the accuracy of estimation of the lateral deviation and the heading deviation directly influences the tracking effect of the unmanned vehicle.
Disclosure of Invention
The invention provides an accurate deviation estimation method for transverse control of an unmanned vehicle, aiming at overcoming the defects in the prior art. The transverse deviation and the course deviation in the running process of the unmanned vehicle are accurately estimated, the deviation is utilized to realize the feedback control of the vehicle, and finally the accurate control of the unmanned vehicle is realized.
In order to achieve the purpose of the invention, the technical scheme adopted by the invention is as follows:
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 an expected track, the output is transverse deviation estimation, the expected track comprises longitude, latitude and course information of a point where the vehicle is expected to run, an optimal estimation point is generated by comparing a spatial relationship between a point C which is the minimum distance from an origin O of the current position of the vehicle in the expected 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 transverse deviation estimation lateralror is obtained through calculation;
the input of the course deviation accurate estimation module is an expected track, the output is course deviation estimation, and course estimation at an 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
(ii) a Further, 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 an origin O (xo, yo) and the course of the current vehicle 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;
and step 3: judging whether the point C is the first point on the expected track, if so, taking the point F equal to the point C, namely (xf, yf) = (xc, yc), and min _0 equal to the 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 equal to 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 behind the point C on the expected track; namely:
Figure 285991DEST_PATH_IMAGE003
and 4, step 4: if the point C is not the first point or the last point on the expected track, judging whether cosine values of < BCO and < FCO are greater than 0; if COs-FCO is greater than 0, the COs-FCO is an acute angle, which indicates that a point N which is closer to a distance | CO | between the point C and the point O exists ON a connecting line FC between the point F and the point C, the value | ON | of the point N is equal to the distance between the point O and the point FC, and the value is used as an estimated value of min _ 0; if COs-FCO is less than 0, the COs-FCO is an obtuse angle, a point which is closer than the distance | CO | between the point C and the 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 method for preparing the composite material,
Figure 340163DEST_PATH_IMAGE006
Figure 924728DEST_PATH_IMAGE007
and 5: comparing the magnitudes of min _0 and min _1 obtained in step 3 or step 4, and taking the smaller value as the absolute value of the lateral deviation estimation error:
|lateral_error| = min( min_0, min_1);
and 6: and judging whether yc is positive or negative in the current vehicle coordinate system at the point C, if yc is less than 0, estimating the lateral deviation as negative, and if yc is more than 0, estimating the lateral deviation as positive.
The calculation method of the course deviation estimation comprises the following steps:
step 1: if the minimum lateral deviation estimation point is a point on the expected track, namely the point C, the heading of the point C is
Figure 171033DEST_PATH_IMAGE008
The current course is
Figure 182851DEST_PATH_IMAGE010
And obtaining course deviation estimation 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, obtaining an optimal estimation point N according to a lateral deviation accurate estimation module, and if the point N is a point between the point C and the 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 by calculating according to the following formula:
Figure 988182DEST_PATH_IMAGE012
according to the physical space continuity and smoothness of the vehicle operation, a track between a point F and a point C is regarded as a section of circular arc, the center of the circular arc is a 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
As heading estimate for point N
Figure 6134DEST_PATH_IMAGE014
The course bias estimate is derived by:
Figure 582609DEST_PATH_IMAGE015
in the formula (I), the compound is shown in the specification,
Figure 132145DEST_PATH_IMAGE016
for the course estimate of the point N,
Figure 212097DEST_PATH_IMAGE017
the course of the point M is the course,
Figure 706663DEST_PATH_IMAGE018
the course of the point F is the course,
Figure 239276DEST_PATH_IMAGE019
the course of the point C is the course,
Figure 703755DEST_PATH_IMAGE020
the current heading of the vehicle is the current heading,
Figure 762847DEST_PATH_IMAGE021
is a heading bias estimate.
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 calculated by the following equations:
Figure 552948DEST_PATH_IMAGE022
wherein, | CO | is the distance between the point C and the point O, | ON | is the distance between the point O and the point N;
according to the physical space continuity and smoothness of the vehicle running, a 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
As heading estimate for point N
Figure 716393DEST_PATH_IMAGE024
The course bias estimate is derived by:
Figure 505358DEST_PATH_IMAGE025
in the formula (I), the compound is shown in the specification,
Figure 935202DEST_PATH_IMAGE026
for the course estimate of the point N,
Figure 334085DEST_PATH_IMAGE027
the course of the point M is the course,
Figure 140367DEST_PATH_IMAGE028
the heading of the point B is the direction of the point B,
Figure 924783DEST_PATH_IMAGE029
the course of the point C is the course,
Figure 791108DEST_PATH_IMAGE030
the current heading of the vehicle is the current heading,
Figure 520029DEST_PATH_IMAGE031
is a heading bias estimate.
Furthermore, the lateral deviation estimation and the course deviation estimation are used as feedback control quantity to be brought into a track tracking control rate, so that accurate tracking control of the unmanned vehicle is achieved.
Has the advantages that:
the invention can accurately estimate the transverse deviation and the course deviation of the current vehicle relative to the expected track, reduce the error input of the system and has particularly obvious improvement in the tasks with large curvature such as turning around or sharp turning; by the scheme, the transverse deviation and the course deviation of vehicle control can be effectively estimated, and the problem of overlarge transverse position and course change between adjacent points on an expected track is well solved, so that the tracking precision of vehicle control is effectively improved. The estimation method provided by the invention is simple in calculation, high in estimation precision and convenient to use.
Drawings
FIG. 1 is an analysis diagram of the lateral deviation accurate estimation of the deviation accurate estimation method for the lateral control of the unmanned vehicle according to the present invention;
FIG. 2 is a flow chart of the lateral deviation accurate estimation of the deviation accurate estimation method for the lateral control of the unmanned vehicle of the present invention;
FIG. 3 is a first analysis chart of course deviation accurate estimation of the deviation accurate estimation method for the unmanned vehicle lateral control of the present invention.
FIG. 4 is a second analysis diagram of the course deviation accurate estimation of the deviation accurate estimation method for the lateral control of the unmanned vehicle of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention. In addition, the technical features involved in the embodiments of the present invention described below may be combined with each other as long as they do not conflict with each other.
In this embodiment, as shown in fig. 1, 2, and 3, the method for accurately estimating the lateral deviation for the lateral control of the unmanned aerial vehicle according to the present invention is performed as follows:
step one, obtaining an expected track:
a GPS/IMU combined navigation system is applied in advance to collect a section of expected track, and the expected track comprises real-time longitude, latitude and heading information of a vehicle. In an actual application process, the expected trajectory may also be generated by way of path planning.
Step two, acquiring GPS position and course information of the vehicle at the current moment through a GPS/IMU integrated navigation system, and converting points of an expected track acquired in advance into expected path points under a vehicle coordinate system with the current moment pose as an origin:
Figure 785794DEST_PATH_IMAGE032
in the formula, R is the earth radius, PI represents the circumference ratio, lat is the latitude of the expected waypoint, lng is the longitude of the expected 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 are the vertical projection of the expected track point on the coordinate plane of the current vehicle, az is the heading of the vehicle at the current time, and X, Y are the coordinates of the expected waypoint in the coordinate system of the vehicle.
Step three, traversing a point C (xc, yc) with the minimum 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
in the formula, x and y are coordinates of the expected road point in the vehicle coordinate system, and dis is the distance between the expected road point and the current vehicle.
Step four, 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 the 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 to be equal to the point C, (xb, yb) = (xc, yc), and if not, taking the point B to be the point behind the point C on the expected track, wherein min _1 is equal to the distance | BO | between the point B and the point O;
Figure 461944DEST_PATH_IMAGE034
step five, if the point C is not the first point or the last point on the expected track, judging whether cosine values of the & lt BCO and the & lt FCO are larger than 0; if COs & lt FCO is greater than 0, then & lt FCO is an acute angle, which indicates that a point N which is closer than a distance | CO | between the point C and the point O exists ON a connecting line FC between the point F and the point C, the value | ON | of the point N is equal to the distance from the point O to the point FC, and the value is used as an estimated value of min _ 0; if COs & lt FCO is less than 0, then & lt FCO is an obtuse angle, a point which is closer than the distance | CO | between the point C and the point O does not exist on a connecting line FC between the point F and the point C, and | CO | is used as an estimated value of min _ 0; namely:
Figure 943740DEST_PATH_IMAGE035
Figure 91825DEST_PATH_IMAGE036
in the same way, the method for preparing the composite material,
Figure 604496DEST_PATH_IMAGE037
Figure 547044DEST_PATH_IMAGE038
step six, comparing the magnitudes of min _0 and min _1, and taking the smaller value as the absolute value of the lateral deviation estimation:
|lateral_error| = min( min_0, min_1);
and seventhly, judging whether yc is positive or negative in the current vehicle coordinate system of the point C, if yc is less than 0, estimating that the transverse deviation is negative, and if yc is more than 0, estimating that the transverse deviation is positive.
Step eight, estimating a point according to the minimum transverse deviation and the minimum transverse deviation obtained in the step five and the step six, wherein if the estimated point of the minimum transverse deviation is a point on the expected track, the point is a point C, and the heading of the point C is
Figure 516137DEST_PATH_IMAGE039
The current course is
Figure 343279DEST_PATH_IMAGE040
The course deviation estimate can be derived from the following equation:
Figure 815848DEST_PATH_IMAGE041
step nine: if the estimated point with the minimum lateral deviation is not a point on the expected track, obtaining an optimal estimated point N according to the accurate lateral deviation estimation module, and if the point N is a point between the point C and the point F, as shown in fig. 3, obtaining a distance | CN | between the point C and the point N and a distance | CF | between the point C and the point F by the following formula:
Figure 460456DEST_PATH_IMAGE042
where | 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 vehicle operation, a track between a point F and a point C is regarded as a section of circular arc, the center of the circular arc is a 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
As heading estimate for point N
Figure 531366DEST_PATH_IMAGE044
The course bias estimate is derived by:
Figure 264967DEST_PATH_IMAGE045
in the formula (I), the compound is shown in the specification,
Figure 80476DEST_PATH_IMAGE047
for the course estimate of the point N,
Figure 493003DEST_PATH_IMAGE048
the course of the point M is the course,
Figure 412680DEST_PATH_IMAGE049
the course of the point F is the course,
Figure 859842DEST_PATH_IMAGE050
is the heading of the point C and,
Figure 846252DEST_PATH_IMAGE051
is the current heading of the vehicle and is,
Figure 887021DEST_PATH_IMAGE052
is a heading bias estimate.
If point N is a point between point C and point B, as shown in fig. 4, the distance | BN | between point B and point N and the distance | CB | between point C and point B are calculated by the following equations:
Figure 984290DEST_PATH_IMAGE053
according to the physical space continuity and smoothness of the vehicle running, a 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
As heading estimate for point N
Figure 567904DEST_PATH_IMAGE024
The course bias estimate is derived by:
Figure 955023DEST_PATH_IMAGE025
in the formula (I), the compound is shown in the specification,
Figure 590403DEST_PATH_IMAGE026
for the course estimate of the point N,
Figure 887524DEST_PATH_IMAGE027
the course of the point M is the course,
Figure 950158DEST_PATH_IMAGE028
the heading of the point B is the direction of the point B,
Figure 90152DEST_PATH_IMAGE029
the course of the point C is the course,
Figure 886813DEST_PATH_IMAGE030
the current heading of the vehicle is the current heading,
Figure 163074DEST_PATH_IMAGE054
is a heading bias estimate.
Step ten: and solving to obtain the expected turning curvature of the vehicle according to the obtained lateral deviation estimation and course deviation estimation by applying a track tracking controller of the following formula:
q0=tan(-1*(heading_error*PI/180)+arctan(k*lateral_error/(speed))/L
in the formula, the heading _ error is course deviation estimation, the lateral _ error is transverse deviation estimation, k is a proportional parameter required to be adjusted for track tracking, speed is the current speed of the unmanned vehicle, L is the wheelbase of the unmanned vehicle, and q0 is the expected steering curvature.
Step eleven: the desired steering angle is solved for based on the vehicle characteristics. Taking a certain type of chevroleraceae park car as an example, the expected steering angle is obtained according to the relationship between the steering size of the steering wheel of the car and the steering curvature of the car:
turn=-4857*q0*q0*q0+117.4*q0*q0+2753*q0+3266
where q0 is the vehicle desired steering curvature and turn is the vehicle desired steering angle.
It will be understood by those skilled in the art that the foregoing is only a preferred embodiment of the present invention, and is not intended to limit the invention, and that any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the scope of the present invention.

Claims (3)

1. A deviation accurate estimation method for the transverse control of an unmanned vehicle is characterized in that the accurate estimation of the deviation is realized through a transverse deviation accurate estimation module and a course deviation accurate estimation module;
the input of the transverse deviation accurate estimation module is an expected track, the output is transverse deviation estimation, the expected track comprises longitude, latitude and course information of a point where the vehicle is expected to run, an optimal estimation point is generated by comparing a spatial relationship between a point C which is the minimum distance from an origin O of the current position of the vehicle in the expected 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 transverse deviation estimation lateralror is obtained through calculation;
the input of the course deviation accurate estimation module is an expected track, the output of the course deviation accurate estimation module is course deviation estimation, course estimation at an optimal estimation point is obtained through calculation, and the course estimation and the current course of the vehicle are obtained
Figure 243494DEST_PATH_IMAGE001
Comparing to obtain course deviation estimation
Figure 184905DEST_PATH_IMAGE002
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 current vehicle longitude and latitude as an original point O (xo, yo) of the current position of the vehicle and the current vehicle course 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;
and step 3: judging whether the point C is the first point on the expected track, if so, taking the point F equal to the point C, namely (xf, yf) = (xc, yc), and min _0 equal to the 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 to be equal to 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 to be the point behind the point C on the expected track; namely:
Figure 32775DEST_PATH_IMAGE004
wherein, | CO | is the distance between the point C and the point O, | FO | is the distance between the point F and the point O;
and 4, step 4: if the point C is not the first point or the last point on the expected track, judging whether cosine values of the & lt BCO and the & lt FCO are more than 0; if COs-FCO is greater than 0, the COs-FCO is an acute angle, which indicates that a point N which is closer to a distance | CO | between the point C and the point O exists ON a connecting line FC between the point F and the point C, the value | ON | of the point N is equal to the distance between the point O and the point FC, and the value is used as an estimated value of min _ 0; if COs & lt FCO is less than 0, then & lt FCO is an obtuse angle, a point which is closer than the distance | CO | between the point C and the point O does not exist on a connecting line FC between the point F and the point C, and | CO | is used as an estimated value of min _ 0; namely:
Figure 318525DEST_PATH_IMAGE005
Figure 11675DEST_PATH_IMAGE007
in the same way, the method for preparing the composite material,
Figure 807593DEST_PATH_IMAGE008
Figure 950998DEST_PATH_IMAGE010
wherein, | FC | is the distance between point F and point C, | BC | is the distance between point B and point C;
and 5: comparing the magnitudes of min _0 and min _1 obtained in step 3 or step 4, and taking the smaller value as the absolute value of the lateral deviation estimation filter _ error:
|lateral_error| = min( min_0, min_1);
step 6: and judging whether yc is positive or negative in the current vehicle coordinate system at the point C, if yc is less than 0, estimating that the lateral deviation is negative, and if yc is more than 0, estimating that the lateral deviation is positive.
2. The method for accurately estimating the deviation for the lateral control of the unmanned vehicle as claimed in claim 1, wherein the calculation method of the heading deviation estimation is as follows:
step 1: if the estimated point of the minimum transverse deviation is a point on the expected track, namely the point C, the heading of the point C is
Figure 97946DEST_PATH_IMAGE011
The current course is
Figure 860365DEST_PATH_IMAGE012
And obtaining course deviation estimation according to the following formula:
Figure 776369DEST_PATH_IMAGE013
and 2, step: if the minimum lateral deviation estimation point is not a point on the expected track, obtaining an optimal estimation point according to a lateral deviation accurate estimation module, and marking the optimal estimation point as a point N, and if the point N is a point between the point C and the point F, calculating a distance | CN | between the point C and the point N and a distance | CF | between the point C and the point F according to the following formula:
Figure 825096DEST_PATH_IMAGE014
wherein, | CO | is the distance between the point C and the point O, | ON | is the distance between the point O and the point N;
according to the physical space continuity and smoothness of the vehicle operation, a track between a point F and a point C is regarded as a section of circular arc, the center of the circular arc is a point S, and the course of the intersection point M of the SN extension line and the circular arc is calculated
Figure 193760DEST_PATH_IMAGE015
Heading estimation as Point N
Figure 494292DEST_PATH_IMAGE016
The course bias estimate is derived by:
Figure 655015DEST_PATH_IMAGE017
in the formula (I), the compound is shown in the specification,
Figure 750010DEST_PATH_IMAGE019
for the course estimate of the point N,
Figure 871549DEST_PATH_IMAGE020
the course of the point M is the course,
Figure 975772DEST_PATH_IMAGE021
the course of the point F is the course,
Figure 952518DEST_PATH_IMAGE022
is the heading of the point C and,
Figure 483994DEST_PATH_IMAGE023
is the current heading of the vehicle and is,
Figure 827251DEST_PATH_IMAGE024
estimating course deviation;
if point N is a point between point C and point B, the distance | BN | between point B and point N, and the distance | CB | between point C and point B are calculated by the following equations:
Figure 859797DEST_PATH_IMAGE025
according to the physical space continuity and smoothness of the vehicle running, a 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 604900DEST_PATH_IMAGE026
As heading estimate for point N
Figure 307276DEST_PATH_IMAGE027
The course bias estimate is derived by:
Figure 137829DEST_PATH_IMAGE028
in the formula (I), the compound is shown in the specification,
Figure 442909DEST_PATH_IMAGE029
for the course estimate of the point N,
Figure 42517DEST_PATH_IMAGE030
the course of the point M is the course,
Figure 915795DEST_PATH_IMAGE031
the heading of the point B is the direction of the point B,
Figure 358278DEST_PATH_IMAGE032
the course of the point C is the course,
Figure 342414DEST_PATH_IMAGE033
the current heading of the vehicle is the current heading,
Figure 796529DEST_PATH_IMAGE034
is a heading bias estimate.
3. The method as claimed in claim 2, wherein the lateral deviation estimate and the heading deviation estimate are used as feedback control quantities to be brought into a trajectory 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 true CN115542925A (en) 2022-12-30
CN115542925B 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)

Cited By (1)

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

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106681327A (en) * 2017-01-11 2017-05-17 中南大学 Method and system for intelligent driving horizontal and vertical decoupling control of great inertia electric motor coach
WO2018078606A1 (en) * 2016-10-31 2018-05-03 MAGNETI MARELLI S.p.A. Adaptive control method and system in a terrestrial vehicle for tracking a route, particularly in an autonomous driving scenario
WO2018149501A1 (en) * 2017-02-17 2018-08-23 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
CN110502009A (en) * 2019-08-14 2019-11-26 南京理工大学 The automatic driving vehicle path tracking control method estimated based on course
CN111158379A (en) * 2020-01-16 2020-05-15 合肥中科智驰科技有限公司 Steering wheel zero-bias self-learning unmanned vehicle track tracking method
CN112046504A (en) * 2020-09-21 2020-12-08 北京易控智驾科技有限公司 Unmanned vehicle, transverse control method thereof and electronic equipment
CN113336117A (en) * 2021-06-18 2021-09-03 湖南国天电子科技有限公司 Automatic deviation rectifying method and device for warm salt deep winch
WO2021238747A1 (en) * 2020-05-26 2021-12-02 三一专用汽车有限责任公司 Method and apparatus for controlling lateral motion of self-driving vehicle, and self-driving vehicle
CN114834484A (en) * 2022-05-13 2022-08-02 中汽创智科技有限公司 Vehicle track following control method and device, electronic equipment and storage medium

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018078606A1 (en) * 2016-10-31 2018-05-03 MAGNETI MARELLI S.p.A. Adaptive control method and system in a terrestrial vehicle for tracking a route, particularly in an autonomous driving scenario
CN106681327A (en) * 2017-01-11 2017-05-17 中南大学 Method and system for intelligent driving horizontal and vertical decoupling control of great inertia electric motor coach
WO2018149501A1 (en) * 2017-02-17 2018-08-23 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
CN110502009A (en) * 2019-08-14 2019-11-26 南京理工大学 The automatic driving vehicle path tracking control method estimated based on course
CN111158379A (en) * 2020-01-16 2020-05-15 合肥中科智驰科技有限公司 Steering wheel zero-bias self-learning unmanned vehicle track tracking method
WO2021238747A1 (en) * 2020-05-26 2021-12-02 三一专用汽车有限责任公司 Method and apparatus for controlling lateral motion of self-driving vehicle, and self-driving vehicle
CN112046504A (en) * 2020-09-21 2020-12-08 北京易控智驾科技有限公司 Unmanned vehicle, transverse control method thereof and electronic equipment
CN113336117A (en) * 2021-06-18 2021-09-03 湖南国天电子科技有限公司 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

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
陈龙 等: "极限工况下无人驾驶车辆稳定跟踪控制", 《汽车工程》 *
高琳琳 等: "智能无人车路径跟踪控制方法研究", 《汽车实用技术》 *

Cited By (1)

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

Also Published As

Publication number Publication date
CN115542925B (en) 2023-05-02

Similar Documents

Publication Publication Date Title
CN106840179B (en) Intelligent vehicle positioning method based on multi-sensor information fusion
CN108116497B (en) The determination method and device of point, steering angle is taken aim in steering for intelligent driving in advance
US20200341474A1 (en) Method and device for generating an autonomous driving trajectory of a vehicle
US9885578B2 (en) Curve-shape modeling device, vehicle information processing system, curve-shape modeling method, and non-transitory tangible computer readable medium for the same
CN110341688B (en) Front wheel steering angle compensation method and device, vehicle-mounted equipment and storage medium
CN107132563B (en) Combined navigation method combining odometer and dual-antenna differential GNSS
CN107037818A (en) A kind of path following method of pilotless automobile
CN106476883A (en) The travel controlling system of vehicle
CN108180921B (en) AR-HUD navigation system using GPS data and navigation method thereof
CN108345021B (en) Doppler radar assisted GPS/INS vehicle speed measurement method
CN111137298B (en) Vehicle automatic driving method, device, system and storage medium
CN111006667A (en) Automatic driving track generation system under high-speed scene
CN115542925A (en) Accurate deviation estimation method for transverse control of unmanned vehicle
CN113689735A (en) Vehicle lane change collision early warning method and device
CN112433531A (en) Trajectory tracking method and device for automatic driving vehicle and computer equipment
Rodriguez-Castaño et al. High-speed autonomous navigation system for heavy vehicles
CN111176298A (en) Unmanned vehicle track recording and tracking method
CN111158379B (en) Steering wheel zero-bias self-learning unmanned vehicle track tracking method
Scott et al. Increased accuracy of motor vehicle position estimation by utilising map data: vehicle dynamics, and other information sources
Yang et al. An algorithm of curved path tracking with prediction model for autonomous vehicle
CN113665587A (en) Lateral control method, device, storage medium, and apparatus for autonomous vehicle
CN114906173A (en) Automatic driving decision-making method based on two-point preview driver model
CN112710301B (en) High-precision positioning method and system for automatic driving vehicle
CN110094498B (en) Wheel speed ratio obtaining method and device
CN111609866B (en) Intelligent driving path fitting tracking control method for park vehicles based on differential GPS

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