Team Cornell's Skynet: Robust perception and planning in an urban environment