Vehicle control method and device, electronic equipment and storage medium
1. A vehicle control method characterized by comprising:
acquiring front lane line information and front high-quality guard rail information of the vehicle;
calculating the transverse displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information; wherein the lateral displacement deviation is a lateral distance between the current position of the host vehicle and the pre-aiming position of the host vehicle;
and controlling the vehicle to run according to the transverse displacement deviation.
2. The method of claim 1, wherein the calculating the lateral displacement deviation of the host vehicle according to the front lane line information and/or the front high-quality guard rail information comprises:
when the fact that the front lane line information comprises lane lines on two sides is determined, the front high-quality guard rail information comprises the front high-quality guard rail, and under the condition that the fact that the front lane line information needs to be corrected according to a first guard rail correction condition is determined, the lateral displacement deviation of the vehicle is calculated according to the front high-quality guard rail information and the front lane line information;
and calculating the transverse displacement deviation of the vehicle according to the front lane line information under the condition that the front lane line information is determined to comprise lane lines on two sides, the front high-quality guard rail information comprises the front high-quality guard rail, and the front lane line information does not need to be corrected by the guard rail according to a second guard rail correction condition.
3. The method of claim 1, wherein the calculating the lateral displacement deviation of the host vehicle according to the front lane line information and/or the front high-quality guard rail information comprises:
determining front target vehicle information under the condition that the front lane line information does not include lane lines on two sides;
and calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and/or the front target vehicle information.
4. The method according to claim 3, wherein the calculating the lateral displacement deviation of the host vehicle according to the front high-quality guard rail information and/or the front target vehicle information comprises:
determining the type of one side lane line when it is determined that the front high-quality guard rail information does not include the front high-quality guard rail and the front lane line information includes the one side lane line;
and calculating the transverse displacement deviation of the vehicle according to the type of the lane line on one side.
5. The method according to claim 3, wherein the calculating the lateral displacement deviation of the host vehicle according to the front high-quality guard rail information and/or the front target vehicle information comprises:
and under the condition that the front high-quality guard rail information does not comprise the front high-quality guard rail and the front lane line information does not comprise a lane line on one side, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information.
6. The method of claim 5, wherein said calculating a lateral displacement bias of the host vehicle from the forward target vehicle information comprises:
determining a vehicle longitudinal distance between the host vehicle and a front target vehicle in a case where it is determined that the front target vehicle exists;
and under the condition that the longitudinal distance of the vehicle is determined to be smaller than or equal to a set distance threshold value, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information.
7. The method of claim 6, further comprising:
acquiring current vehicle state information of the vehicle under the condition that the front high-quality guard rail information and the front target vehicle information do not exist or the longitudinal distance of the vehicle is determined to be greater than the set distance threshold;
and controlling the vehicle to run according to the current vehicle state information.
8. The method according to claim 7, wherein said controlling the host-vehicle to travel according to the current-vehicle-state information comprises:
maintaining the current driving state of the vehicle according to the current vehicle state information;
acquiring current vehicle state maintaining time; wherein the current vehicle state maintaining time is duration for maintaining the current driving state of the host vehicle;
when it is determined that the current vehicle state maintaining time is less than a set time threshold and the host vehicle does not acquire at least one of the front lane line information, the front high-quality guard rail information and the front target vehicle information in the process of maintaining the current driving state, returning to maintain the current driving state of the host vehicle according to the current vehicle state information until it is determined that the current vehicle state maintaining time is equal to the set time threshold;
and returning to execute the operation of calculating the lateral displacement deviation of the host vehicle according to the front lane line information and/or the front high-quality guard rail information or returning to execute the operation of calculating the lateral displacement deviation of the host vehicle according to the front target vehicle information when the current vehicle state maintaining time is determined to be less than a set time threshold and the host vehicle acquires at least one of the front lane line information, the front high-quality guard rail information and the front target vehicle information in the process of maintaining the current driving state.
9. The method according to claim 3, wherein the calculating the lateral displacement deviation of the host vehicle according to the front high-quality guard rail information and/or the front target vehicle information comprises:
and under the condition that the front high-quality guard rail information comprises the front high-quality guard rail and the front lane line information comprises a lane line on one side, calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and the lane line on one side.
10. The method according to claim 3, wherein the calculating the lateral displacement deviation of the host vehicle according to the front high-quality guard rail information and/or the front target vehicle information comprises:
and under the condition that the front high-quality guard rail information comprises the front high-quality guard rail and the front lane line information does not comprise a lane line on one side, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information.
11. The method of claim 10, wherein said calculating a lateral displacement bias of the host vehicle from the forward target vehicle information comprises:
determining a vehicle longitudinal distance between the host vehicle and a front target vehicle in a case where it is determined that the front target vehicle exists in the front target vehicle information;
under the condition that the longitudinal distance of the vehicle is determined to be smaller than or equal to a set distance threshold value, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information;
and under the condition that no front target vehicle exists or the longitudinal distance of the vehicle is greater than a set distance threshold value, calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information.
12. The method according to claim 1, wherein the front high quality guard rail is determined based on the following method:
determining the one-side front protective guard as the front high-quality protective guard when the front high-quality protective guard information is determined to include one-side front protective guard and the distance between the one-side front protective guard and the vehicle is smaller than the half-distance of a single lane;
determining that the front high-quality guard rail information includes front guard rails on two sides, and the distance between a target side front guard rail of the front guard rails on the two sides and the vehicle is smaller than the half-distance of the single lane, wherein the target side front guard rail is the front high-quality guard rail;
and under the condition that the information of the front high-quality guard rail comprises front guard rails on two sides and the distances between the front guard rails on the two sides and the vehicle are smaller than the half distance of the single lane, determining the front guard rail on one side as the front high-quality guard rail.
13. The method according to claim 1, wherein said controlling the host-vehicle to travel according to the lateral displacement deviation comprises:
calculating an expected steering angle of the host vehicle according to the lateral displacement deviation;
and controlling the vehicle to run according to the expected steering angle.
Background
With the advancement of technology, the quantity of auxiliary driving systems of level L2 defined by the SAE of the american society of automotive engineering has increased rapidly in recent years. The functions of the L2 level driving assistance system mainly comprise two functions of lane center keeping and full-speed adaptive cruise, and the two functions jointly realize the transverse control and the longitudinal control of the vehicle in the lane.
The existing lane keeping system actively controls a steering wheel torque or a steering angle to realize lateral control of a vehicle when a function is applied, thereby continuously controlling the vehicle at the center of a lane. However, the existing lateral control method can be enabled only when the quality of the lane line is high, and the function is quitted when the quality of the lane line is poor. That is, the existing lane keeping system highly depends on the visual lane line information, and cannot realize the lateral control of the vehicle when the lane line quality is poor or no lane line exists, thereby affecting the driving experience.
Disclosure of Invention
Embodiments of the present invention provide a vehicle control method and apparatus, an electronic device, and a storage medium, which can calculate a lateral displacement deviation of a vehicle according to a multidimensional influence factor, so that the lateral displacement deviation is more accurate and precise, thereby improving an accuracy rate of vehicle control and further improving a control effect of vehicle control.
In a first aspect, an embodiment of the present invention provides a vehicle control method, including:
acquiring front lane line information and front high-quality guard rail information of the vehicle;
calculating the transverse displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information; wherein the lateral displacement deviation is a lateral distance between the current position of the host vehicle and the pre-aiming position of the host vehicle;
and controlling the vehicle to run according to the transverse displacement deviation.
In a second aspect, an embodiment of the present invention further provides a vehicle control apparatus, including:
the front information acquisition module is used for acquiring front lane line information and front high-quality guard rail information of the vehicle;
the transverse displacement deviation calculation module is used for calculating the transverse displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information; wherein the lateral displacement deviation is a lateral distance between the current position of the host vehicle and the pre-aiming position of the host vehicle;
and the vehicle running control module is used for controlling the vehicle to run according to the transverse displacement deviation.
In a third aspect, an embodiment of the present invention further provides an electronic device, where the electronic device includes:
one or more processors;
storage means for storing one or more programs;
when the one or more programs are executed by the one or more processors, the one or more processors are caused to implement the vehicle control method provided by any of the embodiments of the present invention.
In a fourth aspect, embodiments of the present invention also provide a computer storage medium, on which a computer program is stored, which when executed by a processor implements the vehicle control method provided by any of the embodiments of the present invention.
According to the embodiment of the invention, the front lane line information and the front high-quality guard rail information of the vehicle are acquired, the transverse distance between the current position of the vehicle and the pre-aiming position of the vehicle is calculated according to the front lane line information and/or the front high-quality guard rail information to serve as the transverse displacement deviation of the vehicle, so that the vehicle is controlled to run according to the transverse displacement deviation, the problems of low accuracy, poor control effect and the like existing in the prior art that the vehicle is controlled transversely only according to single lane line information are solved, the transverse displacement deviation of the vehicle can be calculated according to multi-dimensional influence factors, the transverse displacement deviation is more accurate and precise, the accuracy of vehicle control is improved, and the control effect of the vehicle control is further improved.
Drawings
Fig. 1 is a schematic structural diagram of a lane keeping system according to an embodiment of the present invention;
FIG. 2 is a flow chart of a vehicle control method according to an embodiment of the present invention;
fig. 3 is a flowchart of a vehicle control method according to a second embodiment of the present invention;
fig. 4 is a flowchart of a vehicle control method according to a third embodiment of the present invention;
FIG. 5 is a schematic diagram of calculating a lateral displacement deviation according to a third embodiment of the present invention;
fig. 6 is a flowchart of a specific example of a vehicle control method according to a fourth embodiment of the present invention;
fig. 7 is a schematic view of multi-mode control priorities of a vehicle control method according to a fourth embodiment of the present invention;
fig. 8 is a schematic diagram of a vehicle control apparatus according to a fifth embodiment of the present invention;
fig. 9 is a schematic structural diagram of an electronic device according to a sixth embodiment of the present invention.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings and examples. It is to be understood that the specific embodiments described herein are merely illustrative of the invention and are not limiting of the invention.
It should be further noted that, for the convenience of description, only some but not all of the relevant aspects of the present invention are shown in the drawings. Before discussing exemplary embodiments in more detail, it should be noted that some exemplary embodiments are described as processes or methods depicted as flowcharts. Although a flowchart may describe the operations (or steps) as a sequential process, many of the operations can be performed in parallel, concurrently or simultaneously. In addition, the order of the operations may be re-arranged. The process may be terminated when its operations are completed, but may have additional steps not included in the figure. The processes may correspond to methods, functions, procedures, subroutines, and the like.
The terms "first" and "second," and the like in the description and claims of embodiments of the invention and in the drawings, are used for distinguishing between different objects and not for describing a particular order. Furthermore, the terms "comprising" and "having," as well as any variations thereof, are intended to cover non-exclusive inclusions. For example, a process, method, system, article, or apparatus that comprises a list of steps or elements is not set forth for a listed step or element but may include steps or elements not listed.
Fig. 1 is a schematic structural diagram of a lane keeping system according to an embodiment of the present invention. As shown in fig. 1, the lane keeping system receives information from an external visual recognition system and information of a vehicle, and transmits a control command through a command transmitting module. The lane keeping system may include: the calibration device comprises a state management module, a calibration parameter adjusting module and an output signal calculating module; wherein:
the state management module is used for determining the functional state of the current LKS (Lane Keeping Systems) according to sensing, vehicle and driver input; the calibration parameter adjusting module is used for dynamically adjusting real-time calibration parameters according to the lane line and the vehicle information and the calibration parameter setting; and the output signal calculation module is used for outputting the current function state, the vehicle signal and the calibration signal to calculate an output signal.
In an embodiment of the present invention, the status management module may further include an enable condition determination submodule, a driver suppression function determination submodule, and a function diagnosis submodule. The calibration parameter adjusting module can also comprise a working condition identification submodule, a parameter setting submodule and a vehicle parameter self-checking submodule; the working condition identification submodule is used for identifying the working condition of the vehicle, such as a straight line or a curve; the parameter setting submodule is used for adjusting control parameters according to the vehicle speed and the recognition working condition; the vehicle parameter self-checking submodule is used for monitoring the static deviation of the steering wheel corner of the vehicle in real time and carrying out self-adaptive correction when the deviation is large. The output signal calculation module can also comprise a target track generation submodule, a control variable calculation submodule, a man-machine interaction signal generation submodule, a target steering wheel corner calculation submodule and a control variable smoothing module. Specifically, the state management module may manage the functional state of the vehicle from a top level perspective, which may include, but is not limited to: disable, Standby, Ready To Assist, Fail, and Acitve, among others. In the above modules, the calculation function of vehicle control is mainly completed by a control variable calculation submodule and a target steering wheel angle calculation submodule.
Example one
Fig. 2 is a flowchart of a vehicle control method according to an embodiment of the present invention, where the embodiment is applicable to a case where a vehicle is controlled according to multidimensional influencing factors, and the method may be executed by a vehicle control device, which may be implemented by software and/or hardware, and may be generally integrated in an electronic device executing the method. The electronic device may be a control device or the like integrated in a vehicle, and a lane keeping system may be integrated to realize a vehicle control function. As shown in fig. 2, the vehicle control method may specifically include the steps of:
s210, acquiring front lane line information and front high-quality guard rail information of the vehicle.
The front lane line information may be lane line information in front of the vehicle, for example, lane lines on both sides in front of the vehicle, lane lines on any side in front of the vehicle, or the like, or no lane line, which is not limited in the embodiment of the present invention. The front high-quality guard rail information may include front high-quality guard rail and front high-quality guard rail related parameters, or may be null. The front high-quality guard rail can be a guard rail which can be used for correcting the lane line to calculate the lateral displacement deviation or directly calculating the lateral displacement deviation in front of the vehicle, and the reliability of the high-quality guard rail is higher than that of the lane line. Optionally, the front high-quality guard rail may be a high-quality guard rail on both sides in front of the vehicle, or a high-quality guard rail on any side in front of the vehicle, and the like, which is not limited in the embodiment of the present invention. The front high-quality guard rail related parameters can be related parameters obtained through calculation according to the front high-quality guard rail, and can be used for calculating the transverse displacement deviation when the vehicle is transversely controlled according to the front high-quality guard rail.
In the embodiment of the present invention, the acquiring of the lane line information in front of the host vehicle may be the lane keeping system acquiring the lane line information on both sides in front of the host vehicle, or the lane keeping system acquiring the lane line information on any side in front of the host vehicle. If there is no lane line in front of the host vehicle, the front lane line information may be null. The acquiring of the front high-quality guard rail information of the vehicle may be the lane keeping system acquiring the high-quality guard rail information of both sides in front of the vehicle, or the lane keeping system acquiring the high-quality guard rail information of any one side in front of the vehicle. If there is no high-quality guard rail in front of the host vehicle, the front high-quality guard rail information may be null.
In an alternative implementation of the embodiment of the present invention, the front high-quality guard rail may be determined based on the following method: when it is determined that the front high-quality guard rail information includes one side front guard rail and the distance between the one side front guard rail and the vehicle is smaller than the half distance between the single lane and the vehicle, it is determined that the one side front guard rail is the guard rail of the lane where the vehicle is located. The one side front guard rail may be a guard rail on any side in front of the vehicle, for example, the guard rail on the left side of the vehicle may also be a guard rail on the right side of the vehicle, which is not limited in the embodiment of the present invention. When it is determined that the front high-quality guard rail information includes front guard rails on both sides and a distance between a target-side front guard rail of the front guard rails on both sides and the host vehicle is smaller than a half-distance of a single lane, it is described that the target-side front guard rail is a guard rail of a lane where the vehicle is located, and it is determined that the target-side front guard rail is the front high-quality guard rail. Where the single lane half-pitch may be half the distance of the single lane pitch, for example, 5 meters for a single lane pitch, then 2.5 meters for a single lane half-pitch. The target side front guard rail may be any one of the side guard rails determined when there are both side guard rails in front of the vehicle. When it is determined that the front high-quality guard rail information includes front guard rails on two sides and the distances between the front guard rails on the two sides and the vehicle are smaller than the half distance between a single lane, it is described that the front guard rails on the two sides are the guard rails of the lane where the vehicle is located, and it can be determined that the front guard rail on one side is the front high-quality guard rail. When the front guard rails on the two sides of the front side are both high-quality guard rails, it is preferable that the guard rail on the right side of the vehicle is selected as the front high-quality guard rail.
S220, calculating the transverse displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information; the transverse displacement deviation is a transverse distance between the current position of the vehicle and the aiming position of the vehicle.
The lateral displacement deviation may be a lateral distance between the current position of the host vehicle and the home address position of the host vehicle, and may be used to control the vehicle to travel at a suitable position of the host vehicle lane.
In the embodiment of the present invention, after the lane keeping system acquires the front lane line information and the front high-quality guard rail information of the host vehicle, if the front lane line information includes lane lines on both sides and the front high-quality guard rail information is empty, the lane keeping system may calculate the lateral displacement deviation of the host vehicle according to the front lane line information. If the front lane line information is empty and the front high-quality guard rail information includes the front high-quality guard rail, the lateral displacement deviation of the vehicle can be calculated according to the front high-quality guard rail information. If neither the front lane line information nor the front high-quality guard rail information is empty, the lateral displacement deviation of the vehicle may be calculated according to the front lane line information and the front high-quality guard rail information, which is not limited in the embodiments of the present invention.
And S230, controlling the vehicle to run according to the transverse displacement deviation.
In the embodiment of the present invention, after the lateral displacement deviation of the host vehicle is calculated, the host vehicle may be further controlled to travel according to the lateral displacement deviation. The transverse displacement deviation of the vehicle is calculated according to the front lane line information and/or the front high-quality guard rail information, so that the transverse displacement deviation is calculated by introducing a plurality of influence factors, and the vehicle control effect is improved.
According to the technical scheme of the embodiment, the transverse distance between the current position of the vehicle and the pre-aiming position of the vehicle is calculated as the transverse displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information, so that the vehicle is controlled to run according to the transverse displacement deviation, the problems of low accuracy, poor control effect and the like in the existing transverse control of the vehicle only according to single lane line information are solved, the transverse displacement deviation of the vehicle can be calculated according to multi-dimensional influence factors, the transverse displacement deviation is more accurate and precise, the accuracy of vehicle control is improved, and the control effect of vehicle control is improved.
Example two
Fig. 3 is a flowchart of a vehicle control method according to a second embodiment of the present invention, which further details the above technical solutions and shows various specific alternative implementations of calculating a lateral displacement deviation of a host vehicle according to front lane line information and/or front high-quality guard rail information and controlling the host vehicle to run according to the lateral displacement deviation. The solution in this embodiment may be combined with the individual alternatives in one or more of the embodiments described above. As shown in fig. 3, the method may include the steps of:
s310, acquiring front lane line information and front high-quality guard rail information of the vehicle.
S320, judging whether the front lane line information comprises lane lines on two sides; if not, go to S330, and if so, go to S340.
Wherein, the lane lines on both sides may be lane lines on both sides of the current driving lane of the vehicle.
In the embodiment of the present invention, after the front lane line information of the host vehicle is acquired, it may be further determined whether the front lane line information includes a both-side lane line. It is understood that if the both-side lane lines are not included in the front lane line information, the front target vehicle information may be further determined to calculate the lateral displacement deviation of the host vehicle from the front high-quality guard rail information and/or the front target vehicle information, thereby implementing lateral control of the vehicle without the both-side lane lines. If the front lane line information includes lane lines on both sides, it may be further determined whether the front high-quality guard rail information includes the front high-quality guard rail, and further, when the front high-quality guard rail information includes the front high-quality guard rail, it may be further determined whether the front lane line information needs to be subjected to guard rail correction. Or the transverse displacement deviation of the vehicle can be directly calculated according to the lane lines on the two sides when the front high-quality guard rail information is empty.
And S330, determining the front target vehicle information.
The front target vehicle information may be information of a target vehicle traveling ahead of the current traveling lane of the host vehicle, or the front target vehicle information may be null, that is, there is no target vehicle traveling ahead on the current traveling lane of the host vehicle.
In the embodiment of the present invention, after determining that the two lane lines are not included in the front lane line information, the front target vehicle information may be further determined to calculate the lateral displacement deviation of the host vehicle according to the front high-quality guard rail information and/or the front target vehicle information, so as to implement lateral control of the vehicle according to the front target vehicle information when there are no two lane lines.
For example, when there is a front target vehicle in front of the host vehicle, available distance information between the front target vehicle and the host vehicle may be determined as the front target vehicle information. Alternatively, when there is no preceding target vehicle in front of the host vehicle, the preceding target vehicle information may be determined to be null.
S340, judging whether the front high-quality guard rail information comprises a front high-quality guard rail; if not, go to S350, and if so, go to S360.
In an embodiment of the present invention, after it is determined that the front lane line information includes the both-side lane lines, it may be further determined whether the front high-quality guard rail information includes the front high-quality guard rail. Specifically, if the front high-quality guard rail information is empty, the lateral displacement deviation of the vehicle can be directly calculated according to the lane lines on the two sides. If the front high-quality guard rail information includes the front high-quality guard rail, it may be further determined whether the front lane line information needs to be subjected to guard rail correction.
And S350, calculating the transverse displacement deviation of the vehicle according to the lane lines on the two sides.
In the embodiment of the present invention, after it is determined that the front lane line information includes lane lines on both sides and the front high-quality guard rail information is empty, the lateral displacement deviation of the host vehicle may be further calculated according to the lane lines on both sides.
And S360, judging whether the front lane line information needs to be corrected by the guardrail, if so, executing S370, and otherwise, executing S380.
The guard rail correction may be to correct the front lane line information according to the front high-quality guard rail information, so as to prevent a vehicle from colliding with the guard rail when the guard rail is inside the lane line of the current driving lane.
In the embodiment of the invention, the fact that the front lane line information needs to be corrected by the guardrail can be determined according to the first guardrail correction condition. Or it may be determined that the guard rail correction is not necessary according to the second guard rail correction condition.
The first guardrail correction condition may be a guardrail correction condition, and is used to determine that the front lane line information needs guardrail correction. The second guardrail correction condition may be another guardrail correction condition for determining that the preceding lane line information does not require guardrail correction.
Specifically, when it is determined whether the front lane line information needs to be corrected by the guardrail, it may be determined that the front lane line information needs to be corrected by the guardrail according to the first guardrail correction condition, or it may be determined that the front lane line information does not need to be corrected by the guardrail according to the second guardrail correction condition.
In the embodiment of the present invention, after it is determined that the front lane line information includes the lane lines on both sides and it is determined that the front high quality guard rail information includes the front high quality guard rail, it may be further determined whether the front lane line information needs to be modified by the guard rail. It can be understood that, if the guard rail is located inside the lane line of the current driving lane, which means that the distance between the guard rail and the vehicle is smaller than the distance between the lane line and the vehicle, at this time, if the driving route of the vehicle is determined according to the information of the front lane line, it is possible that the vehicle may collide with the guard rail, that is, the guard rail of the front lane line information needs to be corrected according to the information of the front high-quality guard rail, so as to prevent the vehicle from colliding with the guard rail. Correspondingly, if the protective guard is arranged outside the lane line of the current driving lane, the distance between the protective guard and the vehicle is larger than the distance between the lane line and the vehicle, namely the driving route of the vehicle is determined according to the information of the front lane line so that the vehicle does not collide with the protective guard, and the information of the front lane line does not need to be corrected by the protective guard.
And S370, calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and the front lane line information.
In the embodiment of the invention, after the front lane line information is determined to include the lane lines on two sides, the front high-quality guard rail information includes the front high-quality guard rail, and the front lane line information is determined to need to be corrected by the guard rail, the transverse displacement deviation of the vehicle can be further calculated simultaneously according to the two influence factors of the front high-quality guard rail information and the front lane line information, so that the transverse accurate control of the vehicle is realized, the vehicle can run at a proper position of the current running lane, and the influence of the guard rail on the safe running of the vehicle is avoided.
According to the technical scheme, the transverse displacement deviation of the vehicle is simultaneously calculated according to the two influence factors of the front high-quality guard rail information and the front lane line information, so that the fault-tolerant capability and the stability of the lane keeping system are improved.
And S380, calculating the transverse displacement deviation of the vehicle according to the front lane line information.
In the embodiment of the present invention, after determining that the front lane line information includes the lane lines on both sides, the front high-quality guard rail information includes the front high-quality guard rail, and determining that the front lane line information does not require guard rail correction, the lateral displacement deviation of the vehicle may be further calculated according to the front lane line information to implement lateral control of the vehicle, so that the vehicle travels in the center of the current driving lane.
Optionally, when the lateral displacement deviation of the host vehicle is calculated according to two influence factors, namely, the front lane line information and/or the front high-quality guard rail information, the lateral displacement deviation of the host vehicle may be calculated based on the following formula:
dct=act+bct·blt·(tp·v)+cct·(tp·v)2+dct·(tp·v)3 (3)
wherein d isfix1Represents the lateral displacement deviation of the vehicle calculated according to the front high-quality guard rail information and the front lane line information or only the front lane line information, FlaneRepresenting the lane line weight coefficient, FrdgRepresenting a first barrier weight coefficient, dctRepresenting the lateral displacement deviation of the vehicle calculated from the lane centre line, drdgRepresenting the lateral displacement deviation, a, of the vehicle calculated according to the relevant parameters of the front high-quality protective fencerdg、brdgAnd crdgAnd the correlation parameters of the front high-quality guard rail are obtained. Alternatively, a second-order polynomial a for representing the front high-quality guard rail may be determined according to geographical location information of the front high-quality guard railrdgAn intercept representing the current position of the host vehicle calculated from the front high-quality guard rail, i.e., a constant term in a polynomial representing the front high-quality guard rail, brdgA slope representing the current position of the host vehicle calculated from the front high-quality guard rail, i.e., a first-order coefficient in a polynomial representing the front high-quality guard rail, crdgA curvature representing the current position of the vehicle calculated from a front high-quality guard rail, that is, a quadratic coefficient in a polynomial representing the front high-quality guard rail, and D a calibration parameter representing the detected distance of the vehicle; dct<ardg+brdg·D+crdg·D2Indicating the first guardrail correction condition; dct≥ardg+brdg·D+crdg·D2Indicating the second guardrail correction condition; alternatively, a cubic polynomial a for representing the lane center line may be determined from the geographical location information of the lane center linectAn intercept representing the current position of the host vehicle calculated from the lane center line, i.e., a constant term in a polynomial representing the lane center line, bctRepresenting calculation from the centre line of the laneThe slope of the current position of the host vehicle, i.e. the coefficient of the first order in the polynomial representing the lane center line, cctA curvature representing the current position of the host vehicle calculated from the lane center line, i.e., a coefficient of a quadratic term in a polynomial representing the lane center line, bltA slope, t, representing the current position of the host vehicle calculated from the left lane linepThe preview time is shown, and v shows the vehicle traveling speed.
In particular, according to dct<ardg+brdg·D+crdg·D2After determining that the current lane line information needs to be corrected by the guardrail, the lateral displacement deviation of the vehicle can be further calculated according to the formula (1) and the formula (3). In accordance with dct≥ardg+brdg·D+crdg·D2After determining that the current lane line information does not need to be corrected by the guardrail, the lateral displacement deviation of the vehicle can be further calculated according to the formula (2) and the formula (3).
And S390, calculating the expected steering angle of the vehicle according to the transverse displacement deviation.
Wherein the expected steering angle may be an angle required to turn the vehicle to travel in the center of the current trip lane.
In the embodiment of the present invention, after calculating the lateral displacement deviation of the host vehicle, the target steering wheel angle calculation module of the lane keeping system may further calculate an expected steering angle of the host vehicle according to the lateral displacement deviation, so that the vehicle controls the vehicle to travel according to the expected steering angle.
Optionally, calculating the expected steering angle of the host vehicle according to the lateral displacement deviation may include: calculating an expected steering angle of the host vehicle from the lateral displacement deviation based on the following formula:
wherein, deltafShowing a steering angle of a front wheel of the host vehicle, L showing a wheel base of the host vehicle, ddesignRepresenting the lateral displacement deviation.
And S3100, controlling the vehicle to run according to the expected steering angle.
In the embodiment of the invention, after the expected steering angle of the host vehicle is calculated from the lateral displacement deviation, the host vehicle may be further controlled to travel according to the expected steering angle, thereby achieving lateral control of the vehicle.
According to the technical scheme of the embodiment, when the front lane line information comprises lane lines on two sides, whether the front high-quality protective guard information comprises the front high-quality protective guard is determined by acquiring the front lane line information and the front high-quality protective guard information of the vehicle; if the front high-quality guard rail information is empty, calculating the transverse displacement deviation of the vehicle according to lane lines on two sides; if the front high-quality guard rail information comprises the front high-quality guard rail, judging whether the front lane line information needs to be corrected by the guard rail; when the fact that front lane line information needs to be corrected is determined according to the first guardrail correction condition, the transverse displacement deviation of the vehicle is calculated according to the front high-quality guardrail information and the front lane line information; when the fact that the front lane line information does not need to be corrected through the guardrail correction is determined according to the second guardrail correction condition, the transverse displacement deviation of the vehicle is calculated according to the front lane line information, the expected steering angle of the vehicle is calculated according to the transverse displacement deviation, the vehicle is controlled to run according to the expected steering angle, the problems that the accuracy rate is low, the control effect is poor and the like when the vehicle is controlled transversely only according to single lane line information are solved, the transverse displacement deviation of the vehicle can be calculated according to multi-dimensional influence factors, the transverse displacement deviation is accurate and precise, the accuracy rate of vehicle control is improved, and the control effect of the vehicle control is improved.
EXAMPLE III
Fig. 4 is a flowchart of a vehicle control method according to a third embodiment of the present invention, which further details the above technical solutions and provides various specific alternative implementations of calculating a lateral displacement deviation of a host vehicle according to front lane line information, front high-quality guard rail information, and target vehicle information. The solution in this embodiment may be combined with the individual alternatives in one or more of the embodiments described above. As shown in fig. 4, the method may include the steps of:
s410, acquiring front lane line information and front high-quality guard rail information of the vehicle.
And S420, when the front lane line information does not comprise the lane lines on the two sides, determining the front target vehicle information.
S430, judging whether the front high-quality guard rail information comprises the front high-quality guard rail; if so, go to S480, otherwise, go to S440.
In the embodiment of the present invention, when it is determined that the both-side lane lines are not included in the front lane line information, and after the front target vehicle information is determined, it may be further determined whether the front high-quality guard rail information includes the front high-quality guard rail. It is understood that, if the front lane line information does not include the lane lines on both sides and the front high-quality guard rail information is empty, it may be further determined whether the front lane line information includes a lane line on one side. And if the one-side lane line is determined to exist, calculating the transverse displacement deviation of the vehicle according to the one-side lane line. And if the fact that the front lane line information does not have one side lane line is determined, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information. Accordingly, if the both-side lane lines are not included in the front lane line information and the front high-quality guard rail information includes the front high-quality guard rail, it may be further determined whether the one-side lane line is included in the front lane line information. And if the one-side lane line is determined to exist, calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and the one-side lane line. And if the fact that the front lane line information does not have one side lane line is determined, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information.
S440, judging whether the front lane line information comprises a lane line on one side; if so, go to S450, otherwise, go to S470.
The lane line on one side may be any lane line on one side of the current driving lane of the vehicle, for example, the lane line on the left side may also be a lane line on the right side, which is not limited in the embodiment of the present invention.
In the embodiment of the present invention, after it is determined that the front lane line information does not include the two side lane lines and the front high-quality guard rail information is empty, it may be further determined whether the front lane line information includes one side lane line, so that the lateral displacement deviation of the host vehicle is calculated according to the one side lane line when the one side lane line is included in the front lane line information, and the lateral displacement deviation of the host vehicle is calculated according to the front target vehicle information when the front lane line information is empty.
S450, determining the type of the lane line on one side.
In the embodiment of the present invention, after determining that the front lane line information does not include the lane lines on both sides, the front high-quality guard rail information is empty, and determining that the front lane line information includes the lane line on one side, the type of the lane line on one side may be further determined, so as to determine that the lane line on one side is the lane line on the left side or the lane line on the right side.
And S460, calculating the lateral displacement deviation of the vehicle according to the type of the lane line on one side.
In the embodiment of the present invention, after the type of the one-side lane line is determined, the lateral displacement deviation of the host vehicle may be further calculated according to the type of the one-side lane line, thereby implementing lateral control of the vehicle according to the one-side lane line.
Optionally, calculating the lateral displacement deviation of the host vehicle according to the type of the lane line on one side may include: in the case where it is determined that the one-side lane line is the left-side lane line, the lateral displacement deviation of the host vehicle is calculated based on the following formula:
in the case where it is determined that the one-side lane line is the right-side lane line, the lateral displacement deviation of the host vehicle is calculated based on the following formula:
wherein d isltIn order to represent the lateral displacement deviation of the vehicle calculated according to the left lane line, optionally, a cubic polynomial a for representing the left lane line may be determined according to the geographic location information of the left lane lineltA constant term in a polynomial representing the left lane line, bltA slope representing the current position of the host vehicle calculated from the left lane line, i.e., a first-order coefficient in a polynomial representing the left lane line, cltA curvature representing the current position of the host vehicle calculated from the left lane line, i.e., a coefficient of a quadratic term in a polynomial representing the left lane line, DltRepresenting the rate of change of curvature calculated from the left lane line, i.e. the coefficient of the cubic term in the polynomial representing the left lane line, WlaneIndicates a default lane line width, drtThe lateral displacement deviation of the vehicle calculated according to the right lane line is represented, and optionally, a cubic polynomial a for representing the right lane line may be determined according to the geographic position information of the right lane linertA constant term in a polynomial representing the right lane line, brtA slope representing the current position of the host vehicle calculated from the right lane line, i.e., a first-order coefficient in a polynomial representing the right lane line, crtA curvature representing the current position of the host vehicle calculated from the right lane line, i.e., a coefficient of a quadratic term in a polynomial representing the right lane line, DrtRepresents a rate of change in curvature calculated from the right lane line, that is, a cubic coefficient in a polynomial representing the right lane line.
And S470, calculating the lateral displacement deviation of the vehicle according to the front target vehicle information.
In the embodiment of the present invention, when it is determined that the front lane line information is empty and the front high-quality guard rail information is empty, the lateral displacement deviation of the host vehicle may be further calculated based on the front target vehicle information, thereby implementing lateral control of the vehicle based on the front target vehicle information.
Optionally, calculating the lateral displacement deviation of the host vehicle according to the information of the front target vehicle may include: in the case where it is determined that there is a preceding target vehicle, the vehicle longitudinal distance between the own vehicle and the preceding target vehicle may be further determined. The vehicle longitudinal distance may be a longitudinal distance between the host vehicle and the front target vehicle, for example, a distance between center points of the two vehicles, or a distance between a head of the host vehicle and a tail of the front target vehicle. And under the condition that the longitudinal distance of the vehicle is determined to be less than or equal to the set distance threshold value, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information. The set distance threshold may be a threshold of a longitudinal distance between the host vehicle and the front target vehicle. It is understood that if the vehicle longitudinal distance is less than or equal to the set distance threshold, indicating that the distance between the preceding target vehicle and the host vehicle is close, the lateral displacement deviation of the host vehicle may be calculated from the preceding target vehicle. If the longitudinal distance of the vehicle is greater than the set distance threshold, which indicates that the distance between the front target vehicle and the vehicle is long, and the error of calculating the lateral displacement deviation according to the front target vehicle is large, the lateral displacement deviation of the vehicle cannot be calculated according to the front target vehicle.
Optionally, the vehicle control method may further include: when the situation that the front high-quality guard rail information and the front target vehicle information do not exist or the situation that the longitudinal distance of the vehicle is larger than the set distance threshold value is determined, it is indicated that the vehicle does not have the referable influence factor to calculate the transverse displacement deviation, or the front target vehicle does not have the reference value, at this moment, the current vehicle state information of the vehicle can be obtained, and the vehicle is controlled to run according to the current vehicle state information.
Optionally, controlling the vehicle to run according to the current vehicle state information may include: maintaining the current driving state of the vehicle according to the current vehicle state information, and acquiring the current vehicle state maintaining time; the current vehicle state maintaining time is the duration time for maintaining the current running state of the vehicle; the current vehicle state maintaining time may be a duration of time for which the current traveling state of the host vehicle is maintained. When the situation that the current vehicle state maintaining time is smaller than the set time threshold value and at least one of the front lane line information, the front high-quality guard rail information and the front target vehicle information is not acquired in the process of maintaining the current running state of the vehicle is determined, the situation that the vehicle cannot acquire the referable influence factor to calculate the lateral displacement deviation is indicated, the current running state of the vehicle is maintained according to the current vehicle state information, and the vehicle can exit the lane keeping system until the current vehicle state maintaining time is determined to be equal to the set time threshold value. The set time threshold may be a threshold that is set for a duration of time for which the current running state of the host vehicle is maintained. When it is determined that the current vehicle state maintaining time is less than the set time threshold and the host vehicle acquires at least one of the front lane line information, the front high-quality guard rail information and the front target vehicle information in the process of maintaining the current driving state, it is indicated that the host vehicle acquires the referable influence factor to calculate the lateral displacement deviation, and then the operation of calculating the lateral displacement deviation of the host vehicle according to the front lane line information and/or the front high-quality guard rail information is returned to be executed, or the operation of calculating the lateral displacement deviation of the host vehicle according to the front target vehicle information is returned to be executed, that is, the lateral displacement deviation can be recalculated according to the type of the influence factor. For example, if the host vehicle acquires the front lane line information and/or the front high-quality guard rail information while maintaining the current traveling state, the operation of calculating the lateral displacement deviation of the host vehicle from the front lane line information and/or the front high-quality guard rail information may be returned to be executed. If the host vehicle acquires only the available forward target vehicle information while maintaining the current running state, it may return to performing an operation of calculating the lateral displacement deviation of the host vehicle from the forward target vehicle information.
S480, judging whether the front lane line information comprises a lane line on one side; if so, perform S490, otherwise, perform S4100.
In the embodiment of the present invention, in a case where it is determined that the both-side lane lines are not included in the front lane line information and the front high-quality guard rail information includes the front high-quality guard rail, it may be further determined whether the one-side lane line is included in the front lane line information. It is understood that, if the one-side lane line is included in the front lane line information, the lateral displacement deviation of the host vehicle can be calculated from the front high-quality guard rail information and the one-side lane line. If the preceding lane line information is empty, the lateral displacement deviation of the own vehicle can be calculated from the preceding target vehicle information.
And S490, calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and the lane line on one side.
In the embodiment of the present invention, after determining that the front lane line information does not include the lane lines on both sides, the front high-quality guard rail information includes the front high-quality guard rail, and the front lane line information includes the lane line on one side, the lateral displacement deviation of the host vehicle may be further calculated according to the front high-quality guard rail information and the lane line on one side.
Optionally, calculating the lateral displacement deviation of the vehicle according to the front high-quality guard rail information and the lane line on one side may include: calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and the lane line on one side based on the following formula:
dfix2=W1·dyt+W2·drdg
W1+W2=1
wherein d isfix2Representing the lateral displacement deviation of the vehicle calculated according to the front high-quality guard rail information and the lane line on one side, dytIndicating a lane line on one side, dytGet dltOr drt,W1Represents a side lane weight, W2Representing a second guardrail weight coefficient.
S4100, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information.
In the embodiment of the invention, when the front lane line information is determined to be empty and the front high-quality guard rail information comprises the front high-quality guard rail, the transverse displacement deviation of the vehicle is calculated according to the front target vehicle information, so that the transverse control of the vehicle is realized according to the front target vehicle information.
Optionally, calculating the lateral displacement deviation of the host vehicle according to the information of the front target vehicle may include: determining a vehicle longitudinal distance between the host vehicle and the front target vehicle in a case where it is determined that the front target vehicle exists in the front target vehicle information; under the condition that the longitudinal distance of the vehicle is determined to be smaller than or equal to the set distance threshold, calculating the transverse displacement deviation of the vehicle according to the information of the front target vehicle; and under the condition that the front target vehicle does not exist or the longitudinal distance of the vehicle is larger than a set distance threshold value, calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information. It is understood that if the vehicle longitudinal distance is less than or equal to the set distance threshold, indicating that the distance between the preceding target vehicle and the host vehicle is close, the lateral displacement deviation of the host vehicle may be calculated from the preceding target vehicle. If the longitudinal distance of the vehicle is larger than the set distance threshold value, which indicates that the distance between the front target vehicle and the host vehicle is long, the lateral displacement deviation of the host vehicle cannot be calculated according to the front target vehicle.
Optionally, calculating the lateral displacement deviation of the host vehicle according to the information of the front target vehicle may include: calculating the lateral displacement deviation of the vehicle according to the front target vehicle information based on the following formula:
wherein d isobjRepresenting the lateral displacement deviation, x, of the vehicle calculated from a preceding target vehicleobjIndicating the longitudinal distance, y, between the host vehicle and the preceding target vehicleobjIndicating the lateral distance between the host vehicle and the forward target vehicle.
Fig. 5 is a schematic diagram of calculating a lateral displacement deviation according to a third embodiment of the present invention. As shown in fig. 5, a lateral displacement bias is calculated based on a preset longitudinal distance 550 between the front target vehicle 520 and the host vehicle 510, where the lateral displacement bias 540 is the lateral distance between the current position of the host vehicle 510 and the pre-target position 530 of the host vehicle.
Optionally, calculating the lateral displacement deviation of the vehicle according to the front high-quality guard rail information may include: calculating the lateral displacement deviation of the host vehicle according to the front target vehicle information based on the following formula:
drdg=ardg+brdg·(tp·v)+crdg·(tp·v)2+Wrdg
wherein, WrdgIndicating the deviation of the road calculated from the front guard rail.
In the above technical scheme, WrdgThe value of (c) can be updated in real time. When the information of the front lane line is unavailable, the last moment value before the unavailability is used as the control deviation, so that the unsmooth control of the data source switching process is reduced.
S4110, calculating an expected steering angle of the vehicle according to the lateral displacement deviation.
And S4120, controlling the vehicle to run according to the expected steering angle.
According to the technical scheme, when the quality of the lane line is low, available sensing results including the guard rail, the front target vehicle and the like are utilized to the maximum degree, and meanwhile, the expected track is subjected to smoothing processing, so that the stability and the smoothness of the lane keeping system are improved.
According to the technical scheme of the embodiment, the information of the front target vehicle is determined when the front lane line information does not comprise lane lines on two sides by acquiring the front lane line information and the front high-quality guard rail information of the vehicle; when the front high-quality guard rail information is empty, if the front lane line information comprises a lane line on one side, calculating the transverse displacement deviation of the vehicle according to the type of the lane line on one side, and if the front lane line information is empty, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information; when the front high-quality guard rail information comprises the front high-quality guard rail, if the front lane line information comprises a lane line on one side, calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and the lane line on one side, and if the front lane line information is empty, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information; the method comprises the steps of calculating an expected steering angle of a vehicle according to the transverse displacement deviation, controlling the vehicle to run according to the expected steering angle, solving the problems of low accuracy, poor control effect and the like existing in the prior art of only carrying out transverse control on the vehicle according to single lane line information, and calculating the transverse displacement deviation of the vehicle according to multi-dimensional influence factors to enable the transverse displacement deviation to be more accurate and precise, so that the accuracy of vehicle control is improved, and the control effect of vehicle control is further improved.
Example four
Fig. 6 is a flowchart of a specific example of a vehicle control method according to a fourth embodiment of the present invention. In order to enable those skilled in the art to better understand the vehicle control method, the embodiment of the invention is described by using a specific example. As shown in fig. 6, the method includes the following specific steps:
s610, judging whether the front lane line information comprises lane lines on two sides or not through a state management module; if so, go to S620, otherwise, go to S660.
S620, judging whether high-quality guard rail information exists or not; if so, go to S630, otherwise, go to S650.
S630, judging whether the front lane line information needs guardrail correction or not; if so, go to S640, otherwise, go to S650.
And S640, the output signal calculation module corrects the lane line according to the high-quality guard rail information so as to calculate the transverse displacement deviation of the vehicle.
And S650, calculating the transverse displacement deviation of the vehicle according to the lane lines on the two sides in the front lane line information.
S660, judging whether high-quality guard rail information exists or not; if not, go to S670, and if so, go to S6160.
S670, judging whether a lane line at one side exists in the front lane line information; if so, go to S680, otherwise, go to S690.
And S680, calculating a pre-aiming position according to the lane line on one side, and calculating the transverse displacement deviation of the vehicle according to the pre-aiming position.
S690, judging whether a CIPV (Closest In Path Vehicle, a front following target, namely a front target Vehicle, exists or not; if so, S6100 is performed, otherwise, S6120 is performed.
S6100, judging whether the longitudinal distance between the vehicle and the CIPV is smaller than a preset distance threshold value; if so, perform S6110, otherwise, perform S6120.
S6110, calculating the lateral displacement deviation of the vehicle according to the CIPV.
And S6120, controlling the vehicle to run according to the current output value of the vehicle.
S6130, judging whether the maintaining time of the current output value of the vehicle is smaller than a preset time threshold value; if so, perform S6140, otherwise, perform S6150.
S6140, keeping the vehicle running state, and continuously acquiring the front lane line information, the front high-quality guard rail information and the front target vehicle information. And returning to execute S610 or S6100 when at least one of the front lane line information, the front high-quality guard rail information, and the front target vehicle information is determined to be acquired.
Accordingly, if any one of the front lane line information, the front high-quality guard rail information, and the front target vehicle information is not acquired while the vehicle maintains the vehicle driving state, the vehicle driving state is continuously maintained, and the lane keeping system is exited when the current output value maintaining time of the vehicle is equal to the preset time threshold.
And S6150, exiting the lane keeping system function.
S6160, judging whether a lane line at one side exists in the front lane line information; if so, executing S6170, otherwise, executing S6180.
S6170, the front lane line information is corrected according to the front high-quality guard rail information, so that the transverse displacement deviation of the vehicle is calculated.
S6180, judging whether CIPV exists or not; if so, go to S6190, otherwise, go to S6210.
S6190, judging whether the longitudinal distance between the vehicle and the CIPV is smaller than a preset distance threshold value; if so, perform S6200, otherwise, perform S6210.
S6200, the lateral displacement deviation of the vehicle is calculated according to the CIPV.
And S6210, calculating the lateral displacement deviation of the vehicle according to the high-quality guard rail information.
And S6220, calculating the expected steering wheel angle according to the lateral displacement deviation of the vehicle so as to realize vehicle control.
Fig. 7 is a schematic view of multi-mode control priorities of a vehicle control method according to a fourth embodiment of the present invention. In the above technical solution, as shown in fig. 7, the priority of controlling the vehicle according to the two-sided lane lines is greater than the priority of controlling the vehicle according to the one-sided lane line and the guard rail, greater than the priority of controlling the vehicle according to the one-sided lane line, greater than the priority of controlling the vehicle according to the CIPV, and greater than the priority of controlling the vehicle according to the guard rail.
The technical scheme of the embodiment reduces the calculation consumption of the lane keeping system and reduces the requirement on a software platform; meanwhile, the lane keeping system takes various data sources as the basis of transverse control, and mutually verifies the transverse control data sources, so that the fault-tolerant capability of the lane keeping system is improved, the dependence on a single data source is reduced, and the usability of the lane keeping system is improved.
EXAMPLE five
Fig. 8 is a schematic diagram of a vehicle control device according to a fifth embodiment of the present invention, and as shown in fig. 8, the device includes: a front information acquisition module 810, a lateral displacement deviation calculation module 820, and a vehicle travel control module 830, wherein:
a front information acquisition module 810 configured to acquire front lane line information and front high-quality guard rail information of the host vehicle;
a lateral displacement deviation calculation module 820, configured to calculate a lateral displacement deviation of the host vehicle according to the front lane line information and/or the front high-quality guard rail information; wherein the lateral displacement deviation is a lateral distance between the current position of the host vehicle and the pre-aiming position of the host vehicle;
and a vehicle running control module 830, configured to control the vehicle to run according to the lateral displacement deviation.
Optionally, the lateral displacement deviation calculating module 820 may be further configured to:
when the front lane line information is determined to comprise lane lines on two sides, the front high-quality protective guard information comprises a front high-quality protective guard, and the front lane line information is determined to need to be corrected by the aid of a first protective guard correction condition, the transverse displacement deviation of the vehicle is calculated according to the front high-quality protective guard information and the front lane line information; and calculating the transverse displacement deviation of the vehicle according to the front lane line information under the condition that the front lane line information comprises lane lines on two sides and the front high-quality guard rails, and the front lane line information does not need to be corrected by the guard rails according to the second guard rail correction condition.
Optionally, the lateral displacement deviation calculating module 820 may be further configured to:
the lateral displacement deviation of the host vehicle is calculated based on the following formula:
dct=act+bct·blt·(tp·v)+cct·(tp·v)2+dct·(tp·v)3。
wherein d isfix1Represents the lateral displacement deviation of the vehicle calculated according to the front high-quality guard rail information and the front lane line information or only the front lane line information, FlaneRepresenting the lane line weight coefficient, FrdgRepresenting a first barrier weight coefficient, dctRepresenting the lateral displacement deviation of the vehicle calculated from the lane centre line, drdgRepresenting the lateral displacement deviation, a, of the vehicle calculated according to the relevant parameters of the front high-quality protective fencerdg、brdgAnd crdgIs the front high-quality protective fence associated parameter, ardgAn intercept representing the current position of the host vehicle calculated from a high-quality guard rail ahead, brdgIs shown according toSlope of the current position of the host vehicle calculated by the high-quality guard rail, crdgA calibration parameter representing a curvature of a current position of the host vehicle calculated from a front high-quality guard rail, and a calibration parameter representing a detection distance of the host vehicle; dct<ardg+brdg·D+crdg·D2Indicating the first guardrail correction condition; dct≥ardg+brdg·D+crdg·D2Indicating the second guardrail correction condition; a isctAn intercept representing the current position of the host vehicle calculated from the lane center line, bctA slope representing the current position of the host vehicle calculated from the lane center line, cctA curvature representing a current position of the host vehicle calculated from the lane center line; bltA slope representing a current position of the host vehicle calculated from the left lane line; t is tpThe preview time is shown, and v shows the vehicle traveling speed.
Optionally, the lateral displacement deviation calculating module 820 may be further configured to:
determining front target vehicle information under the condition that the front lane line information does not include lane lines on two sides; and calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and/or the front target vehicle information.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
determining the type of a lane line on one side under the condition that the information of the front high-quality protective guard does not comprise the front high-quality protective guard and the information of the front lane line comprises the lane line on one side; and calculating the transverse displacement deviation of the vehicle according to the type of the lane line on one side.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
in the case where it is determined that the one-side lane line is the left-side lane line, the lateral displacement deviation of the host vehicle is calculated based on the following formula:
in the case where it is determined that the one-side lane line is the right-side lane line, the lateral displacement deviation of the host vehicle is calculated based on the following formula:
wherein d isltIs a deviation representing the lateral displacement of the vehicle calculated from the left lane lineltAn intercept representing the current position of the host vehicle calculated from the left lane line, bltA slope representing the current position of the host vehicle calculated from the left lane line, cltA curvature representing the current position of the host vehicle calculated from the left lane line, DltRepresenting the rate of change of curvature, W, calculated from the left lane linelaneIndicates a default lane line width, drtRepresenting the lateral displacement deviation, a, of the vehicle calculated from the right lane linertAn intercept representing the current position of the host vehicle calculated from the right lane line, brtA slope representing the current position of the host vehicle calculated from the right lane line, crtA curvature, D, representing the current position of the host vehicle calculated from the right lane linertRepresenting the rate of change of curvature calculated from the right lane line.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
when it is determined that the front high-quality guard rail information does not include the front high-quality guard rail and that one-side lane line is not included in the front lane line information, the lateral displacement deviation of the host vehicle is calculated from the front target vehicle information.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
determining a vehicle longitudinal distance between the host vehicle and the front target vehicle in the case where it is determined that the front target vehicle exists; and under the condition that the longitudinal distance of the vehicle is determined to be less than or equal to the set distance threshold value, calculating the transverse displacement deviation of the vehicle according to the front target vehicle information.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
acquiring current vehicle state information of the vehicle under the condition that the front high-quality guard rail information and the front target vehicle information do not exist or the longitudinal distance of the vehicle is determined to be greater than a set distance threshold; and controlling the vehicle to run according to the current vehicle state information.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
maintaining the current driving state of the vehicle according to the current vehicle state information; acquiring current vehicle state maintaining time; the current vehicle state maintaining time is the duration time for maintaining the current running state of the vehicle; under the condition that the current vehicle state maintaining time is smaller than the set time threshold value and at least one of the front lane line information, the front high-quality guard rail information and the front target vehicle information is not acquired in the process of maintaining the current running state of the vehicle, returning to maintain the current running state of the vehicle according to the current vehicle state information until the current vehicle state maintaining time is equal to the set time threshold value; and under the condition that the current vehicle state maintaining time is determined to be less than the set time threshold, and at least one of the front lane line information, the front high-quality guard rail information and the front target vehicle information is acquired in the process of maintaining the current driving state of the vehicle, returning to execute the operation of calculating the lateral displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information, or returning to execute the operation of calculating the lateral displacement deviation of the vehicle according to the front target vehicle information.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
and under the condition that the information of the front high-quality protective guard comprises the front high-quality protective guard and the information of the front lane line comprises the one-side lane line, calculating the transverse displacement deviation of the vehicle according to the information of the front high-quality protective guard and the one-side lane line.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information and the lane line on one side based on the following formula:
dfix2=W1·dyt+W2·drdg;
W1+W2=1。
wherein d isfix2Representing the lateral displacement deviation of the vehicle calculated according to the front high-quality guard rail information and the lane line on one side, dytIndicating a lane line on one side, dytGet dltOr drt,W1Represents a side lane weight, W2Representing a second guardrail weight coefficient.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
and calculating the lateral displacement deviation of the vehicle according to the front target vehicle information when the front high-quality guard rail information is determined to comprise the front high-quality guard rail and the front lane line information does not comprise the one-side lane line.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
determining a vehicle longitudinal distance between the host vehicle and the front target vehicle in a case where it is determined that the front target vehicle exists in the front target vehicle information; under the condition that the longitudinal distance of the vehicle is determined to be smaller than or equal to the set distance threshold, calculating the transverse displacement deviation of the vehicle according to the information of the front target vehicle; and under the condition that the front target vehicle does not exist or the longitudinal distance of the vehicle is larger than a set distance threshold value, calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
calculating the lateral displacement deviation of the vehicle according to the front target vehicle information based on the following formula:
wherein d isobjRepresenting the lateral displacement deviation, x, of the vehicle calculated from a preceding target vehicleobjIndicating the longitudinal distance, y, between the host vehicle and the preceding target vehicleobjIndicating the lateral distance between the host vehicle and the forward target vehicle.
Optionally, the lateral displacement deviation calculating module 820 may be further specifically configured to:
calculating the transverse displacement deviation of the vehicle according to the front high-quality guard rail information based on the following formula:
drdg=ardg+brdg·(tp·v)+crdg·(tp·v)2+Wrdg。
wherein, WrdgIndicating the deviation of the road calculated from the front guard rail.
Optionally, the front information obtaining module 810 may be further configured to determine a front high-quality guard rail based on the following method:
determining that the front high-quality guard rail information comprises a front guard rail on one side, and under the condition that the distance between the front guard rail on one side and the vehicle is smaller than the half distance of a single lane, determining that the front guard rail on one side is the front high-quality guard rail; determining the front high-quality guard rail as a front high-quality guard rail when the information of the front high-quality guard rail is determined to include the front guard rails on two sides, and the distance between the front guard rail on the target side in the front guard rails on the two sides and the vehicle is smaller than the half distance of a single lane; and under the condition that the determined front high-quality guard rail information comprises front guard rails on two sides, and the distances between the front guard rails on the two sides and the vehicle are smaller than the half distance of the single lane, determining the front guard rail on one side as the front high-quality guard rail.
Optionally, the vehicle driving control module 830 may be further configured to:
calculating an expected steering angle of the vehicle according to the lateral displacement deviation; and controlling the vehicle to run according to the expected steering angle.
Optionally, the vehicle driving control module 830 may be further configured to:
calculating an expected steering angle of the host vehicle from the lateral displacement deviation based on the following formula:
wherein, deltafShowing a steering angle of a front wheel of the host vehicle, L showing a wheel base of the host vehicle, ddesignRepresenting the lateral displacement deviation.
According to the technical scheme of the embodiment, the transverse distance between the current position of the vehicle and the pre-aiming position of the vehicle is calculated as the transverse displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information, so that the vehicle is controlled to run according to the transverse displacement deviation, the problems of low accuracy, poor control effect and the like in the existing transverse control of the vehicle only according to single lane line information are solved, the transverse displacement deviation of the vehicle can be calculated according to multi-dimensional influence factors, the transverse displacement deviation is more accurate and precise, the accuracy of vehicle control is improved, and the control effect of vehicle control is improved.
The vehicle control device can execute the vehicle control method provided by any embodiment of the invention, and has corresponding functional modules and beneficial effects of the execution method. For technical details that are not described in detail in the present embodiment, reference may be made to a vehicle control method provided in any embodiment of the present invention.
Since the vehicle control device described above is a device that can execute the vehicle control method in the embodiment of the present invention, a person skilled in the art can understand the specific implementation of the vehicle control device of the embodiment and its various modifications based on the vehicle control method described in the embodiment of the present invention, and therefore, how the vehicle control device implements the vehicle control method in the embodiment of the present invention will not be described in detail herein. The device adopted by the person skilled in the art to implement the vehicle control method in the embodiment of the invention is within the protection scope of the present application.
EXAMPLE six
Fig. 9 is a schematic structural diagram of an electronic device according to a sixth embodiment of the present invention. As shown in fig. 9, the electronic device includes a processor 910, a memory 920, an input device 930, and an output device 940; the number of the processors 910 in the electronic device may be one or more, and one processor 910 is taken as an example in fig. 9; the processor 910, the memory 920, the input device 930, and the output device 940 in the electronic apparatus may be connected by a bus or other means, and fig. 9 illustrates an example of connection by a bus.
The memory 920 is a computer-readable storage medium that can be used to store software programs, computer-executable programs, and modules, such as program instructions/modules corresponding to the vehicle control method in the embodiment of the present invention (for example, the front information acquisition module 810, the lateral displacement deviation calculation module 820, and the own-vehicle travel control module 830 in the vehicle control apparatus). The processor 910 executes various functional applications and data processing of the electronic device by running software programs, instructions and modules stored in the memory 920, that is, implements the vehicle control method described above: acquiring front lane line information and front high-quality guard rail information of the vehicle; calculating the transverse displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information; wherein the lateral displacement deviation is a lateral distance between the current position of the host vehicle and the pre-aiming position of the host vehicle; and controlling the vehicle to run according to the transverse displacement deviation.
The memory 920 may mainly include a program storage area and a data storage area, wherein the program storage area may store an operating system, an application program required for at least one function; the storage data area may store data created according to the use of the terminal, and the like. Further, the memory 920 may include high speed random access memory, and may also include non-volatile memory, such as at least one magnetic disk storage device, flash memory device, or other non-volatile solid state storage device. In some examples, the memory 920 may further include memory located remotely from the processor 910, which may be connected to electronic devices over a network. Examples of such networks include, but are not limited to, the internet, intranets, local area networks, mobile communication networks, and combinations thereof.
The input device 930 may be used to receive input numeric or character information and generate key signal inputs related to user settings and function controls of the electronic apparatus. The output device 940 may include a display device such as a display screen.
EXAMPLE seven
An embodiment seven of the present invention further provides a computer storage medium storing a computer program which, when executed by a computer processor, is operable to execute the vehicle control method according to any one of the above embodiments of the present invention: acquiring front lane line information and front high-quality guard rail information of the vehicle; calculating the transverse displacement deviation of the vehicle according to the front lane line information and/or the front high-quality guard rail information; wherein the lateral displacement deviation is a lateral distance between the current position of the host vehicle and the pre-aiming position of the host vehicle; and controlling the vehicle to run according to the transverse displacement deviation.
Computer storage media for embodiments of the invention may employ any combination of one or more computer-readable media. The computer readable medium may be a computer readable signal medium or a computer readable storage medium. 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 (a non-exhaustive list) of the computer readable storage medium would include the following: 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 context of this document, 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.
A computer readable signal medium may include a propagated data signal with computer readable program code embodied therein, for example, 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 wireless, wireline, optical fiber cable, Radio Frequency (RF), etc., or any suitable combination of the foregoing.
Computer program code for carrying out operations for aspects of the present invention may be written in any combination of one or more programming languages, including an object oriented programming language such as Java, Smalltalk, C + + or the like 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).
It is to be noted that the foregoing is only illustrative of the preferred embodiments of the present invention and the technical principles employed. It will be understood by those skilled in the art that the present invention is not limited to the particular embodiments described herein, but is capable of various obvious changes, rearrangements and substitutions as will now become apparent to those skilled in the art without departing from the scope of the invention. Therefore, although the present invention has been described in greater detail by the above embodiments, the present invention is not limited to the above embodiments, and may include other equivalent embodiments without departing from the spirit of the present invention, and the scope of the present invention is determined by the scope of the appended claims.
- 上一篇:石墨接头机器人自动装卡簧、装栓机
- 下一篇:一种巡航控制方法、装置及电动汽车