Testing and cleaning up.  Problems with AStar pathing