Basic (broken) state machine code.
Stub debugging module.
Updated drone.launch config.
Slight tidy up + updated CMakeLists.txt
Controller outline.