Graph and AStar merged, and it looks like it works now!!! Huzzah
Made the world bigger, now going to add some obstacles and see what happens.
Some bugs worked out... but still having problems with blockages.