Fixed bug in IR Sensor Class

Filter was turned off.
Added corner stall detect

When stuck against a wall for more than 5 seconds, enter backoff state.