[Issue 110] Added support for next instruction

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.