More Pathfinding code

Im still working on pathfinding, no changes anyone would notice, but
wanted to commit before joel and wes make any major changes. Also ignore
the test levels, they are just for debug for me