Problems with routing in EgoAgent

1. EgoAgent::UpdatePositionInGraph() returns wrong result if a road is skipped by an agent (i.e. because the road length is shorter than the traveled distance in one timestep)
2. In EgoAgent::GetLaneDirection() there is a copy/paste issue (calling GetLaneWidth())