Update findpath.cpp