CPC G01C 21/16 (2013.01) | 21 Claims |
1. A sensor data fusion system comprising:
a first accelerometer having low noise and high bias;
a second accelerometer having high noise and low bias;
a first subtracter connected to receive a signal from the first accelerometer and a signal from the second accelerometer and configured to output a first difference signal representing a difference between the signals from the first and second accelerometers;
a first filter connected to receive the first difference signal from the first subtracter and configured to output a signal representing an estimated relative bias of the first and second accelerometers;
a second subtracter connected to receive the signal from the first accelerometer and the signal from the first filter and configured to output a second difference signal representing a difference between the signals from the first accelerometer and the first filter;
a third accelerometer having low noise and high bias;
a third subtracter connected to receive signals from the second and third accelerometers and configured to output a third difference signal representing a difference between the signals from the second and third accelerometers;
a second filter connected to receive the third difference signal output by the third subtracter and configured to output a signal representing an estimated relative bias of the second and third accelerometers; and
a fourth subtracter connected to receive the signal from the third accelerometer and the signal from the second filter and configured to output a fourth difference signal representing a difference between the signals from the third accelerometer and second filter.
|