Check the color in main loop of robot