Continuing the programming

Finished GPS thread callback.
Removed code that caused a crash in PESO_GPS.cpp