Occupancy Grid Based Reactive Planner