One paper accepted to IEEE Trans. on Intelligent Transportation Systems.