Simple path finding implemented