Added autonomous commands to Robot.cpp