Speed planning for urban scenes

This is a project for speed planning in urban scenes. The main problem is building a model to represent uncertatin during driving and giving a planner to solve the model.