Added drive till obstacle