CPC B60W 40/10 (2013.01) [G01C 21/3461 (2013.01); B60W 2552/15 (2020.02); B60W 2552/30 (2020.02); B60W 2552/53 (2020.02)] | 20 Claims |
1. A system in a vehicle traveling on a roadway, the system comprising a computing device including a processor and a memory, the memory including instructions such that the processor is configured to:
transform vehicle dynamics data, received from one or more sensors mounted on the vehicle, to corresponding roadway geometry data;
calculate a rationalization value based on a difference between the roadway geometry data and map-based roadway geometry data, wherein the rationalization value is calculated according to:
eρ=ρmap−ρV,
eθ=θmap−θV,
eØ=Ømap−ØV,
where eρ comprises a curvature estimation error, eθ comprises a bank angle estimation error, eØ represents a grade angle estimation error, ρmap comprises a map-based curvature estimation, θmap comprises a map-based bank angle estimation, Ømap comprises a map-based grade angle estimation, ρV comprises a vehicle curvature estimation, θV comprises a vehicle bank angle estimation, and ØV comprises a vehicle grade angle estimation;
determine whether to modify a vehicle state based on the rationalization value; and
command a change in the vehicle state from an autonomous state to at least one of a semi-autonomous state or a non-autonomous state based on the rationalization value.
|