Done path finding

Done path fidning