minecraft-src/net/minecraft/world/level/pathfinder/Node.java

package net.minecraft.world.level.pathfinder;

import net.minecraft.core.BlockPos;
import net.minecraft.network.FriendlyByteBuf;
import net.minecraft.util.Mth;
import net.minecraft.world.phys.Vec3;
import org.jetbrains.annotations.Nullable;

public class Node {
	public final int x;
	public final int y;
	public final int z;
	private final int hash;
	/**
	 * The index in the PathHeap. -1 if not assigned.
	 */
	public int heapIdx = -1;
	/**
	 * The total cost of all path points up to this one. Corresponds to the A* g-score.
	 */
	public float g;
	/**
	 * The estimated cost from this path point to the target. Corresponds to the A* h-score.
	 */
	public float h;
	/**
	 * The total cost of the path containing this path point. Used as sort criteria in PathHeap. Corresponds to the A* f-score.
	 */
	public float f;
	@Nullable
	public Node cameFrom;
	public boolean closed;
	public float walkedDistance;
	/**
	 * The additional cost of the path point. If negative, the path point will be sorted out by NodeProcessors.
	 */
	public float costMalus;
	public PathType type = PathType.BLOCKED;

	public Node(int x, int y, int z) {
		this.x = x;
		this.y = y;
		this.z = z;
		this.hash = createHash(x, y, z);
	}

	public Node cloneAndMove(int x, int y, int z) {
		Node node = new Node(x, y, z);
		node.heapIdx = this.heapIdx;
		node.g = this.g;
		node.h = this.h;
		node.f = this.f;
		node.cameFrom = this.cameFrom;
		node.closed = this.closed;
		node.walkedDistance = this.walkedDistance;
		node.costMalus = this.costMalus;
		node.type = this.type;
		return node;
	}

	public static int createHash(int x, int y, int z) {
		return y & 0xFF | (x & 32767) << 8 | (z & 32767) << 24 | (x < 0 ? Integer.MIN_VALUE : 0) | (z < 0 ? 32768 : 0);
	}

	/**
	 * Returns the linear distance to another path point
	 */
	public float distanceTo(Node point) {
		float f = point.x - this.x;
		float g = point.y - this.y;
		float h = point.z - this.z;
		return Mth.sqrt(f * f + g * g + h * h);
	}

	public float distanceToXZ(Node point) {
		float f = point.x - this.x;
		float g = point.z - this.z;
		return Mth.sqrt(f * f + g * g);
	}

	public float distanceTo(BlockPos pos) {
		float f = pos.getX() - this.x;
		float g = pos.getY() - this.y;
		float h = pos.getZ() - this.z;
		return Mth.sqrt(f * f + g * g + h * h);
	}

	/**
	 * Returns the squared distance to another path point
	 */
	public float distanceToSqr(Node point) {
		float f = point.x - this.x;
		float g = point.y - this.y;
		float h = point.z - this.z;
		return f * f + g * g + h * h;
	}

	public float distanceToSqr(BlockPos pos) {
		float f = pos.getX() - this.x;
		float g = pos.getY() - this.y;
		float h = pos.getZ() - this.z;
		return f * f + g * g + h * h;
	}

	public float distanceManhattan(Node point) {
		float f = Math.abs(point.x - this.x);
		float g = Math.abs(point.y - this.y);
		float h = Math.abs(point.z - this.z);
		return f + g + h;
	}

	public float distanceManhattan(BlockPos pos) {
		float f = Math.abs(pos.getX() - this.x);
		float g = Math.abs(pos.getY() - this.y);
		float h = Math.abs(pos.getZ() - this.z);
		return f + g + h;
	}

	public BlockPos asBlockPos() {
		return new BlockPos(this.x, this.y, this.z);
	}

	public Vec3 asVec3() {
		return new Vec3(this.x, this.y, this.z);
	}

	public boolean equals(Object object) {
		return !(object instanceof Node node) ? false : this.hash == node.hash && this.x == node.x && this.y == node.y && this.z == node.z;
	}

	public int hashCode() {
		return this.hash;
	}

	/**
	 * Returns {@code true} if this point has already been assigned to a path
	 */
	public boolean inOpenSet() {
		return this.heapIdx >= 0;
	}

	public String toString() {
		return "Node{x=" + this.x + ", y=" + this.y + ", z=" + this.z + "}";
	}

	public void writeToStream(FriendlyByteBuf buffer) {
		buffer.writeInt(this.x);
		buffer.writeInt(this.y);
		buffer.writeInt(this.z);
		buffer.writeFloat(this.walkedDistance);
		buffer.writeFloat(this.costMalus);
		buffer.writeBoolean(this.closed);
		buffer.writeEnum(this.type);
		buffer.writeFloat(this.f);
	}

	public static Node createFromStream(FriendlyByteBuf buffer) {
		Node node = new Node(buffer.readInt(), buffer.readInt(), buffer.readInt());
		readContents(buffer, node);
		return node;
	}

	protected static void readContents(FriendlyByteBuf buffer, Node node) {
		node.walkedDistance = buffer.readFloat();
		node.costMalus = buffer.readFloat();
		node.closed = buffer.readBoolean();
		node.type = buffer.readEnum(PathType.class);
		node.f = buffer.readFloat();
	}
}