Kalman Filter based signal filtering

May 2020 - December 2020

Filtering signal for robust control of flying microrobot (full report)


Overview

Flying microrobots function at very high frequency. There is high frequency noise in their signals, which need to be filtered out. Without filtering them out, the control of robot is very unstable. The most simple way to achieve this is using a low pass filter. However that introduces delay which again introduces instability.

Bee+ developed at USC AMSL

The other idea is to use filters such as LMS or RLS, however they depend on input signal to filter correctly and that was not available. There a Kalman Filter approach was used, where 2 Kalman Filter approaches gave good results.

Results

The graph below shows the results from the Linear Kalman Filter. The blue line is the measured signal, the red is the kalman filtered signal and the yellow is the offline filtered signal which represents the true signal. The linear filter is good approximation however for angular velocities do not line up exactly.

Bee+ developed at USC AMSL

The results from the extended Kalman Filter show far better results, except for the yaw angle angular velocity, there is some initial non-minimum phase response.

EKF results

Link for report

For more information on the equations and design involved, check out the full report. This report is the property of the Autonomous Microrobotic Systems Lab at USC.