- moved GPS reading to 100Hz loop
- fixed RSSI calibration in GPS mode
- added debug messages