Improve finding next instruction via including heading and last coordinate

[karussell]

We can improve GeoMethods.ts especially for multiple via points or "loop" cases like this.

[karussell]

This is done in #279.