Worked on path finding algo