Finally! A* up and running in a very basic form. No collision in the
pathing yet, but now it works at least.