public void setPositions(SortedList p)
{
positions.Clear();
foreach (PedestrianPosition ped in p.Values) {
positions.AddLast(ped);
}
PedestrianPosition pos = (PedestrianPosition)p.GetByIndex (0);
transform.position = new Vector3 (pos.getX(), 0, pos.getY());
}