Optimal Platoon Trajectory Planning Approach at Arterials