Differential D4635 Diff 14542 source/blender/blenkernel/intern/armature.c

Changeset View

Standalone View

source/blender/blenkernel/intern/armature.c

Context not available.
	}	}
	}	}

	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_by_one_segment(const DualQuat seg_dq, const float seg_mat[4][4], float co[3], DualQuat dq, float defmat[3][3])
	{	{
	const Mat4 *b_bone = pdef_info->b_bone_mats;	if (dq) {
	const float (*mat)[4] = b_bone[0].mat;	copy_dq_dq(dq, seg_dq);
	float segment, y;	}
	int a;	else {
		mul_m4_v3(seg_mat, co);
	/* need to transform co back to bonespace, only need y */	if (defmat) {
	y = mat[0][1] * co[0] + mat[1][1] * co[1] + mat[2][1] * co[2] + mat[3][1];	copy_m3_m4(defmat, seg_mat);
		}
	/* now calculate which of the b_bones are deforming this */	}
	segment = bone->length / ((float)bone->segments);	}
	a = (int)(y / segment);

	/* note; by clamping it extends deform at endpoints, goes best with	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])
	* straight joints in restpos. */	{
	CLAMP(a, 0, bone->segments - 1);	float m[4][4];
		float other_blend = 1.0f - blend;
		int i, j;

	if (dq) {	if (dq) {
	copy_dq_dq(dq, &(pdef_info->b_bone_dual_quats)[a]);	/* 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 {	else {
	mul_m4_v3(b_bone[a + 1].mat, co);	/* Linearly interpolate matrices. */
		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…
		for (i = 0; i < 4; i++) {
		for (j = 0; j < 4; j++) {
		m[i][j] = other_blend * seg1_mat[i][j] + blend * seg2_mat[i][j];
		}
		}
		mul_m4_v3(m, co);
	if (defmat) {	if (defmat) {
	copy_m3_m4(defmat, b_bone[a + 1].mat);	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])
		{
		const DualQuat *quats = pdef_info->b_bone_dual_quats;
		const Mat4 *mats = pdef_info->b_bone_mats;
		const float (*mat)[4] = mats[0].mat;
		float blend, y;
		int seg_index;

		/* 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];

		/* Calculate the indices of the 2 affecting b_bone segments.
		* Integer part is the first segment's index.
		* Integer part plus 1 is the second segment's index.*/
		blend = (y / bone->length) * (float)bone->segments - 0.5f;

		if (blend <= 0.0f) {
		/* Deform by first b_bone. */
		b_bone_deform_by_one_segment(&quats[0], mats[1].mat, co, dq, defmat);
		}
		else if (blend >= (float)(bone->segments - 1)) {
		/* Deform by last b_bone. */
		b_bone_deform_by_one_segment(&quats[bone->segments - 1], mats[bone->segments].mat, co, dq, defmat);
		}
		else {
		/* Blend deform between two b_bones. */
		seg_index = (int)blend;
		blend -= (float)seg_index;
		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);
		}
		}

	/* using vec with dist to bone b1 - b2 */	/* using vec with dist to bone b1 - b2 */
	float distfactor_to_bone(const float vec[3], const float b1[3], const float b2[3], float rad1, float rad2, float rdist)	float distfactor_to_bone(const float vec[3], const float b1[3], const float b2[3], float rad1, float rad2, float rdist)
	{	{
Context not available.