Added antenna sensor, bug fixes

* added antenna sensor, piggybacks on GPS interrupt, b/c all the timers
are used.
* added GPS debugging cond. var
* bug fixes w/ ultra code
* moved all print statements to one function