Az+Bz Ay+By Ax+Bx

;data
align 16
vecA     dd 0,0,0,0 ;x,y,z,w
vecB     dd 0,0,0,0
vecOut   dd 0,0,0,0

;code
movaps  xmm0,[vecA]
addps   xmm0,[vecB]
movaps  [vecOut],xmm0
    

;64

;<DllImport(AsmLib, EntryPoint:="MatrixMultiply", CharSet:=CharSet.Auto, CallingConvention:=CallingConvention.StdCall)>
;Public Shared Sub MatrixMultiply(ByRef MD As Matrix, ByVal MA As Matrix, ByVal MB As Matrix)
;End Sub


proc  MatrixMultiply  MatrixD, MatrixA, MatrixB


        mov     rax,[MatrixD]      ; Matrix Dest
        mov     rdx,[MatrixB]      ; Matrix B
        mov     rcx,[MatrixA]      ; Matrix A

        movups  xmm4,[rdx+00]      ; [b3 b2 b1 b0] wzyx
        movups  xmm5,[rdx+16]      ; [b7 b6 b5 b4] wzyx
        movups  xmm6,[rdx+32]      ; [bB bA b9 b8] wzyx
        movups  xmm7,[rdx+48]      ; [bF bE bD bC] wzyx

        i = 0

   repeat 4

        movups  xmm0,[rcx+i*16]    ; [a3 a2 a1 a0] wzyx

        movaps  xmm1,xmm0
        movaps  xmm2,xmm0
        movaps  xmm3,xmm0
        shufps  xmm0,xmm0,0x00     ; [a0 a0 a0 a0]
        shufps  xmm1,xmm1,0x55     ; [a1 a1 a1 a1]
        shufps  xmm2,xmm2,0xAA     ; [a2 a2 a2 a2]
        shufps  xmm3,xmm3,0xFF     ; [a3 a3 a3 a3]

        mulps   xmm0,xmm4          ; [a0*b3 a0*b2 a0*b1 a0*b0]
        mulps   xmm1,xmm5          ; [a1*b7 a1*b6 a1*b5 a1*b4]
        mulps   xmm2,xmm6          ; [a2*bB a2*bA a2*b9 a2*b8]
        mulps   xmm3,xmm7          ; [a3*bF a3*bE a3*bD a3*bC]

        addps   xmm2,xmm0
        addps   xmm3,xmm1
        addps   xmm3,xmm2
        movups  [rax+i*16],xmm3    ; [d3 d2 d1 d0] wzyx

        i = i + 1

   end repeat

   ret

endp
    

;32

proc  MatrixMultiply  MatrixD, MatrixA, MatrixB


        mov     eax,[MatrixD]      ; Matrix Dest
        mov     edx,[MatrixB]      ; Matrix B
        mov     ecx,[MatrixA]      ; Matrix A

        movups  xmm4,[edx+00]      ; [b3 b2 b1 b0] wzyx
        movups  xmm5,[edx+16]      ; [b7 b6 b5 b4] wzyx
        movups  xmm6,[edx+32]      ; [bB bA b9 b8] wzyx
        movups  xmm7,[edx+48]      ; [bF bE bD bC] wzyx

        i = 0

   repeat 4

        movups  xmm0,[ecx+i*16]    ; [a3 a2 a1 a0] wzyx

        movaps  xmm1,xmm0
        movaps  xmm2,xmm0
        movaps  xmm3,xmm0
        shufps  xmm0,xmm0,0x00     ; [a0 a0 a0 a0]
        shufps  xmm1,xmm1,0x55     ; [a1 a1 a1 a1]
        shufps  xmm2,xmm2,0xAA     ; [a2 a2 a2 a2]
        shufps  xmm3,xmm3,0xFF     ; [a3 a3 a3 a3]

        mulps   xmm0,xmm4          ; [a0*b3 a0*b2 a0*b1 a0*b0]
        mulps   xmm1,xmm5          ; [a1*b7 a1*b6 a1*b5 a1*b4]
        mulps   xmm2,xmm6          ; [a2*bB a2*bA a2*b9 a2*b8]
        mulps   xmm3,xmm7          ; [a3*bF a3*bE a3*bD a3*bC]

        addps   xmm2,xmm0
        addps   xmm3,xmm1
        addps   xmm3,xmm2
        movups  [eax+i*16],xmm3    ; [d3 d2 d1 d0] wzyx

        i = i + 1

   end repeat

   ret
endp
    

mov rax,[MatrixD] ; Matrix Dest
mov rdx,[MatrixB] ; Matrix B
mov rcx,[MatrixA] ; Matrix A