System and method for enhancing non-inertial tracking system with inertial constraints
AssigneeRobert Bosch GmbH
InventorsBenzun Pious Wisely Babu, Mao Ye, Liu Ren
Life of this patent
Estimating the term…
Abstract
A system and method for generating a. tracking state for a device includes synchronizing measurement data from exteroceptive sensors and an inertial measurement unit (IMU). A processing unit is programmed to offset one of the measurement signals by a time offset that minimizes a total error between a change in rotation of the device predicted by the exteroceptive sensor data over a time interval defined by an exteroceptive sensor sampling rate and a change in rotation of the device predicted by the IMU sensor data over the time interval.
Claims20
A method for tracking position and orientation of a device comprising:
- by a controller,
- predicting a first tracking state of the device using measurements from an exteroceptive sensor (ES) sampled at a first rate;
- generating a second tracking state of the device using measurements from an inertial measurement unit (IMU) sampled at a second rate that is asynchronous to the first rate;
- synchronizing the first and second tracking states to a common time domain by estimating a time offset that minimizes an error between changes over time between the first and second tracking states such that a first time series associated with the first tracking state and a second time series associated with the second tracking state are aligned in time;
- aligning the first tracking state and the second tracking state to an inertial reference frame;
- and
- generating an inertial-aided tracking state by minimizing a cost function that includes a first residual term derived from propagating a previous state estimate using the second tracking state shifted by the time offset and a second residual term derived from the first tracking state.
A position and orientation tracking system for a device comprising:
- a controller, in communication with an exteroceptive sensor core that samples an exteroceptive sensor at a first rate and generates a first set of measurement data and an inertial measurement unit (IMU) that samples IMU sensors at a second rate asynchronous to the first rate and generates a second set of measurement data, programmed to track motion of the device according to a tracking state derived by synchronizing the first and second sets of measurement data to a common time domain, wherein the first and second sets of measurement data are synchronized by offsetting one of the sets by a time offset that minimizes a. total error between a change in orientation of the device predicted by the first set of measurement data over a time interval defined by the first rate and a change in orientation of the device predicted by the second set of measurement data over the time interval.
An apparatus for synchronizing measurement data from an inertial measurement unit (IMU) and an exteroceptive sensor (ES) without a common electrical measurement trigger signal therebetween comprising:
- a controller, in communication with an exteroceptive sensor core that is configured to sample an exteroceptive sensor at a first rate and an inertial measurement unit (IMU) that is configured to sample IMU sensors at a second rate asynchronous to the exteroceptive sensor, programmed to predict a first change in orientation based on a difference between most recent ES orientation data over a time interval defined by the first rate, predict a second change in orientation based on IMU orientation data over the time interval, and offset measurement data from the ES by a time offset that minimizes an error between the first change and the second change such that a first time series associated with the first change and a second time series associated with the second change are aligned in time.
Dependencies are inferred from the claim text.