Added the basic BFL implementation for an EKF for IMU type data in 12DoF