Automated Driving Functionality for Intersection Crossing