Traffic signal control and vehicle trajectory planning