Fixed logical bug, only correct message...: GPS.c