Searched refs:pfPsiDeg (Results 1 – 2 of 2) sorted by relevance
/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/ |
D | orientation.c | 492 …id fNEDAnglesDegFromRotationMatrix(float R[][3], float *pfPhiDeg, float *pfTheDeg, float *pfPsiDeg, in fNEDAnglesDegFromRotationMatrix() argument 511 *pfPsiDeg = fatan2_deg(R[CHZ][CHY], R[CHY][CHY]) + *pfPhiDeg; in fNEDAnglesDegFromRotationMatrix() 516 *pfPsiDeg = fatan2_deg(-R[CHZ][CHY], R[CHY][CHY]) - *pfPhiDeg; in fNEDAnglesDegFromRotationMatrix() 521 *pfPsiDeg = fatan2_deg(R[CHX][CHY], R[CHX][CHX]); in fNEDAnglesDegFromRotationMatrix() 525 if (*pfPsiDeg < 0.0F) in fNEDAnglesDegFromRotationMatrix() 527 *pfPsiDeg += 360.0F; in fNEDAnglesDegFromRotationMatrix() 531 if (*pfPsiDeg >= 360.0F) in fNEDAnglesDegFromRotationMatrix() 533 *pfPsiDeg = 0.0F; in fNEDAnglesDegFromRotationMatrix() 537 *pfRhoDeg = *pfPsiDeg; in fNEDAnglesDegFromRotationMatrix() 548 …AndroidAnglesDegFromRotationMatrix(float R[][3], float *pfPhiDeg, float *pfTheDeg, float *pfPsiDeg, in fAndroidAnglesDegFromRotationMatrix() argument [all …]
|
D | orientation.h | 97 float *pfPsiDeg, ///< output: the yaw (compass) angle 0.0 <= Psi < 360.0 deg 106 float *pfPsiDeg, ///< yaw angle Psi with range 0.0 <= Psi < 360.0 deg 115 float *pfPsiDeg, ///< yaw angle Psi in range 0.0 <= Psi < 360.0 deg
|