spine-runtimes/spine-ts/spine-core/src/PhysicsConstraint.ts

271 lines
8.3 KiB
TypeScript

/******************************************************************************
* Spine Runtimes License Agreement
* Last updated July 28, 2023. Replaces all prior versions.
*
* Copyright (c) 2013-2023, Esoteric Software LLC
*
* Integration of the Spine Runtimes into software or otherwise creating
* derivative works of the Spine Runtimes is permitted under the terms and
* conditions of Section 2 of the Spine Editor License Agreement:
* http://esotericsoftware.com/spine-editor-license
*
* Otherwise, it is permitted to integrate the Spine Runtimes into software or
* otherwise create derivative works of the Spine Runtimes (collectively,
* "Products"), provided that each user of the Products must obtain their own
* Spine Editor license and redistribution of the Products in any form must
* include this license and copyright notice.
*
* THE SPINE RUNTIMES ARE PROVIDED BY ESOTERIC SOFTWARE LLC "AS IS" AND ANY
* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
* DISCLAIMED. IN NO EVENT SHALL ESOTERIC SOFTWARE LLC BE LIABLE FOR ANY
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES,
* BUSINESS INTERRUPTION, OR LOSS OF USE, DATA, OR PROFITS) HOWEVER CAUSED AND
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THE
* SPINE RUNTIMES, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*****************************************************************************/
import { Bone } from "./Bone.js";
import { PhysicsConstraintData } from "./PhysicsConstraintData.js";
import { Physics, Skeleton } from "./Skeleton.js";
import { Updatable } from "./Updatable.js";
import { MathUtils } from "./Utils.js";
/** Stores the current pose for a physics constraint. A physics constraint applies physics to bones.
* <p>
* See <a href="http://esotericsoftware.com/spine-physics-constraints">Physics constraints</a> in the Spine User Guide. */
export class PhysicsConstraint implements Updatable {
readonly data: PhysicsConstraintData;
private _bone: Bone | null = null;
/** The bone constrained by this physics constraint. */
public set bone (bone: Bone) { this._bone = bone; }
public get bone () {
if (!this._bone) throw new Error("Bone not set.")
else return this._bone;
}
inertia = 0;
strength = 0;
damping = 0;
massInverse = 0;
wind = 0;
gravity = 0;
mix = 0;
_reset = true;
ux = 0;
uy = 0;
cx = 0;
cy = 0;
tx = 0;
ty = 0;
xOffset = 0;
xVelocity = 0;
yOffset = 0;
yVelocity = 0;
rotateOffset = 0;
rotateVelocity = 0;
scaleOffset = 0
scaleVelocity = 0;
active = false;
readonly skeleton: Skeleton;
remaining = 0;
lastTime = 0;
constructor(data: PhysicsConstraintData, skeleton: Skeleton) {
this.data = data;
this.skeleton = skeleton;
this.bone = skeleton.bones[data.bone.index];
this.inertia = data.inertia;
this.strength = data.strength;
this.damping = data.damping;
this.massInverse = data.massInverse;
this.wind = data.wind;
this.gravity = data.gravity;
this.mix = data.mix;
}
reset () {
this.remaining = 0;
this.lastTime = this.skeleton.time;
this._reset = true;
this.xOffset = 0;
this.xVelocity = 0;
this.yOffset = 0;
this.yVelocity = 0;
this.rotateOffset = 0;
this.rotateVelocity = 0;
this.scaleOffset = 0;
this.scaleVelocity = 0;
}
setToSetupPose () {
const data = this.data;
this.inertia = data.inertia;
this.strength = data.strength;
this.damping = data.damping;
this.massInverse = data.massInverse;
this.wind = data.wind;
this.gravity = data.gravity;
this.mix = data.mix;
}
isActive () {
return this.active;
}
/** Applies the constraint to the constrained bones. */
update (physics: Physics) {
const mix = this.mix;
if (mix == 0) return;
const x = this.data.x > 0, y = this.data.y > 0, rotateOrShearX = this.data.rotate > 0 || this.data.shearX > 0, scaleX = this.data.scaleX > 0;
const bone = this.bone;
const l = bone.data.length;
switch (physics) {
case Physics.none:
return;
case Physics.reset:
this.reset();
// Fall through.
case Physics.update:
this.remaining += Math.max(this.skeleton.time - this.lastTime, 0);
this.lastTime = this.skeleton.time;
const bx = bone.worldX, by = bone.worldY;
if (this._reset) {
this._reset = false;
this.ux = bx;
this.uy = by;
} else {
let remaining = this.remaining, i = this.inertia, step = this.data.step;
if (x || y) {
if (x) {
this.xOffset += (this.ux - bx) * i;
this.ux = bx;
}
if (y) {
this.yOffset += (this.uy - by) * i;
this.uy = by;
}
if (remaining >= step) {
const m = this.massInverse * step, e = this.strength, w = this.wind * 100, g = this.gravity * -100;
const d = Math.pow(this.damping, 60 * step);
do {
if (x) {
this.xVelocity += (w - this.xOffset * e) * m;
this.xOffset += this.xVelocity * step;
this.xVelocity *= d;
}
if (y) {
this.yVelocity += (g - this.yOffset * e) * m;
this.yOffset += this.yVelocity * step;
this.yVelocity *= d;
}
remaining -= step;
} while (remaining >= step);
}
if (x) bone.worldX += this.xOffset * mix * this.data.x;
if (y) bone.worldY += this.yOffset * mix * this.data.y;
}
if (rotateOrShearX || scaleX) {
let ca = Math.atan2(bone.c, bone.a), c = 0, s = 0, mr = 0;
if (rotateOrShearX) {
mr = mix * this.data.rotate;
let dx = this.cx - bone.worldX, dy = this.cy - bone.worldY, r = Math.atan2(dy + this.ty, dx + this.tx) - ca - this.rotateOffset * mr;
this.rotateOffset += (r - Math.ceil(r * MathUtils.invPI2 - 0.5) * MathUtils.PI2) * i;
r = this.rotateOffset * mr + ca;
c = Math.cos(r);
s = Math.sin(r);
if (scaleX) {
r = l * bone.getWorldScaleX();
if (r > 0) this.scaleOffset += (dx * c + dy * s) * i / r;
}
} else {
c = Math.cos(ca);
s = Math.sin(ca);
const r = l * bone.getWorldScaleX();
if (r > 0) this.scaleOffset += ((this.cx - bone.worldX) * c + (this.cy - bone.worldY) * s) * i / r;
}
remaining = this.remaining;
if (remaining >= step) {
const m = this.massInverse * step, e = this.strength, w = this.wind, g = this.gravity;
const d = Math.pow(this.damping, 60 * step);
while (true) {
remaining -= step;
if (scaleX) {
this.scaleVelocity += (w * c - g * s - this.scaleOffset * e) * m;
this.scaleOffset += this.scaleVelocity * step;
this.scaleVelocity *= d;
}
if (rotateOrShearX) {
this.rotateVelocity += (-0.01 * l * (w * s + g * c) - this.rotateOffset * e) * m;
this.rotateOffset += this.rotateVelocity * step;
this.rotateVelocity *= d;
if (remaining < step) break;
const r = this.rotateOffset * mr + ca;
c = Math.cos(r);
s = Math.sin(r);
} else if (remaining < step) //
break;
}
}
}
this.remaining = remaining;
}
this.cx = bone.worldX;
this.cy = bone.worldY;
break;
case Physics.pose:
if (x) bone.worldX += this.xOffset * mix * this.data.x;
if (y) bone.worldY += this.yOffset * mix * this.data.y;
}
if (rotateOrShearX) {
let o = this.rotateOffset * mix, s = 0, c = 0, a = 0;
if (this.data.shearX > 0) {
let r = 0;
if (this.data.rotate > 0) {
r = o * this.data.rotate;
s = Math.sin(r);
c = Math.cos(r);
a = bone.b;
bone.b = c * a - s * bone.d;
bone.d = s * a + c * bone.d;
}
r += o * this.data.shearX;
s = Math.sin(r);
c = Math.cos(r);
a = bone.a;
bone.a = c * a - s * bone.c;
bone.c = s * a + c * bone.c;
} else {
o *= this.data.rotate;
s = Math.sin(o);
c = Math.cos(o);
a = bone.a;
bone.a = c * a - s * bone.c;
bone.c = s * a + c * bone.c;
a = bone.b;
bone.b = c * a - s * bone.d;
bone.d = s * a + c * bone.d;
}
}
if (scaleX) {
const s = 1 + this.scaleOffset * mix * this.data.scaleX;
bone.a *= s;
bone.c *= s;
}
if (physics != Physics.pose) {
this.tx = l * bone.a;
this.ty = l * bone.c;
}
bone.updateAppliedTransform();
}
}