MotionControllerWalk.java

package com.hypixel.hytale.server.npc.movement.controllers;

import com.hypixel.hytale.assetstore.map.BlockTypeAssetMap;
import com.hypixel.hytale.component.ComponentAccessor;
import com.hypixel.hytale.component.Ref;
import com.hypixel.hytale.component.Store;
import com.hypixel.hytale.logger.HytaleLogger;
import com.hypixel.hytale.math.shape.Box;
import com.hypixel.hytale.math.util.ChunkUtil;
import com.hypixel.hytale.math.util.MathUtil;
import com.hypixel.hytale.math.util.TrigMathUtil;
import com.hypixel.hytale.math.vector.Vector2d;
import com.hypixel.hytale.math.vector.Vector3d;
import com.hypixel.hytale.math.vector.Vector3f;
import com.hypixel.hytale.protocol.BlockMaterial;
import com.hypixel.hytale.protocol.MovementStates;
import com.hypixel.hytale.server.core.asset.type.blockhitbox.BlockBoundingBoxes;
import com.hypixel.hytale.server.core.asset.type.blocktype.config.BlockType;
import com.hypixel.hytale.server.core.asset.type.fluid.Fluid;
import com.hypixel.hytale.server.core.asset.type.fluidfx.config.FluidFX;
import com.hypixel.hytale.server.core.asset.type.model.config.Model;
import com.hypixel.hytale.server.core.modules.blockset.BlockSetModule;
import com.hypixel.hytale.server.core.modules.collision.BlockCollisionData;
import com.hypixel.hytale.server.core.modules.collision.BoxBlockIntersectionEvaluator;
import com.hypixel.hytale.server.core.modules.collision.CollisionMath;
import com.hypixel.hytale.server.core.modules.collision.CollisionModule;
import com.hypixel.hytale.server.core.modules.collision.CollisionResult;
import com.hypixel.hytale.server.core.modules.collision.WorldUtil;
import com.hypixel.hytale.server.core.modules.entity.component.PositionDataComponent;
import com.hypixel.hytale.server.core.modules.entity.component.TransformComponent;
import com.hypixel.hytale.server.core.modules.physics.component.Velocity;
import com.hypixel.hytale.server.core.modules.physics.util.PhysicsMath;
import com.hypixel.hytale.server.core.modules.splitvelocity.VelocityConfig;
import com.hypixel.hytale.server.core.universe.world.World;
import com.hypixel.hytale.server.core.universe.world.chunk.BlockChunk;
import com.hypixel.hytale.server.core.universe.world.chunk.WorldChunk;
import com.hypixel.hytale.server.core.universe.world.chunk.section.BlockSection;
import com.hypixel.hytale.server.core.universe.world.storage.ChunkStore;
import com.hypixel.hytale.server.core.universe.world.storage.EntityStore;
import com.hypixel.hytale.server.core.util.FillerBlockUtil;
import com.hypixel.hytale.server.npc.asset.builder.BuilderSupport;
import com.hypixel.hytale.server.npc.entities.NPCEntity;
import com.hypixel.hytale.server.npc.movement.MotionKind;
import com.hypixel.hytale.server.npc.movement.Steering;
import com.hypixel.hytale.server.npc.movement.controllers.builders.BuilderMotionControllerWalk;
import com.hypixel.hytale.server.npc.role.Role;
import com.hypixel.hytale.server.npc.util.NPCPhysicsMath;
import java.util.EnumSet;
import java.util.function.Supplier;
import java.util.logging.Level;
import javax.annotation.Nonnull;
import javax.annotation.Nullable;

public class MotionControllerWalk extends MotionControllerBase {
   public static final String TYPE = "Walk";
   public static final double CLIMB_FORWARD_DISTANCE = 0.1;
   public static final double CLIMB_FORWARD_DISTANCE_SQUARED = 0.010000000000000002;
   public static final double JUMP_FORWARD_DISTANCE = 0.5;
   public static final double ONE_PLUS_THRESHOLD = 1.00001;
   public static final double DROP_MIN_STOP_DIST = 0.001;
   protected static final EnumSet<MotionKind> STATE_CAN_HOVER;
   protected static final EnumSet<MotionKind> VALID_MOTIONS;
   protected static final int COLLISION_MATERIALS = 4;
   protected static final int WALKING_MATERIALS = 5;
   protected static final int WALKING_MATERIALS_RELAXED = 13;
   protected final double minHorizontalSpeed;
   protected final double maxVerticalSpeed;
   protected final double maxVerticalSpeedFluid;
   protected final double acceleration;
   protected final double maxRotationSpeed;
   protected final float maxMoveTurnAngle;
   protected final float blendRestTurnAngle;
   protected final double blendRestRelativeSpeed;
   protected final double maxClimbHeight;
   protected final double jumpHeight;
   protected final double minJumpHeight;
   protected final double minJumpDistance;
   protected final double jumpForce;
   protected final double jumpDescentSteepness;
   protected final double jumpBlending;
   protected final double jumpDescentBlending;
   protected final double climbSpeedMult;
   protected final double climbSpeedPow;
   protected final double climbSpeedConst;
   protected final double maxDropHeight;
   protected final double minDescentAnimationHeight;
   protected final double descendFlatness;
   protected final double descendSpeedCompensation;
   protected final double descentSteepness;
   protected final double descentBlending;
   protected final DescentAnimationType descentAnimationType;
   protected final AscentAnimationType ascentAnimationType;
   protected final double maxWalkSpeedAfterHitMultiplier;
   protected final int fenceBlockSet;
   protected final double minHover;
   protected final double maxHover;
   protected final double hoverFreq;
   protected final float hoverCycle;
   protected final double minHoverClimb;
   protected final double minHoverDrop;
   protected final boolean floatsDown;
   protected boolean onGround;
   protected boolean inWater;
   protected double horizontalSpeedMultiplier;
   protected double fallStartHeight;
   protected double fallSpeed;
   protected double currentRelativeSpeed;
   protected boolean isFullyRotated = true;
   @Nullable
   protected BlockType belowBlockType;
   protected int belowBlockTypeId = 0;
   protected int[] footingBlocks;
   protected short[] footingFillers;
   protected byte[] footingRotations;
   protected final Vector3d footingPosition = new Vector3d();
   protected boolean footingBlocksValid;
   protected double breathingDepth;
   protected double constraintDepth;
   protected double climbUpDistance;
   protected double currentJumpHeight;
   protected double jumpDropHeight;
   protected double jumpBlockHeight;
   protected double predictedFallHeight;
   protected final Vector3d jumpDropDirection = new Vector3d();
   protected final Vector3d climbUpDirection = new Vector3d();
   protected double currentClimbForwardDistance;
   protected double maxClimbForwardDistance;
   protected double totalDropDistance;
   protected final Vector3d climbForwardDirection = new Vector3d();
   protected double climbSpeed;
   protected boolean jumping;
   protected final MotionController.VerticalRange verticalRange = new MotionController.VerticalRange();
   protected final Vector3d tmpClimbPosition = new Vector3d();
   protected final Vector3d tmpClimbMovement = new Vector3d();
   protected final Vector3d tmpMovePosition = new Vector3d();
   protected final CollisionResult tmpResults = new CollisionResult();
   protected final Vector2d tmpClimbHeightResults = new Vector2d();

   public MotionControllerWalk(@Nonnull BuilderMotionControllerWalk builder, @Nonnull BuilderSupport builderSupport) {
      super(builderSupport, builder);
      this.setGravity(builder.getGravity());
      this.minHorizontalSpeed = builder.getMinHorizontalSpeed();
      this.maxVerticalSpeed = builder.getMaxVerticalSpeed();
      this.maxVerticalSpeedFluid = builder.getMaxVerticalSpeedFluid();
      this.acceleration = builder.getAcceleration(builderSupport);
      this.maxRotationSpeed = builder.getMaxRotationSpeed(builderSupport);
      this.maxMoveTurnAngle = builder.getMaxMoveTurnAngle(builderSupport);
      this.blendRestTurnAngle = builder.getBlendRestTurnAngle(builderSupport);
      this.blendRestRelativeSpeed = builder.getBlendRestRelativeSpeed(builderSupport);
      this.maxClimbHeight = builder.getMaxClimbHeight(builderSupport);
      this.jumpHeight = builder.getJumpHeight(builderSupport);
      this.minJumpHeight = builder.getMinJumpHeight(builderSupport);
      this.minJumpDistance = builder.getMinJumpDistance(builderSupport);
      this.jumpForce = builder.getJumpForce(builderSupport);
      this.jumpDescentSteepness = builder.getJumpDescentSteepness(builderSupport);
      this.jumpBlending = builder.getJumpBlending(builderSupport);
      this.jumpDescentBlending = builder.getJumpDescentBlending(builderSupport);
      this.ascentAnimationType = builder.getAscentAnimationType(builderSupport);
      this.climbSpeedMult = builder.getClimbSpeedMult(builderSupport);
      this.climbSpeedPow = builder.getClimbSpeedPow(builderSupport);
      this.climbSpeedConst = builder.getClimbSpeedConst(builderSupport);
      this.minDescentAnimationHeight = builder.getMinDescentAnimationHeight(builderSupport);
      this.descendFlatness = builder.getDescendForwardAmount(builderSupport);
      this.descendSpeedCompensation = builder.getDescendSpeedCompensation(builderSupport);
      this.maxDropHeight = builder.getMaxDropHeight(builderSupport);
      this.fenceBlockSet = builder.getFenceBlockSet();
      this.minHover = builder.getMinHover();
      this.maxHover = builder.getMaxHover();
      this.minHoverClimb = builder.getMinHoverClimb();
      this.minHoverDrop = builder.getMinHoverDrop();
      this.floatsDown = builder.isFloatsDown();
      this.hoverFreq = (double)builder.getHoverFreq();
      this.hoverCycle = this.hoverFreq > 0.0 ? 1.0F / (float)this.hoverFreq : 0.0F;
      this.maxWalkSpeedAfterHitMultiplier = builder.getMaxWalkSpeedAfterHitMultiplier();
      this.descentAnimationType = builder.getDescentAnimationType(builderSupport);
      this.descentSteepness = builder.getDescentSteepness(builderSupport);
      this.descentBlending = builder.getDescentBlending(builderSupport);
   }

   @Nonnull
   public String getType() {
      return "Walk";
   }

   public void spawned() {
      Vector3d var10000 = this.position;
      var10000.y += this.minHover;
   }

   public double getWanderVerticalMovementRatio() {
      return 0.0;
   }

   @Nonnull
   public MotionController.VerticalRange getDesiredVerticalRange(@Nonnull Ref<EntityStore> ref, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      TransformComponent transformComponent = (TransformComponent)componentAccessor.getComponent(ref, TransformComponent.getComponentType());

      assert transformComponent != null;

      this.verticalRange.assign(transformComponent.getPosition().getY(), 0.0, 320.0);
      return this.verticalRange;
   }

   protected void adjustReadPosition(Ref<EntityStore> ref, ComponentAccessor<EntityStore> componentAccessor) {
      NPCEntity npcComponent = (NPCEntity)componentAccessor.getComponent(ref, NPCEntity.getComponentType());

      assert npcComponent != null;

      Vector3d var10000 = this.position;
      var10000.y -= npcComponent.getHoverHeight();
   }

   protected void adjustWritePosition(Ref<EntityStore> ref, double dt, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      NPCEntity npcComponent = (NPCEntity)componentAccessor.getComponent(ref, NPCEntity.getComponentType());

      assert npcComponent != null;

      if (this.maxHover > 0.0 && this.hoverCycle > 0.0F && dt > 0.0) {
         double hoverHeight = npcComponent.getHoverHeight();
         float hoverPhase = npcComponent.getHoverPhase();
         if (!this.switchedToMotionKind(MotionKind.DROPPING) && !this.switchedToMotionKind(MotionKind.DESCENDING)) {
            if (this.switchedToMotionKind(MotionKind.ASCENDING)) {
               double hoverClimb = hoverHeight - this.minHoverClimb;
               if (hoverClimb > this.climbUpDistance) {
                  hoverClimb = this.climbUpDistance;
               } else {
                  hoverPhase = 0.0F;
               }

               hoverHeight -= hoverClimb;
               Vector3d var16 = this.position;
               var16.y += hoverClimb;
               this.climbUpDistance -= hoverClimb;
            } else if (hoverHeight < this.minHover) {
               hoverHeight += dt * this.computeClimbSpeed(this.moveSpeed);
               if (hoverHeight >= this.minHover) {
                  hoverHeight = this.minHover;
                  hoverPhase = 0.0F;
               }
            } else if (STATE_CAN_HOVER.contains(this.getMotionKind())) {
               hoverPhase = (hoverPhase + (float)dt) % this.hoverCycle;
               double scale = (double)(6.2831855F / this.hoverCycle);
               double derivate = (double)TrigMathUtil.cos(scale * (double)hoverPhase - 1.5707963705062866) * scale;
               hoverHeight += dt * derivate * (this.maxHover - this.minHover) / 2.0;
               if (hoverHeight <= this.minHover) {
                  hoverHeight = this.minHover;
                  hoverPhase = 0.0F;
               } else if (hoverHeight >= this.maxHover) {
                  hoverHeight = this.maxHover;
                  hoverPhase = this.hoverCycle / 2.0F;
               }
            }
         } else {
            double hoverDrop = this.maxHover - hoverHeight;
            double dropDist = this.dropDistance(this.position, hoverDrop, componentAccessor);
            if (dropDist < hoverDrop) {
               hoverDrop = dropDist;
            } else {
               hoverPhase = this.hoverCycle / 2.0F;
            }

            hoverHeight += hoverDrop;
            Vector3d var10000 = this.position;
            var10000.y -= hoverDrop;
         }

         npcComponent.setHoverPhase(hoverPhase);
         npcComponent.setHoverHeight(hoverHeight);
      }

      Vector3d var17 = this.position;
      var17.y += npcComponent.getHoverHeight();
   }

   protected void updateAscendingStates(@Nonnull Ref<EntityStore> ref, @Nonnull MovementStates movementStates, boolean fastMotionKind, boolean horizontalIdleKind, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      if (!this.jumping) {
         switch (this.ascentAnimationType.ordinal()) {
            case 0:
               movementStates.jumping = false;
               movementStates.idle = false;
               movementStates.flying = false;
               break;
            case 1:
               movementStates.jumping = true;
               movementStates.idle = false;
               movementStates.flying = false;
               break;
            case 2:
               movementStates.jumping = false;
               movementStates.idle = false;
               movementStates.flying = false;
               movementStates.climbing = true;
               break;
            case 3:
               movementStates.jumping = false;
               movementStates.idle = false;
               movementStates.flying = true;
               break;
            case 4:
               movementStates.jumping = false;
               movementStates.idle = true;
               movementStates.flying = false;
         }
      } else {
         NPCEntity npcComponent = (NPCEntity)componentAccessor.getComponent(ref, NPCEntity.getComponentType());

         assert npcComponent != null;

         movementStates.jumping = this.jumping;
         movementStates.idle = false;
         movementStates.flying = npcComponent.getHoverHeight() > 0.0;
      }

      movementStates.horizontalIdle = horizontalIdleKind;
      movementStates.falling = false;
      movementStates.running = fastMotionKind;
      movementStates.walking = !fastMotionKind;
      movementStates.sprinting = false;
      movementStates.swimming = false;
   }

   protected void updateDescendingStates(@Nonnull Ref<EntityStore> ref, @Nonnull MovementStates movementStates, boolean fastMotionKind, boolean hovering, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      if (this.predictedFallHeight >= this.minDescentAnimationHeight - 1.0E-5) {
         switch (this.descentAnimationType.ordinal()) {
            case 0:
               movementStates.falling = false;
               movementStates.idle = false;
               movementStates.running = fastMotionKind;
               movementStates.walking = !fastMotionKind;
               movementStates.flying = hovering;
               break;
            case 1:
               movementStates.falling = true;
               movementStates.idle = false;
               movementStates.running = false;
               movementStates.walking = false;
               movementStates.flying = false;
               break;
            case 2:
               movementStates.falling = false;
               movementStates.idle = true;
               movementStates.running = false;
               movementStates.walking = false;
               movementStates.flying = hovering;
         }
      } else {
         movementStates.falling = false;
         movementStates.idle = false;
         movementStates.running = fastMotionKind;
         movementStates.walking = !fastMotionKind;
         movementStates.flying = hovering;
      }

      movementStates.horizontalIdle = false;
      movementStates.swimming = false;
      movementStates.jumping = false;
      movementStates.sprinting = false;
   }

   public boolean isFastMotionKind(double speed) {
      boolean isRunning = this.fastMotionKind;
      if (this.jumping && this.getMotionKind() == MotionKind.ASCENDING) {
         return isRunning;
      } else {
         double threshold;
         if (isRunning) {
            threshold = this.fastMotionThreshold - this.fastMotionThresholdRange;
         } else {
            threshold = this.fastMotionThreshold + this.fastMotionThresholdRange;
         }

         threshold *= this.maxHorizontalSpeed;
         return speed > threshold;
      }
   }

   public boolean isInProgress() {
      MotionKind motionKind = this.getMotionKind();
      return motionKind == MotionKind.ASCENDING || motionKind == MotionKind.DESCENDING || motionKind == MotionKind.DROPPING;
   }

   public boolean canAct(@Nonnull Ref<EntityStore> ref, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      return super.canAct(ref, componentAccessor) && this.onGround && this.belowBlockType != null && this.belowBlockType.getMaterial() == BlockMaterial.Solid;
   }

   public void updateModelParameters(Ref<EntityStore> ref, Model model, @Nonnull Box boundingBox, ComponentAccessor<EntityStore> componentAccessor) {
      super.updateModelParameters(ref, model, boundingBox, componentAccessor);
      float eyeHeight = model != null ? model.getEyeHeight(ref, componentAccessor) : 0.0F;
      Vector3d var10000 = this.collisionBoundingBox.max;
      var10000.y += this.maxHover;
      this.breathingDepth = 1.0E-5 + (double)eyeHeight;
      if (this.role.isBreathesInAir() && this.role.isBreathesInWater()) {
         this.constraintDepth = this.breathingDepth;
      } else if (this.role.isBreathesInAir()) {
         this.constraintDepth = Math.min(0.25, this.breathingDepth / 2.0);
      } else {
         this.constraintDepth = 1.0E-5;
      }

      int size = (int)(MathUtil.fastCeil(this.collisionBoundingBox.width() + 1.0) * MathUtil.fastCeil(this.collisionBoundingBox.depth() + 1.0));
      this.footingBlocks = new int[size];
      this.footingFillers = new short[size];
      this.footingRotations = new byte[size];
      this.footingBlocksValid = false;
   }

   public void constrainRotations(Role role, @Nonnull TransformComponent transform) {
      Vector3f rotation = transform.getRotation();
      rotation.setPitch(0.0F);
      rotation.setRoll(0.0F);
   }

   public void forceVelocity(@Nonnull Vector3d velocity, VelocityConfig velocityConfig, boolean ignoreDamping) {
      super.forceVelocity(velocity, velocityConfig, ignoreDamping);
      this.onGround = false;
   }

   public boolean inAir() {
      return !this.onGround && !this.inWater;
   }

   public boolean onGround() {
      return this.onGround;
   }

   public boolean standingOnBlockOfType(int blockSet) {
      return BlockSetModule.getInstance().blockInSet(blockSet, this.belowBlockType);
   }

   public boolean inWater() {
      return this.inWater;
   }

   public boolean touchesWater(boolean defaultValue, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      return this.inWater;
   }

   public double getCurrentSpeed() {
      return this.moveSpeed;
   }

   public double getCurrentTurnRadius() {
      return 0.0;
   }

   public float getMaxClimbAngle() {
      return 0.0F;
   }

   public float getMaxSinkAngle() {
      return 0.0F;
   }

   public double getMaximumSpeed() {
      return this.maxHorizontalSpeed * this.horizontalSpeedMultiplier * this.effectHorizontalSpeedMultiplier;
   }

   public boolean is2D() {
      return true;
   }

   public boolean canRestAtPlace() {
      return true;
   }

   public double getDesiredAltitudeWeight() {
      return 0.0;
   }

   public double getHeightOverGround() {
      return 0.0;
   }

   public boolean estimateVelocity(@Nonnull Steering steering, @Nonnull Vector3d velocityOut) {
      if (steering.hasTranslation()) {
         velocityOut.assign(steering.getTranslation()).scale(this.getCurrentSpeed());
         return true;
      } else {
         velocityOut.assign(Vector3d.ZERO);
         return false;
      }
   }

   public void setMotionKind(MotionKind motionKind) {
      if (!VALID_MOTIONS.contains(motionKind)) {
         motionKind = MotionKind.STANDING;
      }

      super.setMotionKind(motionKind);
   }

   public void postReadPosition(@Nonnull Ref<EntityStore> ref, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      if (!this.footingPosition.equals(this.position)) {
         this.footingBlocksValid = false;
         this.footingPosition.assign(this.position);
      }

      World world = ((EntityStore)componentAccessor.getExternalData()).getWorld();
      boolean wasOnGround = this.onGround;
      double bottomY = this.position.y + this.collisionBoundingBox.min.y;
      int blockY = MathUtil.floor(bottomY);
      if (bottomY - (double)blockY < 1.0E-5) {
         --blockY;
      }

      if (blockY >= 0 && blockY <= 319) {
         double xPos = this.position.x > 0.0 ? this.position.x + MathUtil.EPSILON_DOUBLE : this.position.x - MathUtil.EPSILON_DOUBLE;
         double zPos = this.position.z > 0.0 ? this.position.z + MathUtil.EPSILON_DOUBLE : this.position.z - MathUtil.EPSILON_DOUBLE;
         long minBlockX = MathUtil.fastFloor(xPos + this.collisionBoundingBox.min.x);
         long maxBlockX = MathUtil.fastFloor(xPos + this.collisionBoundingBox.max.x);
         long minBlockZ = MathUtil.fastFloor(zPos + this.collisionBoundingBox.min.z);
         long maxBlockZ = MathUtil.fastFloor(zPos + this.collisionBoundingBox.max.z);
         int minChunkX = ChunkUtil.chunkCoordinate(minBlockX);
         int maxChunkX = ChunkUtil.chunkCoordinate(maxBlockX);
         int minChunkZ = ChunkUtil.chunkCoordinate(minBlockZ);
         int maxChunkZ = ChunkUtil.chunkCoordinate(maxBlockZ);
         boolean different = !this.footingBlocksValid;
         int blockIndex = 0;
         this.footingBlocksValid = true;

         label260:
         for(int chunkX = minChunkX; chunkX <= maxChunkX; ++chunkX) {
            for(int chunkZ = minChunkZ; chunkZ <= maxChunkZ; ++chunkZ) {
               WorldChunk chunk = world.getChunkIfInMemory(ChunkUtil.indexChunk(chunkX, chunkZ));
               if (chunk == null) {
                  this.footingBlocksValid = false;
                  this.belowBlockType = null;
                  this.belowBlockTypeId = 0;
                  this.onGround = false;
                  break label260;
               }

               int minX = chunkX == minChunkX ? ChunkUtil.localCoordinate(minBlockX) : 0;
               int maxX = chunkX == maxChunkX ? ChunkUtil.localCoordinate(maxBlockX) : 31;
               int minZ = chunkZ == minChunkZ ? ChunkUtil.localCoordinate(minBlockZ) : 0;
               int maxZ = chunkZ == maxChunkZ ? ChunkUtil.localCoordinate(maxBlockZ) : 31;
               BlockSection chunkSection = chunk.getBlockChunk().getSectionAtBlockY(blockY);

               for(int x = minX; x <= maxX; ++x) {
                  for(int z = minZ; z <= maxZ; ++z) {
                     int block = chunkSection.get(x, blockY, z);
                     if (different || block != this.footingBlocks[blockIndex]) {
                        this.footingBlocks[blockIndex] = block;
                        this.footingFillers[blockIndex] = (short)chunkSection.getFiller(x, blockY, z);
                        this.footingRotations[blockIndex] = (byte)chunkSection.getRotationIndex(x, blockY, z);
                        different = true;
                     }

                     ++blockIndex;
                  }
               }
            }
         }

         if (different && this.footingBlocksValid) {
            this.belowBlockType = null;
            this.onGround = false;
            this.belowBlockTypeId = 0;
            BoxBlockIntersectionEvaluator boxBlockIntersectionEvaluator = this.collisionResult.getBoxBlockIntersection();
            boxBlockIntersectionEvaluator.setBox(this.collisionBoundingBox, this.footingPosition);
            blockIndex = 0;

            label227:
            for(int chunkX = minChunkX; chunkX <= maxChunkX; ++chunkX) {
               int chunkMinBlockX = ChunkUtil.minBlock(chunkX);

               for(int chunkZ = minChunkZ; chunkZ <= maxChunkZ; ++chunkZ) {
                  int chunkMinBlockZ = ChunkUtil.minBlock(chunkZ);
                  int minX = chunkX == minChunkX ? ChunkUtil.localCoordinate(minBlockX) : 0;
                  int maxX = chunkX == maxChunkX ? ChunkUtil.localCoordinate(maxBlockX) : 31;
                  int minZ = chunkZ == minChunkZ ? ChunkUtil.localCoordinate(minBlockZ) : 0;
                  int maxZ = chunkZ == maxChunkZ ? ChunkUtil.localCoordinate(maxBlockZ) : 31;

                  for(int localX = minX; localX <= maxX; ++localX) {
                     for(int localZ = minZ; localZ <= maxZ; ++localZ) {
                        int rotation = this.footingRotations[blockIndex];
                        int filler = this.footingFillers[blockIndex];
                        int blockId = this.footingBlocks[blockIndex++];
                        if (blockId != 0) {
                           BlockType blockType = (BlockType)BlockType.getAssetMap().getAsset(blockId);
                           int x = chunkMinBlockX + localX;
                           int z = chunkMinBlockZ + localZ;
                           int y = blockY;
                           if (filler != 0) {
                              x -= FillerBlockUtil.unpackX(filler);
                              y = blockY - FillerBlockUtil.unpackY(filler);
                              z -= FillerBlockUtil.unpackZ(filler);
                           }

                           BlockMaterial material = blockType.getMaterial();
                           if (material == BlockMaterial.Solid) {
                              BlockBoundingBoxes boundingBoxes = (BlockBoundingBoxes)BlockBoundingBoxes.getAssetMap().getAsset(blockType.getHitboxTypeIndex());
                              BlockBoundingBoxes.RotatedVariantBoxes rotatedBoxes = boundingBoxes.get(rotation);
                              int code = boxBlockIntersectionEvaluator.intersectBoxComputeOnGround(rotatedBoxes.getBoundingBox(), (double)x, (double)y, (double)z);
                              if (!CollisionMath.isDisjoint(code)) {
                                 if (rotatedBoxes.hasDetailBoxes()) {
                                    for(Box detailBox : rotatedBoxes.getDetailBoxes()) {
                                       code = boxBlockIntersectionEvaluator.intersectBoxComputeOnGround(detailBox, (double)x, (double)y, (double)z);
                                       if (!CollisionMath.isDisjoint(code) && boxBlockIntersectionEvaluator.isOnGround()) {
                                          this.belowBlockType = blockType;
                                          this.belowBlockTypeId = blockId;
                                          this.onGround = true;
                                          break label227;
                                       }
                                    }
                                 } else if (boxBlockIntersectionEvaluator.isOnGround()) {
                                    this.belowBlockType = blockType;
                                    this.belowBlockTypeId = blockId;
                                    this.onGround = true;
                                    break label227;
                                 }
                              }
                           }
                        }
                     }
                  }
               }
            }
         }
      } else {
         this.footingBlocksValid = false;
         this.belowBlockType = null;
         this.belowBlockTypeId = 0;
         this.onGround = false;
      }

      if (this.debugModeMove && wasOnGround != this.onGround) {
         LOGGER.at(Level.INFO).log("PostReadPosition: OnGround was changed from %s to %s", wasOnGround, this.onGround);
      }

      int x = MathUtil.floor(this.position.x);
      int y = MathUtil.floor(this.position.y + this.collisionBoundingBox.min.y);
      int z = MathUtil.floor(this.position.z);
      TransformComponent transformComponent = (TransformComponent)componentAccessor.getComponent(ref, TransformComponent.getComponentType());

      assert transformComponent != null;

      Ref<ChunkStore> chunkRef = transformComponent.getChunkRef();
      Fluid fluidType;
      if (chunkRef != null && chunkRef.isValid()) {
         Store<ChunkStore> chunkStore = world.getChunkStore().getStore();
         WorldChunk worldChunkComponent = (WorldChunk)chunkStore.getComponent(chunkRef, WorldChunk.getComponentType());

         assert worldChunkComponent != null;

         fluidType = (Fluid)Fluid.getAssetMap().getAsset(worldChunkComponent.getFluidId(x, y, z));
      } else {
         fluidType = null;
      }

      this.inWater = fluidType != null && !fluidType.equals(Fluid.EMPTY);
      this.horizontalSpeedMultiplier = 1.0;
      if (this.inWater) {
         int fxIndex = fluidType.getFluidFXIndex();
         if (fxIndex != 0) {
            FluidFX fx = (FluidFX)FluidFX.getAssetMap().getAsset(fxIndex);
            this.horizontalSpeedMultiplier = fx != null && fx.getMovementSettings() != null ? (double)fx.getMovementSettings().horizontalSpeedMultiplier : 1.0;
         }
      }

      if (chunkRef != null && chunkRef.isValid()) {
         PositionDataComponent positionDataComponent = (PositionDataComponent)componentAccessor.getComponent(ref, PositionDataComponent.getComponentType());

         assert positionDataComponent != null;

         Store<ChunkStore> chunkStore = world.getChunkStore().getStore();
         BlockChunk blockChunkComponent = (BlockChunk)chunkStore.getComponent(chunkRef, BlockChunk.getComponentType());

         assert blockChunkComponent != null;

         positionDataComponent.setInsideBlockTypeId(blockChunkComponent.getBlock(x, y, z));
         positionDataComponent.setStandingOnBlockTypeId(this.belowBlockTypeId);
      }

   }

   public boolean translateToAccessiblePosition(@Nonnull Vector3d position, @Nullable Box boundingBox, double minYValue, double maxYValue, ComponentAccessor<EntityStore> componentAccessor) {
      if (maxYValue < minYValue) {
         return false;
      } else {
         if (minYValue < 0.0) {
            minYValue = 0.0;
         }

         if (maxYValue > 320.0) {
            maxYValue = 320.0;
         }

         if (boundingBox == null) {
            return this.translateToAccessiblePosition(position, minYValue, maxYValue, componentAccessor) > 0;
         } else {
            int minX = MathUtil.floor(boundingBox.min.x + position.x);
            int maxX = MathUtil.floor(boundingBox.max.x + position.x);
            int minZ = MathUtil.floor(boundingBox.min.z + position.z);
            int maxZ = MathUtil.floor(boundingBox.max.z + position.z);
            double originalY = position.y;
            double y = position.y + boundingBox.min.y;
            double resultY = -1.0;
            if (maxX - minX > 2 || maxZ - minZ > 2) {
               position.y = y;
               int retCode = this.translateToAccessiblePosition(position, minYValue, maxYValue, componentAccessor);
               if (retCode < 0) {
                  position.y = originalY;
                  return false;
               }

               if (retCode > 0 && position.y > resultY) {
                  resultY = position.y;
                  minYValue = resultY;
                  if (resultY > y) {
                     y = resultY;
                  }
               }
            }

            for(int x = minX; x <= maxX; ++x) {
               for(int z = minZ; z <= maxZ; ++z) {
                  position.y = y;
                  int retCode = this.translateToAccessiblePosition(position, minYValue, maxYValue, componentAccessor);
                  if (retCode < 0) {
                     position.y = originalY;
                     return false;
                  }

                  if (retCode > 0 && position.y > resultY) {
                     resultY = position.y;
                     minYValue = resultY;
                     if (resultY > y) {
                        y = resultY;
                     }
                  }
               }
            }

            if (resultY < 0.0) {
               position.y = originalY;
               return false;
            } else {
               position.y = resultY - boundingBox.min.y;
               return true;
            }
         }
      }
   }

   public int translateToAccessiblePosition(@Nonnull Vector3d position, double minYValue, double maxYValue, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      if (position.getY() < 0.0) {
         return -1;
      } else {
         World world = ((EntityStore)componentAccessor.getExternalData()).getWorld();
         long chunkIndex = ChunkUtil.indexChunkFromBlock(position.getX(), position.getZ());
         WorldChunk chunk = world.getChunkIfInMemory(chunkIndex);
         if (chunk == null) {
            return -1;
         } else {
            BlockChunk blockChunk = chunk.getBlockChunk();
            BlockTypeAssetMap<String, BlockType> assetMap = BlockType.getAssetMap();
            int x = MathUtil.floor(position.getX());
            int y = MathUtil.floor(position.getY());
            int z = MathUtil.floor(position.getZ());
            if (y < 320) {
               int blockId = chunk.getBlock(x, y, z);
               if (blockId != 0) {
                  BlockType blockType = assetMap.getAsset(blockId);
                  int filler = chunk.getFiller(x, y, z);
                  boolean isFiller = filler != 0;
                  if (isFiller || blockType.getMaterial() == BlockMaterial.Solid) {
                     int maxY;
                     for(maxY = MathUtil.ceil(maxYValue); y < maxY; ++y) {
                        blockId = chunk.getBlock(x, y, z);
                        if (blockId == 0) {
                           break;
                        }

                        blockType = assetMap.getAsset(blockId);
                        filler = chunk.getFiller(x, y, z);
                        if (blockType.getMaterial() != BlockMaterial.Solid) {
                           break;
                        }
                     }

                     if (y == maxY) {
                        return 0;
                     } else {
                        --y;
                        blockType = chunk.getBlockType(x, y, z);
                        int rotation = chunk.getRotationIndex(x, y, z);
                        BlockBoundingBoxes boxesAsset = (BlockBoundingBoxes)BlockBoundingBoxes.getAssetMap().getAsset(blockType.getHitboxTypeIndex());
                        BlockBoundingBoxes.RotatedVariantBoxes rotatedBoxes = boxesAsset.get(rotation);
                        double top;
                        if (filler != 0) {
                           top = (double)(y - FillerBlockUtil.unpackY(filler)) + rotatedBoxes.getBoundingBox().max.y;
                        } else {
                           top = (double)y + rotatedBoxes.getBoundingBox().max.y;
                        }

                        if (top > maxYValue) {
                           return 0;
                        } else {
                           position.setY(top);
                           return 1;
                        }
                     }
                  }
               }
            } else {
               y = 319;
            }

            int indexSection = ChunkUtil.indexSection(y);

            while(indexSection >= 0) {
               BlockSection chunkSection = blockChunk.getSectionAtIndex(indexSection);
               if (chunkSection.isSolidAir()) {
                  y = 32 * indexSection - 1;
                  if ((double)y < minYValue) {
                     return 0;
                  }

                  --indexSection;
               } else {
                  int yBottom = 32 * indexSection--;

                  while(y >= yBottom) {
                     if ((double)y < minYValue) {
                        return 0;
                     }

                     int rotation = chunkSection.getRotationIndex(x, y, z);
                     int filler = chunkSection.getFiller(x, y, z);
                     int blockId = chunkSection.get(x, y--, z);
                     if (blockId != 0) {
                        BlockType blockType = assetMap.getAsset(blockId);
                        if (filler != 0) {
                           if (blockType.getMaterial() == BlockMaterial.Solid) {
                              BlockBoundingBoxes boundingBoxes = (BlockBoundingBoxes)BlockBoundingBoxes.getAssetMap().getAsset(blockType.getHitboxTypeIndex());
                              BlockBoundingBoxes.RotatedVariantBoxes rotatedBoxes = boundingBoxes.get(rotation);
                              double top = (double)(y + 1 - FillerBlockUtil.unpackY(filler)) + rotatedBoxes.getBoundingBox().max.y;
                              if (top < minYValue) {
                                 return 0;
                              }

                              position.setY(top);
                              return 1;
                           }
                        } else if (blockType.getMaterial() == BlockMaterial.Solid) {
                           BlockBoundingBoxes boundingBoxes = (BlockBoundingBoxes)BlockBoundingBoxes.getAssetMap().getAsset(blockType.getHitboxTypeIndex());
                           BlockBoundingBoxes.RotatedVariantBoxes rotatedBoxes = boundingBoxes.get(rotation);
                           double top = (double)(y + 1) + rotatedBoxes.getBoundingBox().max.y;
                           if (top < minYValue) {
                              return 0;
                           }

                           position.setY(top);
                           return 1;
                        }
                     }
                  }
               }
            }

            return 0;
         }
      }
   }

   protected double computeMove(@Nonnull Ref<EntityStore> ref, @Nonnull Role role, @Nonnull Steering steering, double dt, @Nonnull Vector3d translation, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      NPCEntity npcComponent = (NPCEntity)componentAccessor.getComponent(ref, NPCEntity.getComponentType());

      assert npcComponent != null;

      this.saveMotionKind();
      this.isFullyRotated = true;
      Vector3d direction = steering.getTranslation();
      direction.y = 0.0;
      this.currentRelativeSpeed = direction.length();
      if (!steering.hasPitch()) {
         steering.setPitch(0.0F);
      }

      double maxVerticalSpeed = this.inWater() ? this.maxVerticalSpeedFluid : this.maxVerticalSpeed;
      double maxHorizontalSpeed = this.getMaximumSpeed();
      boolean isDead = !this.isAlive(ref, componentAccessor);
      if (isDead) {
         this.climbUpDistance = 0.0;
         this.currentClimbForwardDistance = 0.0;
         this.maxClimbForwardDistance = 0.0;
         this.forceVelocity.assign(Vector3d.ZERO);
         this.appliedVelocities.clear();
         steering.setYaw(this.getYaw());
         if (this.onGround) {
            translation.assign(Vector3d.ZERO);
            steering.setPitch(0.0F);
         } else {
            steering.setPitch(this.getPitch());
            Velocity velocityComponent = (Velocity)componentAccessor.getComponent(ref, Velocity.getComponentType());
            Vector3d velocity = velocityComponent.getVelocity();
            translation.assign(velocity);
         }

         translation.y = this.computeNewFallSpeed(dt, translation.y);
         translation.scale(dt);
         this.validateTranslation(translation, "Death");
         return dt;
      } else if (this.forceVelocity.equals(Vector3d.ZERO) && this.appliedVelocities.isEmpty()) {
         if (this.cachedMovementBlocked) {
            return dt;
         } else {
            float heading = this.getYaw();
            if (this.getMotionKind() == MotionKind.ASCENDING) {
               if (this.isRequiresPreciseMovement() && this.havePreciseMovementTarget) {
                  double maxDistance = this.waypointDistance(this.preciseMovementTarget, this.position) + this.currentClimbForwardDistance;
                  if (maxDistance < this.maxClimbForwardDistance) {
                     this.maxClimbForwardDistance = maxDistance;
                  }
               }

               double distance = dt * this.climbSpeed;
               if (this.jumping) {
                  if (this.climbUpDistance > 0.0) {
                     distance *= Math.max(Math.pow(this.climbUpDistance * this.climbUpDistance * this.jumpForce, this.jumpBlending), 1.0);
                     this.climbUpDistance = this.computeClimbMove(this.climbUpDirection, this.climbUpDistance, distance, translation);
                  } else if (this.jumpDropHeight > 0.0) {
                     double jumpDiff = this.currentJumpHeight - this.jumpDropHeight;
                     distance *= Math.max(Math.pow(jumpDiff * jumpDiff * this.jumpDescentSteepness, this.jumpDescentBlending), 1.0);
                     this.jumpDropHeight = this.computeClimbMove(this.jumpDropDirection, this.jumpDropHeight, distance, translation);
                  } else {
                     this.setMotionKind(MotionKind.DROPPING);
                  }

                  double heightAboveBlock = this.currentJumpHeight - this.climbUpDistance - translation.y;
                  double moveDistance = 0.0;
                  if (heightAboveBlock > this.jumpBlockHeight) {
                     double percentage;
                     if (this.climbUpDistance > 0.0) {
                        percentage = (heightAboveBlock - this.jumpBlockHeight) / heightAboveBlock / 2.0;
                     } else {
                        percentage = 0.5 + (1.0 - this.jumpDropHeight / (this.currentJumpHeight - this.jumpBlockHeight)) / 2.0;
                     }

                     double expectedDistance = this.maxClimbForwardDistance * percentage;
                     if (expectedDistance > this.maxClimbForwardDistance) {
                        expectedDistance = this.maxClimbForwardDistance;
                     }

                     moveDistance = expectedDistance - this.currentClimbForwardDistance;
                     if (moveDistance < 0.0) {
                        moveDistance = 0.0;
                     }

                     this.currentClimbForwardDistance = expectedDistance;
                     translation.add(this.climbForwardDirection.x * moveDistance, 0.0, this.climbForwardDirection.z * moveDistance);
                  }

                  if (this.isBlendingHeading) {
                     heading = this.computeBlendHeading(heading, NPCPhysicsMath.headingFromDirection(this.climbForwardDirection.x, this.climbForwardDirection.z, heading), dt, moveDistance / dt, steering.getRelativeTurnSpeed());
                  }

                  this.lockOrientation(steering, translation, heading);
                  this.fallSpeed = 0.0;
                  this.onGround = false;
                  this.validateTranslation(translation, "AscendingJump");
                  return dt;
               } else {
                  double moveDistance;
                  if (this.climbUpDistance > 0.0) {
                     double prevDistance = this.climbUpDistance;
                     this.climbUpDistance = this.computeClimbMove(this.climbUpDirection, prevDistance, distance, translation);
                     moveDistance = prevDistance - this.climbUpDistance;
                  } else if (this.currentClimbForwardDistance < this.maxClimbForwardDistance) {
                     double remaining = this.maxClimbForwardDistance - this.currentClimbForwardDistance;
                     if (distance < remaining) {
                        double newRemaining = remaining - distance;
                        moveDistance = newRemaining <= 1.0E-5 ? remaining : distance;
                     } else {
                        moveDistance = remaining;
                     }

                     this.currentClimbForwardDistance += moveDistance;
                     translation.assign(this.climbForwardDirection).scale(moveDistance);
                     this.onGround = false;
                  } else {
                     this.setMotionKind(MotionKind.DROPPING);
                     moveDistance = 0.0;
                  }

                  if (this.isBlendingHeading) {
                     heading = this.computeBlendHeading(heading, NPCPhysicsMath.headingFromDirection(this.climbForwardDirection.x, this.climbForwardDirection.z, heading), dt, moveDistance / dt, steering.getRelativeTurnSpeed());
                  }

                  this.lockOrientation(steering, translation, heading);
                  this.fallSpeed = 0.0;
                  this.onGround = false;
                  this.validateSpeeds(ref, "Ascending", componentAccessor);
                  this.validateTranslation(translation, "Ascending");
                  return dt;
               }
            } else if (this.getMotionKind() == MotionKind.DESCENDING) {
               double maxForwardSpeed = this.currentRelativeSpeed * maxHorizontalSpeed;
               if (this.isRequiresPreciseMovement() && this.havePreciseMovementTarget) {
                  double maxForwardDistance = this.waypointDistance(this.position, this.preciseMovementTarget);
                  if (maxForwardDistance < maxForwardSpeed * dt) {
                     maxForwardSpeed = maxForwardDistance / dt;
                  }
               }

               this.fallSpeed = MathUtil.maxValue(0.0, NPCPhysicsMath.accelerateDragCapped(this.fallSpeed, 5.0 * this.gravity, dt, maxVerticalSpeed));
               this.moveSpeed = MathUtil.clamp(maxForwardSpeed, 0.0, this.moveSpeed + dt * this.acceleration);
               if (this.moveSpeed > maxHorizontalSpeed) {
                  this.moveSpeed = maxHorizontalSpeed;
               }

               if (this.moveSpeed <= 0.3 * this.maxHorizontalSpeed) {
                  this.setMotionKind(MotionKind.DROPPING);
               }

               double vertical = this.climbForwardDirection.y;
               if (this.predictedFallHeight > 0.0) {
                  this.totalDropDistance += Math.abs(this.climbForwardDirection.y * this.moveSpeed * dt);
                  double scaledDiff = Math.min(this.totalDropDistance / this.predictedFallHeight, 1.0);
                  vertical *= Math.pow(this.descentSteepness, this.descentBlending) * Math.pow(scaledDiff, this.descentBlending);
               }

               translation.assign(this.climbForwardDirection.x, vertical, this.climbForwardDirection.z);
               translation.scale(this.moveSpeed * dt);
               translation.clipToZero(this.getEpsilonSpeed());
               if (this.isBlendingHeading) {
                  heading = this.computeBlendHeading(heading, NPCPhysicsMath.headingFromDirection(this.climbForwardDirection.x, this.climbForwardDirection.z, heading), dt, this.moveSpeed, steering.getRelativeTurnSpeed());
               }

               this.lockOrientation(steering, translation, heading);
               this.validateSpeeds(ref, "Descending", componentAccessor);
               this.validateTranslation(translation, "Descending");
               return dt;
            } else {
               this.validateSpeeds(ref, "Enter Walk/Drop", componentAccessor);
               boolean canAct = this.canAct(ref, componentAccessor);
               boolean isBlendResting = false;
               float moveHeading;
               if (canAct) {
                  moveHeading = NPCPhysicsMath.headingFromDirection(direction.x, direction.z, heading);
                  if (this.isRequiresPreciseMovement() && !this.isBlendingHeading) {
                     float turnAngle = NPCPhysicsMath.turnAngle(heading, moveHeading);
                     float epsilon = this.getEpsilonAngle();
                     if (turnAngle < -epsilon || turnAngle > epsilon) {
                        float maxRotation = (float)MathUtil.clamp(dt * this.getCurrentMaxBodyRotationSpeed() * steering.getRelativeTurnSpeed(), 0.0, 1.5707963705062866);
                        turnAngle = MathUtil.clamp(turnAngle, -maxRotation, maxRotation);
                        heading = PhysicsMath.normalizeTurnAngle(heading + turnAngle);
                        translation.assign(0.0, 0.0, 0.0);
                        steering.setYaw(heading);
                        this.isFullyRotated = false;
                        return dt;
                     }

                     heading = moveHeading;
                  }

                  this.moveSpeed = MathUtil.clamp(this.currentRelativeSpeed * maxHorizontalSpeed, 0.0, this.moveSpeed + dt * this.acceleration);
                  if (this.fallSpeed > 0.0) {
                     this.fallSpeed = 0.0;
                  }

                  if (this.moveSpeed < this.getEpsilonSpeed()) {
                     this.moveSpeed = 0.0;
                  } else if (this.moveSpeed < this.minHorizontalSpeed) {
                     this.moveSpeed = this.minHorizontalSpeed;
                  }

                  if (this.isBlendingHeading) {
                     if (this.blendRestTurnAngle > 0.0F) {
                        float turnAngle = this.computeBlendTurnAngle(heading, moveHeading);
                        if (Math.abs(turnAngle) > this.blendRestTurnAngle) {
                           isBlendResting = true;
                        }

                        heading = this.computeBlendHeading(heading, moveHeading, dt, this.moveSpeed, turnAngle, steering.getRelativeTurnSpeed());
                     } else {
                        heading = this.computeBlendHeading(heading, moveHeading, dt, this.moveSpeed, steering.getRelativeTurnSpeed());
                     }

                     steering.setYaw(heading);
                     this.isFullyRotated = true;
                  } else if (steering.hasYaw()) {
                     heading = this.computeHeading(steering.getYaw(), steering.getRelativeTurnSpeed(), heading, dt, false, false);
                     steering.setYaw(heading);
                  } else if (this.moveSpeed != 0.0) {
                     heading = this.computeHeading(moveHeading, steering.getRelativeTurnSpeed(), heading, dt, true, true);
                     moveHeading = heading;
                     steering.setYaw(heading);
                  }

                  if (this.debugModeSteer) {
                     LOGGER.at(Level.INFO).log("=== Compute = t =%.4f v =%.4f h =%.4f mh=%.4f", dt, this.moveSpeed, 57.295776F * heading, 57.295776F * moveHeading);
                  }
               } else {
                  Velocity velocityComponent = (Velocity)componentAccessor.getComponent(ref, Velocity.getComponentType());
                  Vector3d velocity = velocityComponent.getVelocity();
                  moveHeading = NPCPhysicsMath.headingFromDirection(velocity.x, velocity.z, heading);
                  if (!steering.hasYaw()) {
                     steering.setYaw(heading);
                  }

                  if (this.maxHover > 0.0 && this.floatsDown) {
                     this.fallSpeed = this.climbSpeedConst;
                     if (this.fallSpeed != 0.0 && this.climbSpeedMult != 0.0) {
                        double prevFallSpeed = this.fallSpeed;
                        double deltaFallSpeed = this.climbSpeedMult * Math.pow(prevFallSpeed, this.climbSpeedPow);
                        this.fallSpeed += deltaFallSpeed;
                     }
                  } else {
                     double prevFallSpeed = this.fallSpeed;
                     this.fallSpeed = -NPCPhysicsMath.gravityDrag(-prevFallSpeed, 5.0 * this.gravity, dt, maxVerticalSpeed);
                  }
               }

               if (this.moveSpeed > maxHorizontalSpeed) {
                  this.moveSpeed = maxHorizontalSpeed;
               }

               if (this.fallSpeed > maxVerticalSpeed) {
                  this.fallSpeed = maxVerticalSpeed;
               } else if (this.fallSpeed < -maxVerticalSpeed) {
                  this.fallSpeed = -maxVerticalSpeed;
               }

               double appliedSpeed = this.moveSpeed;
               if (isBlendResting) {
                  double maxSpeed = this.blendRestRelativeSpeed * this.getMaximumSpeed();
                  if (appliedSpeed > maxSpeed) {
                     appliedSpeed = maxSpeed;
                  }
               }

               translation.x = appliedSpeed * dt * (double)PhysicsMath.headingX(moveHeading);
               translation.z = appliedSpeed * dt * (double)PhysicsMath.headingZ(moveHeading);
               translation.y = -this.fallSpeed * dt;
               double maxDistance = steering.getMaxDistance();
               if (this.canAct(ref, componentAccessor) && maxDistance < 1.7976931348623157E308 && maxDistance > 0.0) {
                  double lenSquared = NPCPhysicsMath.dotProduct(translation.x, translation.y, translation.z, this.getComponentSelector());
                  double len = Math.sqrt(lenSquared);
                  if (len > maxDistance) {
                     translation.scale(maxDistance / len);
                  }
               }

               this.validateSpeeds(ref, canAct ? "Moving" : "Falling", componentAccessor);
               this.validateTranslation(translation, canAct ? "Moving" : "Falling");
               return dt;
            }
         }
      } else {
         this.climbUpDistance = 0.0;
         this.currentClimbForwardDistance = 0.0;
         this.maxClimbForwardDistance = 0.0;
         translation.assign(this.forceVelocity);

         for(int i = 0; i < this.appliedVelocities.size(); ++i) {
            MotionControllerBase.AppliedVelocity entry = (MotionControllerBase.AppliedVelocity)this.appliedVelocities.get(i);
            if (entry.velocity.y + this.forceVelocity.y <= 0.0 || entry.velocity.y < 0.0) {
               entry.canClear = true;
            }

            if (this.onGround && entry.canClear) {
               entry.velocity.y = 0.0;
            }

            translation.add(entry.velocity);
         }

         translation.scale(dt);
         if (this.onGround && this.forceVelocity.y < 0.0) {
            if (translation.y < 0.0) {
               translation.y = 0.0;
               this.forceVelocity.y = 0.0;
            }
         } else {
            this.forceVelocity.y = this.computeNewFallSpeed(dt, this.forceVelocity.y);
         }

         if (!this.appliedForce.equals(Vector3d.ZERO)) {
            if (this.moveSpeed > 0.0) {
               float headingX = PhysicsMath.headingX(this.getYaw());
               float headingZ = PhysicsMath.headingZ(this.getYaw());
               double length2 = this.appliedForce.x * this.appliedForce.x + this.appliedForce.z * this.appliedForce.z;
               double multiplier = length2 > 0.0 ? ((double)headingX * this.appliedForce.x + (double)headingZ * this.appliedForce.z) / Math.sqrt(length2) : 0.0;
               multiplier = Math.min((multiplier + 1.0) / 2.0, this.maxWalkSpeedAfterHitMultiplier);
               this.moveSpeed *= multiplier;
               if (this.moveSpeed > this.minHorizontalSpeed) {
                  translation.add(this.moveSpeed * dt * (double)headingX, 0.0, this.moveSpeed * dt * (double)headingZ);
                  this.currentRelativeSpeed = this.moveSpeed;
               } else {
                  this.moveSpeed = 0.0;
               }
            }

            if (this.maxHover > 0.0) {
               npcComponent.setHoverHeight(translation.y <= 0.0 ? this.minHoverDrop : this.maxHover);
            }

            this.appliedForce.assign(Vector3d.ZERO);
         }

         if (this.onGround && this.ignoreDamping) {
            double speed = this.forceVelocity.length() - dt * this.inertia * this.acceleration * 5.0;
            if (speed > 0.0) {
               this.forceVelocity.setLength(speed);
            } else {
               this.forceVelocity.assign(Vector3d.ZERO);
            }
         }

         steering.setYaw(this.getYaw());
         this.validateTranslation(translation, "ExtForce");
         return dt;
      }
   }

   private double computeNewFallSpeed(double dt, double fallSpeed) {
      Box hitbox = this.collisionBoundingBox;
      int invertedGravityModifier = this.movementSettings.invertedGravity ? 1 : -1;
      double terminalVelocity = (double)invertedGravityModifier * PhysicsMath.getTerminalVelocity((double)this.movementSettings.mass, 0.001225, Math.abs((hitbox.max.x - hitbox.min.x) * (hitbox.max.z - hitbox.min.z)), (double)this.movementSettings.dragCoefficient);
      double gravityStep = (double)invertedGravityModifier * PhysicsMath.getAcceleration(fallSpeed, terminalVelocity) * dt;
      if (fallSpeed < terminalVelocity && gravityStep > 0.0) {
         fallSpeed = Math.min(fallSpeed + gravityStep, terminalVelocity);
      } else if (fallSpeed > terminalVelocity && gravityStep < 0.0) {
         fallSpeed = Math.max(fallSpeed + gravityStep, terminalVelocity);
      }

      return fallSpeed;
   }

   protected double executeMove(@Nonnull Ref<EntityStore> ref, @Nonnull Role role, double dt, @Nonnull Vector3d translation, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      if (this.debugModeMove) {
         LOGGER.at(Level.INFO).log("Move: Execute pos=%s vel=%s onGround=%s blocked=%s canAct=%s avdDmg=%s relax=%s", Vector3d.formatShortString(this.position), Vector3d.formatShortString(translation), this.onGround, this.isObstructed, this.canAct(ref, componentAccessor), this.isAvoidingBlockDamage(), this.isRelaxedMoveConstraints());
      }

      this.collisionResult.setCollisionByMaterial(4, this.isRelaxedMoveConstraints ? 13 : 5);
      this.resetObstructedFlags();
      if (this.debugModeBlockCollisions) {
         this.collisionResult.setLogger(LOGGER);
      }

      boolean avoidingBlockDamage = this.isAvoidingBlockDamage() && this.canAct(ref, componentAccessor);
      boolean relaxMoveConstraints = this.isRelaxedMoveConstraints() || !this.canAct(ref, componentAccessor);
      boolean oldState = this.collisionResult.setDamageBlocking(avoidingBlockDamage);
      boolean shortMove = !CollisionModule.findCollisions(this.collisionBoundingBox, this.position, translation, false, this.collisionResult, componentAccessor);
      this.collisionResult.setDamageBlocking(oldState);
      if (this.debugModeBlockCollisions) {
         this.collisionResult.setLogger((HytaleLogger)null);
      }

      if (this.debugModeCollisions) {
         this.dumpCollisionResults();
      }

      BlockCollisionData collision = this.getFirstCollision(this.collisionResult, avoidingBlockDamage);
      double startSlide;
      double endSlide;
      if (this.collisionResult.isSliding) {
         startSlide = this.collisionResult.slideStart;
         endSlide = this.collisionResult.slideEnd;
         if (this.onGround) {
            collision = this.discardIgnorableSlideCollisions(this.collisionResult, collision, avoidingBlockDamage);
         }
      } else {
         startSlide = 1.7976931348623157E308;
         endSlide = 1.7976931348623157E308;
      }

      boolean tryClimb = false;
      boolean needsRotation = this.isRequiresPreciseMovement() && !this.isFullyRotated;
      this.lastValidPosition.assign(this.position);
      if (collision == null) {
         boolean wasOnGround = this.onGround;
         double triggerScale;
         if (wasOnGround && !(endSlide >= 1.0)) {
            boolean canAct = this.canAct(ref, componentAccessor);
            this.onGround = false;
            if (canAct) {
               if (needsRotation) {
                  this.onGround = true;
                  this.isObstructed = false;
                  endSlide = this.shortenSlide(translation, endSlide);
               } else if (this.isRequiresDepthProbing()) {
                  this.tmpMovePosition.assign(this.position).addScaled(translation, endSlide);
                  if (this.isDropBlocked(this.tmpMovePosition, this.maxDropHeight, false, avoidingBlockDamage, this.isRelaxedMoveConstraints, componentAccessor)) {
                     endSlide = this.shortenSlide(translation, endSlide);
                     this.isObstructed = true;
                     this.onGround = true;
                  }
               }
            }

            this.position.addScaled(translation, endSlide);
            triggerScale = endSlide;
            dt *= endSlide;
         } else {
            this.position.add(translation);
            this.onGround = startSlide <= 1.0 && endSlide >= 1.0;
            triggerScale = 1.0;
         }

         if (this.getMotionKind() != MotionKind.ASCENDING) {
            if (!this.onGround) {
               if (this.initiateDescend(translation, wasOnGround, "No collision", componentAccessor)) {
                  this.position.assign(this.lastValidPosition);
                  this.moveSpeed = 0.0;
                  triggerScale = 0.0;
               }
            } else {
               this.setMotionKind(!this.isObstructed && NPCPhysicsMath.projectedLengthSquared(translation, this.getComponentSelector()) > 0.0 ? MotionKind.MOVING : MotionKind.STANDING);
            }
         }

         if (!this.isValidPosition(this.position, this.collisionResult, componentAccessor)) {
            if (this.getMotionKind() == MotionKind.DESCENDING) {
               this.setMotionKind(MotionKind.DROPPING);
            }

            double scale = this.bisect(this.lastValidPosition, this.position, this.position, componentAccessor);
            triggerScale *= scale;
            if (this.debugModeMove) {
               LOGGER.at(Level.INFO).log("Move: No collision, bisect onGround was/is=%s/%s slide=%s/%s scale=%s newpos=%s state=%s blocked=%s", wasOnGround, this.onGround, startSlide, endSlide, scale, Vector3d.formatShortString(this.position), this.getMotionKind(), this.isObstructed);
            }

            if (scale == 0.0) {
               this.isObstructed = true;
            }
         } else if (this.debugModeMove) {
            LOGGER.at(Level.INFO).log("Move: No collision onGround was/is=%s/%s slide=%s/%s newpos=%s state=%s", wasOnGround, this.onGround, startSlide, endSlide, Vector3d.formatShortString(this.position), this.getMotionKind());
         }

         this.processTriggers(ref, this.collisionResult, triggerScale, componentAccessor);
      } else {
         if (this.debugModeValidatePositions && !this.isValidPosition(this.position, this.collisionResult, componentAccessor)) {
            throw new IllegalStateException("Invalid position");
         }

         double triggerScale = collision.collisionStart;
         this.position.assign(collision.collisionPoint);
         Vector3d remainingTranslation = this.lastValidPosition.clone().add(translation).subtract(collision.collisionPoint);
         if (!remainingTranslation.equals(Vector3d.ZERO)) {
            double t = remainingTranslation.dot(collision.collisionNormal);
            remainingTranslation.addScaled(collision.collisionNormal, -t);
            this.position.add(remainingTranslation);
         }

         if (!this.isValidPosition(this.position, this.collisionResult, componentAccessor)) {
            double scale = this.bisect(this.lastValidPosition, this.position, this.position, componentAccessor);
            triggerScale *= scale;
            if (this.debugModeMove) {
               LOGGER.at(Level.INFO).log("Move: Collision bisect=%s triggerScale=%s", scale, triggerScale);
            }
         }

         if (collision.collisionNormal.equals(this.getWorldNormal())) {
            if (this.onGround && this.isRelaxedMoveConstraints && !this.isDropBlocked(this.position, this.maxDropHeight, false, avoidingBlockDamage, this.isRelaxedMoveConstraints, componentAccessor)) {
               this.initiateDescend(translation, true, "Collision", componentAccessor);
               this.onGround = false;
            } else {
               if (this.onGround) {
                  this.isObstructed = true;
                  if (avoidingBlockDamage && collision.willDamage) {
                     triggerScale = this.shortenMovement(triggerScale);
                  }
               } else if (this.getMotionKind() == MotionKind.DROPPING) {
                  double fallHeight = this.fallStartHeight - this.position.y;
                  if (fallHeight >= this.maxDropHeight) {
                     this.moveSpeed = 0.0;
                  } else if (fallHeight > this.maxClimbHeight) {
                     this.moveSpeed *= (fallHeight - this.maxClimbHeight) / (this.maxDropHeight - this.maxClimbHeight);
                     this.validateSpeeds(ref, "Collision on Ground", componentAccessor);
                  }
               }

               this.setMotionKind(MotionKind.STANDING);
               if (this.debugModeMove) {
                  LOGGER.at(Level.INFO).log("Move: Collision Up onGround=%s/%s blocked=%s newpos=%s state=%s", this.onGround, true, this.isObstructed, Vector3d.formatShortString(this.position), this.getMotionKind());
               }

               if (!this.onGround) {
                  this.onGround = true;
                  this.postReadPosition(ref, componentAccessor);
               }

               this.onGround = true;
            }
         } else if (this.forceVelocity.equals(Vector3d.ZERO) && this.appliedVelocities.isEmpty()) {
            if (collision.collisionNormal.equals(this.getWorldAntiNormal())) {
               this.fallSpeed = 0.0;
               this.setMotionKind(MotionKind.DROPPING);
               if (this.debugModeMove) {
                  LOGGER.at(Level.INFO).log("Move: No ext force, collision down, clear vert speed newpos=%s state=%s", Vector3d.formatShortString(this.position), this.getMotionKind());
               }
            } else {
               this.setMotionKind(MotionKind.STANDING);
               if (!shortMove && !needsRotation && this.canAct(ref, componentAccessor) && collision.blockType != null && this.isClimbable(collision.blockType, collision.fluid, avoidingBlockDamage)) {
                  tryClimb = this.tryClimb(translation, avoidingBlockDamage, relaxMoveConstraints, componentAccessor);
                  if (this.debugModeMove) {
                     LOGGER.at(Level.INFO).log("Move: No ext force, collision horz, try climb h=%s succ=%s newpos(succ|fail)=%s|%s state=%s", this.climbUpDistance, tryClimb, Vector3d.formatShortString(this.tmpMovePosition), Vector3d.formatShortString(this.position), this.getMotionKind());
                  }
               } else {
                  tryClimb = false;
                  if (avoidingBlockDamage && collision.willDamage) {
                     triggerScale = this.shortenMovement(triggerScale);
                  }

                  if (this.debugModeMove) {
                     LOGGER.at(Level.INFO).log("Move: No ext force, collision horz, don't try climb onGround %s, block %s newpos=%s state=%s", this.onGround, collision.blockType != null, Vector3d.formatShortString(this.position), this.getMotionKind());
                  }
               }

               this.isObstructed = this.isFullyRotated && !tryClimb && !shortMove;
            }
         } else {
            if (this.ignoreDamping) {
               this.ignoreDamping = false;
               this.clearForce();
            }

            int count = this.collisionResult.getBlockCollisionCount();

            for(int i = 0; i < count; ++i) {
               BlockCollisionData c = this.collisionResult.getBlockCollision(i);
               if (c.collisionNormal.equals(this.getWorldNormal())) {
                  this.onGround = true;
                  this.fallSpeed = 0.0;
                  break;
               }
            }

            this.setMotionKind(MotionKind.DROPPING);
            if (collision.collisionNormal.equals(this.getWorldAntiNormal())) {
               this.fallSpeed = 0.0;
               if (this.debugModeMove) {
                  LOGGER.at(Level.INFO).log("Move: Ext force, collision down, clear force and vert speed newpos=%s state=%s", Vector3d.formatShortString(this.position), this.getMotionKind());
               }
            } else if (this.debugModeMove) {
               LOGGER.at(Level.INFO).log("Move: Ext force, collision not down, clear force newpos=%s state=%s", Vector3d.formatShortString(this.position), this.getMotionKind());
            }
         }

         this.processTriggers(ref, this.collisionResult, triggerScale, componentAccessor);
         dt *= triggerScale;
      }

      if (tryClimb && !this.isProcessTriggersHasMoved()) {
         this.setMotionKind(MotionKind.ASCENDING);
         this.climbUpDirection.assign(this.getWorldNormal());
         this.climbForwardDirection.assign(translation).normalize();
         this.climbSpeed = this.computeClimbSpeed(this.moveSpeed);
         this.onGround = false;
         if (this.debugModeMove) {
            LOGGER.at(Level.INFO).log("Move: No ext force, collision horz, start climbing h=%s forw=%s state=%s", this.climbUpDistance, this.maxClimbForwardDistance, this.getMotionKind());
         }

         if (this.debugModeValidatePositions && !this.isValidPosition(this.position, this.collisionResult, componentAccessor)) {
            throw new IllegalStateException("Invalid position");
         }
      }

      if (this.debugModeValidatePositions && !this.isValidPosition(this.position, this.collisionResult, componentAccessor)) {
         LOGGER.at(Level.WARNING).log("Move: Walked on invalid position pos=%s/%s/%s overlaps=%s", this.position.x, this.position.y, this.position.z, this.collisionResult.getBlockCollisionCount());
      }

      return dt;
   }

   public double probeMove(@Nonnull Ref<EntityStore> ref, @Nonnull ProbeMoveData probeMoveData, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      World world = ((EntityStore)componentAccessor.getExternalData()).getWorld();
      boolean saveSegments = probeMoveData.startProbing();
      Vector3d probeMovement = probeMoveData.probeDirection;
      double distanceLeftSquared = NPCPhysicsMath.projectedLengthSquared(probeMovement, this.getComponentSelector());
      if (distanceLeftSquared == 0.0) {
         return 0.0;
      } else {
         this.collisionResult.setCollisionByMaterial(4, probeMoveData.isRelaxedMoveConstraints ? 13 : 5);
         Vector3d probePosition = probeMoveData.probePosition;
         Vector3d initialPosition = probeMoveData.initialPosition;
         Vector3d targetPosition = probeMoveData.targetPosition;
         Vector3d directionComponentSelector = probeMoveData.directionComponentSelector;
         CollisionModule collisionModule = CollisionModule.get();
         boolean onGround;
         if (initialPosition.equals(this.position)) {
            onGround = this.onGround;
         } else {
            onGround = collisionModule.validatePosition(world, this.collisionBoundingBox, probePosition, this.collisionResult) == 1;
         }

         directionComponentSelector.assign(this.getComponentSelector());
         probeMovement.scale(directionComponentSelector);
         boolean stopOnDamageBlocks = probeMoveData.isAvoidingBlockDamage;
         boolean relaxedMoveConstraints = probeMoveData.isRelaxedMoveConstraints;
         if (saveSegments) {
            probeMoveData.addStartSegment(initialPosition, true);
         }

         if (!onGround) {
            if (this.isDropBlocked(probePosition, this.maxDropHeight, true, stopOnDamageBlocks, relaxedMoveConstraints, componentAccessor)) {
               if (saveSegments) {
                  probeMoveData.addBlockedDropSegment(probePosition, this.waypointDistance(initialPosition, probePosition));
                  return probeMoveData.getLastDistance();
               }

               return this.waypointDistance(initialPosition, probePosition);
            }

            if (saveSegments) {
               probeMoveData.addDropSegment(probePosition, this.waypointDistance(initialPosition, probePosition));
            }
         }

         while(distanceLeftSquared > 0.0) {
            if (this.debugModeProbeBlockCollisions) {
               this.collisionResult.setLogger(LOGGER);
            }

            boolean oldState = this.collisionResult.setDamageBlocking(stopOnDamageBlocks);
            boolean shortMove = !CollisionModule.findCollisions(this.collisionBoundingBox, probePosition, probeMovement, this.collisionResult, componentAccessor);
            this.collisionResult.setDamageBlocking(oldState);
            if (this.debugModeProbeBlockCollisions) {
               this.collisionResult.setLogger((HytaleLogger)null);
            }

            if (this.debugModeMove) {
               LOGGER.at(Level.INFO).log("Probe Step: pos=%s mov=%s left=%s", Vector3d.formatShortString(probePosition), Vector3d.formatShortString(probeMovement), Math.sqrt(distanceLeftSquared));
            }

            if (this.debugModeCollisions) {
               this.dumpCollisionResults();
            }

            BlockCollisionData collision = this.getFirstCollision(this.collisionResult, stopOnDamageBlocks);
            double endSlide = this.collisionResult.isSliding ? this.collisionResult.slideEnd : 1.7976931348623157E308;
            if (this.collisionResult.isSliding) {
               collision = this.discardIgnorableSlideCollisions(this.collisionResult, collision, stopOnDamageBlocks);
            }

            if (collision != null && collision.collisionStart <= endSlide) {
               if (stopOnDamageBlocks && collision.willDamage) {
                  this.shortenMovement(probePosition, collision.collisionPoint, probePosition);
                  distanceLeftSquared = 0.0;
               } else {
                  probePosition.assign(collision.collisionPoint);
                  distanceLeftSquared = this.updateMovementVector(probePosition, probeMovement, targetPosition, directionComponentSelector);
               }

               if (collision.collisionNormal.equals(this.getWorldNormal())) {
                  double distance = this.waypointDistance(initialPosition, probePosition);
                  if (saveSegments) {
                     probeMoveData.addBlockedGroundSegment(probePosition, distance, collision.collisionNormal, collision.blockId);
                  }

                  return distance;
               }

               if (saveSegments) {
                  probeMoveData.addHitWallSegment(probePosition, true, this.waypointDistance(initialPosition, probePosition), collision.collisionNormal, collision.blockId);
               }

               int blockId = collision.blockId;
               if (collision.blockType == null || distanceLeftSquared < 0.010000000000000002 || !this.isClimbable(collision.blockType, collision.fluid, stopOnDamageBlocks)) {
                  if (saveSegments) {
                     probeMoveData.changeSegmentToBlockedWall();
                  }

                  return this.waypointDistance(initialPosition, probePosition);
               }

               double climbHeight = shortMove ? 0.0 : this.computeClimbHeight(probePosition, probeMovement, this.maxClimbHeight, 0.1, (Vector3d)null, this.tmpClimbHeightResults, stopOnDamageBlocks, relaxedMoveConstraints, componentAccessor);
               if (climbHeight <= 0.0) {
                  if (saveSegments) {
                     probeMoveData.changeSegmentToBlockedWall();
                  }

                  return this.waypointDistance(initialPosition, probePosition);
               }

               probePosition.addScaled(this.getWorldNormal(), climbHeight);
               if (saveSegments) {
                  probeMoveData.addClimbSegment(probePosition, this.waypointDistance(initialPosition, probePosition), blockId);
               }

               distanceLeftSquared = this.updateMovementVector(probePosition, probeMovement, targetPosition, directionComponentSelector);
            } else {
               if (endSlide >= 1.0) {
                  probePosition.add(probeMovement);
                  probeMovement.assign(Vector3d.ZERO);
                  double distance = this.waypointDistance(initialPosition, probePosition);
                  if (saveSegments) {
                     probeMoveData.addMoveSegment(probePosition, true, distance);
                  }

                  return distance;
               }

               probePosition.addScaled(probeMovement, endSlide);
               if (saveSegments) {
                  probeMoveData.addHitEdgeSegment(probePosition, this.waypointDistance(initialPosition, probePosition));
               }

               if (this.isDropBlocked(probePosition, this.maxDropHeight, true, stopOnDamageBlocks, relaxedMoveConstraints, componentAccessor)) {
                  probeMovement.assign(targetPosition).subtract(probePosition).scale(directionComponentSelector);
                  if (saveSegments) {
                     probeMoveData.changeSegmentToBlockedEdge();
                     return probeMoveData.getLastDistance();
                  }

                  return this.waypointDistance(initialPosition, probePosition);
               }

               if (saveSegments) {
                  probeMoveData.addDropSegment(probePosition, this.waypointDistance(initialPosition, probePosition));
               }

               distanceLeftSquared = this.updateMovementVector(probePosition, probeMovement, targetPosition, directionComponentSelector);
            }
         }

         double distance = this.waypointDistance(initialPosition, probePosition);
         if (saveSegments) {
            probeMoveData.addEndSegment(probePosition, true, distance);
         }

         return distance;
      }
   }

   protected void postExecuteMove() {
      if (this.isObstructed && !this.onGround) {
         this.moveSpeed = 0.0;
      }

   }

   public double getCurrentMaxBodyRotationSpeed() {
      return this.maxRotationSpeed * this.effectHorizontalSpeedMultiplier;
   }

   protected float computeHeading(float desiredAngle, double relativeTurnSpeed, float heading, double dt, boolean updateFullyRotated, boolean stopIfTurnedTooFar) {
      double turnAngle = (double)NPCPhysicsMath.turnAngle(heading, desiredAngle);
      double epsilonAngle = (double)this.getEpsilonAngle();
      if (turnAngle >= -epsilonAngle && turnAngle <= epsilonAngle) {
         heading = desiredAngle;
         if (updateFullyRotated) {
            this.isFullyRotated = true;
         }
      } else {
         double maxRotation = dt * this.getCurrentMaxBodyRotationSpeed() * relativeTurnSpeed;
         turnAngle = MathUtil.clamp(turnAngle, -maxRotation, maxRotation);
         heading = PhysicsMath.normalizeTurnAngle((float)((double)heading + turnAngle));
         if (updateFullyRotated) {
            this.isFullyRotated = false;
         }
      }

      if (stopIfTurnedTooFar && Math.abs(turnAngle) > (double)this.maxMoveTurnAngle) {
         this.moveSpeed = 0.0;
      }

      return heading;
   }

   protected boolean initiateDescend(@Nonnull Vector3d translation, boolean wasOnGround, String logName, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      if (wasOnGround && this.getMotionKind() != MotionKind.DESCENDING && this.getMotionKind() != MotionKind.DROPPING) {
         this.fallStartHeight = this.position.y;
         this.fallSpeed = 0.0;
         this.predictedFallHeight = this.dropDistance(this.position, this.maxDropHeight, componentAccessor);
         this.totalDropDistance = 0.0;
         this.computeDescendDirection(translation);
         if (this.debugModeMove) {
            LOGGER.at(Level.INFO).log("Move: %s, descend init %s %s", logName, this.moveSpeed, this.climbForwardDirection.toString());
         }
      }

      if (this.getMotionKind() != MotionKind.DROPPING) {
         if (this.fallStartHeight - this.position.y > this.maxClimbHeight || this.dropDistance(this.position, this.maxDropHeight, componentAccessor) > this.maxClimbHeight + 1.0E-5) {
            if (this.debugModeMove) {
               LOGGER.at(Level.INFO).log("Move: %s, dropping %s %s %s %s", logName, this.moveSpeed, this.fallStartHeight - this.position.y, this.dropDistance(this.position, this.maxDropHeight, componentAccessor), this.climbForwardDirection.toString());
            }

            boolean descendToDrop = this.getMotionKind() == MotionKind.DESCENDING;
            this.setMotionKind(MotionKind.DROPPING);
            return descendToDrop;
         }

         if (this.getMotionKind() != MotionKind.DESCENDING) {
            if (this.debugModeMove) {
               LOGGER.at(Level.INFO).log("Move: %s, descending %s %s", logName, this.moveSpeed, this.climbForwardDirection.toString());
            }

            this.setMotionKind(MotionKind.DESCENDING);
         }
      }

      return false;
   }

   protected double updateMovementVector(@Nonnull Vector3d probePosition, @Nonnull Vector3d probeMovement, @Nonnull Vector3d targetPosition, @Nonnull Vector3d directionComponentSelector) {
      probeMovement.assign(targetPosition).subtract(probePosition).scale(directionComponentSelector);
      return this.waypointDistanceSquared(probePosition, targetPosition);
   }

   @Nullable
   private BlockCollisionData discardIgnorableSlideCollisions(@Nonnull CollisionResult collisionResult, @Nullable BlockCollisionData startCollision, boolean acknowledgeDamage) {
      for(double endSlide = collisionResult.slideEnd; startCollision != null; startCollision = collisionResult.forgetFirstBlockCollision()) {
         if (acknowledgeDamage && startCollision.willDamage) {
            return startCollision;
         }

         BlockType blockType = startCollision.blockType;
         if (blockType == null || !startCollision.collisionNormal.equals(this.getWorldNormal()) || startCollision.collisionStart > endSlide) {
            return startCollision;
         }
      }

      return null;
   }

   @Nullable
   private BlockCollisionData getFirstCollision(@Nonnull CollisionResult collisionResult, boolean acknowledgeDamage) {
      return collisionResult.getFirstBlockCollision();
   }

   private double bisect(@Nonnull Vector3d validPosition, @Nonnull Vector3d invalidPosition, @Nonnull Vector3d result, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      if (!this.isValidPosition(validPosition, this.collisionResult, componentAccessor)) {
         result.assign(invalidPosition);
         return 1.0;
      } else {
         return this.bisect(validPosition, invalidPosition, this, (_this, pos) -> _this.isValidPosition(pos, _this.collisionResult, componentAccessor), result);
      }
   }

   private double shortenSlide(@Nonnull Vector3d translation, double endSlide) {
      double moveLength = translation.length() * endSlide;
      if (moveLength > 0.001) {
         endSlide = endSlide * (moveLength - 0.001) / moveLength;
      } else {
         endSlide = 0.0;
      }

      return endSlide;
   }

   private double shortenMovement(@Nonnull Vector3d start, @Nonnull Vector3d end, @Nonnull Vector3d result) {
      double moveLength = end.distanceTo(start);
      if (moveLength <= 0.001) {
         return 0.0;
      } else {
         moveLength = (moveLength - 0.001) / moveLength;
         NPCPhysicsMath.lerp(start, end, moveLength, result);
         return moveLength;
      }
   }

   private double shortenMovement(double triggerScale) {
      double reduction = this.shortenMovement(this.lastValidPosition, this.position, this.position);
      triggerScale *= reduction;
      if (this.debugModeMove) {
         LOGGER.at(Level.INFO).log("Move: Collision reduction=%s triggerScale=%s", reduction, triggerScale);
      }

      return triggerScale;
   }

   private void validateTranslation(@Nonnull Vector3d translation, String kind) {
      if (this.debugModeValidateMath) {
         boolean b = NPCPhysicsMath.isValid(translation) && translation.squaredLength() < 1000000.0;
         if (!b) {
            throw new IllegalStateException(String.format("Walk - Translation invalid path=%s %s, moveSpeed=%s, fallSpeed=%s, pos=%s", kind, translation.toString(), this.moveSpeed, this.fallSpeed, Vector3d.formatShortString(this.position)));
         }
      } else if (translation.squaredLength() > 1000000.0) {
         translation.assign(Vector3d.ZERO);
      }

   }

   private void validateSpeeds(@Nonnull Ref<EntityStore> ref, @Nonnull String kind, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      if (this.debugModeValidateMath) {
         if (!Double.isFinite(this.moveSpeed) || !(Math.abs(this.moveSpeed) < 200.0) || !Double.isFinite(this.fallSpeed) || !(Math.abs(this.fallSpeed) < 200.0)) {
            throw new IllegalStateException(String.format("Walk - Invalid speed path=%s, moveSpeed=%s, fallSpeed=%s, onGround=%s canAct=%s, pos=%s, motionKind=%s", kind, this.moveSpeed, this.fallSpeed, this.onGround, this.canAct(ref, componentAccessor), Vector3d.formatShortString(this.position), this.getMotionKind()));
         }
      } else {
         this.moveSpeed = MathUtil.clamp(this.moveSpeed, -200.0, 200.0);
         this.fallSpeed = MathUtil.clamp(this.fallSpeed, -200.0, 200.0);
      }
   }

   private void lockOrientation(@Nonnull Steering steering, @Nonnull Vector3d translation, float heading) {
      steering.setYaw(heading);
      steering.setPitch(this.getPitch());
      steering.setRoll(this.getRoll());
      if (this.debugModeValidateMath && !NPCPhysicsMath.isValid(translation)) {
         throw new IllegalArgumentException("Translation invalid");
      }
   }

   private float computeBlendHeading(float heading, float moveHeading, double dt, double speedEstimate, double relativeTurnSpeed) {
      float turnAngle = this.computeBlendTurnAngle(heading, moveHeading);
      return this.computeBlendHeading(heading, moveHeading, dt, speedEstimate, turnAngle, relativeTurnSpeed);
   }

   private float computeBlendHeading(float heading, float moveHeading, double dt, double speedEstimate, float turnAngle, double relativeTurnSpeed) {
      double maxRotationSpeed = this.getCurrentMaxBodyRotationSpeed();
      float maxRotation = (float)MathUtil.clamp(dt * maxRotationSpeed * relativeTurnSpeed, 0.0, 1.5707963705062866);
      if (this.haveBlendHeadingPosition && speedEstimate > 0.0) {
         turnAngle *= (float)this.blendLevelAtTargetPosition;
         double arrivalTime = this.waypointDistance(this.position, this.blendHeadingPosition) / speedEstimate;
         if (arrivalTime * maxRotationSpeed * relativeTurnSpeed > (double)turnAngle) {
            turnAngle = NPCPhysicsMath.turnAngle(heading, moveHeading);
         }
      }

      turnAngle = MathUtil.clamp(turnAngle, -maxRotation, maxRotation);
      return PhysicsMath.normalizeTurnAngle(heading + turnAngle);
   }

   private float computeBlendTurnAngle(float heading, float moveHeading) {
      float desiredHeading = Double.isNaN(this.blendHeading) ? moveHeading : (float)this.blendHeading;
      return NPCPhysicsMath.turnAngle(heading, desiredHeading);
   }

   private double computeClimbMove(@Nonnull Vector3d climbDirection, double climbDistance, double distance, @Nonnull Vector3d translation) {
      if (distance >= climbDistance) {
         distance = climbDistance;
         climbDistance = 0.0;
      } else {
         double newDistance = climbDistance - distance;
         if (newDistance <= 1.0E-5) {
            distance = climbDistance;
            climbDistance = 0.0;
         } else {
            climbDistance = newDistance;
         }
      }

      translation.assign(climbDirection).scale(distance);
      return climbDistance;
   }

   private void computeDescendDirection(@Nonnull Vector3d translation) {
      this.climbForwardDirection.assign(this.getWorldAntiNormal());
      if (!(this.descendFlatness <= 0.0)) {
         double forwardDistance = NPCPhysicsMath.dotProduct(translation.x, 0.0, translation.z);
         if (!(forwardDistance <= 1.0E-12)) {
            forwardDistance = Math.sqrt(forwardDistance);
            double forwardScale = this.descendFlatness / forwardDistance;
            this.climbForwardDirection.x = forwardScale * translation.x;
            this.climbForwardDirection.z = forwardScale * translation.z;
            this.climbForwardDirection.normalize();
            double newForwardDistance = Math.sqrt(NPCPhysicsMath.dotProduct(this.climbForwardDirection.x, 0.0, this.climbForwardDirection.z));
            if (newForwardDistance > 1.0E-6) {
               double compensation = 1.0 + (1.0 / newForwardDistance - 1.0) * this.descendSpeedCompensation;
               this.climbForwardDirection.scale(compensation);
            }

         }
      }
   }

   private double computeClimbSpeed(double walkSpeed) {
      double climbSpeed = this.climbSpeedConst;
      if (walkSpeed != 0.0 && this.climbSpeedMult != 0.0) {
         climbSpeed += this.climbSpeedMult * Math.pow(walkSpeed, this.climbSpeedPow);
      }

      return climbSpeed;
   }

   private boolean tryClimb(@Nonnull Vector3d translation, boolean avoidingBlockDamage, boolean relaxMoveConstraints, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      boolean canJump = this.jumpHeight > 0.0;
      this.currentClimbForwardDistance = 0.0;
      this.maxClimbForwardDistance = 0.1;
      this.climbUpDistance = this.computeClimbHeight(this.position, translation, this.maxClimbHeight + this.jumpHeight, this.maxClimbForwardDistance, (Vector3d)null, this.tmpClimbHeightResults, avoidingBlockDamage, relaxMoveConstraints, componentAccessor);
      double targetJumpHeight = this.climbUpDistance + this.jumpHeight;
      double high = this.tmpClimbHeightResults.y;
      if (this.climbUpDistance > this.maxClimbHeight + 1.0E-5) {
         this.climbUpDistance = 0.0;
      } else if (canJump && this.climbUpDistance >= this.minJumpHeight && high >= targetJumpHeight) {
         this.currentJumpHeight = targetJumpHeight;
         this.jumpDropHeight = this.currentJumpHeight - this.climbUpDistance;
         this.jumpBlockHeight = this.climbUpDistance;
         this.jumpDropDirection.assign(this.getWorldAntiNormal());
         double baseClimbUpDistance = this.climbUpDistance;
         this.climbUpDistance = this.currentJumpHeight;
         this.tmpClimbMovement.assign(translation).setLength(0.4);
         this.tmpMovePosition.assign(this.position).add(0.0, baseClimbUpDistance, 0.0);
         double forwardMax = this.maxMoveFactor(this.tmpMovePosition, this.tmpClimbMovement, avoidingBlockDamage, componentAccessor);
         this.maxClimbForwardDistance += forwardMax * 0.4;
         this.tmpMovePosition.addScaled(this.tmpClimbMovement, forwardMax);
         this.jumping = this.maxClimbForwardDistance >= this.minJumpDistance;
      } else {
         this.jumping = false;
      }

      return this.climbUpDistance > 0.0;
   }

   private double computeClimbHeight(@Nonnull Vector3d position, @Nonnull Vector3d direction, double height, double forward, @Nullable Vector3d targetPosition, @Nonnull Vector2d results, boolean acknowledgeDamage, boolean relaxMoveConstraints, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      World world = ((EntityStore)componentAccessor.getExternalData()).getWorld();
      ChunkStore chunkStore = world.getChunkStore();
      this.tmpResults.setCollisionByMaterial(4, relaxMoveConstraints ? 13 : 5);
      results.assign(0.0);
      Vector3d worldNormal = this.getWorldNormal();
      this.tmpClimbMovement.assign(worldNormal).scale(height);
      double scale = this.maxMoveFactor(position, this.tmpClimbMovement, acknowledgeDamage, componentAccessor);
      height *= scale;
      if (height == 0.0) {
         return 0.0;
      } else {
         this.tmpClimbMovement.assign(direction).setLength(forward);
         this.tmpClimbPosition.assign(position).add(this.tmpClimbMovement);
         this.tmpClimbMovement.assign(worldNormal).scale(height);
         boolean saveComputeOverlaps = this.tmpResults.isComputeOverlaps();
         this.tmpResults.setComputeOverlaps(true);
         CollisionModule.get();
         CollisionModule.findCollisions(this.collisionBoundingBox, this.tmpClimbPosition, this.tmpClimbMovement, false, this.tmpResults, componentAccessor);
         this.tmpResults.setComputeOverlaps(saveComputeOverlaps);
         BlockCollisionData collisionData = this.tmpResults.getFirstBlockCollision();
         Vector3d worldAntiNormal = this.getWorldAntiNormal();
         double top = 0.0;

         double high;
         for(high = 1.0; collisionData != null; collisionData = this.tmpResults.forgetFirstBlockCollision()) {
            BlockType blockType = collisionData.blockType;
            if (blockType == null || !this.isClimbable(blockType, collisionData.fluid, acknowledgeDamage)) {
               break;
            }

            if (collisionData.collisionNormal.equals(worldAntiNormal)) {
               if (collisionData.collisionStart > top) {
                  high = collisionData.collisionStart;
                  break;
               }

               if (collisionData.collisionEnd > top) {
                  top = collisionData.collisionEnd;
                  if (top > 1.00001) {
                     return 0.0;
                  }
               }
            }
         }

         if (top == 0.0) {
            return 0.0;
         } else {
            this.tmpClimbPosition.addScaled(this.tmpClimbMovement, top);
            relaxMoveConstraints |= this.role.isBreathesInAir();
            if (!this.isValidWalkPosition(chunkStore, this.tmpClimbPosition.x, this.tmpClimbPosition.y, this.tmpClimbPosition.z, acknowledgeDamage, relaxMoveConstraints)) {
               return 0.0;
            } else {
               double bottom = height * top;
               results.assign(bottom, height * high);
               if (targetPosition != null) {
                  targetPosition.assign(this.tmpClimbPosition);
               }

               return bottom;
            }
         }
      }
   }

   private boolean isDropBlocked(@Nonnull Vector3d position, double maxDropHeight, boolean updatePosition, boolean acknowledgeDamage, boolean relaxedMoveConstraints, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      World world = ((EntityStore)componentAccessor.getExternalData()).getWorld();
      ChunkStore chunkStore = world.getChunkStore();
      if (this.debugModeValidatePositions && !this.isValidPosition(position, this.tmpResults, componentAccessor)) {
         throw new IllegalStateException("Invalid position");
      } else {
         BlockCollisionData collision = this.findDropBlockCollision(position, maxDropHeight, componentAccessor);
         if (collision == null) {
            return true;
         } else {
            this.tmpClimbPosition.assign(collision.collisionPoint);
            if (acknowledgeDamage) {
               double collisionStart = collision.collisionStart;

               do {
                  if (collision.willDamage) {
                     if (this.debugModeMove) {
                        LOGGER.at(Level.FINE).log("Drop DMG  %.2f/%.2f/%.2f", this.tmpClimbPosition.x, this.tmpClimbPosition.y, this.tmpClimbPosition.z);
                     }

                     return true;
                  }

                  collision = this.tmpResults.forgetFirstBlockCollision();
               } while(collision != null && collision.collisionStart <= collisionStart);
            }

            relaxedMoveConstraints |= this.role.isBreathesInWater();
            if (!this.isValidWalkPosition(chunkStore, this.tmpClimbPosition.x, this.tmpClimbPosition.y, this.tmpClimbPosition.z, acknowledgeDamage, relaxedMoveConstraints)) {
               if (this.debugModeMove) {
                  LOGGER.at(Level.FINE).log("Drop INV  %.2f/%.2f/%.2f", this.tmpClimbPosition.x, this.tmpClimbPosition.y, this.tmpClimbPosition.z);
               }

               return true;
            } else {
               if (this.debugModeMove) {
                  LOGGER.at(Level.FINE).log("Drop END  %.2f/%.2f/%.2f", this.tmpClimbPosition.x, this.tmpClimbPosition.y, this.tmpClimbPosition.z);
               }

               if (updatePosition) {
                  position.assign(this.tmpClimbPosition);
               }

               return false;
            }
         }
      }
   }

   private double dropDistance(@Nonnull Vector3d position, double maxTestDistance, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      BlockCollisionData collision = this.findDropBlockCollision(position, maxTestDistance, componentAccessor);
      return collision != null ? collision.collisionStart * maxTestDistance : maxTestDistance;
   }

   @Nullable
   private BlockCollisionData findDropBlockCollision(@Nonnull Vector3d position, double maxTestDistance, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      this.tmpResults.setCollisionByMaterial(4);
      this.tmpClimbMovement.assign(this.getWorldAntiNormal()).scale(maxTestDistance);
      CollisionModule.get();
      CollisionModule.findCollisions(this.collisionBoundingBox, position, this.tmpClimbMovement, this.tmpResults, componentAccessor);
      BlockCollisionData collision = this.tmpResults.getFirstBlockCollision();
      if (this.debugModeMove) {
         LOGGER.at(Level.FINE).log("Test Drop BOX  %.2f/%.2f/%.2f %.2f/%.2f/%.2f", this.collisionBoundingBox.min.x, this.collisionBoundingBox.min.y, this.collisionBoundingBox.min.z, this.collisionBoundingBox.max.x, this.collisionBoundingBox.max.y, this.collisionBoundingBox.max.z);
         if (collision == null) {
            LOGGER.at(Level.FINE).log("Test Drop NONE %.2f/%.2f/%.2f %.2f/%.2f/%.2f", position.x, position.y, position.z, this.tmpClimbMovement.x, this.tmpClimbMovement.y, this.tmpClimbMovement.z);
         } else {
            LOGGER.at(Level.FINE).log("Test Drop COLL %.2f/%.2f/%.2f %.2f/%.2f/%.2f dist=%s", position.x, position.y, position.z, this.tmpClimbMovement.x, this.tmpClimbMovement.y, this.tmpClimbMovement.z, collision.collisionStart * maxTestDistance);
         }
      }

      return collision;
   }

   private boolean isClimbable(@Nonnull BlockType blockType, @Nonnull Fluid fluid, boolean avoidDamageBlocks) {
      return (blockType.getDamageToEntities() <= 0 && fluid.getDamageToEntities() <= 0 || !avoidDamageBlocks) && (this.fenceBlockSet == -2147483648 || !BlockSetModule.getInstance().blockInSet(this.fenceBlockSet, blockType));
   }

   private boolean isValidWalkPosition(@Nonnull Ref<ChunkStore> chunkRef, @Nonnull ComponentAccessor<ChunkStore> chunkStore, double x, double y, double z, boolean acknowledgeDamage, boolean relaxedMoveConstraints) {
      if (acknowledgeDamage) {
         long packed = WorldUtil.getPackedMaterialAndFluidAtPosition(chunkRef, chunkStore, x, y + this.breathingDepth, z);
         BlockMaterial material = BlockMaterial.VALUES[MathUtil.unpackLeft(packed)];
         int fluidId = MathUtil.unpackRight(packed);
         if (!this.role.couldBreathe(material, fluidId)) {
            return false;
         }

         if (this.breathingDepth == this.constraintDepth) {
            return true;
         }
      }

      if (!relaxedMoveConstraints) {
         long packed = WorldUtil.getPackedMaterialAndFluidAtPosition(chunkRef, chunkStore, x, y + this.constraintDepth, z);
         BlockMaterial material = BlockMaterial.VALUES[MathUtil.unpackLeft(packed)];
         int fluidId = MathUtil.unpackRight(packed);
         if (!this.role.couldBreathe(material, fluidId)) {
            return false;
         }
      }

      return true;
   }

   private boolean isValidWalkPosition(@Nonnull ChunkStore chunkStore, double x, double y, double z, boolean acknowledgeDamage, boolean relaxedMoveConstraints) {
      long chunkIndex = ChunkUtil.indexChunkFromBlock(x, z);
      Ref<ChunkStore> chunkRef = chunkStore.getChunkReference(chunkIndex);
      return chunkRef != null && chunkRef.isValid() ? this.isValidWalkPosition(chunkRef, chunkStore.getStore(), x, y, z, acknowledgeDamage, relaxedMoveConstraints) : false;
   }

   private double maxMoveFactor(@Nonnull Vector3d position, @Nonnull Vector3d velocity, boolean acknowledgeDamage, @Nonnull ComponentAccessor<EntityStore> componentAccessor) {
      CollisionModule.get();
      CollisionModule.findCollisions(this.collisionBoundingBox, position, velocity, this.tmpResults, componentAccessor);
      BlockCollisionData collision;
      if (velocity.y != 0.0) {
         collision = this.getFirstCollision(this.tmpResults, acknowledgeDamage);
      } else {
         collision = this.discardIgnorableSlideCollisions(this.tmpResults, this.tmpResults.getFirstBlockCollision(), acknowledgeDamage);
      }

      return collision == null ? 1.0 : MathUtil.clamp(collision.collisionStart, 0.0, 1.0);
   }

   static {
      STATE_CAN_HOVER = EnumSet.of(MotionKind.MOVING, MotionKind.STANDING);
      VALID_MOTIONS = EnumSet.of(MotionKind.ASCENDING, MotionKind.DESCENDING, MotionKind.DROPPING, MotionKind.STANDING, MotionKind.MOVING);
   }

   public static enum AscentAnimationType implements Supplier<String> {
      Walk("Play walk animation"),
      Jump("Play jump animation"),
      Climb("Play climb animation"),
      Fly("Play fly animation"),
      Idle("Play idle animation");

      private final String description;

      private AscentAnimationType(String description) {
         this.description = description;
      }

      public String get() {
         return this.description;
      }
   }

   public static enum DescentAnimationType implements Supplier<String> {
      Walk("Play walk animation"),
      Fall("Play fall animation"),
      Idle("Play idle animation");

      private final String description;

      private DescentAnimationType(String description) {
         this.description = description;
      }

      public String get() {
         return this.description;
      }
   }
}