Road curvature estimation system
US7522091B2 · kind B2 · utility
Assignee
Inventors
Key dates
| Filing date | Dec 24, 2004 |
| Grant date | Apr 21, 2009 |
| Priority date | — |
| Expiry date | Aug 18, 2026 |
Classification
- Technology area (CPC G)Physics
- CPC primaryG01S2013/93271
- WIPO fieldMeasurement
- WIPO sectorInstruments
Abstract
A processor using a first Kalman filter estimates a host vehicle state from speed and yaw rate, the latter of which may be from a yaw rate sensor if speed is greater than a threshold, and, if less, from a steer angle sensor and speed. Road curvature parameters are estimated from a curve fit of a host vehicle trajectory or from a second Kalman filter for which a state variable may be responsive to a plurality of host state variables. Kalman filters may incorporate adaptive sliding windows. Curvature of a most likely road type is estimated with an interacting multiple model (IMM) algorithm using models of different road types. A road curvature fusion subsystem provides for fusing road curvature estimates from a plurality of curvature estimators using either host vehicle state, a map database responsive to vehicle location, or measurements of a target vehicle with a radar system.
Source: USPTO / EPO open patent data. Objective bibliographic and citation counts.