public void process01_calVariable_ver2() { cur_bendAngle = ThePostureCal.calAngle_3D( posture_current.Joints[JointType.Head].Position, posture_current.Joints[JointType.Spine].Position, 2); facing_Angle = ThePostureCal.calAngle_3D( posture_current.Joints[JointType.ShoulderLeft].Position, posture_current.Joints[JointType.ShoulderRight].Position, 2); diff_bend_Angle = cur_bendAngle - initial_bend_ang; diff_sp_Y = getY(JointType.Spine) - initial_y; diff_kneeL_Y = getY(JointType.KneeLeft) - initial_knee_y; diff_kneeR_Y = getY(JointType.KneeRight) - initial_knee_y; // diff_hL_sC_X = getX_diff(JointType.HandLeft, JointType.ShoulderCenter); diff_hL_sC_Y = getY_diff(JointType.HandLeft, JointType.ShoulderCenter); diff_hL_sC_Z = getZ_diff(JointType.HandLeft, JointType.ShoulderCenter); diff_hR_sC_X = getX_diff(JointType.HandRight, JointType.ShoulderCenter); diff_hR_sC_Y = getY_diff(JointType.HandRight, JointType.ShoulderCenter); diff_hR_sC_Z = getZ_diff(JointType.HandRight, JointType.ShoulderCenter); //Additional diff_fL_kL_Z = getZ_diff(JointType.FootLeft, JointType.KneeLeft); diff_fR_kR_Z = getZ_diff(JointType.FootRight, JointType.KneeRight); // diff_handLR_eu = getDist(JointType.HandLeft, JointType.HandRight); diff_footLR_Z = getZ_diff(JointType.FootLeft, JointType.FootRight); }
//use first row public void recog_InitialPosture(UKI_DataRaw bp) { TheInitialPosture.data_raw = bp; data.initial_y = bp.Spine[1]; data.initial_knee_y = (bp.KneeLeft[1] + bp.KneeRight[1]) / 2; data.initial_bend_ang = ThePostureCal.calAngle_3D(bp.Head, bp.Spine, 2); }
public void process01_calVariable_ver1_optional(UKI_DataRaw current_data) { cur_bendAngle = ThePostureCal.calAngle_3D(current_data.Head, current_data.Spine, 2); facing_Angle = ThePostureCal.calAngle_3D(current_data.ShoulderLeft, current_data.ShoulderRight, 2); diff_bend_Angle = cur_bendAngle - initial_bend_ang; diff_kneeL_Y = current_data.KneeLeft[1] - initial_knee_y; diff_kneeR_Y = current_data.KneeRight[1] - initial_knee_y; // diff_hL_sC_X = current_data.HandLeft[0] - current_data.ShoulderCenter[0]; diff_hL_sC_Y = current_data.HandLeft[1] - current_data.ShoulderCenter[1]; diff_hL_sC_Z = current_data.HandLeft[2] - current_data.ShoulderCenter[2]; diff_hR_sC_X = current_data.HandRight[0] - current_data.ShoulderCenter[0]; diff_hR_sC_Y = current_data.HandRight[1] - current_data.ShoulderCenter[1]; diff_hR_sC_Z = current_data.HandRight[2] - current_data.ShoulderCenter[2]; //Additional diff_fL_kL_Z = current_data.FootLeft[2] - current_data.KneeLeft[2]; diff_fR_kR_Z = current_data.FootRight[2] - current_data.KneeRight[2]; // diff_handLR_eu = TheUKI.getDist(current_data.HandLeft, current_data.HandRight); diff_footLR_Z = current_data.FootLeft[2] - current_data.FootRight[2]; }