GridNode3d.cs

public class GridNode3d {
  public Vector3 gridCoordinates;
  
  string gridName;
  public Type type;
  
  public GridNode3d parent;
  public int F, G, H;
  
  public enum Type {
    BLANK,
    START,
    END,
    BLOCK
  }
  
  /** INITIALISING */
  
  void initialise() {
    this.gridCoordinates = new Vector3();
    this.gridName = "n/a";
    this.type = Type.BLANK;
    
    this.parent = null;
    this.F = this.G = this.H = 0;
  }
  
  /** CREATING AND SETTING */
  
  public GridNode(string gridName, Vector3 gridCoordinates) {
    this.initialise();
    this.setUp(gridName, gridCoordinates);
  }
  
  void setUp(string gridName, Vector3 gridCoordinates) {
    this.gridName = gridName;
    this.gridCoordinates.x = gridCoordinates.x;
    this.gridCoordinates.y = gridCoordinates.y;
    this.gridCoordinates.z = gridCoordinates.z;
  }
  
  /** PATHFINDING */
  
  public void calculateValues(GridNode parentNode, GridNode endNode) {
    this.parent = parentNode;
    
    double xDistance = Mathf.Abs(this.gridCoordinates.x - this.parent.gridCoordinates.x);
    double yDistance = Mathf.Abs(this.gridCoordinates.y - this.parent.gridCoordinates.y);
    double zDistance = Mathf.Abs(this.gridCoordinates.z - this.parent.gridCoordinates.z);
    
    double xEndDistance = Math.abs(this.gridCoordinates.x - endNode.gridCoordinates.x);
    double yEndDistance = Math.abs(this.gridCoordinates.y - endNode.gridCoordinates.y);
    double zEndDistance = Math.abs(this.gridCoordinates.z - endNode.gridCoordinates.z);
    
    if (this.parent != null) {
      if (xDistance != 0 && yDistance != 0 && zDistance != 0) {
        this.G = this.parent.G + 17;
      } else if (
          (xDistance != 0 && yDistance != 0) ||
          (xDistance != 0 && zDistance != 0) ||
          (yDistance != 0 && zDistance != 0)
        ) {
        this.G = this.parent.G + 14;  
      } else {
        this.G = this.parent.G + 10;
      } 
    }
    
    this.H = (int)xEndDistance + (int)yEndDistance + (int)zEndDistance;
    this.F = this.G = this.H;
  }
  
  /** DISPOSING / RESETTING */
  
  public void reset() {
    this.F = this.G = this.H = 0;
    this.parent = null;
  }
}