use of thpmc.vanilla_source.api.entity.ai.pathfinding.BlockPosition in project VanillaSource by TheHollowPlanetMC.
the class Navigator method updatePathfinding.
/**
* Update pathfinding.
* @param locX entity locX
* @param locY entity locY
* @param locZ entity locZ
*/
public void updatePathfinding(int locX, int locY, int locZ) {
if (navigationGoal == null)
return;
currentPaths = null;
if (!entity.isOnGround())
return;
if (!asyncPathfinding) {
BlockPosition start = new BlockPosition(locX, locY, locZ);
List<BlockPosition> paths = new AsyncAStarMachine(entity.getWorld(), start, navigationGoal, descendingHeight, (int) jumpHeight, 50, avoidEntityCollision, entity.getMovementCollideOption()).runPathFinding();
// merge
currentPaths = new ArrayList<>();
BlockPosition previousPosition = null;
int previousDeltaX = 0;
int previousDeltaZ = 0;
for (BlockPosition currentPosition : paths) {
int currentDeltaX;
int currentDeltaZ;
if (previousPosition == null) {
previousPosition = currentPosition;
currentPaths.add(currentPosition);
continue;
} else {
currentDeltaX = currentPosition.x - previousPosition.x;
currentDeltaZ = currentPosition.z - previousPosition.z;
}
if (previousDeltaX != currentDeltaX || previousDeltaZ != currentDeltaZ) {
currentPaths.add(currentPosition);
previousDeltaX = currentDeltaX;
previousDeltaZ = currentDeltaZ;
}
}
currentPathIndex = 0;
return;
}
// Start AsyncAStarMachine
BlockPosition start = new BlockPosition(locX, locY, locZ);
AsyncAStarMachine asyncAStarMachine = new AsyncAStarMachine(entity.getWorld(), start, navigationGoal, descendingHeight, (int) jumpHeight, 500, avoidEntityCollision, entity.getMovementCollideOption());
this.pathfindingTask = asyncAStarMachine.runPathfindingAsync();
// Then finish pathfinding
this.pathfindingTask.thenAccept(paths -> {
if (paths.size() == 0) {
// Failure
tickSyncTask = () -> {
currentPaths = null;
currentPathIndex = 0;
};
return;
}
Collections.reverse(paths);
tickSyncTask = () -> {
currentPaths = paths;
currentPathIndex = 0;
};
});
}
use of thpmc.vanilla_source.api.entity.ai.pathfinding.BlockPosition in project VanillaSource by TheHollowPlanetMC.
the class EntityFollowGoal method run.
@Override
public void run(GoalSelector goalSelector, Navigator navigator) {
tick++;
if (tick % TRACK_INTERVAL != 0) {
goalSelector.setFinished(true);
return;
}
INMSHandler nmsHandler = VanillaSourceAPI.getInstance().getNMSHandler();
EngineWorld world = navigator.getEntity().getWorld();
if (!world.getName().equals(target.getWorld().getName()))
return;
Location location = target.getLocation();
EngineChunk chunk = world.getChunkAt(location.getBlockX() >> 4, location.getBlockZ() >> 4);
if (chunk == null)
return;
for (int dy = 0; dy < 5; dy++) {
Location l = location.clone().add(new Vector(0, -dy, 0));
Object nmsBlockData = world.getNMSBlockData(l.getBlockX(), l.getBlockY(), l.getBlockZ());
if (nmsBlockData == null)
continue;
if (nmsHandler.hasCollision(new EngineBlock(world, chunk, l.getBlockX(), l.getBlockY(), l.getBlockZ(), nmsBlockData), navigator.getEntity().getMovementCollideOption())) {
// Goal set
navigator.setNavigationGoal(new BlockPosition(l.getBlockX(), l.getBlockY() + 1, l.getBlockZ()));
break;
}
}
goalSelector.setFinished(true);
}
use of thpmc.vanilla_source.api.entity.ai.pathfinding.BlockPosition in project VanillaSource by TheHollowPlanetMC.
the class Navigator method tick.
/**
* Run navigation.
* @param locX entity locX
* @param locY entity locY
* @param locZ entity locZ
*/
public void tick(double locX, double locY, double locZ) {
tick++;
if (tickSyncTask != null) {
tickSyncTask.run();
tickSyncTask = null;
}
// Update pathfinding
if (!entity.isOnGround()) {
return;
}
if (tick % pathfindingInterval == 0) {
if (pathfindingTask == null) {
updatePathfinding(NumberConversions.floor(locX), NumberConversions.floor(locY), NumberConversions.floor(locZ));
} else {
if (pathfindingTask.isDone()) {
updatePathfinding(NumberConversions.floor(locX), NumberConversions.floor(locY), NumberConversions.floor(locZ));
}
}
}
// Make the entity walk along the path.
if (currentPaths == null) {
return;
}
// Get next path point
if (currentPaths.size() <= currentPathIndex) {
currentPaths = null;
currentPathIndex = 0;
return;
}
BlockPosition next = currentPaths.get(currentPathIndex);
Vector nextPosition = new Vector(next.x + 0.5, 0, next.z + 0.5);
// if(nextPosition.lengthSquared() > Math.max(jumpHeight, 4.0F)) return;
Vector velocity = nextPosition.clone().add(new Vector(-locX, 0, -locZ));
double velocityLengthSquared = velocity.lengthSquared();
if (highAccuracy) {
if (velocityLengthSquared == 0.0) {
currentPathIndex++;
return;
}
} else {
int blockX = NumberConversions.floor(locX);
int blockZ = NumberConversions.floor(locZ);
if (blockX == next.x && blockZ == next.z) {
currentPathIndex++;
if (currentPaths.size() <= currentPathIndex) {
currentPaths = null;
currentPathIndex = 0;
return;
}
next = currentPaths.get(currentPathIndex);
nextPosition = new Vector(next.x + 0.5, 0, next.z + 0.5);
velocity = nextPosition.clone().add(new Vector(-locX, 0, -locZ));
velocityLengthSquared = velocity.lengthSquared();
}
}
if (velocityLengthSquared > speed * speed) {
velocity.normalize().multiply(speed);
this.move(velocity);
} else {
this.move(velocity);
Vector position = entity.getLocation().toVector();
double velocityLength = Math.sqrt(velocityLengthSquared);
double nextVelocityLength = speed - velocityLength;
currentPathIndex++;
if (currentPaths.size() <= currentPathIndex) {
currentPaths = null;
currentPathIndex = 0;
return;
}
next = currentPaths.get(currentPathIndex);
nextPosition = new Vector(next.x + 0.5, 0, next.z + 0.5);
// if(nextPosition.lengthSquared() > Math.max(jumpHeight, 4.0F)) return;
velocity = nextPosition.clone().add(new Vector(-position.getX(), 0, -position.getZ()));
velocity.normalize().multiply(nextVelocityLength);
entity.move(velocity);
}
}
Aggregations