CN113353074B - Vehicle control method and device, electronic equipment and storage medium - Google Patents
Vehicle control method and device, electronic equipment and storage medium Download PDFInfo
- Publication number
- CN113353074B CN113353074B CN202110910774.8A CN202110910774A CN113353074B CN 113353074 B CN113353074 B CN 113353074B CN 202110910774 A CN202110910774 A CN 202110910774A CN 113353074 B CN113353074 B CN 113353074B
- Authority
- CN
- China
- Prior art keywords
- lane
- vehicle
- boundary line
- curvature
- line
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000004422 calculation algorithm Methods 0.000 claims description 23
- 238000004590 computer program Methods 0.000 claims description 11
- 230000008859 change Effects 0.000 claims description 9
- 238000010586 diagram Methods 0.000 description 15
- 230000006870 function Effects 0.000 description 10
- 238000004891 communication Methods 0.000 description 6
- 230000003287 optical effect Effects 0.000 description 6
- 238000012545 processing Methods 0.000 description 6
- 230000008034 disappearance Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000013307 optical fiber Substances 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000000644 propagated effect Effects 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 206010041349 Somnolence Diseases 0.000 description 1
- 238000003491 array Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/10—Path keeping
- B60W30/12—Lane keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
- B60W40/072—Curvature of the road
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/30—Road curve radius
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/53—Road markings, e.g. lane marker or crosswalk
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
The embodiment of the disclosure discloses a vehicle control method, a vehicle control device, an electronic device and a storage medium, wherein the method comprises the following steps: determining a lane line of a lane where a vehicle is currently located when the vehicle runs; determining a middle line of the lane according to the lane line; predicting a relative curvature of a vehicle travel track based on the intermediate line; obtaining a front wheel turning angle and a rear wheel turning angle of the vehicle based on the correlation curvature and a four-wheel steering vehicle model; and controlling the vehicle through a steering controller according to the front wheel turning angle and the rear wheel turning angle so as to keep the vehicle running in the lane. The lane keeping assist function for the four-wheel steering vehicle is realized, and the driving safety of the vehicle can be improved.
Description
Technical Field
The present disclosure relates to the field of vehicle driving assistance technologies, and in particular, to a vehicle control method and apparatus, an electronic device, and a storage medium.
Background
LKA (Lane Keep Assistance) can be used to control the vehicle to Keep running in the Lane line when the vehicle deviates from the actual road due to a steering error caused by drowsiness of the driver, inattention, or insufficient driving experience.
The LKA controls the steering system based on the relative position of the vehicle and the lane line so as to enable the vehicle to be kept in the lane line, and the LKA is an effective measure for making up for the steering and control error of a driver and improving the road driving safety of the vehicle.
However, most of the LKAs are currently designed based on two-wheel-steered vehicles, and the LKA applied to the two-wheel-steered vehicle is not well applicable to the four-wheel-steered vehicle, so it is necessary to design the LKA for the four-wheel-steered vehicle.
Disclosure of Invention
In order to solve the technical problems described above or at least partially solve the technical problems, embodiments of the present disclosure provide a vehicle control method, apparatus, electronic device, and storage medium, which implement a lane keeping assist function for a four-wheel steering vehicle and may improve driving safety of the vehicle.
In a first aspect, an embodiment of the present disclosure provides a vehicle control method, including:
determining a lane line of a lane where a vehicle is currently located when the vehicle runs;
determining a middle line of the lane according to the lane line;
predicting a relative curvature of a vehicle travel track based on the intermediate line;
obtaining a front wheel turning angle and a rear wheel turning angle of the vehicle based on the correlation curvature and a four-wheel steering vehicle model;
and controlling the vehicle through a steering controller according to the front wheel turning angle and the rear wheel turning angle so as to keep the vehicle running in the lane.
In a second aspect, an embodiment of the present disclosure further provides a vehicle control apparatus, including:
the vehicle lane identification device comprises a first determination module, a second determination module and a control module, wherein the first determination module is used for determining a lane line of a lane where a vehicle is located when the vehicle runs;
the second determining module is used for determining a middle line of the lane according to the lane line;
a prediction module for predicting a curvature associated with a vehicle travel path based on the intermediate line;
a third determination module, configured to obtain a front wheel steering angle and a rear wheel steering angle of the vehicle based on the associated curvature and a four-wheel steering vehicle model;
and the first control module is used for controlling the vehicle through a steering controller according to the front wheel steering angle and the rear wheel steering angle so as to keep the vehicle running in the lane.
An embodiment of the present disclosure further provides an electronic device, which includes:
one or more processors;
storage means for storing one or more programs;
when executed by the one or more processors, cause the one or more processors to implement the method as described above.
Embodiments of the present disclosure also provide a computer-readable storage medium, on which a computer program is stored, which when executed by a processor implements the method as described above.
Embodiments of the present disclosure also provide a computer program product comprising a computer program or instructions which, when executed by a processor, implement the method as described above.
The technical scheme provided by the embodiment of the disclosure has at least the following advantages:
the vehicle control method provided by the embodiment of the disclosure comprises the following steps: determining a lane line of a lane where a vehicle is currently located when the vehicle runs; determining a middle line of the lane according to the lane line; predicting a relative curvature of a vehicle travel track based on the intermediate line; obtaining a front wheel turning angle and a rear wheel turning angle of the vehicle based on the correlation curvature and a four-wheel steering vehicle model; the vehicle is controlled through the steering controller according to the front wheel steering angle and the rear wheel steering angle so as to keep the vehicle running in the lane, a lane keeping auxiliary function aiming at the four-wheel steering vehicle is realized, and the driving safety of the vehicle can be improved.
Drawings
The above and other features, advantages and aspects of various embodiments of the present disclosure will become more apparent by referring to the following detailed description when taken in conjunction with the accompanying drawings. Throughout the drawings, the same or similar reference numbers refer to the same or similar elements. It should be understood that the drawings are schematic and that elements and features are not necessarily drawn to scale.
FIG. 1 is a flow chart of a vehicle control method in an embodiment of the present disclosure;
FIG. 2 is a schematic diagram of a lane line collection in an embodiment of the present disclosure;
FIG. 3 is a schematic view of a lane marking width in an embodiment of the present disclosure;
FIG. 4 is a schematic illustration of a prediction of a future position of a vehicle in an embodiment of the disclosure;
FIG. 5 is a schematic structural diagram of a vehicle steering system in an embodiment of the present disclosure;
fig. 6 is a schematic structural diagram of a vehicle control apparatus in an embodiment of the present disclosure;
fig. 7 is a schematic structural diagram of an electronic device in an embodiment of the disclosure.
Detailed Description
Embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. While certain embodiments of the present disclosure are shown in the drawings, it is to be understood that the present disclosure may be embodied in various forms and should not be construed as limited to the embodiments set forth herein, but rather are provided for a more thorough and complete understanding of the present disclosure. It should be understood that the drawings and embodiments of the disclosure are for illustration purposes only and are not intended to limit the scope of the disclosure.
It should be understood that the various steps recited in the method embodiments of the present disclosure may be performed in a different order, and/or performed in parallel. Moreover, method embodiments may include additional steps and/or omit performing the illustrated steps. The scope of the present disclosure is not limited in this respect.
The term "include" and variations thereof as used herein are open-ended, i.e., "including but not limited to". The term "based on" is "based, at least in part, on". The term "one embodiment" means "at least one embodiment"; the term "another embodiment" means "at least one additional embodiment"; the term "some embodiments" means "at least some embodiments". Relevant definitions for other terms will be given in the following description.
It should be noted that the terms "first", "second", and the like in the present disclosure are only used for distinguishing different devices, modules or units, and are not used for limiting the order or interdependence relationship of the functions performed by the devices, modules or units.
It is noted that references to "a", "an", and "the" modifications in this disclosure are intended to be illustrative rather than limiting, and that those skilled in the art will recognize that "one or more" may be used unless the context clearly dictates otherwise.
The names of messages or information exchanged between devices in the embodiments of the present disclosure are for illustrative purposes only, and are not intended to limit the scope of the messages or information.
Fig. 1 is a flowchart of a vehicle control method in an embodiment of the present disclosure, and the embodiment may be applied to a scenario of automatic driving or assisted driving. The method can be carried out by a vehicle control device, which can be implemented in software and/or hardware, which can be configured in a vehicle.
As shown in fig. 1, the method may specifically include the following steps:
In one embodiment, as shown in fig. 2, a schematic diagram of collecting lane lines is obtained by using a vehicle-mounted camera to obtain the lane lines of the lane where the vehicle is currently located. It is understood that if the vehicle does not travel in the middle of the lane, the lane line on one side of the lane may not fall within the photographing range of the vehicle-mounted camera, and thus the lane line collected by the vehicle-mounted camera at this time may only include the lane line on one side of the lane. As shown in fig. 2, the current lane includes left and right lane lines, i.e., a left lane line 210 and a right lane line 220, which have a certain width, and the boundary of the lane line close to the vehicle is referred to as an inner boundary line, i.e., a left inner boundary line 211 and a right inner boundary line 221 shown in fig. 2, and the boundary of the lane line far from the vehicle is referred to as an outer boundary line, i.e., a left outer boundary line 212 and a right outer boundary line 222 shown in fig. 2. It should be noted that, when determining the left and right, the direction in which the vehicle is moving is used as a reference.
In another embodiment, the lane line of the lane where the vehicle is located can be collected through a vehicle-mounted radar.
Further, if the lane lines only include the lane line on one side of the lane, the missing lane line on the other side of the lane is compensated through a lane line compensation algorithm, and the lane lines on the two sides of the lane are obtained.
In one embodiment, the compensating for the missing lane line on the other side of the lane by a lane line compensation algorithm includes:
obtaining lane line width information in at least two preset time periods before the missing time of the lane line, wherein each preset time period changes along with the change of the vehicle speed, and determining the preset time period by combining the vehicle speed according to the condition that the length of the lane line obtained in the preset time period meets a length threshold, so that the faster the vehicle speed is, the shorter the preset time period is, the slower the vehicle speed is, and the longer the preset time period is; determining the average width information of the lane lines based on the lane line width information in the at least two preset time periods and the lane line width weight corresponding to each preset time period; determining the missing lane line curvature information and lateral offset on the other side of the lane based on the lane line average width information.
Specifically, the lane line missing state may be detected first, and different states of lane line missing may be calibrated. If lane lines (including an inner boundary line and an outer boundary line on the left side of the lane and an inner boundary line and an outer boundary line on the right side) on two sides of the lane exist, the missing state of the lane lines is calibrated to be 6; if only a lane line on the left side of the lane exists (comprising an inner boundary line and an outer boundary line on the left side of the lane), the missing state of the lane line is calibrated to be 5; if only a lane line on the right side of the lane exists (comprising an inner boundary line and an outer boundary line on the right side of the lane), the missing state of the lane line is calibrated to be 4; if only the outer lane line (including the outer boundary line on the left side of the lane and the outer boundary line on the right side of the lane) exists, the lane line missing state is calibrated to be 3; if only the outer boundary line on the left side of the lane (including the outer boundary line on the left side of the lane) exists, the lane line missing state is calibrated to be 2; if only the outer boundary line on the right side of the lane exists, the lane line missing state is calibrated to be 1; if the lane lines on the two sides (including the left inner boundary line and the left outer boundary line and the right inner boundary line and the right outer boundary line) do not exist, the default state of the lane lines is calibrated to be 0. Lane line widths w1, w2 and w3 are acquired in real time through the vehicle-mounted camera, and w1, w2 and w3 respectively represent the lane width of the vehicle, the lane width of the left side of the vehicle and the lane width of the right side of the vehicle. Reference may be made to a schematic diagram of lane line width marking as shown in fig. 3, wherein the width of the lane where the vehicle is located is w1, the width of the lane on the left side of the vehicle is w2, and the width of the lane on the right side of the vehicle is w 3. The lane width w1 of the vehicle indicates the distance between the left inner boundary line 320 and the right inner boundary line 330. The vehicle left lane width w2 specifically refers to the distance between the center line 310 of the vehicle and the inner left boundary line 320 of the lane, and the vehicle left lane width w3 specifically refers to the distance between the center line 310 of the vehicle and the inner right boundary line 330 of the lane.
When the lane line missing state detected by the vehicle-mounted camera is 5, 4, 3, 2 or 1, extracting lane line width information in a preset time period before the lane line missing moment through a lane line compensation algorithm, wherein the preset time period changes along with the change of the vehicle speed and basically meets the condition that the length of the lane line detected in the preset time period is a length threshold (typically 40m for example), namely the faster the vehicle speed is, the shorter the preset time period is, the slower the vehicle speed is, and the longer the preset time period is. Then, determining the average width information of the lane lines by a segmented weighting method, namely determining the average width information of the lane lines based on the lane line width information in the at least two preset time periods and the lane line width weight respectively corresponding to each preset time period:
wherein, a1Represents the boundary line width weight, a, within the preset time period N2Represents the boundary line width weight, a, within the preset time period M3Represents the boundary line width weight within the preset time period L,W iNrepresents the average width of the lane lines detected within the preset time period N,W iM、represents the average width of the lane lines detected within the preset time period M,W iLrepresents the average width of the lane lines detected within the preset time period L.
After obtaining the average width information of the lane lines, performing lane line compensation based on the average width information of the lane lines, that is, estimating the related information of the lane lines (such as curvature change rate, curvature, relative course angle, lateral offset, and the like), wherein the curvature change rate and the relative course angle are basically the same between the lane lines, and therefore, only the curvature and the lateral offset of the missing lane lines need to be estimated. It should be noted that the physical quantities (such as curvature and lateral offset) associated with the lane lines are referred to as positive left and negative right.
Specifically, when lane line disappearance state is 5, what gather through on-vehicle camera promptly the lane line only includes two inside and outside boundary lines on the left of lane, then the inner boundary line curvature on the right side of lane that obtains through lane line compensation algorithm is: if the curvature of the inner boundary line on the left side of the lane is larger than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the inner boundary line on the left side of the lane and the average width of the lane where the vehicle is located; if the curvature of the inner boundary line on the left side of the lane is smaller than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the inner boundary line on the left side of the lane and the average width of the lane in which the vehicle is located.
The curvature of the inner boundary line on the right side of the lane is expressed by the following equation (1),Q l indicating the curvature of the inner boundary line to the left of the lane,Q r indicating the curvature of the inner boundary line on the right side of the lane,representing the average width of the lane in which the vehicle is located.
The lateral offset of the inner boundary line on the right side of the lane is as follows: the difference between the lateral offset of the inner boundary line on the left side of the lane and the average width of the lane where the vehicle is located is specifically as follows:whereinL l indicating a laneThe lateral offset of the inner boundary line on the left side,L r indicating the lateral offset of the inner boundary line on the right side of the lane,representing the average width of the lane in which the vehicle is located.
In an optional embodiment, based on the above equation (1), the curvature of the inner boundary line on the right side of the lane may be further adjusted by multiplying a certain coefficient, so as to improve the accuracy of the obtained curvature of the inner boundary line on the right side of the lane. The coefficients may be adjusted based on business experience. In the same manner, the lateral shift amount of the inner boundary line on the right side of the lane may also be adjusted by multiplying a certain coefficient to improve the calculation accuracy of the lateral shift amount.
When lane line disappearance state is 4, gather promptly through on-vehicle camera the lane line only includes two inside and outside boundary lines on lane right side, then the left inside boundary line curvature of lane that obtains through lane line compensation algorithm is left side lane line curvature:
if the curvature of the inner boundary line on the right side of the lane is larger than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located; if the curvature of the inner boundary line on the right side of the lane is smaller than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located.
The curvature of the inner boundary line on the left side of the lane is expressed by the following equation (2),Q l indicating the curvature of the inner boundary line to the left of the lane,Q r indicating the curvature of the inner boundary line on the right side of the lane,representing the average width of the lane in which the vehicle is located.
The transverse offset of the inner boundary line on the left side of the lane is the sum of the transverse offset of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located, and specifically comprises the following steps:. Wherein,L l indicating the lateral offset of the inner boundary line on the left side of the lane,L r indicating the lateral offset of the inner boundary line on the right side of the lane,representing the average width of the lane in which the vehicle is located.
When the lane line missing state is 3, that is, the lane line acquired by the vehicle-mounted camera only includes the outer boundary line on the left side of the lane and the outer boundary line on the right side of the lane, the curvatures of the inner boundary line on the left side of the lane and the inner boundary line on the right side of the lane obtained by the lane line compensation algorithm are respectively:
if the curvature of the outer boundary line on the left side of the lane is larger than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle; if the curvature of the outer boundary line on the left side of the lane is less than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle.
If the curvature of the outer boundary line on the right side of the lane is larger than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle; if the curvature of the outer boundary line on the right side of the lane is less than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle.
The curvature of the inner boundary line on the left side of the lane is expressed by the following expression (3), and the curvature of the inner boundary line on the right side of the lane is expressed by the following expression (4),Q l indicating the curvature of the inner boundary line to the left of the lane,Q ll indicating the curvature of the outer boundary line to the left of the lane,representing the average width of the left lane of the vehicle,Q r indicating the curvature of the inner boundary line on the right side of the lane,Q rr indicating the curvature of the outer boundary line on the right side of the lane,representing the average width of the right side lane of the vehicle. Inner boundary line curvature on the left side of the lane:(3)
inner boundary line curvature on the right side of the lane:
the lateral offset of the inner boundary line on the left side of the lane is as follows: the sum of the lateral offset of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle, the lateral offset of the inner boundary line on the right side of the lane is: the difference between the lateral offset of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle. The method specifically comprises the following steps:
wherein,L l indicating the lateral offset of the inner boundary line on the left side of the lane,L r indicating the lateral offset of the inner boundary line on the right side of the lane,L ll indicating the lateral offset of the outer boundary line to the left of the lane,L rr indicating the lateral offset of the outer boundary line on the right side of the lane,representing the average width of the left lane of the vehicle,representing the average width of the right side lane of the vehicle.
When the lane line missing state is 2, that is, the lane line acquired by the vehicle-mounted camera only includes the outer boundary line on the left side of the lane, the curvatures of the inner boundary line on the left side of the lane and the inner boundary line on the right side of the lane obtained by the lane line compensation algorithm are respectively:
if the curvature of the outer boundary line on the left side of the lane is larger than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle; if the curvature of the outer boundary line on the left side of the lane is less than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle.
If the curvature of the inner boundary line on the left side of the lane is larger than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the inner boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle; if the curvature of the inner boundary line on the left side of the lane is less than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the inner boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle.
The curvature of the inner boundary line on the left side of the lane is expressed by the following equation (5), and the curvature of the inner boundary line on the right side of the lane is expressed by the following equation (6).
inner boundary line curvature on the right side of the lane:
the transverse offset of the inner boundary line on the left side of the lane is the difference between the transverse offset of the outer boundary line on the left side of the lane and the average width of the lane line on the left side of the vehicle; the lateral deviation of the inner boundary line on the right side of the lane is the difference between the lateral deviation of the inner boundary line on the left side of the lane and the average width of the lane where the vehicle is located:。
when the lane line missing state is 1, that is, the lane line acquired by the vehicle-mounted camera only includes the outer boundary line on the right side of the lane, the curvatures of the inner boundary line on the left side of the lane and the inner boundary line on the right side of the lane obtained by the lane line compensation algorithm are respectively:
if the curvature of the inner boundary line on the right side of the lane is larger than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located; if the curvature of the inner boundary line on the right side of the lane is smaller than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located.
If the curvature of the outer boundary line on the right side of the lane is larger than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle; if the curvature of the outer boundary line on the right side of the lane is less than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle.
The curvature of the inner boundary line on the left side of the lane is expressed by the following equation (7), and the curvature of the inner boundary line on the right side of the lane is expressed by the following equation (8).
Inner boundary line curvature on the left side of the lane:
inner boundary line curvature on the right side of the lane:
the transverse offset of the inner boundary line on the right side of the lane is the sum of the transverse offset of the outer boundary line on the right side of the lane and the average width of the lane line on the right side of the vehicle; the transverse offset of the inner boundary line on the left side of the lane is the sum of the transverse offset of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located:。
wherein, the aboveQ l Indicating the curvature of the inner boundary line to the left of the lane,Q r indicating the curvature of the inner boundary line on the right side of the lane,Q ll indicating the curvature of the outer boundary line to the left of the lane,Q rr indicating the curvature of the outer boundary line on the right side of the lane,L l indicating the lateral offset of the inner boundary line on the left side of the lane,L r indicating the lateral offset of the inner boundary line on the right side of the lane,L ll indicating the lateral offset of the outer boundary line to the left of the lane,L rr indicating the lateral offset of the outer boundary line on the right side of the lane,respectively, the average width of the lane in which the vehicle is located, the average width of the lane on the left side of the vehicle, and the average width of the lane on the right side of the vehicle.
Further, in an embodiment, if the lane line of the lane where the vehicle is currently located is not obtained through the vehicle-mounted camera, selecting the last obtained lane line adjacent to the current time to perform lane keeping auxiliary control on the vehicle, and simultaneously obtaining the lane line of the lane where the vehicle is currently located through the vehicle-mounted camera according to a preset frequency; and if the lane line of the current lane of the vehicle is not acquired after the set time, performing fault early warning, wherein the set time is dynamically reduced when the speed of the vehicle is increased and/or the turning angle of a steering wheel is increased so as to improve the driving safety.
And step 120, determining a middle line of the lane according to the lane line.
After obtaining lane lines on both sides of a lane, determining a middle line of the lane according to the lane lines includes: and fitting the intermediate line by selecting cubic fitting accuracy and using a least square method based on lane lines on two sides of the lane. By selecting the cubic fitting precision, the accuracy of the fitting result of the lane line can be ensured, and great computational pressure can not be brought to the vehicle-mounted chip.
Specifically, the least squares fitting formula is:
according to the fitting formula, the lane middle line equation is obtained as follows:
the four physical quantities related to the lane line can be obtained by multiple derivation. The transverse offset distance between the central line of the vehicle-mounted camera and the middle line of the lane is C0The relative included angle between the central line of the vehicle-mounted camera and the middle line of the lane is C1The curvature of the middle line of the lane is 2C2The rate of change of curvature of the center line of the lane is 6C3. Thus, the system then performs centering control of the vehicle based on the estimated lane center line information.
In summary, after the vehicle-mounted camera detects the lane line information, the detected lane line information is input into the lane line estimation module in a point form, and a virtual intermediate line is synthesized by using a least square method and is used as a reference object for controlling the lane keeping of the vehicle. If only one lane line (left side or right side) is detected by the vehicle-mounted camera, the points of the detected lane line are input into the lane line estimation module, the missing lane line is compensated through a lane line compensation algorithm, and then middle line estimation is carried out according to lane line information.
And step 130, predicting the relevant curvature of the vehicle running track based on the middle line.
The future position of the vehicle can be predicted by using a predictive algorithm, the current control quantity is adjusted according to the future position of the vehicle, and the current position is input in a deviation mode to estimate the relevant curvature of the vehicle running track. The preview algorithm comprises a single-point preview algorithm and a multi-point preview algorithm. In the embodiment, through a single-point preview algorithm, the course deviation (also called longitudinal deviation) and the transverse deviation of the lane line at the future position of the vehicle are previewed to obtain a relevant curvature of the vehicle driving track of the base curvature plus the predicted curvature. A schematic diagram of predicting a future position of a vehicle is shown in fig. 4, where reference numeral 1 denotes the current position of the vehicle, reference numeral 2 denotes the future position of the vehicle, and reference numeral 3 denotes the middle line of the lane.
And step 140, obtaining a front wheel steering angle and a rear wheel steering angle of the vehicle based on the relevant curvature and the four-wheel steering vehicle model.
The two-wheel steering vehicle is a vehicle in which a steering device is provided only on the front wheels of the vehicle, and the four-wheel steering vehicle is a vehicle in which a steering device is provided also on the rear wheels of the vehicle in addition to the two-wheel steering vehicle. For a four-wheel steering vehicle, when controlling the steering of the vehicle, it is necessary to obtain a front wheel steering angle of the vehicle and a rear wheel steering angle of the vehicle respectively, and the four-wheel steering vehicle model refers to a vehicle model constructed for the four-wheel steering vehicle.
For example, the four-wheel steering vehicle model may be specifically expressed by the following equation:
wherein P represents a lateral offset amount of the vehicle, vyRepresenting the speed of the vehicle in the y-axis direction in the vehicle coordinate system. Phi represents the yaw rate of the vehicle, vxRepresenting the speed of the vehicle in the x-axis direction in the vehicle coordinate system, m representing the vehicle mass, k1Representing the cornering stiffness, k, of the front tyre of a vehicle2Representing the cornering stiffness of the rear tyre of the vehicle, a representing the distance of the centre of mass of the vehicle to the front axle, b representing the distance of the centre of mass of the vehicle to the rear axle, δ1Representing the front wheel angle, delta, of the vehicle2Representing the rear wheel steering angle of the vehicle IzRepresenting the moment of inertia of the vehicle.
In one embodiment, the obtaining a front wheel steering angle and a rear wheel steering angle of the vehicle based on the associated curvature and a four-wheel steering vehicle model includes:
determining, by an MPC (multi Point Constraint) controller corresponding to a four-wheel-steered vehicle, a front wheel steering angle and a rear wheel steering angle of the vehicle based on the correlation curvature, wherein a ratio of the front wheel steering angle to the rear wheel steering angle is equal to a ratio of a front wheel steering angle range to a rear wheel steering angle range when a vehicle speed is less than or equal to a vehicle speed threshold, and the ratio of the front wheel steering angle to the rear wheel steering angle increases with an increase in vehicle speed when the vehicle speed is greater than the vehicle speed threshold.
In another embodiment, the front wheel steering angle and the rear wheel steering angle of the vehicle may be obtained by the above-described four-wheel-steering vehicle model based on the relationship between the respective parameters. Specifically, the reciprocal of the associated curvature of the running locus of the vehicle may be determined as the turning radius of the vehicle. The turning radius of the vehicle is equal to the ratio of the velocity vy of the vehicle in the y-axis direction in the vehicle coordinate system to the yaw rate phi of the vehicle, so the front wheel steering angle and the rear wheel steering angle of the vehicle can be obtained in conjunction with the above four-wheel-steering vehicle model based on the relevant curvature of the running track of the vehicle.
And 150, controlling the vehicle through a steering controller according to the front wheel steering angle and the rear wheel steering angle so as to keep the vehicle running in the lane.
In one embodiment, the controlling the vehicle by the steering controller according to the front wheel turning angle and the rear wheel turning angle to keep the vehicle running in the lane includes: determining a steering wheel angle based on the front wheel angle and the rear wheel angle; controlling an EPS (Electronic Power Steering) motor according to the Steering wheel angle by an ESP (Electronic Stability Program) controller so that the vehicle keeps running in the lane. Reference may be made to a schematic structural diagram of a vehicle steering control system as shown in fig. 5, which includes a steering control system 510, a rear wheel steering motor 520 and a front wheel steering motor 530.
Specifically, after the front wheel steering angle and the rear wheel steering angle of the vehicle are obtained, the front wheel steering angle and the rear wheel steering angle of the vehicle are input to the steering system controller, and the ESP controller controls the operation of the EPS motor. Considering that in the four-wheel steering of the vehicle, the steering angle range of the front wheels is usually-36 degrees, and the steering angle range of the rear wheels is usually-6 degrees, therefore, when the steering angle of the front wheels and the rear wheels is controlled, the control is carried out according to the steering angle range proportion of the front wheels and the rear wheels, and the ratio of the steering angle of the front wheels to the steering angle of the rear wheels is 6 at low speed: 1, this ratio increases as the vehicle speed increases. When the speed of the automobile reaches a high speed, the front steering wheel and the rear steering wheel steer in the same direction to ensure the steering performance of the automobile at a high speed. It should be noted that the curvature of the road may be converted into a curvature radius in an inverse form, and may be approximately equal to the turning radius of the vehicle. The vehicle turning radius is the vehicle longitudinal speed to yaw rate.
Fig. 6 is a schematic structural diagram of a vehicle control device in an embodiment of the present disclosure. The device specifically includes: a first determination module 610, a second determination module 620, a prediction module 630, a third determination module 640, and a first control module 650.
The first determining module 610 is configured to determine a lane line of a lane where the vehicle is currently located when the vehicle is running; a second determining module 620, configured to determine a middle line of the lane according to the lane line; a prediction module 630 for predicting a curvature associated with a vehicle travel trajectory based on the intermediate line; a third determining module 640, configured to obtain a front wheel steering angle and a rear wheel steering angle of the vehicle based on the associated curvature and a four-wheel steering vehicle model; a first control module 650 for controlling the vehicle via a steering controller according to the front and rear wheel turning angles to keep the vehicle running in the lane.
Optionally, the first determining module 610 includes: the acquisition unit is used for acquiring a lane line of a lane where the vehicle is located at present through the vehicle-mounted camera; and the compensation unit is used for compensating the missing lane line on the other side of the lane by a lane line compensation algorithm to obtain the lane lines on the two sides of the lane if the lane lines only comprise the lane line on one side of the lane.
Optionally, the compensation unit includes: the system comprises an acquisition subunit, a processing unit and a control unit, wherein the acquisition subunit is used for acquiring lane line width information in at least two preset time periods before the missing time of a missing lane line, the preset time periods change along with the change of the vehicle speed, and the preset time periods are determined by combining the vehicle speed according to the fact that the lane line length acquired in the preset time periods meets a length threshold; the first determining subunit is configured to determine, based on the lane line width information in the at least two preset time periods and the lane line width weight corresponding to each preset time period, average lane line width information; a second determining subunit configured to determine the missing lane line curvature information and the lateral shift amount of the other side of the lane based on the lane line average width information.
Optionally, the apparatus further comprises: the second control module is used for selecting the last acquired lane line adjacent to the current moment to perform lane keeping auxiliary control on the vehicle if the lane line of the current lane of the vehicle is not acquired through the vehicle-mounted camera, and acquiring the lane line of the current lane of the vehicle through the vehicle-mounted camera according to a preset frequency; and the early warning module is used for carrying out fault early warning if the lane line of the current lane of the vehicle is not acquired after the set time, wherein the set time is dynamically reduced when the speed of the vehicle is increased and/or the turning angle of a steering wheel is increased.
Optionally, the second determining module 620 is specifically configured to: and fitting the intermediate line by selecting cubic fitting accuracy and using a least square method based on lane lines on two sides of the lane.
Optionally, the third determining module 640 includes: a determination unit configured to determine a front wheel steering angle and a rear wheel steering angle of the vehicle based on the correlation curvature by a multipoint-constrained MPC controller corresponding to a four-wheel-steering vehicle, wherein a ratio of the front wheel steering angle to the rear wheel steering angle is equal to a ratio of a front wheel steering angle range to a rear wheel steering angle range when a vehicle speed is less than or equal to a vehicle speed threshold, and the ratio of the front wheel steering angle to the rear wheel steering angle increases with an increase in the vehicle speed when the vehicle speed is greater than the vehicle speed threshold.
Optionally, the first control module 650 includes: a determination unit configured to determine a steering wheel angle based on the front wheel angle and the rear wheel angle; and the control unit is used for controlling an electronic assistant steering (EPS) motor according to the steering wheel rotating angle through an Electronic Stability Program (ESP) controller so as to keep the vehicle running in the lane.
The apparatus provided in the embodiment of the present disclosure may perform the steps in the method provided in the embodiment of the present disclosure, and the steps and the advantageous effects are not described herein again.
Fig. 7 is a schematic structural diagram of an electronic device in an embodiment of the disclosure. Referring now specifically to fig. 7, a schematic diagram of an electronic device 500 suitable for use in implementing embodiments of the present disclosure is shown. The electronic device 500 in the embodiment of the present disclosure may include, but is not limited to, a vehicle-mounted terminal. The electronic device shown in fig. 7 is only an example, and should not bring any limitation to the functions and the scope of use of the embodiments of the present disclosure.
As shown in fig. 7, the electronic device 500 may include a processing means (e.g., a central processing unit, a graphic processor, etc.) 501 that may perform various appropriate actions and processes according to a program stored in a Read Only Memory (ROM) 502 or a program loaded from a storage means 508 into a Random Access Memory (RAM) 503 to implement the vehicle control method according to the embodiments described in the present disclosure. In the RAM 503, various programs and data necessary for the operation of the electronic apparatus 500 are also stored. The processing device 501, the ROM 502, and the RAM 503 are connected to each other through a bus 504. An input/output (I/O) interface 505 is also connected to bus 504.
Generally, the following devices may be connected to the I/O interface 505: input devices 506 including, for example, a touch screen, touch pad, keyboard, mouse, camera, microphone, accelerometer, gyroscope, etc.; output devices 507 including, for example, a Liquid Crystal Display (LCD), speakers, vibrators, and the like; storage devices 508 including, for example, magnetic tape, hard disk, etc.; and a communication device 509. The communication means 509 may allow the electronic device 500 to communicate with other devices wirelessly or by wire to exchange data. While fig. 7 illustrates an electronic device 500 having various means, it is to be understood that not all illustrated means are required to be implemented or provided. More or fewer devices may alternatively be implemented or provided.
In particular, according to an embodiment of the present disclosure, the processes described above with reference to the flowcharts may be implemented as computer software programs. For example, embodiments of the present disclosure include a computer program product comprising a computer program carried on a non-transitory computer readable medium, the computer program containing program code for performing the method illustrated by the flow chart, thereby implementing the method as described above. In such an embodiment, the computer program may be downloaded and installed from a network via the communication means 509, or installed from the storage means 508, or installed from the ROM 502. The computer program performs the above-described functions defined in the methods of the embodiments of the present disclosure when executed by the processing device 501.
It should be noted that the computer readable medium in the present disclosure can be a computer readable signal medium or a computer readable storage medium or any combination of the two. A computer readable storage medium may be, for example, but not limited to, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or any combination of the foregoing. More specific examples of the computer readable storage medium may include, but are not limited to: an electrical connection having one or more wires, a portable computer diskette, a hard disk, a Random Access Memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disc read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing. In the present disclosure, a computer readable storage medium may be any tangible medium that can contain, or store a program for use by or in connection with an instruction execution system, apparatus, or device. In contrast, in the present disclosure, a computer readable signal medium may comprise a propagated data signal with computer readable program code embodied therein, either in baseband or as part of a carrier wave. Such a propagated data signal may take many forms, including, but not limited to, electro-magnetic, optical, or any suitable combination thereof. A computer readable signal medium may also be any computer readable medium that is not a computer readable storage medium and that can communicate, propagate, or transport a program for use by or in connection with an instruction execution system, apparatus, or device. Program code embodied on a computer readable medium may be transmitted using any appropriate medium, including but not limited to: electrical wires, optical cables, RF (radio frequency), etc., or any suitable combination of the foregoing.
In some embodiments, the clients, servers may communicate using any currently known or future developed network Protocol, such as HTTP (HyperText Transfer Protocol), and may interconnect with any form or medium of digital data communication (e.g., a communications network). Examples of communication networks include a local area network ("LAN"), a wide area network ("WAN"), the Internet (e.g., the Internet), and peer-to-peer networks (e.g., ad hoc peer-to-peer networks), as well as any currently known or future developed network.
The computer readable medium may be embodied in the electronic device; or may exist separately without being assembled into the electronic device.
The computer readable medium carries one or more programs which, when executed by the electronic device, cause the electronic device to: determining a lane line of a lane where a vehicle is currently located when the vehicle runs; determining a middle line of the lane according to the lane line; predicting a relative curvature of a vehicle travel track based on the intermediate line; obtaining a front wheel turning angle and a rear wheel turning angle of the vehicle based on the correlation curvature and a four-wheel steering vehicle model; and controlling the vehicle through a steering controller according to the front wheel turning angle and the rear wheel turning angle so as to keep the vehicle running in the lane.
Optionally, when the one or more programs are executed by the electronic device, the electronic device may further perform other steps described in the above embodiments.
Computer program code for carrying out operations for the present disclosure may be written in any combination of one or more programming languages, including but not limited to an object oriented programming language such as Java, Smalltalk, C + +, and conventional procedural programming languages, such as the "C" programming language or similar programming languages. The program code may execute entirely on the user's computer, partly on the user's computer, as a stand-alone software package, partly on the user's computer and partly on a remote computer or entirely on the remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer through any type of network, including a Local Area Network (LAN) or a Wide Area Network (WAN), or the connection may be made to an external computer (for example, through the Internet using an Internet service provider).
The flowchart and block diagrams in the figures illustrate the architecture, functionality, and operation of possible implementations of systems, methods and computer program products according to various embodiments of the present disclosure. In this regard, each block in the flowchart or block diagrams may represent a module, segment, or portion of code, which comprises one or more executable instructions for implementing the specified logical function(s). It should also be noted that, in some alternative implementations, the functions noted in the block may occur out of the order noted in the figures. For example, two blocks shown in succession may, in fact, be executed substantially concurrently, or the blocks may sometimes be executed in the reverse order, depending upon the functionality involved. It will also be noted that each block of the block diagrams and/or flowchart illustration, and combinations of blocks in the block diagrams and/or flowchart illustration, can be implemented by special purpose hardware-based systems which perform the specified functions or acts, or combinations of special purpose hardware and computer instructions.
The units described in the embodiments of the present disclosure may be implemented by software or hardware. Where the name of an element does not in some cases constitute a limitation on the element itself.
The functions described herein above may be performed, at least in part, by one or more hardware logic components. For example, without limitation, exemplary types of hardware logic components that may be used include: field Programmable Gate Arrays (FPGAs), Application Specific Integrated Circuits (ASICs), Application Specific Standard Products (ASSPs), systems on a chip (SOCs), Complex Programmable Logic Devices (CPLDs), and the like.
In the context of this disclosure, a machine-readable medium may be a tangible medium that can contain, or store a program for use by or in connection with an instruction execution system, apparatus, or device. The machine-readable medium may be a machine-readable signal medium or a machine-readable storage medium. A machine-readable medium may include, but is not limited to, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or any suitable combination of the foregoing. More specific examples of a machine-readable storage medium would include an electrical connection based on one or more wires, a portable computer diskette, a hard disk, a Random Access Memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disc read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
The foregoing description is only exemplary of the preferred embodiments of the disclosure and is illustrative of the principles of the technology employed. It will be appreciated by those skilled in the art that the scope of the disclosure herein is not limited to the particular combination of features described above, but also encompasses other embodiments in which any combination of the features described above or their equivalents does not depart from the spirit of the disclosure. For example, the above features and (but not limited to) the features disclosed in this disclosure having similar functions are replaced with each other to form the technical solution.
Further, while operations are depicted in a particular order, this should not be understood as requiring that such operations be performed in the particular order shown or in sequential order. Under certain circumstances, multitasking and parallel processing may be advantageous. Likewise, while several specific implementation details are included in the above discussion, these should not be construed as limitations on the scope of the disclosure. Certain features that are described in the context of separate embodiments can also be implemented in combination in a single embodiment. Conversely, various features that are described in the context of a single embodiment can also be implemented in multiple embodiments separately or in any suitable subcombination.
Although the subject matter has been described in language specific to structural features and/or methodological acts, it is to be understood that the subject matter defined in the appended claims is not necessarily limited to the specific features or acts described above. Rather, the specific features and acts described above are disclosed as example forms of implementing the claims.
Claims (9)
1. A vehicle control method, characterized by comprising:
determining a lane line of a lane where a vehicle is currently located when the vehicle runs;
determining a middle line of the lane according to the lane line;
predicting a relative curvature of a vehicle travel track based on the intermediate line;
determining, by a multi-point-constrained MPC controller corresponding to a four-wheel-steering vehicle, a front-wheel steering angle and a rear-wheel steering angle of the vehicle based on the associated curvatures, wherein a ratio of the front-wheel steering angle to the rear-wheel steering angle is equal to a ratio of a front-wheel steering angle range to a rear-wheel steering angle range when a vehicle speed is less than or equal to a vehicle speed threshold, and the ratio of the front-wheel steering angle to the rear-wheel steering angle increases with increasing vehicle speed when the vehicle speed is greater than the vehicle speed threshold;
controlling the vehicle through a steering controller according to the front wheel turning angle and the rear wheel turning angle so as to keep the vehicle running in the lane;
the determining the lane line of the lane where the vehicle is currently located while the vehicle is running includes:
acquiring a lane line of a lane where the vehicle is located at present through a vehicle-mounted camera;
and if the lane lines only comprise the lane lines on one side of the lane, compensating the missing lane lines on the other side of the lane by using a lane line compensation algorithm to obtain the lane lines on two sides of the lane.
2. The method of claim 1, wherein compensating for the missing lane line on the other side of the lane by a lane line compensation algorithm comprises:
acquiring lane line width information in at least two preset time periods before the missing time of the missing lane line, wherein the preset time periods change along with the change of the vehicle speed, and determining the preset time periods by combining the vehicle speed according to the condition that the length of the lane line acquired in the preset time periods meets a length threshold;
determining the average width information of the lane lines based on the lane line width information in the at least two preset time periods and the lane line width weight corresponding to each preset time period;
determining the missing lane line curvature information and lateral offset on the other side of the lane based on the lane line average width information.
3. The method of claim 2,
if the lane line only comprises an inner boundary line and an outer boundary line on the left side of the lane, the curvature of the inner boundary line on the right side of the lane obtained by the lane line compensation algorithm is as follows:
if the curvature of the inner boundary line on the left side of the lane is larger than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the inner boundary line on the left side of the lane and the average width of the lane where the vehicle is located; if the curvature of the inner boundary line on the left side of the lane is smaller than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the inner boundary line on the left side of the lane and the average width of the lane where the vehicle is located;
the lateral offset of the inner boundary line on the right side of the lane is as follows: the difference between the lateral offset of the inner boundary line on the left side of the lane and the average width of the lane where the vehicle is located;
if the lane line only comprises an inner boundary line and an outer boundary line on the right side of the lane, the curvature of the inner boundary line on the left side of the lane obtained by the lane line compensation algorithm is as follows:
if the curvature of the inner boundary line on the right side of the lane is larger than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located; if the curvature of the inner boundary line on the right side of the lane is smaller than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located;
the lateral offset of the inner boundary line on the left side of the lane is as follows: the sum of the transverse offset of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located;
if the lane line only includes the outer boundary line on the left side of the lane and the outer boundary line on the right side of the lane, the curvatures of the inner boundary line on the left side of the lane and the inner boundary line on the right side of the lane obtained by the lane line compensation algorithm are respectively as follows:
if the curvature of the outer boundary line on the left side of the lane is larger than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle; if the curvature of the outer boundary line on the left side of the lane is smaller than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle;
if the curvature of the outer boundary line on the right side of the lane is larger than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle; if the curvature of the outer boundary line on the right side of the lane is smaller than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle;
if the lane line only includes the outer boundary line on the left side of the lane, the curvatures of the inner boundary line on the left side of the lane and the inner boundary line on the right side of the lane obtained by the lane line compensation algorithm are respectively as follows:
if the curvature of the outer boundary line on the left side of the lane is larger than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle; if the curvature of the outer boundary line on the left side of the lane is smaller than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the outer boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle;
if the curvature of the inner boundary line on the left side of the lane is larger than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the inner boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle; if the curvature of the inner boundary line on the left side of the lane is smaller than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the inner boundary line on the left side of the lane and the average width of the lane on the left side of the vehicle;
the transverse offset of the inner boundary line on the left side of the lane is the difference between the transverse offset of the outer boundary line on the left side of the lane and the average width of the lane line on the left side of the vehicle; the transverse offset of the inner boundary line on the right side of the lane is the difference between the transverse offset of the inner boundary line on the left side of the lane and the average width of the lane where the vehicle is located;
if the lane line only includes the outer boundary line on the right side of the lane, the curvatures of the inner boundary line on the left side of the lane and the inner boundary line on the right side of the lane obtained by the lane line compensation algorithm are respectively as follows:
if the curvature of the inner boundary line on the right side of the lane is larger than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located; if the curvature of the inner boundary line on the right side of the lane is smaller than zero, the curvature of the inner boundary line on the left side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located;
if the curvature of the outer boundary line on the right side of the lane is larger than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the sum of the reciprocal of the curvature of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle; if the curvature of the outer boundary line on the right side of the lane is smaller than zero, the curvature of the inner boundary line on the right side of the lane is the reciprocal of the difference between the reciprocal of the curvature of the outer boundary line on the right side of the lane and the average width of the lane on the right side of the vehicle;
the lateral offset of the inner boundary line on the left side of the lane is as follows: the sum of the transverse offset of the inner boundary line on the right side of the lane and the average width of the lane where the vehicle is located; the lateral offset of the inner boundary line on the right side of the lane is the sum of the lateral offset of the outer boundary line on the right side of the lane and the average width of the lane line on the right side of the vehicle.
4. The method of claim 1, further comprising:
if the lane line of the current lane of the vehicle is not acquired through the vehicle-mounted camera, selecting the last acquired lane line adjacent to the current moment to perform lane keeping auxiliary control on the vehicle, and acquiring the lane line of the current lane of the vehicle through the vehicle-mounted camera according to a preset frequency;
and if the lane line of the current lane of the vehicle is not acquired after the set time, performing fault early warning, wherein the set time is dynamically reduced when the speed of the vehicle is increased and/or the turning angle of a steering wheel is increased.
5. The method of any one of claims 1-4, wherein if the lane lines include lane lines on both sides of a lane, said determining a center line of the lane from the lane lines comprises:
and fitting the intermediate line by selecting cubic fitting accuracy and using a least square method based on lane lines on two sides of the lane.
6. The method according to any one of claims 1 to 4,
the controlling the vehicle by a steering controller according to the front wheel turning angle and the rear wheel turning angle so as to keep the vehicle running in the lane includes:
determining a steering wheel angle based on the front wheel angle and the rear wheel angle;
and controlling an electronic assistant steering (EPS) motor by an Electronic Stability Program (ESP) controller according to the steering wheel angle so as to keep the vehicle running in the lane.
7. A vehicle control apparatus characterized by comprising:
the vehicle lane identification device comprises a first determination module, a second determination module and a control module, wherein the first determination module is used for determining a lane line of a lane where a vehicle is located when the vehicle runs;
the second determining module is used for determining a middle line of the lane according to the lane line;
a prediction module for predicting a curvature associated with a vehicle travel path based on the intermediate line;
a third determining module for determining a front wheel steering angle and a rear wheel steering angle of the vehicle based on the associated curvatures by a multi-point-constrained MPC controller corresponding to a four-wheel-steering vehicle, wherein a ratio of the front wheel steering angle to the rear wheel steering angle is equal to a ratio of a front wheel steering angle range to a rear wheel steering angle range when a vehicle speed is less than or equal to a vehicle speed threshold, and the ratio of the front wheel steering angle to the rear wheel steering angle increases with increasing vehicle speed when the vehicle speed is greater than the vehicle speed threshold;
the first control module is used for controlling the vehicle through a steering controller according to the front wheel turning angle and the rear wheel turning angle so as to enable the vehicle to keep running in the lane;
the first determining module includes: the acquisition unit is used for acquiring a lane line of a lane where the vehicle is located at present through the vehicle-mounted camera; and the compensation unit is used for compensating the missing lane line on the other side of the lane by a lane line compensation algorithm to obtain the lane lines on the two sides of the lane if the lane lines only comprise the lane line on one side of the lane.
8. An electronic device, characterized in that the electronic device comprises:
one or more processors;
storage means for storing one or more programs;
when executed by the one or more processors, cause the one or more processors to implement the method of any one of claims 1-6.
9. A computer-readable storage medium, on which a computer program is stored which, when being executed by a processor, carries out the method according to any one of claims 1-6.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110910774.8A CN113353074B (en) | 2021-08-10 | 2021-08-10 | Vehicle control method and device, electronic equipment and storage medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110910774.8A CN113353074B (en) | 2021-08-10 | 2021-08-10 | Vehicle control method and device, electronic equipment and storage medium |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113353074A CN113353074A (en) | 2021-09-07 |
CN113353074B true CN113353074B (en) | 2021-10-29 |
Family
ID=77540846
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110910774.8A Active CN113353074B (en) | 2021-08-10 | 2021-08-10 | Vehicle control method and device, electronic equipment and storage medium |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113353074B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113715816B (en) * | 2021-09-30 | 2023-06-30 | 岚图汽车科技有限公司 | Lane centering function control method, device, equipment and readable storage medium |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5977968A (en) * | 1982-10-26 | 1984-05-04 | Mazda Motor Corp | Four-wheel steering gear for vehicle |
CN103440649A (en) * | 2013-08-23 | 2013-12-11 | 安科智慧城市技术(中国)有限公司 | Detection method and device for lane boundary line |
CN104477237A (en) * | 2014-11-11 | 2015-04-01 | 深圳职业技术学院 | Four wheel independent steering electric car steering control method and system |
CN104670229A (en) * | 2013-11-28 | 2015-06-03 | 现代摩比斯株式会社 | Apparatus and method for generating virtual lane, and system for controlling lane keeping of vehicle with the apparatus |
CN108177652A (en) * | 2017-12-27 | 2018-06-19 | 广州大学 | The track keeping method and system of a kind of four-wheel steering delivery vehicle |
WO2020058735A1 (en) * | 2018-07-02 | 2020-03-26 | 日産自動車株式会社 | Driving support method and driving support device |
CN111762261A (en) * | 2020-07-01 | 2020-10-13 | 中国第一汽车股份有限公司 | Vehicle steering control method, device and system |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6222785B2 (en) * | 2015-08-10 | 2017-11-01 | 株式会社Subaru | Steering support device |
-
2021
- 2021-08-10 CN CN202110910774.8A patent/CN113353074B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5977968A (en) * | 1982-10-26 | 1984-05-04 | Mazda Motor Corp | Four-wheel steering gear for vehicle |
CN103440649A (en) * | 2013-08-23 | 2013-12-11 | 安科智慧城市技术(中国)有限公司 | Detection method and device for lane boundary line |
CN104670229A (en) * | 2013-11-28 | 2015-06-03 | 现代摩比斯株式会社 | Apparatus and method for generating virtual lane, and system for controlling lane keeping of vehicle with the apparatus |
CN104477237A (en) * | 2014-11-11 | 2015-04-01 | 深圳职业技术学院 | Four wheel independent steering electric car steering control method and system |
CN108177652A (en) * | 2017-12-27 | 2018-06-19 | 广州大学 | The track keeping method and system of a kind of four-wheel steering delivery vehicle |
WO2020058735A1 (en) * | 2018-07-02 | 2020-03-26 | 日産自動車株式会社 | Driving support method and driving support device |
CN111762261A (en) * | 2020-07-01 | 2020-10-13 | 中国第一汽车股份有限公司 | Vehicle steering control method, device and system |
Also Published As
Publication number | Publication date |
---|---|
CN113353074A (en) | 2021-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109421709B (en) | Driving support device for vehicle | |
CN110171416B (en) | Vehicle running control method and device, computer readable medium and electronic equipment | |
JP6055525B1 (en) | Vehicle travel control device | |
US9645250B2 (en) | Fail operational vehicle speed estimation through data fusion of 6-DOF IMU, GPS, and radar | |
CN111879957B (en) | Vehicle dynamics determination based on fuzzy logic and enhanced machine learning | |
CN113619584B (en) | Electronic control rear wheel steering method and device, electronic equipment and storage medium | |
CN115617051B (en) | Vehicle control method, device, equipment and computer readable medium | |
CN113044042B (en) | Vehicle predicted lane change image display method and device, electronic equipment and readable medium | |
CN115534925B (en) | Vehicle control method, apparatus, device, and computer-readable medium | |
JP5041946B2 (en) | Stabilizer control device, stabilizer control method, and stabilizer control program | |
CN110217239A (en) | A kind of vehicle yaw velocity measurement method and apparatus | |
CN113353074B (en) | Vehicle control method and device, electronic equipment and storage medium | |
WO2024045741A1 (en) | Vehicle yaw angle prediction method and device and computer readable storage medium | |
CN113682282A (en) | Vehicle stability control method and system, vehicle and storage medium | |
CN112441012A (en) | Vehicle driving track prediction method and device | |
JP7069624B2 (en) | Position calculation method, vehicle control method and position calculation device | |
KR101618501B1 (en) | Method for ego-motion estimation of vehicle | |
CN116772858A (en) | Vehicle positioning method, device, positioning equipment and storage medium | |
JP7234617B2 (en) | Body attitude angle estimation device | |
WO2023035234A1 (en) | Vehicle state parameter estimation method and apparatus | |
CN115571156B (en) | Front vehicle transverse and longitudinal motion state joint estimation method based on sensor fusion | |
CN114750823B (en) | Method and device for determining steering power-assisted characteristic curve and storage medium | |
CN117584982B (en) | Curve radius estimation method, system, medium, electronic equipment, vehicle machine and vehicle | |
Chen et al. | Vehicle side-slip angle and lateral force estimator based on extended Kalman filtering algorithm | |
CN118220177A (en) | Method, device, equipment and medium for determining yaw moment of 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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |