Lines Matching refs:pSrc
244 fx32 VEC_Mag(const VecFx32 *pSrc) in VEC_Mag() argument
249 SDK_NULL_ASSERT(pSrc); in VEC_Mag()
252 t = (u64)((fx64)pSrc->x * pSrc->x); in VEC_Mag()
253 t += (u64)((fx64)pSrc->y * pSrc->y); in VEC_Mag()
254 t += (u64)((fx64)pSrc->z * pSrc->z); in VEC_Mag()
258 pSrc->x, pSrc->y, pSrc->z); in VEC_Mag()
277 fx32 VEC_Fx16Mag(const VecFx16 *pSrc) in VEC_Fx16Mag() argument
282 SDK_NULL_ASSERT(pSrc); in VEC_Fx16Mag()
285 t = pSrc->x * pSrc->x; in VEC_Fx16Mag()
286 t += pSrc->y * pSrc->y; in VEC_Fx16Mag()
287 t += pSrc->z * pSrc->z; in VEC_Fx16Mag()
308 void VEC_Normalize(const VecFx32 *pSrc, VecFx32 *pDst) in VEC_Normalize() argument
313 SDK_NULL_ASSERT(pSrc); in VEC_Normalize()
317 t = (fx64)pSrc->x * pSrc->x; in VEC_Normalize()
318 t += (fx64)pSrc->y * pSrc->y; in VEC_Normalize()
319 t += (fx64)pSrc->z * pSrc->z; // in s39.24 format in VEC_Normalize()
331 pDst->x = (fx32)((t * pSrc->x + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Normalize()
332 pDst->y = (fx32)((t * pSrc->y + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Normalize()
333 pDst->z = (fx32)((t * pSrc->z + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Normalize()
348 void VEC_Fx16Normalize(const VecFx16 *pSrc, VecFx16 *pDst) in VEC_Fx16Normalize() argument
353 SDK_NULL_ASSERT(pSrc); in VEC_Fx16Normalize()
357 t = pSrc->x * pSrc->x; in VEC_Fx16Normalize()
358 t += pSrc->y * pSrc->y; in VEC_Fx16Normalize()
359 t += pSrc->z * pSrc->z; // in s39.24 format in VEC_Fx16Normalize()
369 pDst->x = (fx16)((t * pSrc->x + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Fx16Normalize()
370 pDst->y = (fx16)((t * pSrc->y + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Fx16Normalize()
371 pDst->z = (fx16)((t * pSrc->z + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1)); in VEC_Fx16Normalize()