Added a C++ version of the compass kalman filter