Added StateEstimator.h code that implements UAV Kalman filter.