Automated Driving System with Guaranteed Safety based on Generic Environment Representation and Model Predictive Control