have got the fast tracking fully implemented and running with color observations, starting to fully implement the EKF function