Comprehensive sensor fusion algorithm
First Claim
1. A signal processor based on a comprehensive sensor fusion algorithm, comprising:
- a Factored Quaternion Algorithm (FQA) processor, coupled to at least one accelerometer and at least one magnetometer, the FQA processor combining one or more acceleration rates and one or more magnetic field magnitudes to generate an FQA output;
a gyro-processor, coupled to at least one gyroscope, the gyro-processor generating a gyro output based on one or more rotation rates; and
a complementary filter, coupled to the FQA processor and the gyro-processor, the complementary filter combining the FQA and gyro outputs and generating a motion control signal, the complementary filter having a characteristic frequency and different scale factors that depend on the characteristic frequency and apply different weights based on the different scale factors to the FQA output and the gyro output, wherein the characteristic frequency and the scale factors of the complementary filter being dynamically adjusted based on the magnitude of at least one of the plurality of acceleration rates.
3 Assignments
0 Petitions
Accused Products
Abstract
The present invention relates to a signal processor, and more particularly, to systems, devices and methods of using a comprehensive sensor fusion algorithm to integrate sensor data collected by accelerometers, gyroscopes and magnetometers. The signal processor dynamically applies a Complementary Filter to merge a rotation based gyro output and a FQA output that is obtained by combining acceleration rates and magnetic field magnitudes. Therefore, motion information is derived to generate a motion control signal. Such a comprehensive sensor fusion algorithm significantly reduces the complexity of computation, and the power and area overhead is controlled. As a result, the signal processor may be implemented based on local computation capability of a sensor system, and its integration within such a sensor system is made possible without relying on an external microprocessor.
-
Citations
15 Claims
-
1. A signal processor based on a comprehensive sensor fusion algorithm, comprising:
-
a Factored Quaternion Algorithm (FQA) processor, coupled to at least one accelerometer and at least one magnetometer, the FQA processor combining one or more acceleration rates and one or more magnetic field magnitudes to generate an FQA output; a gyro-processor, coupled to at least one gyroscope, the gyro-processor generating a gyro output based on one or more rotation rates; and a complementary filter, coupled to the FQA processor and the gyro-processor, the complementary filter combining the FQA and gyro outputs and generating a motion control signal, the complementary filter having a characteristic frequency and different scale factors that depend on the characteristic frequency and apply different weights based on the different scale factors to the FQA output and the gyro output, wherein the characteristic frequency and the scale factors of the complementary filter being dynamically adjusted based on the magnitude of at least one of the plurality of acceleration rates. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8)
-
-
9. A method for integrating sensor data, comprising the steps of:
-
receiving at least one acceleration rate, at least one magnetic field magnitude and at least one rotation rate; using the at least one acceleration rate and magnetic field magnitude to generate a first quaternion based on a Factored Quaternion Algorithm (FQA); generating a gyro output that is based on the at least one rotation rate to generate a second quaternion; and processing the first and second quaternions and the gyro output by a complementary filter to generate a motion control signal, the complementary filter compensating a drift of the at least one rotation rate, the complementary filter having a characteristic frequency and different scale factors that depend on the characteristic frequency and apply different weights based on the different scale factors to the FQA output and the gyro output, wherein the characteristic frequency and the scale factors of the complementary filter being dynamically adjusted based on the magnitude of at least one of the plurality of acceleration rates. - View Dependent Claims (10, 11, 12, 13, 14, 15)
-
Specification