Added basic robot control (IOIO commands will follow)