Multi-Vehicle Scenario-Based Trajectory Optimisation For Automated Driving