fixed #110

Added support for next instruction #110.
The new code calculates the distance from a point to every edge of the routing path and return the next instruction.