Real-time trajectory planning for autonomous urban driving: framework, algorithms and verifications