[cpp] Port of #2150

This commit is contained in:
Mario Zechner 2022-09-12 12:34:32 +02:00
parent 34a7eeb56d
commit 0827d88b7b
2 changed files with 67 additions and 29 deletions

View File

@ -496,26 +496,65 @@ void Bone::updateAppliedTransform() {
_ascaleY = MathUtil::sqrt(_b * _b + _d * _d); _ascaleY = MathUtil::sqrt(_b * _b + _d * _d);
_ashearX = 0; _ashearX = 0;
_ashearY = MathUtil::atan2(_a * _b + _c * _d, _a * _d - _b * _c) * MathUtil::Rad_Deg; _ashearY = MathUtil::atan2(_a * _b + _c * _d, _a * _d - _b * _c) * MathUtil::Rad_Deg;
} else { }
float pa = parent->_a, pb = parent->_b, pc = parent->_c, pd = parent->_d; float pa = parent->_a, pb = parent->_b, pc = parent->_c, pd = parent->_d;
float pid = 1 / (pa * pd - pb * pc); float pid = 1 / (pa * pd - pb * pc);
float ia = pd * pid, ib = pb * pid, ic = pc * pid, id = pa * pid;
float dx = _worldX - parent->_worldX, dy = _worldY - parent->_worldY; float dx = _worldX - parent->_worldX, dy = _worldY - parent->_worldY;
float ia = pid * pd; _ax = (dx * ia - dy * ib);
float id = pid * pa; _ay = (dy * id - dx * ic);
float ib = pid * pb;
float ic = pid * pc; float ra, rb, rc, rd;
float ra = ia * _a - ib * _c; if (_data.getTransformMode() == TransformMode_OnlyTranslation) {
float rb = ia * _b - ib * _d; ra = _a;
float rc = id * _c - ic * _a; rb = _b;
float rd = id * _d - ic * _b; rc = _c;
_ax = (dx * pd * pid - dy * pb * pid); rd = _d;
_ay = (dy * pa * pid - dx * pc * pid); } else {
switch (_data.getTransformMode()) {
case TransformMode_NoRotationOrReflection: {
float s = MathUtil::abs(pa * pd - pb * pc) / (pa * pa + pc * pc);
float sa = pa / _skeleton.getScaleX();
float sc = pc / _skeleton.getScaleY();
pb = -sc * s * _skeleton.getScaleX();
pd = sa * s * _skeleton.getScaleY();
pid = 1 / (pa * pd - pb * pc);
ia = pd * pid;
ib = pb * pid;
break;
}
case TransformMode_NoScale:
case TransformMode_NoScaleOrReflection:
float cos = MathUtil::cosDeg(_rotation), sin = MathUtil::sinDeg(_rotation);
pa = (pa * cos + pb * sin) / _skeleton.getScaleX();
pc = (pc * cos + pd * sin) / _skeleton.getScaleY();
float s = MathUtil::sqrt(pa * pa + pc * pc);
if (s > 0.00001f) s = 1 / s;
pa *= s;
pc *= s;
s = MathUtil::sqrt(pa * pa + pc * pc);
if (_data.getTransformMode() == TransformMode_NoScale && pid < 0 != (_skeleton.getScaleX() < 0 != _skeleton.getScaleY() < 0)) s = -s;
float r = MathUtil::Pi / 2 + MathUtil::atan2(pc, pa);
pb = MathUtil::cos(r) * s;
pd = MathUtil::sin(r) * s;
pid = 1 / (pa * pd - pb * pc);
ia = pd * pid;
ib = pb * pid;
ic = pc * pid;
id = pa * pid;
}
ra = ia * _a - ib * _c;
rb = ia * _b - ib * _d;
rc = id * _c - ic * _a;
rd = id * _d - ic * _b;
}
_ashearX = 0; _ashearX = 0;
_ascaleX = MathUtil::sqrt(ra * ra + rc * rc); _ascaleX = MathUtil::sqrt(ra * ra + rc * rc);
if (_ascaleX > 0.0001f) { if (_ascaleX > 0.0001f) {
float det = ra * rd - rb * rc; float det = ra * rd - rb * rc;
_ascaleY = det / _ascaleX; _ascaleY = det / _ascaleX;
_ashearY = MathUtil::atan2(ra * rb + rc * rd, det) * MathUtil::Rad_Deg; _ashearY = -MathUtil::atan2(ra * rb + rc * rd, det) * MathUtil::Rad_Deg;
_arotation = MathUtil::atan2(rc, ra) * MathUtil::Rad_Deg; _arotation = MathUtil::atan2(rc, ra) * MathUtil::Rad_Deg;
} else { } else {
_ascaleX = 0; _ascaleX = 0;
@ -523,7 +562,6 @@ void Bone::updateAppliedTransform() {
_ashearY = 0; _ashearY = 0;
_arotation = 90 - MathUtil::atan2(rd, rb) * MathUtil::Rad_Deg; _arotation = 90 - MathUtil::atan2(rd, rb) * MathUtil::Rad_Deg;
} }
}
} }
bool Bone::isActive() { bool Bone::isActive() {