GPS: waypoints now are saved as Radians
Fixed typo in GPS.c
Merge branch 'master' of https://github.com/jcronq/Final-Project-v1.0 into I2C_test