Added code for Radio controller

The main code is complete and compiles bug free. Just needs real world
testing/debugging.