Multi-Vehicle Scenario-Based Trajectory Optimisation for Automated Driving