Home
last modified time | relevance | path

Searched refs:pInputQuaternions (Results 1 – 6 of 6) sorted by relevance

/hal_nxp-3.5.0/mcux/mcux-sdk/CMSIS/DSP/Source/QuaternionMathFunctions/
Darm_quaternion2rotation_f32.c81 void arm_quaternion2rotation_f32(const float32_t *pInputQuaternions, in arm_quaternion2rotation_f32() argument
92 vec0 = vld1q(pInputQuaternions); in arm_quaternion2rotation_f32()
139 pInputQuaternions += 4; in arm_quaternion2rotation_f32()
144 void arm_quaternion2rotation_f32(const float32_t *pInputQuaternions, in arm_quaternion2rotation_f32() argument
150 float32_t q00 = SQ(pInputQuaternions[0 + nb * 4]); in arm_quaternion2rotation_f32()
151 float32_t q11 = SQ(pInputQuaternions[1 + nb * 4]); in arm_quaternion2rotation_f32()
152 float32_t q22 = SQ(pInputQuaternions[2 + nb * 4]); in arm_quaternion2rotation_f32()
153 float32_t q33 = SQ(pInputQuaternions[3 + nb * 4]); in arm_quaternion2rotation_f32()
154 float32_t q01 = pInputQuaternions[0 + nb * 4]*pInputQuaternions[1 + nb * 4]; in arm_quaternion2rotation_f32()
155 float32_t q02 = pInputQuaternions[0 + nb * 4]*pInputQuaternions[2 + nb * 4]; in arm_quaternion2rotation_f32()
[all …]
Darm_quaternion_inverse_f32.c60 void arm_quaternion_inverse_f32(const float32_t *pInputQuaternions, in arm_quaternion_inverse_f32() argument
70 vec1 = vld1q(pInputQuaternions); in arm_quaternion_inverse_f32()
82 pInputQuaternions += 4; in arm_quaternion_inverse_f32()
89 void arm_quaternion_inverse_f32(const float32_t *pInputQuaternions, in arm_quaternion_inverse_f32() argument
98 temp = SQ(pInputQuaternions[4 * i + 0]) + in arm_quaternion_inverse_f32()
99 SQ(pInputQuaternions[4 * i + 1]) + in arm_quaternion_inverse_f32()
100 SQ(pInputQuaternions[4 * i + 2]) + in arm_quaternion_inverse_f32()
101 SQ(pInputQuaternions[4 * i + 3]); in arm_quaternion_inverse_f32()
103 pInverseQuaternions[4 * i + 0] = pInputQuaternions[4 * i + 0] / temp; in arm_quaternion_inverse_f32()
104 pInverseQuaternions[4 * i + 1] = -pInputQuaternions[4 * i + 1] / temp; in arm_quaternion_inverse_f32()
[all …]
Darm_quaternion_normalize_f32.c59 void arm_quaternion_normalize_f32(const float32_t *pInputQuaternions, in arm_quaternion_normalize_f32() argument
68 vec1 = vld1q(pInputQuaternions); in arm_quaternion_normalize_f32()
75 pInputQuaternions += 4; in arm_quaternion_normalize_f32()
82 void arm_quaternion_normalize_f32(const float32_t *pInputQuaternions, in arm_quaternion_normalize_f32() argument
90 temp = SQ(pInputQuaternions[4 * i + 0]) + in arm_quaternion_normalize_f32()
91 SQ(pInputQuaternions[4 * i + 1]) + in arm_quaternion_normalize_f32()
92 SQ(pInputQuaternions[4 * i + 2]) + in arm_quaternion_normalize_f32()
93 SQ(pInputQuaternions[4 * i + 3]); in arm_quaternion_normalize_f32()
96 pNormalizedQuaternions[4 * i + 0] = pInputQuaternions[4 * i + 0] / temp; in arm_quaternion_normalize_f32()
97 pNormalizedQuaternions[4 * i + 1] = pInputQuaternions[4 * i + 1] / temp; in arm_quaternion_normalize_f32()
[all …]
Darm_quaternion_conjugate_f32.c58 void arm_quaternion_conjugate_f32(const float32_t *pInputQuaternions, in arm_quaternion_conjugate_f32() argument
66 vec1 = vld1q(pInputQuaternions); in arm_quaternion_conjugate_f32()
75 pInputQuaternions += 4; in arm_quaternion_conjugate_f32()
80 void arm_quaternion_conjugate_f32(const float32_t *pInputQuaternions, in arm_quaternion_conjugate_f32() argument
87 pConjugateQuaternions[4 * i + 0] = pInputQuaternions[4 * i + 0]; in arm_quaternion_conjugate_f32()
88 pConjugateQuaternions[4 * i + 1] = -pInputQuaternions[4 * i + 1]; in arm_quaternion_conjugate_f32()
89 pConjugateQuaternions[4 * i + 2] = -pInputQuaternions[4 * i + 2]; in arm_quaternion_conjugate_f32()
90 pConjugateQuaternions[4 * i + 3] = -pInputQuaternions[4 * i + 3]; in arm_quaternion_conjugate_f32()
Darm_quaternion_norm_f32.c60 void arm_quaternion_norm_f32(const float32_t *pInputQuaternions, in arm_quaternion_norm_f32() argument
69 vec1 = vld1q(pInputQuaternions); in arm_quaternion_norm_f32()
74 pInputQuaternions+= 4; in arm_quaternion_norm_f32()
82 void arm_quaternion_norm_f32(const float32_t *pInputQuaternions, in arm_quaternion_norm_f32() argument
90 temp = SQ(pInputQuaternions[4 * i + 0]) + in arm_quaternion_norm_f32()
91 SQ(pInputQuaternions[4 * i + 1]) + in arm_quaternion_norm_f32()
92 SQ(pInputQuaternions[4 * i + 2]) + in arm_quaternion_norm_f32()
93 SQ(pInputQuaternions[4 * i + 3]); in arm_quaternion_norm_f32()
/hal_nxp-3.5.0/mcux/mcux-sdk/CMSIS/DSP/Include/dsp/
Dquaternion_math_functions.h60 void arm_quaternion_norm_f32(const float32_t *pInputQuaternions,
73 void arm_quaternion_inverse_f32(const float32_t *pInputQuaternions,
140 void arm_quaternion2rotation_f32(const float32_t *pInputQuaternions,