246     u64     t;							// always positive number  in VEC_Mag()  local
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()
256     SDK_WARNING(t <= FX64_MAX>>1,  in VEC_Mag()
260 	t <<= 2;                           // for better precision  in VEC_Mag()
262     CP_SetSqrt64(t);  in VEC_Mag()
279     fx64    t;  in VEC_Fx16Mag()  local
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()
289     t <<= 2;                           // for better precision  in VEC_Fx16Mag()
291     CP_SetSqrt64((u64)t);  in VEC_Fx16Mag()
310     fx64    t;  in VEC_Normalize()  local
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()
320     SDK_TASSERTMSG(t > 0, "*pSrc is (0, 0, 0)");  in VEC_Normalize()
322     SDK_WARNING(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT) >= (u64)t, "*pSrc is too large!");  in VEC_Normalize()
324     CP_SetDiv64_64(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT), (u64)t);  in VEC_Normalize()
325     CP_SetSqrt64((u64)(t << 2));  in VEC_Normalize()
328     t = CP_GetDivResult64();           // in s31.32 format(fx64c)  in VEC_Normalize()
330     t = t * sqrt;                      // in s18.45 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()
350     fx64    t;  in VEC_Fx16Normalize()  local
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()
360     SDK_TASSERTMSG(t > 0, "*pSrc is (0, 0, 0)");  in VEC_Fx16Normalize()
362     CP_SetDiv64_64(1LL << (FX32_SHIFT + FX32_SHIFT + FX64C_SHIFT), (u64)t);  in VEC_Fx16Normalize()
363     CP_SetSqrt64((u64)(t << 2));  in VEC_Fx16Normalize()
366     t = CP_GetDivResult64();           // in s31.32 format(fx64c)  in VEC_Fx16Normalize()
368     t = t * sqrt;                      // in s18.45 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()