Finished CompassDemo

Writes compass heading to serial port and transmits over radio