C++ (Cpp) quaternionConjugateの例

コード例 #1

ファイル: quaternion.c プロジェクト: Tglaser92/Robotics_Cape_Installer

void tilt_compensate(float in[4], float tilt[4], float out[4]){
	float tiltConjugate[4];
	float tempQ[4];

	quaternionConjugate(tilt, tiltConjugate);
	quaternionMultiply(in, tiltConjugate, tempQ);
	quaternionMultiply(tilt, tempQ, out);
}

コード例 #2

ファイル: mpulib.c プロジェクト: mickele77/MPULib

void tilt_compensate(quaternion_t magQ, quaternion_t unfusedQ) {
  quaternion_t unfusedConjugateQ;
  quaternion_t tempQ;

  quaternionConjugate(unfusedQ, unfusedConjugateQ);
  quaternionMultiply(magQ, unfusedConjugateQ, tempQ);
  quaternionMultiply(unfusedQ, tempQ, magQ);
}