Compare the actual position of the robot with the one computed. As we have an area where the robot can be we only choose one of this area to draw the position. We also retrieve the interval of solution for this area