EKF project for Navigation System Class