Hey you had some issue when the size of the region is not square

[AdiGaash]

I think it was a mix of variables at grid3D[i, k, j] = new Node(this, notObstacle, worldPoint,i,j,k, movementPenalty);

Will provide fork later on with my project