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()
302     fx64    t;  in VEC_Normalize()  local
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()
312     SDK_TASSERTMSG(t > 0, "*pSrc is (0, 0, 0)");  in VEC_Normalize()
314     SDK_WARNING(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT) >= (u64)t, "*pSrc is too large!");  in VEC_Normalize()
316     CP_SetDiv64_64(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT), (u64)t);  in VEC_Normalize()
317     CP_SetSqrt64((u64)(t << 2));  in VEC_Normalize()
320     t = CP_GetDivResult64();           // in s31.32 format(fx64c)  in VEC_Normalize()
322     t = t * sqrt;                      // in s18.45 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()
342     fx64    t;  in VEC_Fx16Normalize()  local
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()
352     SDK_TASSERTMSG(t > 0, "*pSrc is (0, 0, 0)");  in VEC_Fx16Normalize()
354     CP_SetDiv64_64(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT), (u64)t);  in VEC_Fx16Normalize()
355     CP_SetSqrt64((u64)(t << 2));  in VEC_Fx16Normalize()
358     t = CP_GetDivResult64();           // in s31.32 format(fx64c)  in VEC_Fx16Normalize()
360     t = t * sqrt;                      // in s18.45 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()