242     fx64    t;  in VEC_Mag()  local
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()
252     t <<= 2;                           // for better precision  in VEC_Mag()
254     CP_SetSqrt64((u64)t);  in VEC_Mag()
271     fx64    t;  in VEC_Fx16Mag()  local
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()
281     t <<= 2;                           // for better precision  in VEC_Fx16Mag()
283     CP_SetSqrt64((u64)t);  in VEC_Fx16Mag()
301     fx64    t;  in VEC_Normalize()  local
308     t = (fx64)pSrc->x * pSrc->x;  in VEC_Normalize()
309     t += (fx64)pSrc->y * pSrc->y;  in VEC_Normalize()
310     t += (fx64)pSrc->z * pSrc->z;      // in s39.24 format  in VEC_Normalize()
311     SDK_ASSERTMSG(t > 0, "*pSrc is (0, 0, 0)");  in VEC_Normalize()
313     SDK_WARNING(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT) >= (u64)t, "*pSrc is too large!");  in VEC_Normalize()
315     CP_SetDiv64_64(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT), (u64)t);  in VEC_Normalize()
316     CP_SetSqrt64((u64)(t << 2));  in VEC_Normalize()
319     t = CP_GetDivResult64();           // in s31.32 format(fx64c)  in VEC_Normalize()
321     t = t * sqrt;                      // in s18.45 format  in VEC_Normalize()
322     pDst->x = (fx32)((t * pSrc->x + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1));  in VEC_Normalize()
323     pDst->y = (fx32)((t * pSrc->y + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1));  in VEC_Normalize()
324     pDst->z = (fx32)((t * pSrc->z + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1));  in VEC_Normalize()
340     fx64    t;  in VEC_Fx16Normalize()  local
347     t = pSrc->x * pSrc->x;  in VEC_Fx16Normalize()
348     t += pSrc->y * pSrc->y;  in VEC_Fx16Normalize()
349     t += pSrc->z * pSrc->z;            // in s39.24 format  in VEC_Fx16Normalize()
350     SDK_ASSERTMSG(t > 0, "*pSrc is (0, 0, 0)");  in VEC_Fx16Normalize()
352     CP_SetDiv64_64(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT), (u64)t);  in VEC_Fx16Normalize()
353     CP_SetSqrt64((u64)(t << 2));  in VEC_Fx16Normalize()
356     t = CP_GetDivResult64();           // in s31.32 format(fx64c)  in VEC_Fx16Normalize()
358     t = t * sqrt;                      // in s18.45 format  in VEC_Fx16Normalize()
359     pDst->x = (fx16)((t * pSrc->x + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1));  in VEC_Fx16Normalize()
360     pDst->y = (fx16)((t * pSrc->y + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1));  in VEC_Fx16Normalize()
361     pDst->z = (fx16)((t * pSrc->z + (1LL << (32 + FX32_SHIFT))) >> (32 + FX32_SHIFT + 1));  in VEC_Fx16Normalize()