Integrated probabilistic approach to environmental perception with self-diagnosis capability for advanced driver assistance systems.