RoadGraph - Graph based environmental modelling and function independent situation analysis for driver assistance systems.