VEHICULAR NAVIGATION AND POSITIONING SYSTEM

• US 20100019963A1
• Filed: 06/15/2006
• Published: 01/28/2010
• Est. Priority Date: 06/15/2006
• Status: Abandoned Application

• Current Assignee: Toyota Jidosha Kabushiki Kaisha (Toyota Motor Corporation), UTI Limited Partnership
• Original Assignee: Toyota Jidosha Kabushiki Kaisha (Toyota Motor Corporation), UTI Limited Partnership
• Inventors: Maeda, Iwao, Cannon, Elizabeth, Petovello, Mark, Gao, Jianchen, Kagawa, Kazunori, Nagamiya, Kiyomi
• Application Number:
  US12/304,934
• Publication Number:
  US 20100019963A1
• Time in Patent Office: Days
• US Class Current: 342/357.310
• CPC Class Codes: B60W 2050/0013 Optimal controllers
• CPC Class Codes: B60W 2050/0033 Single-track, 2D vehicle model, i.e. two-wheel bicycle model
• CPC Class Codes: G01S 19/38 Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
• CPC Class Codes: G01S 5/0027 of actual mobile position, i.e. position determined on mobile

Abstract

A vehicular navigation and positioning method and system includes a GNSS receiver, an inertial navigation system and on-board vehicular sensors. Available data is integrated by a Kalman filter and vehicle position, velocity and attitude is updated as a result.

Claims

1. A method of estimating one or more of the velocity, position, or attitude of a vehicle equipped with a GNSS receiver, an inertial navigation system (INS), a vehicle sensor comprising a steering angle sensor and optionally a wheel speed sensor, a yaw rate sensor, and/or at least two G sensors, comprising the steps of:

(a) setting one or more of an initial velocity, position or attitude;

(b) periodically obtaining INS data, vehicle sensor data, and if GNSS data is available, GNSS data from the GNSS receiver;

(c) in a recursive estimation filter, integrating all available data and estimating one or more error states including one or more of position error, velocity error, attitude error, IMU sensor error, vehicle sensor error and GNSS ambiguity; and

(d) updating one or more of the vehicle position, velocity or attitude.

2. The method of claim 1 wherein each of vehicle position, velocity and attitude is set in step (a) and updated in step (d).

3. The method of claim 1 wherein the recursive estimation filter is a Kalman filter.

4. The method of claim 3 wherein the Kalman filter is a centralized master Kalman filter.

5. The method of claim 1 wherein the GNSS receiver is a GPS receiver.

6. The method of claim 1 wherein the recursive estimation filter comprises two or more federated Kalman filters.

7. The method of claim 1 wherein the integration step comprises the step of integrating steering angle data which provides the tire angle relative to its neutral position, and one or more of the group comprising:

(a) integrating velocity data derived from the at least one wheel speed sensor;

(b) integrating azimuth angle data derived from the yaw rate sensor;

(c) integrating position and velocity data derived from the at least two G sensors and the yaw rate sensor.

8. The method of claim 1 further comprising the step of detecting and alleviating violation of non-holonomic constraints if sideslip is detected.

9. A system for estimating the velocity, position, or attitude of a vehicle equipped with a GNSS receiver, an inertial navigation system (INS), a vehicle sensor comprising a steering angle sensor and optionally a wheel speed sensor, a yaw rate sensor, at least two G sensors, comprising:

(a) means for setting one or more of an initial velocity, position or attitude;

(b) means for periodically obtaining INS data, vehicle sensor data, and if GNSS data is available, GNSS data from the GNSS receiver;

(c) a recursive estimation filter for integrating all available data and estimating one or more error states including one or more of position error, velocity error, attitude error, IMU sensor error, vehicle sensor error and GNSS ambiguity; and

(d) means for updating one or more of the vehicle position, velocity or attitude.

10. The system of claim 9 wherein the GNSS receiver is a GPS receiver.

11. The system of claim 9 wherein the recursive estimation filter comprises a module for integrating steering angle data which provides the tire angle relative to its neutral position, and one or more of the group comprising:

(a) a module for integrating velocity data derived from the at least one wheel speed sensor;

(b) a module for integrating azimuth angle data derived from the yaw rate sensor; and

(c) a module for integrating position and velocity data derived from the at least two G sensors and the yaw rate sensor.

12. The system of claim 9 further comprising means for detecting sideslip and means for detecting and alleviating violation of non-holonomic constraints.