Vehicle path adjustment with control barrier function
A system for detecting a road surface includes a computer programmed to determine a virtual boundary for a vehicle body based on a shape of the vehicle body, upon identifying an object, to identify a plurality of points on the object based on received sensor data, to determine a barrier function based on each of the identified plurality of points, wherein the barrier function includes a barrier distance from a reference point of the virtual boundary of the vehicle to a respective one of the points on the object, based on (i) the determined barrier functions, (ii) the determined virtual boundary of the vehicle, and (iii) an input to at least one of propulsion, steering, or braking, to determine at least one of a braking override or a steering override, and based on the determination, to adjust at least one of a vehicle steering or a vehicle speed.
1. A system for detecting a road surface, comprising a processor and a memory, the memory storing instructions executable by the processor to:
determine a virtual boundary for a vehicle body based on a shape of the vehicle body;
upon identifying an object, identify a plurality of points on the object based on received sensor data;
determine a barrier function based on each of the identified plurality of points, wherein the barrier function includes a barrier distance from a reference point of the virtual boundary of the vehicle to a respective one of the points on the object;
based on (i) the determined barrier function, (ii) the determined virtual boundary of the vehicle, and (iii) an input to at least one of propulsion, steering, or braking, determine at least one of a braking override or a steering override by solving an optimization problem including the barrier functions and one or more constraints including at least one of a maximum deceleration threshold, a maximum acceleration threshold, and a maximum steering angle; and
based on the determination, adjust at least one of a vehicle steering or a vehicle speed.
2. The system of claim 1 , wherein the object is a static object or a moving object.
3. The system of claim 1 , wherein the plurality of points includes points on edges of the object.
4. The system of claim 1 , wherein the instructions further include instructions to generate tracking data for the identified object and determine based on the generated tracking data whether the identified object is a static object.
5. The system of claim 1 , wherein the instructions further include instructions to determine the at least one of a braking override or a steering override by solving an optimization problem to identify a set of actuations of one or more vehicle actuators that satisfy the barrier functions.
6. The system of claim 1 , wherein the instructions further include instructions to:
determine a projection of the object on a ground surface based on the identified plurality of points; and
determine the at least one of a braking override or a steering override further based on the determined projection of the object.
7. The system of claim 1 , wherein the instructions further include instructions to:
determine a plurality of radial zones extending from the virtual boundary; and
upon determining that the object is a static object, identify the plurality of points on the static object based on received virtual sensor data from one or more radial zones.
8. The system of claim 7 , wherein the plurality of points is on more than one identified static object.
9. The system of claim 1 , wherein the instructions further include instructions to:
upon determining that the object is a moving object, generate tracking data for the plurality of points on the identified moving object;
determine a speed, a heading, and a location of each of the identified plurality of points of the moving object based on the vehicle sensor data; and
determine the barrier function further based on the determined state of each of the identified plurality of points.
10. The system of claim 9 , wherein the instructions further include instructions to determine a second virtual boundary for the identified object based on the plurality of points on the identified object.
11. The system of claim 10 , wherein the instructions further include instructions to determine the second virtual boundary based on data, received from a vehicle sensor or a remote computer, identifying a type of the identified object.
12. A method, comprising:
determining a virtual boundary for a vehicle body based on a shape of the vehicle body; upon identifying an object, identifying a plurality of points on the object based on received sensor data;
determining a barrier function based on each of the identified plurality of points, wherein the barrier function includes a barrier distance from a reference point of the virtual boundary of the vehicle to a respective one of the points on the object;
based on (i) the determined barrier functions, (ii) the determined virtual boundary of the vehicle, and (iii) an input to at least one of propulsion, steering, or braking, determining at least one of a braking override or a steering override by solving an optimization problem including the barrier functions and one or more constraints including at least one of a maximum deceleration threshold, a maximum acceleration threshold, and a maximum steering angle; and
based on the determination, adjusting at least one of a vehicle steering or a vehicle speed.
13. The method of claim 12 , further comprising generating tracking data for the identified object and determining based on the generated tracking data whether the identified object is a static object.
14. The method of claim 12 , further comprising determining the at least one of a braking override or a steering override by solving an optimization problem to identify a set of actuations of one or more vehicle actuators that satisfy the barrier functions.
15. The method of claim 12 , further comprising:
determining a projection of the object on a ground surface based on the identified first plurality of points; and
determining the at least one of a braking override or a steering override further based on the determined projection of the object.
16. The method of claim 12 , further comprising:
determining a plurality of radial zones extending from the virtual boundary; and
upon determining that the object is a static object, identifying the plurality of points on the static object based on received virtual sensor data from one or more radial zones.
17. The method of claim 12 , further comprising:
upon determining that the object is a moving object, generating tracking data for the plurality of points on the identified moving object;
determining a speed, a heading, and a location of each of the identified plurality of points of the moving object based on the vehicle sensor data; and
determining the barrier function further based on the determined state of each of the identified plurality of points.
18. The method of claim 17 , further comprising determining a second virtual boundary for the identified object based on the plurality of points on the identified object.
19. The method of claim 18 , further comprising determining the second virtual boundary based on data, received from a vehicle sensor or a remote computer, identifying a type of the identified object.