Software debugging complete

The code compiles without bugs. Code has been optimised for file size
and RAM usage.

Radio and Telemetry code yet to be written.