Added Initial stall detection code

Check if the IR sensors have not changed in a while. If so back off the
wall.