Integrating Perception and Planning for Autonomous Navigation of Urban Vehicles