Graph searching done... with a couple bugs

openSet.Sort() doesn't work, a custom solution will be needed.
Git hub's being a bitch again.