Vehicle path processing
A system, comprising a computer that includes a processor and a memory, the memory storing instructions executable by the processor to estimate path coefficients based on a difference between a vehicle location and a vehicle path. Estimating the path coefficients can include minimizing the difference while controlling path coefficient gain to maintain occupant comfort and safety. A vehicle can be operated based on the estimated path coefficients.
1. A method, comprising:
estimating path coefficients of a third-degree polynomial equation based on a lateral distance between the vehicle and the vehicle path, a vehicle steering path heading angle, a steering path curvature, and a steering path curvature rate of change, including minimizing the difference while controlling path coefficient gain to maintain occupant comfort and safety;
determining the estimated path coefficients iteratively using a recursive least squares estimation technique; and
operating a vehicle based on the estimated path coefficients.
2. The method of claim 1 , further comprising controlling the path coefficient gain by limiting values of elements of a four-by-four diagonal gain matrix.
3. The method of claim 2 , further comprising replacing the four-by-four diagonal gain matrix with ordinary differential equations based on a time series in each of the elements of the four-by-four diagonal gain matrix.
4. The method of claim 3 , further comprising solving the ordinary differential equations iteratively as a time series using a least squares error term to determine a new gain matrix that minimizes a prediction error at each time step.
5. The method of claim 1 , further comprising operating the vehicle by inputting path coefficients into a steering controller.
6. The method of claim 5 , further comprising determining instructions to direct vehicle steering components based on the path coefficients.
7. The method of claim 1 , further comprising determining vehicle location based on vehicle sensor data including global positioning system (GPS) sensor data and inertial navigation system (INS) sensor data.
8. The method of claim 1 , further comprising determining the vehicle path based on uploading path information from a plurality of vehicles to a server computer.
9. The method of claim 8 , further comprising downloading the vehicle path based on the vehicle location.
10. A system, comprising a processor; and
a memory, the memory including instructions to be executed by the processor to:
estimate path coefficients of a third-degree polynomial equation based on a lateral distance between the vehicle and the vehicle path, a vehicle steering path heading angle, a steering path curvature, and a steering path curvature rate of change, including minimizing the difference while controlling path coefficient gain to maintain occupant comfort and safety;
determine the estimated path coefficients iteratively using a recursive least squares estimation technique; and
operating a vehicle based on the estimated path coefficients.
11. The system of claim 10 , further comprising replacing the four-by-four diagonal gain matrix with ordinary differential equations based on a time series in each of the elements of the four-by-four diagonal gain matrix.
12. The system of claim 11 , further comprising solving the ordinary differential equations iteratively as a time series using a least squares error term to determine a new gain matrix that minimizes a prediction error at each time step.
13. The system of claim 10 , further comprising controlling the path coefficient gain by limiting values of elements of a four-by-four diagonal gain matrix.
14. The system of claim 10 , further comprising operating the vehicle by inputting path coefficients into a steering controller.
15. The system of claim 14 , further comprising determining instructions to direct vehicle steering components based on the path coefficients.
16. The system of claim 10 , further comprising determining the vehicle location based on vehicle sensor data including global positioning system (GPS) sensor data and inertial navigation system (INS) sensor data.
17. The system of claim 10 , further comprising determining the vehicle path based on uploading path information from a plurality of vehicles to a server computer.
18. The system of claim 17 , further comprising downloading the vehicle path based on the vehicle location.
19. A system, comprising:
means for controlling vehicle steering, braking and powertrain; and
means for:
estimating path coefficients of a third-degree polynomial equation based on a lateral distance between the vehicle and the vehicle path, a vehicle steering path heading angle, a steering path curvature, and a steering path curvature rate of change, including minimizing the difference while controlling path coefficient gain to maintain occupant comfort and safety;
determining the estimated path coefficients iteratively using a recursive least squares estimation technique; and
operating a vehicle based on the estimated path coefficients and the means for controlling vehicle steering, braking and powertrain.
20. The system of claim 19 , further comprising replacing the four-by-four diagonal gain matrix with ordinary differential equations based on a time series in each of the elements of the four-by-four diagonal gain matrix.