Updated TestApp and PathFinding demo