Removing unused code, GPS Fix repaired

Commented out unused code, fixed a significant bug in the GPS fix