Environmental Perception for Automated Vehicles: Localization, Mapping and Tracking