More work on new path finder

Replaced old pathfinder by new everywhere
New one now uses in place list which makes it much faster
Some more minor thingies