Page MenuHome
Differential D4635 Diff 14567 source/blender/blenkernel/intern/armature.c

Changeset View

Standalone View

View Options

source/blender/blenkernel/intern/armature.c

Context not available.
} }
} }
static void b_bone_deform_by_one_segment(const DualQuat *seg_dq, const float seg_mat[4][4], float co[3], DualQuat *dq, float defmat[3][3])
{
if (dq) {
copy_dq_dq(dq, seg_dq);
}
else {
mul_m4_v3(seg_mat, co);
if (defmat) {
copy_m3_m4(defmat, seg_mat);
}
}
}
static void b_bone_deform_by_two_segments(const DualQuat *seg1_dq, const DualQuat *seg2_dq, const float seg1_mat[4][4], const float seg2_mat[4][4], float blend, float co[3], DualQuat *dq, float defmat[3][3])
{
if (dq) {
/* Interpolate dual quats. */
memset(dq, 0, sizeof(DualQuat));
add_weighted_dq_dq(dq, seg1_dq, 1.0f - blend);
add_weighted_dq_dq(dq, seg2_dq, blend);
}
else {
/* Linearly interpolate matrices. */
float m[4][4];
linear_blend_m4_m4m4(m, seg1_mat, seg2_mat, blend);
mul_m4_v3(m, co);
if (defmat) {
angavrilovAuthorUnsubmitted
Done
Inline Actions

There is a whole library of matrix math functions, I'm sure there's something suitable there for this.

angavrilov: There is a whole library of matrix math functions, I'm sure there's something suitable there…
copy_m3_m4(defmat, m);
}
}
}
static void b_bone_deform(const bPoseChanDeform *pdef_info, Bone *bone, float co[3], DualQuat *dq, float defmat[3][3]) static void b_bone_deform(const bPoseChanDeform *pdef_info, Bone *bone, float co[3], DualQuat *dq, float defmat[3][3])
{ {
const Mat4 *b_bone = pdef_info->b_bone_mats; const DualQuat *quats = pdef_info->b_bone_dual_quats;
const float (*mat)[4] = b_bone[0].mat; const Mat4 *mats = pdef_info->b_bone_mats;
float segment, y; const float (*mat)[4] = mats[0].mat;
int a; float blend, y;
int seg_index;
/* need to transform co back to bonespace, only need y */ /* Get y component of co, transformed to bone space. */
y = mat[0][1] * co[0] + mat[1][1] * co[1] + mat[2][1] * co[2] + mat[3][1]; y = mat[0][1] * co[0] + mat[1][1] * co[1] + mat[2][1] * co[2] + mat[3][1];
/* now calculate which of the b_bones are deforming this */ /* Calculate the indices of the 2 affecting b_bone segments.
segment = bone->length / ((float)bone->segments); * Integer part is the first segment's index.
a = (int)(y / segment); * Integer part plus 1 is the second segment's index.*/
blend = (y / bone->length) * (float)bone->segments - 0.5f;
/* note; by clamping it extends deform at endpoints, goes best with if (blend <= 0.0f) {
* straight joints in restpos. */ /* Deform by first b_bone. */
CLAMP(a, 0, bone->segments - 1); b_bone_deform_by_one_segment(&quats[0], mats[1].mat, co, dq, defmat);
}
if (dq) { else if (blend >= (float)(bone->segments - 1)) {
copy_dq_dq(dq, &(pdef_info->b_bone_dual_quats)[a]); /* Deform by last b_bone. */
b_bone_deform_by_one_segment(&quats[bone->segments - 1], mats[bone->segments].mat, co, dq, defmat);
} }
else { else {
mul_m4_v3(b_bone[a + 1].mat, co); /* Blend deform between two b_bones. */
seg_index = (int)blend;
if (defmat) { blend -= (float)seg_index;
copy_m3_m4(defmat, b_bone[a + 1].mat); b_bone_deform_by_two_segments(&quats[seg_index], &quats[seg_index + 1], mats[seg_index + 1].mat, mats[seg_index + 2].mat, blend, co, dq, defmat);
}
} }
} }
Context not available.