Update fmpPathFinder.cpp

Fix some trivial errors + comments on A*