Co-optimization of velocity planning and energy management for autonomous plug-in hybrid electric vehicles in urban driving scenarios