Added more commands and subsystems, started button work in OI and RobotM...

...ap