Device and method for determination of angular position in three-dimensional space, and corresponding electronic apparatus

Abstract

An electronic device determines an estimate of angular position based on an accelerometric signal supplied by an accelerometric sensor and as a function of at least one of a gyroscopic signal from a gyroscopic sensor and a magnetic signal from a magnetic-field sensor. A processing module implements a complementary filter, which is provided with a first processing block, a second processing block, and a combination block. The first processing block receives the acceleration signal and an input signal indicative of the magnetic signal and generates a geomagnetic quaternion. The second processing block receives a signal indicative of the gyroscopic signal (gyro) and generates a gyroscopic quaternion. The combination block determines the estimate ({circumflex over (q)}) of angular position by complementarily combining the geomagnetic quaternion and the gyroscopic quaternion based on a combination factor that has a dynamic value and an adaptive value and that varies as a function of the operating conditions.