mirror of
https://github.com/Fishwaldo/bl_mcu_sdk.git
synced 2025-07-14 16:58:50 +00:00
19 lines
434 B
C
19 lines
434 B
C
#include "ref.h"
|
|
|
|
void ref_quaternion_norm_f32(const float32_t *pInputQuaternions,
|
|
float32_t *pNorms,
|
|
uint32_t nbQuaternions)
|
|
{
|
|
float32_t temp;
|
|
|
|
for(uint32_t i=0; i < nbQuaternions; i++)
|
|
{
|
|
temp = SQ(pInputQuaternions[4 * i + 0]) +
|
|
SQ(pInputQuaternions[4 * i + 1]) +
|
|
SQ(pInputQuaternions[4 * i + 2]) +
|
|
SQ(pInputQuaternions[4 * i + 3]);
|
|
pNorms[i] = sqrtf(temp);
|
|
}
|
|
}
|
|
|
|
|