sensor based path planning