Add some debugging stuff and some hacks to make gps time useful.
Adding killswitch and initialization debug.
Merge remote-tracking branch 'upstream/master'