Fixed bug in A*. Still not working though.
Small cleanup, moved pathfinding to Position. Isolated the error.