Lines Matching refs:pSrc
240 fx32 VEC_Mag(const VecFx32 *pSrc) in VEC_Mag() argument
245 SDK_NULL_ASSERT(pSrc); in VEC_Mag()
248 t = (fx64)pSrc->x * pSrc->x; in VEC_Mag()
249 t += (fx64)pSrc->y * pSrc->y; in VEC_Mag()
250 t += (fx64)pSrc->z * pSrc->z; in VEC_Mag()
269 fx32 VEC_Fx16Mag(const VecFx16 *pSrc) in VEC_Fx16Mag() argument
274 SDK_NULL_ASSERT(pSrc); in VEC_Fx16Mag()
277 t = pSrc->x * pSrc->x; in VEC_Fx16Mag()
278 t += pSrc->y * pSrc->y; in VEC_Fx16Mag()
279 t += pSrc->z * pSrc->z; in VEC_Fx16Mag()
300 void VEC_Normalize(const VecFx32 *pSrc, VecFx32 *pDst) in VEC_Normalize() argument
305 SDK_NULL_ASSERT(pSrc); in VEC_Normalize()
309 t = (fx64)pSrc->x * pSrc->x; in VEC_Normalize()
310 t += (fx64)pSrc->y * pSrc->y; in VEC_Normalize()
311 t += (fx64)pSrc->z * pSrc->z; // in s39.24 format in VEC_Normalize()
323 pDst->x = (fx32)((t * pSrc->x + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Normalize()
324 pDst->y = (fx32)((t * pSrc->y + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Normalize()
325 pDst->z = (fx32)((t * pSrc->z + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Normalize()
340 void VEC_Fx16Normalize(const VecFx16 *pSrc, VecFx16 *pDst) in VEC_Fx16Normalize() argument
345 SDK_NULL_ASSERT(pSrc); in VEC_Fx16Normalize()
349 t = pSrc->x * pSrc->x; in VEC_Fx16Normalize()
350 t += pSrc->y * pSrc->y; in VEC_Fx16Normalize()
351 t += pSrc->z * pSrc->z; // in s39.24 format in VEC_Fx16Normalize()
361 pDst->x = (fx16)((t * pSrc->x + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Fx16Normalize()
362 pDst->y = (fx16)((t * pSrc->y + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Fx16Normalize()
363 pDst->z = (fx16)((t * pSrc->z + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Fx16Normalize()