Kalman Filter Realization for Orientation and Position Estimation on Dedicated Processor

This paper presents Kalman filter design which has been programmed and evaluated in dedicated STM32 platform. The main aim of the work performed was to achieve proper estimation of attitude and position signals which could be further used in unmanned aeri-al vehicle autopilots. Inertial measurement unit and GPS receiver have been used as measurement devices in order to achieve needed raw sensor data. Results of Kalman filter estimation were recorded for signals measurements and compared with raw data. Position actualization frequency was increased from 1 Hz which is characteristic to GPS receivers, to values close to 50 Hz. Furthermore it is shown how Kalman filter deals with GPS accuracy decreases and magnetometer measurement noise.