SHORTEST_PATH: some fixes done, but still not working correctly

- currently calcPath finds some path to POI and following it
  works. The path is often incorrect. There are probably some
  errors in the vertice connections.