OBSTACLE AVOIDANCE CONTROL METHOD AND DEVICE, ADVANCED DRIVER-ASSISTANCE SYSTEM, VEHICLE, AND MEDIUM
The disclosure provides an obstacle avoidance control method and device, an advanced driver-assistance system, a vehicle, and a medium. The method includes the steps of: receiving vehicle sensor data; calculating an obstacle safe boundary and a lane safe boundary based on the vehicle sensor data; and determining a passing region and a passing status for a current vehicle according to the obstacle safe boundary and the lane safe boundary.
This application claims the benefit of China Patent Application No. 202110965058.X filed Aug. 20, 2021, the contents of which are incorporated herein by reference in its entirety.
Technical FieldThe disclosure relates to the field of autonomous driving, and more particularly to an obstacle avoidance control method and device, and an associated advanced driver-assistance system, a vehicle, and a computer-readable recording medium.
Background ArtAdvanced driver-assistance systems (ADAS) use various sensors mounted on a vehicle to, during traveling of the automobile, sense the surroundings, collect data, identify, detect, and track still or moving objects, and perform system operations and analysis in combination with navigation map data, allowing for a driver to be aware of potential dangers in advance, thereby effectively improving the comfort and safety of the automobile during traveling.
A lane centering system (LKS) is one of the common key technologies in the advanced driver-assistance systems (ADAS) and is designed to continuously ensure that a vehicle is centered in a lane. In some special scenarios, for example, when obstacles (such as a cone barrel, a square barrel, and a warning post) occupy a lane, keeping the vehicle centered in the lane may pose a risk. In such a case, a reasonable avoidance may be required to avoid the risk posed by the obstacles occupying the lane.
SUMMARY OF THE DISCLOSURETherefore, the disclosure provides an obstacle avoidance control method and device for the field of vehicle autonomous driving, so that a vehicle avoids obstacles (e.g., a cone barrel, a square barrel, and a warning post) in a safer and more reliable manner.
According to an aspect of the disclosure, an obstacle avoidance control method is provided, the method including the steps of: receiving vehicle sensor data; calculating an obstacle safe boundary and a lane safe boundary based on the vehicle sensor data; and determining a passing region and a passing status for a current vehicle according to the obstacle safe boundary and the lane safe boundary.
Further, according to an embodiment of the aspect of the disclosure, the vehicle sensor data includes a width of a current lane of the current vehicle, a velocity of the current vehicle, a lateral position DB of the obstacle, and a lateral position DV of another vehicle. The vehicle sensor data may further include: a lateral velocity, a longitudinal position, and a longitudinal velocity.
Further, according to an embodiment of the aspect of the disclosure, the calculating an obstacle safe boundary based on the vehicle sensor data includes: calculating the obstacle safe boundary based on the lateral position DB of the obstacle, a width WV of the current vehicle, and a safe distance DS1 of the current vehicle from the obstacle, where the safe distance DS1 of the current vehicle from the obstacle is related to the velocity of the current vehicle.
Further, according to an embodiment of the aspect of the disclosure, the obstacle safe boundary is calculated based on the following formula:
Further, according to an embodiment of the aspect of the disclosure, the calculating a lane safe boundary based on the vehicle sensor data includes: calculating the lane safe boundary based on the width WR of the current lane, the width WV of the current vehicle, and a safe distance DS2 of the current vehicle crossing the current lane, where the safe distance DS2 of the current vehicle crossing the current lane is related to a type of the current lane of the current vehicle.
Further, according to an embodiment of the aspect of the disclosure, the lane safe boundary is calculated based on the following formula:
Further, according to an embodiment of the aspect of the disclosure, the passing region for the current vehicle is a region between the obstacle safe boundary and the lane safe boundary.
Further, according to an embodiment of the aspect of the disclosure, the passing status for the current vehicle includes passable without intervention, passable with intervention, and impassable.
Further, according to an embodiment of the aspect of the disclosure, the intervention includes adjusting the velocity of the current vehicle, a distance of the current vehicle from the obstacle, and a distance of the current vehicle from the another vehicle.
Further, according to an embodiment of the aspect of the disclosure, an occupancy proportion of the obstacle in the lane is calculated based on the obstacle safe boundary and the lane safe boundary.
Further, according to an embodiment of the aspect of the disclosure, the passing status for the current vehicle is set to be passable with intervention when the occupancy proportion of the obstacle in the lane is greater than a first threshold and less than a second threshold.
Further, according to an embodiment of the aspect of the disclosure, the passing status for the current vehicle is set to be passable without intervention when the occupancy proportion of the obstacle in the lane is less than the first threshold.
Further, according to an embodiment of the aspect of the disclosure, the passing status for the current vehicle is set to be impassable when the occupancy proportion of the obstacle in the lane is greater than the second threshold.
Further, according to an embodiment of the aspect of the disclosure, a time to collision (TTC) of the current vehicle with the another vehicle is calculated based on the lateral position DV of the another vehicle, and the time to collision (TTC) is used to determine whether there is a risk of a collision between the current vehicle and the another vehicle.
Further, according to an embodiment of the aspect of the disclosure, if there is a risk of a collision between the current vehicle and the another vehicle, a safe constraint boundary of the another vehicle is calculated based on the lateral position DV s of the another vehicle, the width WV of the current vehicle, and a safe distance DS3 of the vehicle from the another vehicle, where the safe distance DS3 of the current vehicle from the another vehicle is related to the velocity of the current vehicle.
Further, according to an embodiment of the aspect of the disclosure,
Further, according to an embodiment of the aspect of the disclosure, the intervention further includes: controlling, based on the safe constraint boundary of the another vehicle, the current vehicle to adjust a distance Dv of the vehicle from the another vehicle in the passing region, so as to avoid the another vehicle.
Further, according to an embodiment of the aspect of the disclosure, path planning applied to the current vehicle bypassing an obstacle region is generated based on the passing region and the passing status for the current vehicle.
Further, according to an embodiment of the aspect of the disclosure, lateral-direction and longitudinal-direction control applied to the current vehicle is output based on the generated path planning.
According to another aspect of the disclosure, an obstacle avoidance control device is provided, the device including: a receiving apparatus configured to receive vehicle sensor data; a calculation apparatus configured to calculate an obstacle safe boundary and a lane safe boundary based on the vehicle sensor data; and a determination apparatus configured to determine a passing region and a passing status for a current vehicle according to the obstacle safe boundary and the lane safe boundary.
Further, according to an embodiment of the another aspect of the disclosure, the vehicle sensor data includes a width of a current lane, a velocity of the current vehicle, a lateral position DB of the obstacle, and a lateral position DV of another vehicle. The vehicle sensor data may further include: a lateral velocity, a longitudinal position, and a longitudinal velocity.
Further, according to an embodiment of the another aspect of the disclosure, the calculation apparatus is further configured to calculate the obstacle safe boundary based on the lateral position DB of the obstacle, a width WV of the current vehicle, and a safe distance DS1 of the current vehicle from the obstacle, where the safe distance DS1 of the current vehicle from the obstacle is related to the velocity of the current vehicle.
Further, according to an embodiment of the another aspect of the disclosure,
Further, according to an embodiment of the another aspect of the disclosure, the calculation apparatus is further configured to calculate the lane safe boundary based on the width WR of the current lane, the width WV of the current vehicle, and a safe distance DS2 of the current vehicle crossing the current lane, where the safe distance DS2 of the current vehicle crossing the current lane is related to a type of the current lane.
Further, according to an embodiment of the another aspect of the disclosure,
Further, according to an embodiment of the another aspect of the disclosure, the passing region for the current vehicle is a region between the obstacle safe boundary and the lane safe boundary.
Further, according to an embodiment of the another aspect of the disclosure, the passing status for the current vehicle includes passable without intervention, passable with intervention, and impassable.
Further, according to an embodiment of the another aspect of the disclosure, the intervention includes adjusting the velocity of the current vehicle, a distance of the current vehicle from the obstacle, and a distance of the current vehicle from the another vehicle.
Further, according to an embodiment of the another aspect of the disclosure, the determination apparatus being configured to determine the passing status for the current vehicle includes: calculating an occupancy proportion of the obstacle in the lane based on the obstacle safe boundary and the lane safe boundary.
Further, according to an embodiment of the another aspect of the disclosure, the determination apparatus is configured to set the passing status for the current vehicle to be passable with intervention when the occupancy proportion of the obstacle in the lane is greater than a first threshold and less than a second threshold.
Further, according to an embodiment of the another aspect of the disclosure, the determination apparatus is configured to set the passing status for the current vehicle to be passable without intervention when the occupancy proportion of the obstacle in the lane is less than the first threshold.
Further, according to an embodiment of the another aspect of the disclosure, the determination apparatus is configured to set the passing status for the current vehicle to be impassable when the occupancy proportion of the obstacle in the lane is greater than the second threshold.
Further, according to an embodiment of the another aspect of the disclosure, the calculation apparatus is further configured to calculate a time to collision (TTC) of the current vehicle with the another vehicle based on the lateral position Dv of the another vehicle, and the time to collision (TTC) is used to determine whether there is a risk of a collision between the current vehicle and the another vehicle.
Further, according to an embodiment of the another aspect of the disclosure, the calculation apparatus is further configured to: if there is a risk of a collision between the current vehicle and the another vehicle, calculate a safe constraint boundary of the another vehicle based on the lateral position DV of the another vehicle, the width WV of the current vehicle, and a safe distance DS3 of the vehicle from the another vehicle, where the safe distance DS3 of the current vehicle from the another vehicle is related to the velocity of the current vehicle.
Further, according to an embodiment of the another aspect of the disclosure,
Further, according to an embodiment of the another aspect of the disclosure, the intervention further includes controlling, based on the safe constraint boundary of the another vehicle, the current vehicle to further adjust a distance DV of the vehicle from the another vehicle in the passing region, so as to avoid the another vehicle.
Further, according to an embodiment of the the another aspect of the disclosure, the device further includes: a path planning apparatus configured to generate path planning applied to the current vehicle bypassing an obstacle region based on the passing region and the passing status for the current vehicle.
Further, according to an embodiment of the the another aspect of the disclosure, the device further includes: an output control apparatus configured to output lateral-direction and longitudinal-direction control applied to the current vehicle based on the generated path planning
The disclosure further provides a computer-readable storage medium having instructions stored therein, where the instructions, when executed by a processor, cause the processor to perform the method described above.
The disclosure further provides an advanced driver-assistance system, where the advanced driver-assistance system is configured with the obstacle avoidance control device described above.
The disclosure further provides a vehicle, where the vehicle is configured with the advanced driver-assistance system described above.
According to the obstacle avoidance control method and system provided in the embodiments of the disclosure, it is possible to, according to vehicle sensor data, calculate a passable region for a current vehicle, determine a passing status for the current vehicle, and adjust values such as a velocity of the current vehicle, a distance of the current vehicle from an obstacle, and a distance of the current vehicle from another vehicle, thereby controlling the vehicle to decelerate and stop or bypass an obstacle region in accordance with a specified trajectory, so that a collision of the vehicle with the obstacle is avoided, or a collision hazard of the vehicle is mitigated.
Additionally, according to the obstacle avoidance control method and system provided in the embodiments of the disclosure, corresponding path planning may further be made according to the passing region and the passing status for the vehicle, so that the vehicle bypasses the obstacle region in a safe and reliable mariner.
The obstacle avoidance control management method and system in the disclosure are described below in detail in conjunction with the drawings. It should be noted that the following detailed description of embodiments is exemplary rather than limiting, and is intended to provide a basic understanding of the disclosure, and is not intended to confirm key or decisive elements of the disclosure or limit the scope of protection.
The disclosure is described below with reference to the block diagram descriptions, the block diagrams, and/or the flowcharts of the methods and apparatuses in the embodiments of the disclosure. It will be understood that each block of these flowchart descriptions and/or the block diagrams, and combinations of the flowchart descriptions and/or the block diagrams, can be implemented by computer program instructions. These computer program instructions may be provided for a processor of a general-purpose computer, a dedicated computer, or another programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or the another programmable data processing device create components for implementing the functions/operations specified in these flowcharts and/or blocks and/or one or more flow block diagrams.
These computer program instructions may be stored in a computer-readable memory, and the instructions can instruct a computer or another programmable processor to implement the functions in a specific mariner, so that the instructions stored in the computer-readable memory generate a manufactured product containing instruction components that implement the functions/operations specified in one or more blocks of the flowcharts and/or the block diagrams.
These computer program instructions may be loaded onto the computer or the another programmable data processor, so that a series of operations and steps are performed on the computer or the another programmable processor, to generate a computer-implemented process. As such, the instructions executed on the computer or the another programmable data processor provide steps for implementing the functions or operations specified in one or more blocks in the flowcharts and/or block diagrams. It should also be noted that in some alternative implementations, the functions/operations shown in the blocks may not occur in the order shown in the flowcharts. For example, two blocks shown in sequence may actually be executed substantially simultaneously or the blocks may sometimes be executed in a reverse order, depending on the functions/operations involved.
The disclosure provides a method and system for avoidance control of obstacles such as a cone barrel, a square barrel, and a warning post. According to the method and system, a passing region is calculated according to information collected by a vehicle sensor, such as a velocity of a current vehicle (the velocity includes a lateral velocity and a longitudinal velocity of the vehicle), a position of the current vehicle, a width of a lane of the current vehicle, information about an obstacle on the lane, and a safe constraint condition of another vehicle around the lane, so as to determine a passing status for the vehicle and adjust, according to the passing status, values such as the velocity of the current vehicle, a distance of the current vehicle from the obstacle, and a distance of the current vehicle from the another vehicle. Adjusting the above values can control the vehicle to decelerate and stop or bypass an obstacle region in accordance with a specified trajectory, thereby avoiding or mitigating a collision hazard while giving corresponding alert information.
In the context of the disclosure, the term “current vehicle” may also be referred to as a host vehicle and a vehicle. According to the method and system of the disclosure, the Frenet coordinate system may be used to calculate various positions. Specifically, in the Frenet coordinate system that uses the center line of a lane as a reference line, a lateral position of the obstacle and a lateral position of the host vehicle are both relative positions with respect to the center line of the lane. For example, the lateral position of the obstacle is a position of the center of the obstacle to the center line of the lane (i.e., a distance from the center line of the lane), and a lateral position of the another vehicle is a position of the center of a front or rear axle of the another vehicle around to the center line of the lane of the host vehicle.
As known to those skilled in the art, a distance is a signed value in the Frenet or a similar coordinate system. Specifically, a distance on the left side is written with a minus sign, and a distance on the right side is written with a plus sign. For example, the lateral position of the vehicle is a negative value if the vehicle is on the left side of the lane. Therefore, in the context of the disclosure, adjusting a trajectory of the vehicle includes adjusting distances such as a distance of the host vehicle from the obstacle and s a distance of the host vehicle from the another vehicle. For example, the vehicle needs to move towards the left side if a calculated distance of the host vehicle from the obstacle that needs to be adjusted is negative. Similarly, the vehicle needs to move towards the right side if a calculated distance of the host vehicle from the another vehicle that needs to be adjusted is positive. Additionally, adjusting the vehicle further includes adjusting a velocity of the current vehicle. In the context of the disclosure, the velocity of the vehicle may include a lateral velocity in the lateral direction and a longitudinal velocity in the longitudinal direction.
The term “another vehicle” refers to one or more vehicles that are closest to the current vehicle and may have a risk of a collision with the current vehicle. The “another vehicle” may be determined by estimating trajectories of the host vehicle and the another vehicle around at different sampling moments within a control time, and comparing the longitudinal and lateral positions of the host vehicle with those of the another vehicle around to identify whether there is a risk of a collision.
As shown in
The obstacle avoidance system 1000 performs processing according to the obtained information, and specifically, may calculate separately information such as an obstacle safe boundary, a lane safe boundary, and a safe constraint boundary of another vehicle around the current vehicle. The obstacle avoidance system 1000 performs passableness determination based on the obstacle safe boundary and the lane safe boundary, i.e., determine whether the vehicle can pass the lane currently having an obstacle, and whether traveling intervention is needed if the vehicle can pass. If intervention is needed, the system calculates desired adjustment information based on the passableness determination for the lane and the safe constraint boundary (which has a higher priority) of the another vehicle around the vehicle. The adjustment information specifically includes adjusting the velocity of the current vehicle, the distance of the current vehicle from the obstacle (the lateral distance and the longitudinal distance), and the distance of the current vehicle from the another vehicle (the lateral distance and the longitudinal distance), thereby making vehicle movement path planning The vehicle path planning is fed back to the passableness determination for the lane, so as to iteratively calculate desired lateral and longitudinal movement distance information. Finally the obstacle avoidance system 1000 determines vehicle lateral control and longitudinal control as an output.
Alternatively, in an embodiment, the vehicle EPS performs lateral control in real time, and the vehicle VCU/BCU performs longitudinal control in real time, which enables the vehicle to decelerate and stop or bypass an obstacle region in accordance with a specified trajectory, thereby avoiding or mitigating a collision hazard, and at the same time, prompt information is output through the vehicle CDC, and a double-flashing light is turned on in a timely manner to provide warning information for following vehicles when it is determined that braking is required.
How the obstacle avoidance control system according to an embodiment of the disclosure calculates obstacle safe boundary information, lane safe boundary information, safe constraint boundary information of the another vehicle, passableness determination, and a desired lateral/longitudinal movement distance is described in detail below.
Alternatively, the safe distance {circle around (4)} may be related to a current vehicle velocity of the host vehicle. Specifically, the higher the vehicle velocity, the longer the safe distance. A specific safe distance {circle around (4)} may be set by a user or a manufacturer according to driving habits of the user. Therefore, adjusting the vehicle may further include adjusting the velocity of the current vehicle. For example, by reducing the vehicle velocity, the safe distance {circle around (4)} may be correspondingly made smaller, thereby ensuring the safe boundary {circle around (2)}. Additionally or alternatively, a limit of the safe boundary may be set as not being allowed to exceed lane lines on both sides, that is, the safe boundary {circle around (2)} is greater than −0.5×width of the lane.
Similar to the method for calculating the obstacle safe boundary, a lane safe boundary during the vehicle avoiding the obstacle may be calculated according to the type of the lane line. Specifically, a line type (e.g., a dashed line) which allows the host vehicle to cross has a smaller boundary constraint and a wider passable region than a line type (e.g., a solid line and a curb) which does not allow the host vehicle to cross.
As described above, the obstacle avoidance control system further needs to predict a trajectory of the host vehicle and a trajectory of another vehicle around, determine whether there is a risk of a collision, and calculate a safe constraint boundary of the another vehicle around. Generally, a safe boundary of another vehicle has a higher constraint priority than an obstacle safe boundary and a lane safe boundary.
Similarly, as described above, the safe distance {circle around (4)} is related to a vehicle velocity of the host vehicle, and the higher the vehicle velocity, the longer the safe distance. A specific safe distance {circle around (4)} may be set by a user or a manufacturer according to driving habits of the user. Therefore, in a case where there is another vehicle, values such as the velocity of the current vehicle, a distance of the current vehicle from the obstacle, and a distance of the current vehicle from the another vehicle may be adjusted. Alternatively, a limit of the safe boundary may be set as not being allowed to exceed the center line of the current lane, that is, the safe boundary {circle around (2)} is less than 0.
After an obstacle safe boundary, a lane safe boundary, and the safe constraint boundary of the another vehicle are calculated, the obstacle avoidance control system calculates, based on the above information, a width for which the vehicle can pass in the current lane, thereby determining whether the vehicle can pass (i.e., passableness determination). Specifically, a passing status for the current lane includes the following four states: 1. passable without intervention; 2. passable with intervention; 3. returning to the center of the lane; and 4. impassable. The obstacle avoidance control system calculates a passable width and a lane occupancy proportion based on a position of the obstacle, lane line information, and a constrained boundary, and does not allow the vehicle to pass when the passable width is small or the lane occupancy proportion is high; no intervention is required when there is no lane occupation or the lane occupancy proportion is low; and the vehicle returns to the center of the lane after passing the obstacle without collision is identified. An upper threshold and a lower threshold may be set for the occupancy proportion of the obstacle in the lane, that is, the current vehicle cannot pass when the occupancy proportion of the obstacle in the lane is higher than the upper threshold, can pass with intervention when the occupancy proportion of the obstacle in the lane is between the upper threshold and the lower threshold, and can pass without intervention when the occupancy proportion of the obstacle in the lane is lower than the lower threshold.
As described above, the obstacle avoidance control system needs to determine in step S804 whether the obstacle region has been passed. How to determine whether the vehicle has passed the obstacle region is described in detail below. Specifically, the obstacle avoidance control system searches for an obstacle that is most distant from the vehicle in a longitudinal distance, and identifies whether passing the obstacle region brings a risk based on the state and lateral and longitudinal positions from the host vehicle of the most distant obstacle, and identifies that the obstacle region can be passed with no risk when the longitudinal position is small enough, and the lateral position is large enough. The determining thresholds of the lateral position and the longitudinal position are related to a vehicle velocity of the host vehicle, and the higher the vehicle velocity, the greater the corresponding thresholds. When the most distant obstacle disappears, the obstacle avoidance control system identifies that the obstacle region has been passed.
After the obstacle avoidance control system determines the lane passableness and a safe constraint boundary of another vehicle, the obstacle avoidance control system calculates a desired movement distance based on the above data, the distance including a lateral distance and a longitudinal distance. Specifically, the obstacle avoidance control system determines the desired lateral and longitudinal movement distances respectively for two cases where the lane is passable and where the lane is impassable.
In the case where the lane is impassable, distance {circle around (1)} is a desired lateral movement distance, distance {circle around (2)} is a desired longitudinal movement distance, and distance {circle around (3)} is a desired stopping angle. Moving according to the above distances may ensure that the vehicle is parallel to an oblique line formed by cone barrels, so that the vehicles moves better at a later stage. Distance {circle around (4)} is a longitudinal safe distance, and distance {circle around (5)} is a longitudinal distance of the closest impassable obstacle. Calculation of the desired lateral distance {circle around (1)} refers to the above method for calculating a boundary, the boundary is calculated by using the found information about the impassable obstacle closest to the host vehicle, and the impassable desired lateral distance {circle around (1)} should not make the host vehicle cross a line and stop. In addition, the desired longitudinal distance {circle around (2)}={circle around (5)}−{circle around (4)}, where the longitudinal safe distance {circle around (4)} is related to a vehicle velocity, and the higher the vehicle velocity, the longer the reserved safe distance.
Similarly, as described above, the safe distance {circle around (4)} may be set by a user or a manufacturer according to driving habits of the user. Finally, the desired stopping angle {circle around (3)} formed by the vehicle is equal to {circle around (1)}/{circle around (2)}. Because a desired vehicle longitudinal velocity is reduced to 0, a desired longitudinal deceleration of the vehicle=−1×square of current vehicle velocity/(2×desired longitudinal distance).
In the case where the lane is passable, distance {circle around (1)} is a left lane line boundary, distance {circle around (2)} is a left vehicle boundary, distance {circle around (3)} is a desired lateral movement distance, distance {circle around (4)} is a right boundary, distance {circle around (5)} a longitudinal position of an obstacle occupying the most of the lane, distance {circle around (6)} is a longitudinal position of the most distant obstacle, and distance {circle around (7)} a desired longitudinal movement distance. The desired lateral distance {circle around (3)}=0.5×({circle around (1)}+{circle around (4)}). The vehicle is not allowed to exceed the distance {circle around (2)} at the same time when the another vehicle around is considered (the safe boundary of the another vehicle has a higher priority than an obstacle safe boundary and a lane safe boundary). The desired longitudinal distance {circle around (7)} needs to consider both {circle around (5)} and {circle around (6)}, and refers preferentially to the longitudinal position {circle around (6)} of the most distant obstacle, and the longitudinal position {circle around (5)} of the obstacle occupying the most of the lane has an increased priority when a lane occupancy proportion of the obstacle occupying the most of the lane is significantly greater than that of the most distant obstacle.
Additionally, during avoidance, in order to ensure that the lateral distance {circle around (3)} needs to be enough to avoid the obstacle when approaching the obstacle, there is a need to limit a longitudinal velocity based on the desired longitudinal distance, and reserve enough time for completing a lateral movement. Desired time for the lateral movement=({circle around (3)}−actual lateral position)/desired lateral velocity. Therefore, a desired lateral deceleration=({circle around (6)}−current vehicle velocity×desired time for lateral movement)/(0.5×square of desired lateral movement time), and the deceleration does not exceed 0. In addition, a desired velocity=vehicle velocity+accumulated control time×desired deceleration.
Alternatively, after obtaining the desired lateral and longitudinal movement distances and desired velocity determined for the lane being passable, the obstacle avoidance control system may also feed back the above information to passableness determination, to repeatedly and iteratively determine whether the current lane is passable. Finally, the obstacle avoidance control system makes lateral and longitudinal control.
The vehicle sensor data includes a width of a current lane, a velocity of the current vehicle, a lateral position DB of an obstacle, and a lateral position DV of another vehicle. The obstacle safe boundary is calculated based on the lateral position DB of the obstacle, the width WV of the current vehicle, and a safe distance DS1 of the current vehicle from the obstacle, where the safe distance DS1 of the current vehicle from the obstacle is related to the velocity of the current vehicle. More specifically,
Additionally, the lane safe boundary is calculated based on the width WR of the current lane, the width WV of the current vehicle, and a safe distance DS2 of the current vehicle crossing the current lane, where the safe distance DS2 of the current vehicle crossing the current lane is related to a type of the current lane. More specifically,
The passing region for the current vehicle is a region between the obstacle safe boundary and the lane safe boundary. The passing status for the current vehicle includes passable without intervention, passable with intervention, and impassable. The intervention includes adjusting the velocity of the current vehicle, a distance of the current vehicle from the obstacle, and a distance of the current vehicle from the another vehicle, where the velocity may include a lateral velocity and a longitudinal velocity, and the distance includes a lateral distance and a longitudinal distance.
More specifically, the determining a passing status for the current vehicle may include: calculating an occupancy proportion of the obstacle in the lane based on the obstacle safe boundary and the lane safe boundary. The determining a passing status for the current vehicle may further include setting the passing status for the current vehicle to be passable with intervention when the occupancy proportion of the obstacle in the lane is greater than a first threshold and less than a second threshold. The determining a passing status for the current vehicle may further include setting the passing status for the current vehicle to be passable without intervention when the occupancy proportion of the obstacle in the lane is less than the first threshold. The determining a passing status for the current vehicle may further include: setting the passing status for the current vehicle to be impassable when the occupancy proportion of the obstacle in the lane is greater than the second threshold.
Additionally or alternatively, the method may further include: step S1104: calculating a time to collision (TTC) of the current vehicle with the another vehicle based on the lateral position DV of the another vehicle, where the time to collision (TTC) is used to determine whether there is a risk of a collision between the current vehicle and the another vehicle around the lane. S1104 further includes: if there is a risk of a collision between the current vehicle and the another vehicle, calculating a safe constraint boundary of the another vehicle based on the lateral position DV of the another vehicle, the width WV of the current vehicle, and a safe distance DS3 of the current vehicle from the another vehicle, where the safe distance DS3 of the current vehicle from the another vehicle is related to the velocity of the current vehicle. Specifically,
The safe constraint boundary of the another vehicle may be fed back to step S1103 to be used to further determine the passing status for the current vehicle.
Therefore, the intervention may further include: controlling the vehicle to adjust a distance DV of the vehicle in the passing region from the another vehicle based on the safe constraint boundary of the another vehicle, so as to avoid the another vehicle.
Alternatively, the method further includes step S1105: generating path planning applied to the current vehicle bypassing an obstacle region based on the passing region and the passing status for the current vehicle.
Alternatively, the method further includes step S1106: outputting lateral-direction and longitudinal-direction control applied to the current vehicle based on the generated path planning.
The vehicle sensor data includes a width of a current lane, a velocity of the current vehicle, a lateral position DB of an obstacle, and a lateral position DV of another vehicle. The calculation apparatus may further be configured to calculate the obstacle safe boundary based on the lateral position DB of the obstacle, the width WV of the current vehicle, and a safe distance DS1 of the vehicle from the obstacle, where the safe distance DS1 of the current vehicle from the obstacle is related to the velocity of the current vehicle. Specifically,
The calculation apparatus is further configured to calculate the lane safe boundary based on the width WR of the current lane, the width WV of the current vehicle, and a safe distance DS2 of the vehicle crossing the current lane, where the safe distance DS2 of the current vehicle crossing the current lane is related to a type of the current lane. Specifically,
The passing region for the current vehicle is a region between the obstacle safe boundary and the lane safe boundary. The passing status for the current vehicle includes passable without intervention, passable with intervention, and impassable. The intervention includes adjusting the velocity of the current vehicle, a distance of the current vehicle from the obstacle, and a distance of the current vehicle from the another vehicle, where the velocity may include a lateral velocity and a longitudinal velocity, and the distance includes a lateral distance and a longitudinal distance.
More specifically, the determination apparatus being configured to determine the passing status for the current vehicle includes: calculating an occupancy proportion of the obstacle in the lane based on the obstacle safe boundary and the lane safe boundary. The determination apparatus being able to be configured to determine the passing status for the current vehicle further includes: setting the passing status for the current vehicle to be passable with intervention when the occupancy proportion of the obstacle in the lane is greater than a first threshold and less than a second threshold. The determination apparatus being able to be configured to determine the passing status for the current vehicle further includes: setting the passing status for the current vehicle to be passable without intervention when the occupancy proportion of the obstacle in the lane is less than the first threshold. The determination apparatus being able to be configured to determine the passing status for the current vehicle further includes: setting the passing status for the current vehicle to be impassable when the occupancy proportion of the obstacle in the lane is greater than the second threshold.
The calculation apparatus may further be configured to calculate a time to collision (TTC) of the current vehicle with the another vehicle based on the lateral position Dv of the another vehicle, where the time to collision (TTC) is used to determine whether there is a risk of a collision between the current vehicle and the another vehicle around the lane.
Further, according to an embodiment of the another aspect of the disclosure, the calculation apparatus is further configured to: if there is a risk of a collision between the current vehicle and the another vehicle, calculate a safe constraint boundary of the another vehicle based on the lateral position DV of the another vehicle, the width WV of the current vehicle, and a safe distance DS3 of the current vehicle from the another vehicle, where the safe distance DS3 of the current vehicle from the another vehicle is related to the velocity of the current vehicle. Specifically,
The safe constraint boundary of the another vehicle may be fed back to step S1103 to be used to further determine the passing status for the current vehicle.
Therefore, the intervention may further include controlling the vehicle to further adjust a distance DV of the vehicle in the passing region from the another vehicle based on the safe constraint boundary of the another vehicle, so as to avoid the another vehicle around the vehicle.
Alternatively, the device may further include: a path planning apparatus 1204 configured to generate path planning applied to the current vehicle bypassing an obstacle region based on the passing region and the passing status for the current vehicle.
Alternatively, the device may further include: an output control apparatus 1205 configured to output lateral-direction and longitudinal-direction control applied to the current vehicle based on the generated path planning.
The disclosure further provides an advanced driver-assistance system (ADAS), where the advanced driver-assistance system is configured with the obstacle avoidance control device described above, so that the ADAS may implement the above obstacle avoidance control method or functions of the above obstacle avoidance control device.
The disclosure further provides a vehicle, where the vehicle is configured with the advanced driver-assistance system (ADAS) described above, and the ADAS is capable of implementing the above obstacle avoidance control method or functions of the above obstacle avoidance control device.
Additionally, as described above, the disclosure may also be implemented as a recording medium, in which a program for enabling a computer to perform the obstacle avoidance control method described above is stored.
Here, various recording media, such as disks (e.g., a magnetic disk, an optical disc, etc.), cards (e.g., a memory card, an optical card, etc.), semiconductor memories (e.g., a ROM, a non-volatile memory, etc.), and tapes (e.g., a magnetic tape, a cassette tape, etc.), can be used as the recording medium.
By recording, in these recording media, a computer program that enables a computer to perform the obstacle avoidance control method in the embodiments above or a computer program that enables a computer to implement functions of the obstacle avoidance control method in the embodiments above, and circulating the computer program, costs are reduced, and portability and versatility are improved.
Moreover, the recording medium above is loaded onto a computer, a computer program recorded in the recording medium is read by the computer and stored in a memory, and processors (central processing unit (CPU) and micro processing unit (MPU)) provided in the computer read and execute the computer program, and thus, the computer can perform the obstacle avoidance control method in the embodiments above and implement functions of the apparatuses of the obstacle avoidance control method in the embodiments above.
Those of ordinary skill in the art should understand that the disclosure is not limited to the embodiments above, and the disclosure can be implemented in many other forms without departing from the essence and scope thereof. Therefore, the presented examples and embodiments are regarded to be schematic rather than restrictive, and without departing from the spirit and scope of the disclosure that are defined by the appended claims, the disclosure may cover various changes and replacements.
Claims
1. An obstacle avoidance control method, comprising the steps of:
- receiving vehicle sensor data;
- calculating an obstacle safe boundary and a lane safe boundary based on the vehicle sensor data; and
- determining a passing region and a passing status for a current vehicle according to the obstacle safe boundary and the lane safe boundary.
2. The method according to claim 1, wherein the vehicle sensor data comprises a width of a current lane of the current vehicle, a velocity of the current vehicle, a lateral position DB of an obstacle, and a lateral position DV of another vehicle.
3. The method according to claim 2, wherein the calculating an obstacle safe boundary based on the vehicle sensor data comprises:
- calculating the obstacle safe boundary based on the lateral position DB of the obstacle, a width WV of the current vehicle, and a safe distance DS1 of the current vehicle from the obstacle, wherein the safe distance DS1 of the current vehicle from the obstacle is related to the velocity of the current vehicle.
4. The method according to claim 3, wherein the obstacle safe boundary is calculated based on the following formula: Obstacle safe boundary = D B - W V 2 - D S 1.
5. The method according to claim 2, wherein the calculating a lane safe boundary based on the vehicle sensor data comprises:
- calculating the lane safe boundary based on the width WR of the current lane, the width WV of the current vehicle, and a safe distance DS2 of the current vehicle crossing the current lane, wherein the safe distance DS2 of the current vehicle crossing the current lane is related to a type of the current lane of the current vehicle.
6. An obstacle avoidance control device, comprising:
- a receiving apparatus configured to receive vehicle sensor data;
- a calculation apparatus configured to calculate an obstacle safe boundary and a lane safe boundary based on the vehicle sensor data; and
- a determination apparatus configured to determine a passing region and a passing status for a current vehicle according to the obstacle safe boundary and the lane safe boundary.
7. The device according to claim 6, wherein the vehicle sensor data comprises a width of a current lane, a velocity of the current vehicle, a lateral position DB of an obstacle, and a lateral position DV of another vehicle.
8. The device according to claim 7, wherein the calculation apparatus is further configured to calculate the obstacle safe boundary based on the lateral position DB of the obstacle, a width WV of the current vehicle, and a safe distance DS1 of the current vehicle from the obstacle, wherein the safe distance DS1 of the current vehicle from the obstacle is related to the velocity of the current vehicle.
9. The device according to claim 8, wherein the calculation apparatus calculates the obstacle safe boundary based on the following formula: Obstacle safe boundary = D B - W V 2 - D S 1.
10. The device according to claim 7, wherein the calculation apparatus is further configured to calculate the lane safe boundary based on the width WR of the current lane, the width WV of the current vehicle, and a safe distance DS2 of the current vehicle crossing the current lane, wherein the safe distance DS2 of the current vehicle crossing the current lane is related to a type of the current lane.
11. A computer-readable storage medium having instructions stored therein, wherein the instructions, when executed by a processor, cause the processor to perform an obstacle avoidance control method, the method comprising the steps of:
- receiving vehicle sensor data;
- calculating an obstacle safe boundary and a lane safe boundary based on the vehicle sensor data; and
- determining a passing region and a passing status for a current vehicle according to the obstacle safe boundary and the lane safe boundary.
Type: Application
Filed: Aug 8, 2022
Publication Date: Feb 23, 2023
Inventors: Shuangwu LIN (Shanghai), Daoyan GUO (Shanghai)
Application Number: 17/882,887