Added state machine

Added state machine like behaviour.
Only prints data on serial port once per GPS update. Done to open up
time to turn on different LEDs for persistance of vision and indication
of GPS status