Trajectory Planning And Following In Urban Environments