Started work on some gps math tests
gps range testing code
Slim down function defs, remove some comments