I am trying to make an algorithm that will show the shortest path between 2 given points (S for start and D for destination) in a 2D array with obstacles (represented by *).