[waypoints] start fixing waypoint accuracy issue (#762)

- all transformation are done in double on ground
- 7 digits in degrees for Ivy messages and GCS display
[math] add some geodetic functions in double precision