161 lines
6.9 KiB
NASM
Executable File
161 lines
6.9 KiB
NASM
Executable File
;-----------------------------------------------------------------------------
|
|
; Torque Game Engine
|
|
; Copyright (C) GarageGames.com, Inc.
|
|
;-----------------------------------------------------------------------------
|
|
|
|
|
|
segment .data
|
|
|
|
matA dd 0
|
|
result dd 0
|
|
matB dd 0
|
|
|
|
segment .text
|
|
|
|
%macro export_fn 1
|
|
%ifdef LINUX
|
|
; No underscore needed for ELF object files
|
|
global %1
|
|
%1:
|
|
%else
|
|
global _%1
|
|
_%1:
|
|
%endif
|
|
%endmacro
|
|
|
|
|
|
%define arg(x) [esp+(x*4)]
|
|
|
|
|
|
|
|
;void Athlon_MatrixF_x_MatrixF(const F32 *matA, const F32 *matB, F32 *result)
|
|
|
|
export_fn Athlon_MatrixF_x_MatrixF
|
|
|
|
mov ecx, arg(1)
|
|
mov edx, arg(2)
|
|
mov eax, arg(3)
|
|
|
|
femms
|
|
prefetch [ecx+32] ; These may help -
|
|
prefetch [edx+32] ; and probably don't hurt
|
|
|
|
movq mm0,[ecx] ; a21 | a11
|
|
movq mm1,[ecx+8] ; a41 | a31
|
|
movq mm4,[edx] ; b21 | b11
|
|
punpckhdq mm2,mm0 ; a21 |
|
|
movq mm5,[edx+16] ; b22 | b12
|
|
punpckhdq mm3,mm1 ; a41 |
|
|
movq mm6,[edx+32] ; b23 | b13
|
|
punpckldq mm0,mm0 ; a11 | a11
|
|
punpckldq mm1,mm1 ; a31 | a31
|
|
pfmul mm4,mm0 ; a11*b21 | a11*b11
|
|
punpckhdq mm2,mm2 ; a21 | a21
|
|
pfmul mm0,[edx+8] ; a11*b41 | a11*b31
|
|
movq mm7,[edx+48] ; b24 | b14
|
|
pfmul mm5,mm2 ; a21*b22 | a21*b12
|
|
punpckhdq mm3,mm3 ; a41 | a41
|
|
pfmul mm2,[edx+24] ; a21*b42 | a21*b32
|
|
pfmul mm6,mm1 ; a31*b23 | a31*b13
|
|
pfadd mm5,mm4 ; a21*b22 + a11*b21 | a21*b12 + a11*b11
|
|
pfmul mm1,[edx+40] ; a31*b43 | a31*b33
|
|
pfadd mm2,mm0 ; a21*b42 + a11*b41 | a21*b32 + a11*b31
|
|
pfmul mm7,mm3 ; a41*b24 | a41*b14
|
|
pfadd mm6,mm5 ; a21*b22 + a11*b21 + a31*b23 | a21*b12 + a11*b11 + a31*b13
|
|
pfmul mm3,[edx+56] ; a41*b44 | a41*b34
|
|
pfadd mm2,mm1 ; a21*b42 + a11*b41 + a31*b43 | a21*b32 + a11*b31 + a31*b33
|
|
pfadd mm7,mm6 ; a41*b24 + a21*b22 + a11*b21 + a31*b23 | a41*b14 + a21*b12 + a11*b11 + a31*b13
|
|
movq mm0,[ecx+16] ; a22 | a12
|
|
pfadd mm3,mm2 ; a41*b44 + a21*b42 + a11*b41 + a31*b43 | a41*b34 + a21*b32 + a11*b31 + a31*b33
|
|
movq mm1,[ecx+24] ; a42 | a32
|
|
movq [eax],mm7 ; r21 | r11
|
|
movq mm4,[edx] ; b21 | b11
|
|
movq [eax+8],mm3 ; r41 | r31
|
|
|
|
punpckhdq mm2,mm0 ; a22 | XXX
|
|
movq mm5,[edx+16] ; b22 | b12
|
|
punpckhdq mm3,mm1 ; a42 | XXX
|
|
movq mm6,[edx+32] ; b23 | b13
|
|
punpckldq mm0,mm0 ; a12 | a12
|
|
punpckldq mm1,mm1 ; a32 | a32
|
|
pfmul mm4,mm0 ; a12*b21 | a12*b11
|
|
punpckhdq mm2,mm2 ; a22 | a22
|
|
pfmul mm0,[edx+8] ; a12*b41 | a12*b31
|
|
movq mm7,[edx+48] ; b24 | b14
|
|
pfmul mm5,mm2 ; a22*b22 | a22*b12
|
|
punpckhdq mm3,mm3 ; a42 | a42
|
|
pfmul mm2,[edx+24] ; a22*b42 | a22*b32
|
|
pfmul mm6,mm1 ; a32*b23 | a32*b13
|
|
pfadd mm5,mm4 ; a12*b21 + a22*b22 | a12*b11 + a22*b12
|
|
pfmul mm1,[edx+40] ; a32*b43 | a32*b33
|
|
pfadd mm2,mm0 ; a12*b41 + a22*b42 | a12*b11 + a22*b32
|
|
pfmul mm7,mm3 ; a42*b24 | a42*b14
|
|
pfadd mm6,mm5 ; a32*b23 + a12*b21 + a22*b22 | a32*b13 + a12*b11 + a22*b12
|
|
pfmul mm3,[edx+56] ; a42*b44 | a42*b34
|
|
pfadd mm2,mm1 ; a32*b43 + a12*b41 + a22*b42 | a32*b33 + a12*b11 + a22*b32
|
|
pfadd mm7,mm6 ; a42*b24 + a32*b23 + a12*b21 + a22*b22 | a42*b14 + a32*b13 + a12*b11 + a22*b12
|
|
movq mm0,[ecx+32] ; a23 | a13
|
|
pfadd mm3,mm2 ; a42*b44 + a32*b43 + a12*b41 + a22*b42 | a42*b34 + a32*b33 + a12*b11 + a22*b32
|
|
movq mm1,[ecx+40] ; a43 | a33
|
|
movq [eax+16],mm7 ; r22 | r12
|
|
movq mm4,[edx] ; b21 | b11
|
|
movq [eax+24],mm3 ; r42 | r32
|
|
|
|
punpckhdq mm2,mm0 ; a23 | XXX
|
|
movq mm5,[edx+16] ; b22 | b12
|
|
punpckhdq mm3,mm1 ; a43 | XXX
|
|
movq mm6,[edx+32] ; b23 | b13
|
|
punpckldq mm0,mm0 ; a13 | a13
|
|
punpckldq mm1,mm1 ; a33 | a33
|
|
pfmul mm4,mm0 ; a13*b21 | a13*b11
|
|
punpckhdq mm2,mm2 ; a23 | a23
|
|
pfmul mm0,[edx+8] ; a13*b41 | a13*b31
|
|
movq mm7,[edx+48] ; b24 | b14
|
|
pfmul mm5,mm2 ; a23*b22 | a23*b12
|
|
punpckhdq mm3,mm3 ; a43 | a43
|
|
pfmul mm2,[edx+24] ; a23*b42 | a23*b32
|
|
pfmul mm6,mm1 ; a33*b23 | a33*b13
|
|
pfadd mm5,mm4 ; a23*b22 + a13*b21 | a23*b12 + a13*b11
|
|
pfmul mm1,[edx+40] ; a33*b43 | a33*b33
|
|
pfadd mm2,mm0 ; a13*b41 + a23*b42 | a13*b31 + a23*b32
|
|
pfmul mm7,mm3 ; a43*b24 | a43*b14
|
|
pfadd mm6,mm5 ; a33*b23 + a23*b22 + a13*b21 | a33*b13 + a23*b12 + a13*b11
|
|
pfmul mm3,[edx+56] ; a43*b44 | a43*b34
|
|
pfadd mm2,mm1 ; a33*b43*a13*b41 + a23*b42 | a33*b33 + a13*b31 + a23*b32
|
|
pfadd mm7,mm6 ; a43*b24 + a33*b23 + a23*b22 + a13*b21 | a43*b14 + a33*b13 + a23*b12 + a13*b11
|
|
movq mm0,[ecx+48] ; a24 | a14
|
|
pfadd mm3,mm2 ; a43*b44 + a33*b43*a13*b41 + a23*b42 | a43*b34 + a33*b33 + a13*b31 + a23*b32
|
|
movq mm1,[ecx+56] ; a44 | a34
|
|
movq [eax+32],mm7 ; r23 | r13
|
|
movq mm4,[edx] ; b21 | b11
|
|
movq [eax+40],mm3 ; r43 | r33
|
|
|
|
punpckhdq mm2,mm0 ; a24 | XXX
|
|
movq mm5,[edx+16] ; b22 | b12
|
|
punpckhdq mm3,mm1 ; a44 | XXX
|
|
movq mm6,[edx+32] ; b23 | b13
|
|
punpckldq mm0,mm0 ; a14 | a14
|
|
punpckldq mm1,mm1 ; a34 | a34
|
|
pfmul mm4,mm0 ; a14*b21 | a14*b11
|
|
punpckhdq mm2,mm2 ; a24 | a24
|
|
pfmul mm0,[edx+8] ; a14*b41 | a14*b31
|
|
movq mm7,[edx+48] ; b24 | b14
|
|
pfmul mm5,mm2 ; a24*b22 | a24*b12
|
|
punpckhdq mm3,mm3 ; a44 | a44
|
|
pfmul mm2,[edx+24] ; a24*b 42 | a24*b32
|
|
pfmul mm6,mm1 ; a34*b23 | a34*b13
|
|
pfadd mm5,mm4 ; a14*b21 + a24*b22 | a14*b11 + a24*b12
|
|
pfmul mm1,[edx+40] ; a34*b43 | a34*b33
|
|
pfadd mm2,mm0 ; a14*b41 + a24*b 42 | a14*b31 + a24*b32
|
|
pfmul mm7,mm3 ; a44*b24 | a44*b14
|
|
pfadd mm6,mm5 ; a34*b23 + a14*b21 + a24*b22 | a34*b13 + a14*b11 + a24*b12
|
|
pfmul mm3,[edx+56] ; a44*b44 | a44*b34
|
|
pfadd mm2,mm1 ; a34*b43 + a14*b41 + a24*b 42 | a34*b33 + a14*b31 + a24*b32
|
|
pfadd mm7,mm6 ; a44*b24 + a14*b23 + a24*b 42 | a44*b14 + a14*b31 + a24*b32
|
|
pfadd mm3,mm2 ; a44*b44 + a34*b43 + a14*b41 + a24*b42 | a44*b34 + a34*b33 + a14*b31 + a24*b32
|
|
movq [eax+48],mm7 ; r24 | r14
|
|
movq [eax+56],mm3 ; r44 | r34
|
|
femms
|
|
|
|
ret
|