pathfinder: Change to C++ file
pathfinder: Use STL implementation of list and heap
pathfinder: Use C++ style casts
Merge branch 'pathfinder-c++'

Convert pathfinder to C++.