Counter-steering penalization during vehicle turns
Devices, systems, and methods are provided for counter-steering penalization. A device may analyze, by one or more processors, lane geometry associated with one or more lanes at a geographic location. The device may identify one or more corners in the lane geometry. The device may select one or more desired maximum steering angles of a steering wheel of an autonomous vehicle. The device may select weight values associated with the one or more desired maximum steering angles. The device may execute a path planning optimization based on the one or more desired maximum steering angles and the weight values.
1 . A method comprising:
detecting, by one or more processors, lane geometry associated with one or more lanes at a location;
identifying one or more corners in the lane geometry;
selecting one or more desired maximum steering angles of a steering wheel of an autonomous vehicle;
selecting one or more weight values associated with the one or more desired maximum steering angles; and
performing a path planning optimization to select a steering wheel angle as a function of time or distance wherein an objective function of the optimization penalizes, based on the one or more weight values, steering wheel angles that exceed, in absolute value, one or more of the desired maximum steering angles.
2 . The method of claim 1 , wherein the one or more desired maximum steering angles are associated with a time interval prior to a first corner of the one or more corners.
3 . The method of claim 1 , wherein the one or more desired maximum steering angles comprises a first desired maximum steering angle of a left turn and a second desired maximum steering angle of a right turn.
4 . The method of claim 3 , wherein the first desired maximum steering angle associated with the left turn is independent of the second desired maximum steering angle of the right turn.
5 . The method of claim 1 , wherein performing the path planning optimization comprises imposing a slack variable to control the path planning optimization.
6 . The method of claim 5 , wherein the slack value is based on an avoidance path of an object in a region associated with a corner of the one or more corners.
7 . The method of claim 1 , wherein a positive steering wheel angle is associated with left movements on the steering wheel, and a negative steering wheel angle is associated with right movements on the steering wheel.
8 . A non-transitory computer-readable medium storing computer-executable instructions, which when executed by one or more processors result in performing operations comprising:
detecting lane geometry associated with one or more lanes at a location;
identifying one or more corners in the lane geometry;
selecting one or more desired maximum steering angles of a steering wheel of an autonomous vehicle;
selecting one or more weight values associated with the one or more desired maximum steering angles; and
performing a path planning optimization to select a steering wheel angle as a function of time wherein an objective function of the optimization penalizes, one or more weight values, steering wheel angles that exceed, in absolute value, one or more of the desired maximum steering angles.
9 . The non-transitory computer-readable medium of claim 8 , wherein the one or more desired maximum steering angles are associated with a time interval prior to a first corner of the one or more corners.
10 . The non-transitory computer-readable medium of claim 8 , wherein the one or more desired maximum steering angles comprises a first desired maximum steering angle of a left turn and a second desired maximum steering angle of a right turn.
11 . The non-transitory computer-readable medium of claim 10 , wherein the first desired maximum steering angle associated with the left turn, is independent of the second desired maximum steering angle of the right turn.
12 . The non-transitory computer-readable medium of claim 8 , wherein to perform the path planning optimization further comprises applying the weight values to penalize the one or more desired maximum steering angles.
13 . The non-transitory computer-readable medium of claim 8 , wherein a steering angle of the steering wheel of the autonomous vehicle is less than the one or more desired maximum steering angles.
14 . The non-transitory computer-readable medium of claim 8 , wherein to perform the path planning optimization further comprises imposing a slack variable to control the path planning optimization.
15 . A system for controlling an operation of an autonomous vehicle, the system comprising:
a global positioning system sensor;
a memory device;
one or more autonomous driving sensors; and
an autonomous mode controller to:
determine a geographic location of the autonomous vehicle via the global positioning system sensor;
analyze lane geometry associated with one or more lanes at the geographic location;
identify one or more corners in the lane geometry;
select one or more desired maximum steering angles of a steering wheel of an autonomous vehicle;
select one or more weight values from the memory device associated with the one or more desired maximum steering angles; and
execute a path planning optimization to select a steering wheel angle as a function of time or distance wherein an objective function of the optimization penalizes, based on the one or more weight values, steering wheel angles that exceed, in absolute value, one or more of the desired maximum steering angles.
16 . The system of claim 15 , wherein the one or more desired maximum steering angles are associated with a time interval prior to a first corner of the one or more corners.
17 . The system of claim 15 , wherein the one or more desired maximum steering angles comprises a first desired maximum steering angle of a left turn and a second desired maximum steering angle of a right turn.
18 . The method of claim 1 , wherein the one or more weights are based on the presence of obstacles.
19 . The non-transitory computer-readable medium of claim 8 , wherein the one or more weights are based on the presence of obstacles.
20 . The system of claim 15 , wherein the one or more weights are based on the presence of obstacles.