Kalman filter now uses GPS
Merge branch 'master' of https://github.com/clubcapra/capra_2dnav