private void PerformNormalMove(float elapsedTime, float speed, TGCVector3 headPosition) { CharacterOnSight = false; var XRotation = 0f; var YRotation = 0f; ChangeDirectionTimeCounter -= elapsedTime; Terrain.world.InterpoledHeight(headPosition.X, headPosition.Z, out float floorHeight); var distanceToFloor = Body.CenterOfMassPosition.Y - floorHeight; var XRotationStep = FastMath.PI * 0.1f * elapsedTime; var YRotationStep = FastMath.PI * 0.4f * elapsedTime; var distanceToWater = Constants.WATER_HEIGHT - floorHeight - 200; TGCVector2 sharkRangePosition = new TGCVector2(Constants.SHARK_HEIGHT.X, FastMath.Min(distanceToWater, Constants.SHARK_HEIGHT.Y)); if (distanceToFloor < sharkRangePosition.X - 150 && AcumulatedXRotation < Constants.MaxAxisRotation) { XRotation = XRotationStep; } else if (FastUtils.IsNumberBetweenInterval(distanceToFloor, sharkRangePosition) && AcumulatedXRotation > 0.0012) { XRotation = -XRotationStep; } else if (distanceToFloor > sharkRangePosition.Y + 150 && AcumulatedXRotation > -Constants.MaxAxisRotation) { XRotation = -XRotationStep; } else if (FastUtils.IsNumberBetweenInterval(distanceToFloor, sharkRangePosition) && AcumulatedXRotation < -0.0012) { XRotation = XRotationStep; } if (ChangeDirectionTimeCounter <= 0) { if (FastMath.Abs(AcumulatedYRotation) < Constants.MaxYRotation) { YRotation = YRotationStep * RotationYSign(); } else { ChangeDirectionTimeCounter = Constants.CHANGE_DIRECTION_TIME; } } else { AcumulatedYRotation = 0; } AcumulatedXRotation += XRotation; AcumulatedYRotation += YRotation; Body.ActivationState = ActivationState.ActiveTag; TGCMatrix rotation = TGCMatrix.Identity; if (XRotation != 0 || FastMath.Abs(AcumulatedXRotation) > 0.0012) { var rotationAxis = TGCVector3.Cross(TGCVector3.Up, director); director.TransformCoordinate(TGCMatrix.RotationAxis(rotationAxis, XRotation)); rotation = TGCMatrix.RotationAxis(rotationAxis, XRotation); speed /= 1.5f; } else if (YRotation != 0) { director.TransformCoordinate(TGCMatrix.RotationY(YRotation)); rotation = TGCMatrix.RotationY(YRotation); } TotalRotation *= rotation; Mesh.Transform = TotalRotation * TGCMatrix.Translation(new TGCVector3(Body.CenterOfMassPosition)); Body.WorldTransform = Mesh.Transform.ToBulletMatrix(); Body.LinearVelocity = director.ToBulletVector3() * -speed; }
private void PerformNormalMove(float elapsedTime, float speed, TGCVector3 headPosition) { time -= elapsedTime; ChangeDirectionTimeCounter -= elapsedTime; float XRotation = 0f, YRotation = 0f; var meshPosition = GetMeshPosition(); Terrain.world.InterpoledHeight(headPosition.X, headPosition.Z, out float floorHeight); var distanceToFloor = FastUtils.Distance(meshPosition.Y, floorHeight); var XRotationStep = FastMath.PI * 0.1f * elapsedTime; var YRotationStep = FastMath.PI * 0.03f * elapsedTime; if (FastUtils.LessThan(distanceToFloor, Constants.FishHeight.X - 40) && FastUtils.LessThan(acumulatedXRotation, Constants.MaxAxisRotation)) { XRotation = XRotationStep; } else if (FastUtils.IsNumberBetweenInterval(distanceToFloor, Constants.FishHeight) && FastUtils.GreaterThan(acumulatedXRotation, 0.0012f)) { XRotation = -XRotationStep; } if (FastUtils.GreaterThan(distanceToFloor, Constants.FishHeight.Y + 40) && FastUtils.GreaterThan(acumulatedXRotation, -Constants.MaxAxisRotation)) { XRotation = -XRotationStep; } else if (FastUtils.IsNumberBetweenInterval(distanceToFloor, Constants.FishHeight) && FastUtils.LessThan(acumulatedXRotation, -0.0012f)) { XRotation = XRotationStep; } if (ChangeDirectionTimeCounter <= 0) { if (FastUtils.LessThan(FastMath.Abs(acumulatedYRotation), Constants.MaxYRotation)) { YRotation = YRotationStep * RotationYSign(); } else { ChangeDirectionTimeCounter = Constants.CHANGE_DIRECTION_TIME; } } else { acumulatedYRotation = 0; } acumulatedXRotation += XRotation; acumulatedYRotation += YRotation; TGCMatrix rotation = TGCMatrix.Identity; if (XRotation != 0 || FastUtils.GreaterThan(FastMath.Abs(acumulatedXRotation), 0.0012f)) { var rotationAxis = TGCVector3.Cross(TGCVector3.Up, director); director.TransformCoordinate(TGCMatrix.RotationAxis(rotationAxis, XRotation)); rotation = TGCMatrix.RotationAxis(rotationAxis, XRotation); speed /= 1.5f; } else if (YRotation != 0) { director.TransformCoordinate(TGCMatrix.RotationY(YRotation)); rotation = TGCMatrix.RotationY(YRotation); } TotalRotation *= rotation; TGCMatrix traslation = TGCMatrix.Translation(meshPosition + director * -speed * elapsedTime); Mesh.Mesh.Transform = TGCMatrix.Scaling(Constants.Scale) * TotalRotation * traslation; Mesh.Mesh.BoundingBox.transform(Mesh.Mesh.Transform); }
public bool InPerimeterSkyBox(float posX, float posZ) => FastUtils.IsNumberBetweenInterval(posX, (CurrentPerimeter.xMin, CurrentPerimeter.xMax)) &&