added a function to GPSPosition so we can get the distance between two points, added comments to the IMU that alert us to now internal only used methods.
Merge branch 'master' of https://github.com/josephlewis42/autopilot