computeRoute

Computes a route from currentPos to finalPos.