Code for a NXT robot to follow a line / park using color and light sensors