Tracking, auto-calibration, and map-building system
View Patent ↗A navigation or motion tracking system includes components associated with particular sensors, which are decoupled from a tracking component that takes advantage of information in the sensor measurements. The architecture of this system enables development of sensor-specific components independently of the tracking component, and enables sensors and their associated components to be added or removed without having to re-implement the tracking component. In a software implementation of the system, sensor-specific software components may be dynamically incorporated into the system and the tracking component is then automatically configured to take advantage of measurements from the corresponding sensors without having to modify the tracking component.
1. A tracking system comprising:
an estimation subsystem; and
a sensor subsystem coupled to the estimation subsystem and configured to provide configuration data to the estimation subsystem and to provide measurement information to the estimation subsystem for localizing an object;
wherein the estimation subsystem is configured to update a location estimate for the object based on configuration data and measurement information accepted from the sensor subsystem.
2. The system of claim 1 wherein the sensor subsystem includes one or more sensor modules, each providing an interface for interacting with a corresponding set of one or more sensing elements.
3. The system of claim 2 wherein the interface enables the sensor module to perform computations independently of an implementation of the estimation subsystem.
4. The system of claim 2 wherein the interface enables the estimation subsystem to perform computations independently of an implementation of the sensor modules.
5. The system of claim 1 further comprising a navigation subsystem to navigate the object in an environment based on the location estimate for the object.
6. A method comprising:
enumerating sensing elements available to a tracking system that includes an estimation subsystem that estimates a position or orientation of an object; and
providing parameters specific to the enumerated sensing elements to the tracking system to enable the estimation subsystem to be configured based on the parameters specific to the enumerated sensing elements to enable the estimation subsystem to estimate the position or orientation of the object.
7. The method of claim 6 , further comprising selecting a pair of sensing elements from a sequence of candidates of pairs of sensing elements, the selected pair of sensing elements being ready to make a measurement at the time of selection of the pair or at a predefined time after the time of selection of the pair, the selected pair having a highest expected utility of a measurement among the sequence of candidates.
8. The method of claim 6 wherein the set of sensing elements comprises at least one sensor and at least one target, the sensor making a measurement with respect to the target.
9. The method of claim 8 wherein the target comprises a natural feature in an environment.