Update RobotMainTask.cpp