FALCO Sensor-Fusion Sensor fusion developement and testing code, and EKF is used to merge data from 6-axis IMU, magnetometer, barometer and GPS