[c][cpp] Port of commit e04e7b5. Adjusted fix for IK constraint NaN when parent has zero scale.

This commit is contained in:
Mario Zechner 2023-04-06 13:25:13 +02:00
parent 9382265484
commit 1fb89b6e89
2 changed files with 16 additions and 12 deletions

View File

@ -94,12 +94,15 @@ void spIkConstraint_apply1(spBone *bone, float targetX, float targetY, int /*boo
default: {
float x = targetX - p->worldX, y = targetY - p->worldY;
float d = pa * pd - pb * pc;
if (d > 0) d = MAX(0.0001f, d);
else d = MIN(-0.0001f, d);
if (ABS(d) <= 0.0001f) {
tx = 0;
ty = 0;
} else {
tx = (x * pd - y * pb) / d - bone->ax;
ty = (y * pa - x * pc) / d - bone->ay;
}
}
}
rotationIK += ATAN2(ty, tx) * RAD_DEG;
if (bone->ascaleX < 0) rotationIK += 180;
@ -180,8 +183,7 @@ void spIkConstraint_apply2(spBone *parent, spBone *child, float targetX, float t
c = pp->c;
d = pp->d;
id = a * d - b * c;
if (id > 0) id = 1 / MAX(0.0001f, id);
else id = 1 / MIN(-0.0001f, id);
id = ABS(id) <= 0.0001f ? 0 : 1 / id;
x = cwx - pp->worldX;
y = cwy - pp->worldY;
dx = (x * d - y * b) * id - px;

View File

@ -61,11 +61,14 @@ void IkConstraint::apply(Bone &bone, float targetX, float targetY, bool compress
default:
float x = targetX - p->_worldX, y = targetY - p->_worldY;
float d = pa * pd - pb * pc;
if (d > 0) d = MathUtil::max(0.0001f, d);
d = MathUtil::min(-0.0001f, d);
if (MathUtil::abs(d) <= 0.0001f) {
tx = 0;
ty = 0;
} else {
tx = (x * pd - y * pb) / d - bone._ax;
ty = (y * pa - x * pc) / d - bone._ay;
}
}
rotationIK += MathUtil::atan2(ty, tx) * MathUtil::Rad_Deg;
if (bone._ascaleX < 0) rotationIK += 180;
if (rotationIK > 180) rotationIK -= 360;
@ -143,8 +146,7 @@ void IkConstraint::apply(Bone &parent, Bone &child, float targetX, float targetY
c = pp->_c;
d = pp->_d;
id = a * d - b * c;
if (id > 0) MathUtil::max(0.0001f, id);
else MathUtil::min(-0.0001f, id);
id = MathUtil::abs(id) <= 0.0001f ? 0 : 1 / id;
x = cwx - pp->_worldX;
y = cwy - pp->_worldY;
dx = (x * d - y * b) * id - px;