Fixed route finding function and added departure times