Journal: IEEE Trans. Intelligent Vehicles