Spatially Formulated Connected Automated Vehicle Trajectory Optimization with Infrastructure Assistance