Model predictive control for comfort optimization in assisted and driverless vehicles