Method of estimating location and orientation of magnetic dipoles using extended Kalman filtering and Schweppe likelihood ratio detection
First Claim
1. A method of determining the location and orientation of a magnet having one of a known set of orientations, comprising the steps of:
- providing a plurality of extended Kalman filters, each of said extended Kalman filters corresponding to an assumed one of the known set of possible magnet orientations;
measuring a magnetic field produced by the magnet;
providing sensor signals corresponding to said measured magnetic field to each of said plurality of extended Kalman filters;
each of said extended Kalman filters generating an estimate of the relative location of the magnet based on said assumed orientation and generating a likelihood that said assumed orientation corresponds to the orientation of the magnet;
determining the most likely one of said assumed orientations;
selecting the one of said Kalman filters corresponding to said most likely one of said assumed orientations; and
providing output signals corresponding to said most likely orientation and estimate of the relative location of the magnet generated by said selected Kalman filter.
9 Assignments
0 Petitions
Accused Products
Abstract
A method for real time processing of information received from a plurality of permanent magnets embedded in the pavement of an Intelligent Vehicle Highway System. A sequence of magnet orientations provides coded information to sensors mounted on automotive vehicles. The method uses a combination of extended Kalman filtering and Schweppe likelihood estimation to determine the relative location and orientation of the magnets. A separate location estimator (extended Kalman filter) is provided for each of the possible magnet orientations. A decision process identifies the most likely orientation of the magnet, and the Kalman filter selected by the process contains the best estimate of the location of the magnet. Schweppe likelihood estimation is extended to use the detector as a decoder of the information provided by the orientation sequence of the magnets. Failure of the decision process to arrive at a clearly defined decision (resulting, for example, from a missing or defective magnet) can be carried to a higher decoding level in which possible sequences of orientations and their relative likelihood can be used to select the most likely sequence.
37 Citations
10 Claims
-
1. A method of determining the location and orientation of a magnet having one of a known set of orientations, comprising the steps of:
-
providing a plurality of extended Kalman filters, each of said extended Kalman filters corresponding to an assumed one of the known set of possible magnet orientations; measuring a magnetic field produced by the magnet; providing sensor signals corresponding to said measured magnetic field to each of said plurality of extended Kalman filters; each of said extended Kalman filters generating an estimate of the relative location of the magnet based on said assumed orientation and generating a likelihood that said assumed orientation corresponds to the orientation of the magnet; determining the most likely one of said assumed orientations; selecting the one of said Kalman filters corresponding to said most likely one of said assumed orientations; and providing output signals corresponding to said most likely orientation and estimate of the relative location of the magnet generated by said selected Kalman filter. - View Dependent Claims (2, 3, 4)
-
-
5. A method of determining the location and orientation of a magnet having one of a known set of orientations, comprising the steps of:
-
providing a plurality of extended Kalman filters, each of said extended Kalman filters based on an assumed orientation corresponding to one of the known set of orientations of the magnet; making a sequence of measurements of a magnetic field produced by the magnet; providing sensor signals corresponding to said magnetic field measurements to each of said plurality of extended Kalman filters; each of said extended Kalman filters generating an estimate of the relative location of the magnet, generating measurement innovations sequences comprising differences between each of said measurements and a predicted value, and feeding back said innovations to correct said relative location estimate; computing relative likelihoods of each of said assumed orientations from said innovations sequences using Schweppe likelihood ratio detection; selecting the one of said extended Kalman filters corresponding to the most likely one of said assumed orientations; and providing output signals from said selected Kalman filter corresponding to said most likely orientation and relative location estimate of the magnet. - View Dependent Claims (6, 7)
-
-
8. A method of determining the location and orientation of a magnet embedded in a highway with one of a known set of orientations, comprising the steps of:
-
providing an automotive vehicle with a magnetic sensor; making a sequence of measurements of a magnetic field produced by the magnet as said vehicle passes over said magnet; providing a plurality of extended Kalman filters, each of said extended Kalman filters based on an assumed orientation corresponding to one of the known set of orientations of the magnet; providing signals corresponding to said magnetic field measurements from said sensor to each of said plurality of extended Kalman filters; each of said extended Kalman filters generating an estimate of the relative location of the magnet, generating measurement innovations sequences comprising differences between each of said measurements and a predicted value, and feeding back said innovations to correct said relative location estimate; computing relative likelihoods of each of said assumed orientations from said innovations sequences using Schweppe likelihood ratio detection; selecting the one of said extended Kalman filters corresponding to the most likely one of said assumed orientations; and providing output signals from said selected Kalman filter corresponding to said most likely orientation and relative location estimate of the magnet. - View Dependent Claims (9, 10)
-
Specification