×

Vehicle positioning method and system thereof

  • US 6,167,347 A
  • Filed: 02/08/1999
  • Issued: 12/26/2000
  • Est. Priority Date: 11/04/1998
  • Status: Expired due to Term
First Claim
Patent Images

1. An improved vehicle positioning system, comprising:

  • a global positioning system (GPS) processor for providing GPS measurements including pseudorange, carrier phase, and Doppler shift;

    an inertial measurement unit (IMU) for providing inertial measurements including body angular rates and specific forces;

    a central navigation processor, which are connected with said GPS processor and said IMU, comprising an inertial navigation system (INS) processor, a Kalman filter, a and a carrier phase integer ambiguity resolution module; and

    an input/output (I/O) interface connected to said central navigation processor;

    wherein said GPS measurements are passed to said central navigation processor and said inertial measurements are injected into said inertial navigation system (INS) processor;

    wherein an output of said INS processor and said GPS measurements are blended in said Kalman filter;

    an output of said Kalman filter is fed back to said INS processor to correct an INS navigation solution outputting from said central navigation processor to said I/O interface;

    wherein said INS processor provides velocity and acceleration data injecting into a micro-processor of said GPS processor to aid code and carrier phase tracking of GPS satellite signals;

    wherein an output of said micro-processor of said GPS processor, an output of said INS processor and an output of said Kalman filter are injected into said carrier phase integer ambiguity resolution module to fix global positioning system satellite signal carrier phase integer ambiguity number;

    wherein said carrier phase integer ambiguity resolution module outputs carrier phase integer number into said Kalman filter to further improve positioning accuracy and said INS processor outputs navigation data to said I/O interface;

    wherein said microprocessor of said GPS processor outputs pseudorange, Doppler shifts, global positioning system satellite ephemeris, and atmosphere parameters to said Kalman filter;

    wherein said INS processor processes said inertial measurements, which are body angular rates and specific forces, and said position error, velocity error, and attitude error coming from said Kalman filter to derive said corrected navigation solution;

    wherein said INS processor comprises an IMU I/O interface, an IMU error compensation module, a coordinate transformation computation module, an attitude position velocity computation module, a transformation matrix computation module, and an earth and vehicle rate computation module, wherein said IMU I/O interface collects said signal of said body angular rates and specific forces from said IMU for processing and converting to digital data which are corrupted by said inertial sensor measurement errors to form contaminated data that are passed to said IMU error compensation module, wherein said IMU error compensation module receives sensor error estimates derived from said Kalman filter to perform IMU error mitigation on said IMU data, said corrected inertial data being sent to said coordinate transformation computation module and said transformation matrix computation module, where said body angular rates are sent to said transformation matrix computation module and said specific forces are sent said coordinate transformation computation module, wherein said transformation matrix computation module receives said body angular rates from said IMU error computation module and an earth and vehicle rate from said earth and vehicle rate computation module to perform transformation matrix computation, said transformation matrix computation module sending said transformation matrix to said coordinate transformation computation module and attitude position velocity computation module, an attitude update algorithm in said transformation matrix computation module using a quaternion method wherein said coordinate transformation module collects said specific forces from said IMU error computation module and said transformation matrix from said transformation matrix computation module to perform said coordinate transformation, said coordinate transformation computation sending said specific forces transferred into said coordinate system presented by said transformation matrix to said attitude position velocity computation module, wherein said attitude position velocity computation module receives said transformed specific forces from said coordinate transformation computation module and said transformation matrix from said transformation matrix computation module to perform said attitude, position, velocity update.

View all claims
  • 1 Assignment
Timeline View
Assignment View
    ×
    ×