Added 10 second heartbeat signal

Moved REMOVE_BEFORE_FLIGHT check to after imu.update and gps.update in
order to give the heartbeat a delay from those updates instead of
putting in a delay() call. Hopefully it is enough to trigger the XBee
signal. Should be fine.
Beginning to add command link code
Command link code is in