Implemented bug nav to break out of U-shaped wall cases. Replaces random movement when we realize we are oscillating between places.