Real-time constrained trajectory planning and vehicle control for proactive autonomous driving with road users