Update RobotUtil.java