Fixed pathfinding, solved colision(basic)