Implemented path finding based on cell graph