Trajectory Control of Connected Autonomous Vehicles at Roundabouts- Part 1: Trajectory Optimization