Added some code for building UART packets, also organized things.

Sensor initialization/reading code now goes in the Sensors.c file

builds, but has not been tested