Fixed a_star, now actually works
a_star now shows shortest path upon finding destination