Add missing includes
Adjust paths and costs in Pathfinder.