Problem with stopping a servo with Sensor Value