107 void C_MTXCopy ( MTX_CONST Mtx src, Mtx dst )  in C_MTXCopy()  argument
109     ASSERTMSG( (src != 0) , MTX_COPY_1 );  in C_MTXCopy()
112     if( src == dst )  in C_MTXCopy()
117 …dst[0][0] = src[0][0];    dst[0][1] = src[0][1];    dst[0][2] = src[0][2];    dst[0][3] = src[0][3…  in C_MTXCopy()
118 …dst[1][0] = src[1][0];    dst[1][1] = src[1][1];    dst[1][2] = src[1][2];    dst[1][3] = src[1][3…  in C_MTXCopy()
119 …dst[2][0] = src[2][0];    dst[2][1] = src[2][1];    dst[2][2] = src[2][2];    dst[2][3] = src[2][3…  in C_MTXCopy()
128 void PSMTXCopy(MTX_CONST Mtx src, Mtx dst )  in PSMTXCopy()  argument
133     fp0 = __PSQ_L(src, 0, 0);  in PSMTXCopy()
139     fp1 = __PSQ_LX(src, 8, 0, 0);  in PSMTXCopy()
145     fp2 = __PSQ_LX(src, 16, 0, 0);  in PSMTXCopy()
151     fp3 = __PSQ_LX(src, 24, 0, 0);  in PSMTXCopy()
157     fp4 = __PSQ_LX(src, 32, 0, 0);  in PSMTXCopy()
163     fp5 = __PSQ_LX(src, 40, 0, 0);  in PSMTXCopy()
441 void C_MTXTranspose ( MTX_CONST Mtx src, Mtx xPose )  in C_MTXTranspose()  argument
446     ASSERTMSG( (src   != 0), MTX_TRANSPOSE_1  );  in C_MTXTranspose()
449     if(src == xPose)  in C_MTXTranspose()
458     m[0][0] = src[0][0];   m[0][1] = src[1][0];      m[0][2] = src[2][0];     m[0][3] = 0.0f;  in C_MTXTranspose()
459     m[1][0] = src[0][1];   m[1][1] = src[1][1];      m[1][2] = src[2][1];     m[1][3] = 0.0f;  in C_MTXTranspose()
460     m[2][0] = src[0][2];   m[2][1] = src[1][2];      m[2][2] = src[2][2];     m[2][3] = 0.0f;  in C_MTXTranspose()
475 void PSMTXTranspose ( MTX_CONST Mtx src, Mtx xPose )  in PSMTXTranspose()  argument
481     row0a = __PSQ_L(src, 0, 0);  in PSMTXTranspose()
484     row1a = __PSQ_LX(src, 16, 0, 0);  in PSMTXTranspose()
490     row0b = __PSQ_LX(src, 8, 1, 0);  in PSMTXTranspose()
496     row1b = __PSQ_LX(src, 24, 1, 0);  in PSMTXTranspose()
502     row0a = __PSQ_LX(src, 32, 0, 0);  in PSMTXTranspose()
523     row0b = __PSQ_LX(src, 40, 1, 0);  in PSMTXTranspose()
559 u32 C_MTXInverse ( MTX_CONST Mtx src, Mtx inv )  in C_MTXInverse()  argument
565     ASSERTMSG( (src != 0), MTX_INVERSE_1 );  in C_MTXInverse()
568     if( src == inv )  in C_MTXInverse()
578 …det =   src[0][0]*src[1][1]*src[2][2] + src[0][1]*src[1][2]*src[2][0] + src[0][2]*src[1][0]*src[2]…  in C_MTXInverse()
579 …   - src[2][0]*src[1][1]*src[0][2] - src[1][0]*src[0][1]*src[2][2] - src[0][0]*src[2][1]*src[1][2];  in C_MTXInverse()
594     m[0][0] =  (src[1][1]*src[2][2] - src[2][1]*src[1][2]) * det;  in C_MTXInverse()
595     m[0][1] = -(src[0][1]*src[2][2] - src[2][1]*src[0][2]) * det;  in C_MTXInverse()
596     m[0][2] =  (src[0][1]*src[1][2] - src[1][1]*src[0][2]) * det;  in C_MTXInverse()
598     m[1][0] = -(src[1][0]*src[2][2] - src[2][0]*src[1][2]) * det;  in C_MTXInverse()
599     m[1][1] =  (src[0][0]*src[2][2] - src[2][0]*src[0][2]) * det;  in C_MTXInverse()
600     m[1][2] = -(src[0][0]*src[1][2] - src[1][0]*src[0][2]) * det;  in C_MTXInverse()
602     m[2][0] =  (src[1][0]*src[2][1] - src[2][0]*src[1][1]) * det;  in C_MTXInverse()
603     m[2][1] = -(src[0][0]*src[2][1] - src[2][0]*src[0][1]) * det;  in C_MTXInverse()
604     m[2][2] =  (src[0][0]*src[1][1] - src[1][0]*src[0][1]) * det;  in C_MTXInverse()
607     m[0][3] = -m[0][0]*src[0][3] - m[0][1]*src[1][3] - m[0][2]*src[2][3];  in C_MTXInverse()
608     m[1][3] = -m[1][0]*src[0][3] - m[1][1]*src[1][3] - m[1][2]*src[2][3];  in C_MTXInverse()
609     m[2][3] = -m[2][0]*src[0][3] - m[2][1]*src[1][3] - m[2][2]*src[2][3];  in C_MTXInverse()
628 u32 PSMTXInverse ( MTX_CONST Mtx src, Mtx inv )  in PSMTXInverse()  argument
648     fp0 = __PSQ_LX(src, 0, 1, 0);  in PSMTXInverse()
651     fp1 = __PSQ_LX(src, 4, 0, 0);  in PSMTXInverse()
654     fp2 = __PSQ_LX(src, 16, 1, 0);  in PSMTXInverse()
660     fp3 = __PSQ_LX(src, 20, 0, 0);  in PSMTXInverse()
663     fp4 = __PSQ_LX(src, 32, 1, 0);  in PSMTXInverse()
669     fp5 = __PSQ_LX(src, 36, 0, 0);  in PSMTXInverse()
743     fp1[0] = src[0][3];  in PSMTXInverse()
744     fp1[1] = src[0][3];  in PSMTXInverse()
750     fp2[0] = src[1][3];  in PSMTXInverse()
751     fp2[1] = src[1][3];  in PSMTXInverse()
757     fp3[0] = src[2][3];  in PSMTXInverse()
758     fp3[1] = src[2][3];  in PSMTXInverse()
865 u32 C_MTXInvXpose ( MTX_CONST Mtx src, Mtx invX )  in C_MTXInvXpose()  argument
871     ASSERTMSG( (src != 0), MTX_INVXPOSE_1 );  in C_MTXInvXpose()
874     if( src == invX )  in C_MTXInvXpose()
884 …det =   src[0][0]*src[1][1]*src[2][2] + src[0][1]*src[1][2]*src[2][0] + src[0][2]*src[1][0]*src[2]…  in C_MTXInvXpose()
885 …   - src[2][0]*src[1][1]*src[0][2] - src[1][0]*src[0][1]*src[2][2] - src[0][0]*src[2][1]*src[1][2];  in C_MTXInvXpose()
900     m[0][0] =  (src[1][1]*src[2][2] - src[2][1]*src[1][2]) * det;  in C_MTXInvXpose()
901     m[0][1] = -(src[1][0]*src[2][2] - src[2][0]*src[1][2]) * det;  in C_MTXInvXpose()
902     m[0][2] =  (src[1][0]*src[2][1] - src[2][0]*src[1][1]) * det;  in C_MTXInvXpose()
904     m[1][0] = -(src[0][1]*src[2][2] - src[2][1]*src[0][2]) * det;  in C_MTXInvXpose()
905     m[1][1] =  (src[0][0]*src[2][2] - src[2][0]*src[0][2]) * det;  in C_MTXInvXpose()
906     m[1][2] = -(src[0][0]*src[2][1] - src[2][0]*src[0][1]) * det;  in C_MTXInvXpose()
908     m[2][0] =  (src[0][1]*src[1][2] - src[1][1]*src[0][2]) * det;  in C_MTXInvXpose()
909     m[2][1] = -(src[0][0]*src[1][2] - src[1][0]*src[0][2]) * det;  in C_MTXInvXpose()
910     m[2][2] =  (src[0][0]*src[1][1] - src[1][0]*src[0][1]) * det;  in C_MTXInvXpose()
934 u32 PSMTXInvXpose ( MTX_CONST Mtx src, Mtx invX )  in PSMTXInvXpose()  argument
955     fp0 = __PSQ_LX(src, 0, 1, 0);  in PSMTXInvXpose()
960     fp1 = __PSQ_LX(src, 4, 0, 0);  in PSMTXInvXpose()
965     fp2 = __PSQ_LX(src, 16, 1, 0);  in PSMTXInvXpose()
973     fp3 = __PSQ_LX(src, 20, 0, 0);  in PSMTXInvXpose()
978     fp4 = __PSQ_LX(src, 32, 1, 0);  in PSMTXInvXpose()
986     fp5 = __PSQ_LX(src, 36, 0, 0);  in PSMTXInvXpose()
1687 void C_MTXTransApply ( MTX_CONST Mtx src, Mtx dst, f32 xT, f32 yT, f32 zT )  in C_MTXTransApply()  argument
1689     ASSERTMSG( (src != 0), MTX_TRANSAPPLY_1 );  in C_MTXTransApply()
1692     if ( src != dst )  in C_MTXTransApply()
1694         dst[0][0] = src[0][0];    dst[0][1] = src[0][1];    dst[0][2] = src[0][2];  in C_MTXTransApply()
1695         dst[1][0] = src[1][0];    dst[1][1] = src[1][1];    dst[1][2] = src[1][2];  in C_MTXTransApply()
1696         dst[2][0] = src[2][0];    dst[2][1] = src[2][1];    dst[2][2] = src[2][2];  in C_MTXTransApply()
1699     dst[0][3] = src[0][3] + xT;  in C_MTXTransApply()
1700     dst[1][3] = src[1][3] + yT;  in C_MTXTransApply()
1701     dst[2][3] = src[2][3] + zT;  in C_MTXTransApply()
1710 void PSMTXTransApply( Mtx src, Mtx dst, f32 xT, f32 yT, f32 zT )  in PSMTXTransApply()  argument
1718     fp4 = __PSQ_L(src, 0, 0);  in PSMTXTransApply()
1722     fp5 = __PSQ_LX(src, 8, 0, 0);  in PSMTXTransApply()
1726     fp7 = __PSQ_LX(src, 24, 0, 0);  in PSMTXTransApply()
1730     fp8 = __PSQ_LX(src, 40, 0, 0);  in PSMTXTransApply()
1739     fp6 = __PSQ_LX(src, 16, 0, 0);  in PSMTXTransApply()
1748     fp9 = __PSQ_LX(src, 32, 0, 0);  in PSMTXTransApply()
1842 void C_MTXScaleApply ( MTX_CONST Mtx src, Mtx dst, f32 xS, f32 yS, f32 zS )  in C_MTXScaleApply()  argument
1844     ASSERTMSG( (src != 0), MTX_SCALEAPPLY_1 );  in C_MTXScaleApply()
1847     dst[0][0] = src[0][0] * xS;     dst[0][1] = src[0][1] * xS;  in C_MTXScaleApply()
1848     dst[0][2] = src[0][2] * xS;     dst[0][3] = src[0][3] * xS;  in C_MTXScaleApply()
1850     dst[1][0] = src[1][0] * yS;     dst[1][1] = src[1][1] * yS;  in C_MTXScaleApply()
1851     dst[1][2] = src[1][2] * yS;     dst[1][3] = src[1][3] * yS;  in C_MTXScaleApply()
1853     dst[2][0] = src[2][0] * zS;     dst[2][1] = src[2][1] * zS;  in C_MTXScaleApply()
1854     dst[2][2] = src[2][2] * zS;     dst[2][3] = src[2][3] * zS;  in C_MTXScaleApply()
1864 void PSMTXScaleApply ( MTX_CONST Mtx src, Mtx dst, f32 xS, f32 yS, f32 zS )  in PSMTXScaleApply()  argument
1885     fp4 = __PSQ_LX(src, 0, 0, 0);  in PSMTXScaleApply()
1888     fp5 = __PSQ_LX(src, 8, 0, 0);  in PSMTXScaleApply()
1894     fp6 = __PSQ_LX(src, 16, 0, 0);  in PSMTXScaleApply()
1900     fp7 = __PSQ_LX(src, 24, 0, 0);  in PSMTXScaleApply()
1906     fp8 = __PSQ_LX(src, 32, 0, 0);  in PSMTXScaleApply()
1915     fp2 = __PSQ_LX(src, 40, 0, 0);  in PSMTXScaleApply()
2378 void C_MTXReorder(MTX_CONST Mtx src, ROMtx dst)  in C_MTXReorder()  argument
2380     dst[0][0] = src[0][0];    dst[0][1] = src[1][0];    dst[0][2] = src[2][0];  in C_MTXReorder()
2381     dst[1][0] = src[0][1];    dst[1][1] = src[1][1];    dst[1][2] = src[2][1];  in C_MTXReorder()
2382     dst[2][0] = src[0][2];    dst[2][1] = src[1][2];    dst[2][2] = src[2][2];  in C_MTXReorder()
2383     dst[3][0] = src[0][3];    dst[3][1] = src[1][3];    dst[3][2] = src[2][3];  in C_MTXReorder()
2390 void PSMTXReorder(MTX_CONST Mtx src, register ROMtx dest)  in PSMTXReorder()  argument
2396     S00_S01 = __PSQ_L(src, 0, 0);  in PSMTXReorder()
2399     S10_S11 = __PSQ_LX(src, 16, 0, 0);  in PSMTXReorder()
2402     S20_S21 = __PSQ_LX(src, 32, 0, 0);  in PSMTXReorder()
2405     S02_S03 = __PSQ_LX(src, 8, 0, 0);  in PSMTXReorder()
2411     S12_S13 = __PSQ_LX(src, 24, 0, 0);  in PSMTXReorder()
2417     S22_S23 = __PSQ_LX(src, 40, 0, 0);  in PSMTXReorder()