Update RobotCommand.cpp