Added TestApp, updated PathFinding sample