Apparatus and method for measuring the accurate position of moving objects in an indoor environment
First Claim
Patent Images
1. An apparatus for providing accurate position of a moving object in an indoor environment, comprising:
- a Reference Positioning System (RPS);
an Inertial Measurement Unit (IMU) installed on said moving object;
a Coordinate Transformer (COT) coupled to the outputs of said IMU; and
a Location Position Estimator (LPE) coupled to the outputs of said RPS and said COT, wherein said LPE comprises, for each dimension of the position coordinates;
a forward Kalman Filter having one input coupled to the output from the RPS for receiving the reference position signal and a second input coupled to the output from said COT for obtaining the rotated accelerometer measurements;
a recording unit having one input coupled to the output from the RPS and a second unit coupled to the output from said COT;
a motion and reference detector having one input coupled to the output from the RPS and a second input coupled to the output from said COT;
a backward Kalman Filter having its inputs connected to the outputs of said recording unit;
a smoothing unit having one input coupled to an output of said forward Kalman Filter and a second input connected to the output of said backward Kalman Filter; and
a control unit coupled to the output of said motion and reference detector, said control unit controlling the operation of said forward Kalman Filter, said backward Kalman Filter, and said smoothing unit.
20 Assignments
0 Petitions
Accused Products
Abstract
An apparatus and method is disclosed for efficiently sensing and tracking objects in an indoor environment by simultaneously measuring the object movement with an inertial navigation system and a reference location positioning system. By combining the measurements obtained with accelerometers, gyroscopes, angle estimators and the reference system using an extended Kalman filter based approach, a position estimate is obtained with high reliability and precision accuracy. Improvement in performance is obtained by the incorporation of dynamic mode switching and forward-backward smoothing in the location position estimator.
71 Citations
11 Claims
-
1. An apparatus for providing accurate position of a moving object in an indoor environment, comprising:
-
a Reference Positioning System (RPS); an Inertial Measurement Unit (IMU) installed on said moving object; a Coordinate Transformer (COT) coupled to the outputs of said IMU; and a Location Position Estimator (LPE) coupled to the outputs of said RPS and said COT, wherein said LPE comprises, for each dimension of the position coordinates; a forward Kalman Filter having one input coupled to the output from the RPS for receiving the reference position signal and a second input coupled to the output from said COT for obtaining the rotated accelerometer measurements; a recording unit having one input coupled to the output from the RPS and a second unit coupled to the output from said COT; a motion and reference detector having one input coupled to the output from the RPS and a second input coupled to the output from said COT; a backward Kalman Filter having its inputs connected to the outputs of said recording unit; a smoothing unit having one input coupled to an output of said forward Kalman Filter and a second input connected to the output of said backward Kalman Filter; and a control unit coupled to the output of said motion and reference detector, said control unit controlling the operation of said forward Kalman Filter, said backward Kalman Filter, and said smoothing unit. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8)
-
-
9. A method for accurately determining the position of a moving object in an indoor environment using a combination of an Inertial Measurement Unit (IMU) and a Reference Positioning System (RPS), comprising the steps of:
-
obtaining reference position data from said RPS; obtaining additional data on the moving object from said IMU; and estimating the position of the moving object from the data obtained from the RPS and the IMU, wherein the position estimation is performed by the steps of; detecting first event “
object motion status”
based on said rotated accelerometer measurements, and detecting second event “
presence or absence of said reference position signal”
;switching between modes of operation depending on said first event and said second event according to; if object is in motion and said reference position signal is present, then said forward Kalman Filter provides estimates for position, acceleration, and velocity of object, and an estimate for accelerometer bias based on said rotated accelerometer measurements and said reference position signal; if object is in motion and said reference position signal is absent, then said forward Kalman Filter is reconfigured to reflect absence of reference position measurements in the filter and to freeze the estimate of accelerometer bias to the present value, and then provide estimates for determining position, acceleration, and velocity of object; if object is in motion, then said rotated acceleration measurements, said reference positioning signal, and said first and second events are recorded for performing forward-backward smoothing at the next stop of the object; if object is stationary, then the acceleration and velocity estimates in said forward Kalman Filter are set to zero, and said forward Kalman Filter is reconfigured to reflect the stationary object status in the filter; and
said forward Kalman Filter, said backward Kalman Filter, and said smoothing unit provide smoothed position estimates by performing forward-backward smoothing based on said recorded rotated acceleration measurements and reference position signal. - View Dependent Claims (10, 11)
-
Specification