Comment the code in robot_control program