Refactors the AStar code to not be retarded.  Works just like it used to.
Fixes a small derp.