Added shortest path functionality

Added shortest path functionality. Doesn't work for cyclic routes.