Firmware rewrite

[oswinso]

For a while now our firmware code has been very poorly written and pretty much neglected. We need much better lower level controls, and to do that we need better firmware and communications between the mbed and the computer.