84 lines
3.2 KiB
Java
84 lines
3.2 KiB
Java
package net.citizensnpcs.npc.ai;
|
|
|
|
import net.citizensnpcs.api.ai.NavigatorParameters;
|
|
import net.citizensnpcs.api.ai.TargetType;
|
|
import net.citizensnpcs.api.ai.event.CancelReason;
|
|
import net.citizensnpcs.api.astar.AStarMachine;
|
|
import net.citizensnpcs.api.astar.pathfinder.ChunkBlockSource;
|
|
import net.citizensnpcs.api.astar.pathfinder.Path;
|
|
import net.citizensnpcs.api.astar.pathfinder.VectorGoal;
|
|
import net.citizensnpcs.api.astar.pathfinder.VectorNode;
|
|
import net.citizensnpcs.api.npc.NPC;
|
|
import net.citizensnpcs.util.Messaging;
|
|
import net.citizensnpcs.util.NMS;
|
|
import net.minecraft.server.v1_4_5.EntityLiving;
|
|
|
|
import org.bukkit.Effect;
|
|
import org.bukkit.Location;
|
|
import org.bukkit.Material;
|
|
import org.bukkit.World;
|
|
import org.bukkit.util.Vector;
|
|
|
|
public class AStarNavigationStrategy extends AbstractPathStrategy {
|
|
private final Location destination;
|
|
private final NPC npc;
|
|
private final NavigatorParameters params;
|
|
private Path plan;
|
|
private Vector vector;
|
|
|
|
AStarNavigationStrategy(NPC npc, Location dest, NavigatorParameters params) {
|
|
super(TargetType.LOCATION);
|
|
this.params = params;
|
|
this.destination = dest;
|
|
this.npc = npc;
|
|
Location location = npc.getBukkitEntity().getEyeLocation();
|
|
plan = ASTAR.runFully(new VectorGoal(dest), new VectorNode(location, new ChunkBlockSource(location,
|
|
params.range()), params.examiners()), (int) (params.range() * 10));
|
|
if (plan == null || plan.isComplete()) {
|
|
setCancelReason(CancelReason.STUCK);
|
|
} else {
|
|
vector = plan.getCurrentVector();
|
|
}
|
|
}
|
|
|
|
@Override
|
|
public Location getTargetAsLocation() {
|
|
return destination;
|
|
}
|
|
|
|
@Override
|
|
public void stop() {
|
|
plan = null;
|
|
}
|
|
|
|
@Override
|
|
public boolean update() {
|
|
if (getCancelReason() != null || plan == null || plan.isComplete())
|
|
return true;
|
|
if (npc.getBukkitEntity().getLocation(NPC_LOCATION).toVector().distanceSquared(vector) <= params
|
|
.distanceMargin()) {
|
|
plan.update(npc);
|
|
if (plan.isComplete())
|
|
return true;
|
|
vector = plan.getCurrentVector();
|
|
World world = npc.getBukkitEntity().getWorld();
|
|
world.playEffect(vector.toLocation(world), Effect.STEP_SOUND, Material.STONE.getId());
|
|
}
|
|
EntityLiving handle = NMS.getHandle(npc.getBukkitEntity());
|
|
double dX = vector.getBlockX() - handle.locX;
|
|
double dZ = vector.getBlockZ() - handle.locZ;
|
|
double dY = vector.getY() - Math.floor(handle.boundingBox.b + 0.5D);
|
|
double dXdZ = dX * dX + dZ * dZ;
|
|
double distance = dXdZ + dY * dY;
|
|
|
|
if (distance >= 0.00001 && (dY > 0 && dXdZ <= 2.75))
|
|
NMS.setShouldJump(npc.getBukkitEntity());
|
|
else
|
|
Messaging.log(distance >= 0.0001, dY > 0, dXdZ < 1, dXdZ);
|
|
NMS.setDestination(npc.getBukkitEntity(), vector.getX(), vector.getY(), vector.getZ(), params.speed());
|
|
return false;
|
|
}
|
|
|
|
private static final AStarMachine<VectorNode, Path> ASTAR = AStarMachine.createWithDefaultStorage();
|
|
private static final Location NPC_LOCATION = new Location(null, 0, 0, 0);
|
|
} |