added find_path_djisktra

not sure on a couple things, will discuss later today