Small bugfix
Changed the high level controller behavior to allow reaching closer to walls. core_sensors_ir now does a median filtering of the signal, but that needs to be tuned.