METHOD FOR PLANNING PATH FOR LANE CHANGING, ELECTRONIC DEVICE AND COMPUTER READABLE MEDIUM
A method for planning a path for lane changing includes: determining, based on position information of a detected obstacle, a reference position to be passed by a vehicle when the vehicle detours the obstacle; estimating an end position of the vehicle detouring the obstacle based on a positional relationship between the vehicle and the obstacle; and determining a path of the vehicle to detour the obstacle based on a current position of the vehicle, the reference position and the end position.
1 . A method for planning a path for lane changing, comprising:
determining, based on position information of a detected obstacle, a reference position to be passed by a vehicle when the vehicle detours the obstacle;
estimating an end position of the vehicle detouring the obstacle based on a positional relationship between the vehicle and the obstacle; and
determining a path of the vehicle to detour the obstacle based on a current position of the vehicle, the reference position and the end position.
2 . The method of claim 1 , wherein, before determining the reference position to be passed by the vehicle when the vehicle detours the detected obstacle based on the position information of the obstacle, the method further comprises:
detecting the position information of the obstacle and a motion state of the obstacle before the vehicle starts lane changing.
3 . The method of claim 1 , wherein determining the reference position to be passed by the vehicle when the vehicle detours the detected obstacle based on the position information of the obstacle comprises:
obtaining a boundary position of the obstacle close to the vehicle from the position information of the obstacle; and
calculating a position with a predetermined deviation distance from the boundary position, to obtain the reference position to be passed by the vehicle when the vehicle detours the obstacle,
wherein the predetermined deviation distance is a preset spacing distance between the obstacle and the vehicle in a direction perpendicular to a road centerline, and the predetermined deviation distance is greater than 0.
4 . The method of claim 1 , wherein estimating the end position of the vehicle detouring the obstacle based on the positional relationship between the vehicle and the obstacle comprises:
estimating the end position of the vehicle detouring the obstacle based on the current position and a motion state of the vehicle, and the position information and a motion state of the obstacle.
5 . The method of claim 4 , wherein the positional relationship between the vehicle and the obstacle while the vehicle is driving is determined based on the current position and a motion state of the vehicle, and the position information and a motion state of the obstacle.
6 . The method of claims 1 , wherein determining the path of the vehicle to detour the obstacle based on the current position of the vehicle, the reference position and the end position comprises:
taking the current position of the vehicle, the reference position and the end position as trajectory points on the path of the vehicle detouring the obstacle;
calculating a driving angular velocity of the vehicle from the current position to the end position in a direction along the road centerline; and
establishing a path passing through the trajectory points at the driving angular velocity as the path of the vehicle to detour the obstacle.
7 . The method of claim 6 , wherein calculating the driving angular velocity of the vehicle from the current position to the end position in the direction along the road centerline comprises:
calculating a driving path length of the vehicle from the current position to the end position in the direction along the road centerline based on a distance between the current position of the vehicle and the estimated end position;
calculating a driving linear velocity of the vehicle based on a motion state of the vehicle and the driving path length; and
calculating the driving angular velocity of the vehicle from the current position to the end position by utilizing a conversion relationship between the driving linear velocity and the driving angular velocity.
8 . An electronic device, comprising:
one or more processors;
a storage device having one or more programs stored thereon that, when executed by the one or more processors, cause the one or more processors to implement a method for planning a path for lane changing; and
one or more I/O interfaces, coupled between the one or more processors and the storage device and configured to implement information interaction between the one or more processors and the storage device,
wherein, the method comprises:
determining, based on position information of a detected obstacle, a reference position to be passed by a vehicle when the vehicle detours the obstacle;
estimating an end position of the vehicle detouring the obstacle based on a positional relationship between the vehicle and the obstacle; and
determining a path of the vehicle to detour the obstacle based on a current position of the vehicle, the reference position and the end position.
9 . The electronic device of claim 8 , wherein, before determining the reference position to be passed by the vehicle when the vehicle detours the detected obstacle based on the position information of the obstacle, the method further comprises:
detecting the position information of the obstacle and a motion state of the obstacle before the vehicle starts lane changing.
10 . The electronic device of claim 8 , wherein determining the reference position to be passed by the vehicle when the vehicle detours the detected obstacle based on the position information of the obstacle comprises:
obtaining a boundary position of the obstacle close to the vehicle from the position information of the obstacle; and
calculating a position with a predetermined deviation distance from the boundary position, to obtain the reference position to be passed by the vehicle when the vehicle detours the obstacle,
wherein the predetermined deviation distance is a preset spacing distance between the obstacle and the vehicle in a direction perpendicular to a road centerline, and the predetermined deviation distance is greater than 0.
11 . The electronic device of claim 8 , wherein estimating the end position of the vehicle detouring the obstacle based on the positional relationship between the vehicle and the obstacle comprises:
estimating the end position of the vehicle detouring the obstacle based on the current position and a motion state of the vehicle, and the position information and a motion state of the obstacle.
12 . The electronic device of claim 11 , wherein the positional relationship between the vehicle and the obstacle while the vehicle is driving is determined based on the current position and a motion state of the vehicle, and the position information and a motion state of the obstacle.
13 . The electronic device of claims 8 , wherein determining the path of the vehicle to detour the obstacle based on the current position of the vehicle, the reference position and the end position comprises:
taking the current position of the vehicle, the reference position and the end position as trajectory points on the path of the vehicle detouring the obstacle;
calculating a driving angular velocity of the vehicle from the current position to the end position in a direction along the road centerline; and
establishing a path passing through the trajectory points at the driving angular velocity as the path of the vehicle to detour the obstacle.
14 . The electronic device of claim 13 , wherein calculating the driving angular velocity of the vehicle from the current position to the end position in the direction along the road centerline comprises:
calculating a driving path length of the vehicle from the current position to the end position in the direction along the road centerline based on a distance between the current position of the vehicle and the estimated end position;
calculating a driving linear velocity of the vehicle based on a motion state of the vehicle and the driving path length; and
calculating the driving angular velocity of the vehicle from the current position to the end position by utilizing a conversion relationship between the driving linear velocity and the driving angular velocity.
15 . A computer readable medium having a computer program stored thereon, wherein a method for planning a path for lane changing when the computer program is executed by a processor, the method comprising:
determining, based on position information of a detected obstacle, a reference position to be passed by a vehicle when the vehicle detours the obstacle;
estimating an end position of the vehicle detouring the obstacle based on a positional relationship between the vehicle and the obstacle; and
determining a path of the vehicle to detour the obstacle based on a current position of the vehicle, the reference position and the end position.
16 . The computer readable medium of claim 15 , wherein, before determining the reference position to be passed by the vehicle when the vehicle detours the detected obstacle based on the position information of the obstacle, the method further comprises:
detecting the position information of the obstacle and a motion state of the obstacle before the vehicle starts lane changing.
17 . The computer readable medium of claim 15 , wherein determining the reference position to be passed by the vehicle when the vehicle detours the detected obstacle based on the position information of the obstacle comprises:
obtaining a boundary position of the obstacle close to the vehicle from the position information of the obstacle; and
calculating a position with a predetermined deviation distance from the boundary position, to obtain the reference position to be passed by the vehicle when the vehicle detours the obstacle,
wherein the predetermined deviation distance is a preset spacing distance between the obstacle and the vehicle in a direction perpendicular to a road centerline, and the predetermined deviation distance is greater than 0 .
18 . The computer readable medium of claim 15 , wherein estimating the end position of the vehicle detouring the obstacle based on the positional relationship between the vehicle and the obstacle comprises:
estimating the end position of the vehicle detouring the obstacle based on the current position and a motion state of the vehicle, and the position information and a motion state of the obstacle.
19 . The computer readable medium of claims 15 , wherein determining the path of the vehicle to detour the obstacle based on the current position of the vehicle, the reference position and the end position comprises:
taking the current position of the vehicle, the reference position and the end position as trajectory points on the path of the vehicle detouring the obstacle;
calculating a driving angular velocity of the vehicle from the current position to the end position in a direction along the road centerline; and
establishing a path passing through the trajectory points at the driving angular velocity as the path of the vehicle to detour the obstacle.
20 . The computer readable medium of claim 19 , wherein calculating the driving angular velocity of the vehicle from the current position to the end position in the direction along the road centerline comprises:
calculating a driving path length of the vehicle from the current position to the end position in the direction along the road centerline based on a distance between the current position of the vehicle and the estimated end position;
calculating a driving linear velocity of the vehicle based on a motion state of the vehicle and the driving path length; and
calculating the driving angular velocity of the vehicle from the current position to the end position by utilizing a conversion relationship between the driving linear velocity and the driving angular velocity.