2008-10-13 19:25:11 +00:00
|
|
|
|
|
|
|
|
%include "Tools64.inc"
|
|
|
|
|
|
|
|
|
|
segment_code
|
|
|
|
|
|
|
|
|
|
;
|
|
|
|
|
; void Adapt ( short* pM, const short* pAdapt, int nDirection, int nOrder )
|
|
|
|
|
;
|
|
|
|
|
; r9d nOrder
|
|
|
|
|
; r8d nDirection
|
|
|
|
|
; rdx pAdapt
|
|
|
|
|
; rcx pM
|
|
|
|
|
; [esp+ 0] Return Address
|
|
|
|
|
|
|
|
|
|
align 16
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
proc Adapt
|
|
|
|
|
|
|
|
|
|
shr r9d, 4
|
|
|
|
|
|
|
|
|
|
cmp r8d, byte 0 ; nDirection
|
|
|
|
|
jle short AdaptSub
|
|
|
|
|
|
|
|
|
|
AdaptAddLoop:
|
|
|
|
|
movq mm0, [rcx]
|
|
|
|
|
paddw mm0, [rdx]
|
|
|
|
|
movq [rcx], mm0
|
|
|
|
|
movq mm1, [rcx + 8]
|
|
|
|
|
paddw mm1, [rdx + 8]
|
|
|
|
|
movq [rcx + 8], mm1
|
|
|
|
|
movq mm2, [rcx + 16]
|
|
|
|
|
paddw mm2, [rdx + 16]
|
|
|
|
|
movq [rcx + 16], mm2
|
|
|
|
|
movq mm3, [rcx + 24]
|
|
|
|
|
paddw mm3, [rdx + 24]
|
|
|
|
|
movq [rcx + 24], mm3
|
|
|
|
|
add rcx, byte 32
|
|
|
|
|
add rdx, byte 32
|
|
|
|
|
dec r9d
|
|
|
|
|
jnz AdaptAddLoop
|
|
|
|
|
|
|
|
|
|
emms
|
|
|
|
|
ret
|
|
|
|
|
|
|
|
|
|
align 16
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
|
|
|
|
|
AdaptSub: je short AdaptDone
|
|
|
|
|
|
|
|
|
|
AdaptSubLoop:
|
|
|
|
|
movq mm0, [rcx]
|
|
|
|
|
psubw mm0, [rdx]
|
|
|
|
|
movq [rcx], mm0
|
|
|
|
|
movq mm1, [rcx + 8]
|
|
|
|
|
psubw mm1, [rdx + 8]
|
|
|
|
|
movq [rcx + 8], mm1
|
|
|
|
|
movq mm2, [rcx + 16]
|
|
|
|
|
psubw mm2, [rdx + 16]
|
|
|
|
|
movq [rcx + 16], mm2
|
|
|
|
|
movq mm3, [rcx + 24]
|
|
|
|
|
psubw mm3, [rdx + 24]
|
|
|
|
|
movq [rcx + 24], mm3
|
|
|
|
|
add rcx, byte 32
|
|
|
|
|
add rdx, byte 32
|
|
|
|
|
dec r9d
|
|
|
|
|
jnz AdaptSubLoop
|
|
|
|
|
|
|
|
|
|
emms
|
|
|
|
|
AdaptDone:
|
|
|
|
|
|
|
|
|
|
endproc
|
|
|
|
|
|
|
|
|
|
;
|
|
|
|
|
; int CalculateDotProduct ( const short* pA, const short* pB, int nOrder )
|
|
|
|
|
;
|
|
|
|
|
|
|
|
|
|
align 16
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
nop
|
|
|
|
|
|
|
|
|
|
proc CalculateDotProduct
|
|
|
|
|
|
|
|
|
|
shr r8d, 4
|
|
|
|
|
pxor xmm7, xmm7
|
2008-10-14 00:19:30 +00:00
|
|
|
mov r9d, r8d
|
|
|
|
|
and r9d, 1
|
|
|
|
|
shr r8d, 1
|
2008-10-13 19:25:11 +00:00
|
|
|
|
2008-10-14 00:19:30 +00:00
|
|
|
LoopDotEven:
|
|
|
|
|
movdqu xmm0, [rcx] ;pA
|
2008-10-13 19:25:11 +00:00
|
|
|
pmaddwd xmm0, [rdx] ;pB
|
|
|
|
|
paddd xmm7, xmm0
|
2008-10-14 00:19:30 +00:00
|
|
|
movdqu xmm1, [rcx + 16]
|
|
|
|
|
pmaddwd xmm1, [rdx + 16]
|
2008-10-13 19:25:11 +00:00
|
|
|
paddd xmm7, xmm1
|
2008-10-14 00:19:30 +00:00
|
|
|
movdqu xmm2, [rcx + 32]
|
|
|
|
|
pmaddwd xmm2, [rdx + 32]
|
|
|
|
|
paddd xmm7, xmm2
|
|
|
|
|
movdqu xmm3, [rcx + 48]
|
|
|
|
|
pmaddwd xmm3, [rdx + 48]
|
|
|
|
|
add rcx, byte 64
|
|
|
|
|
add rdx, byte 64
|
|
|
|
|
paddd xmm7, xmm3
|
2008-10-13 19:25:11 +00:00
|
|
|
dec r8d
|
2008-10-14 00:19:30 +00:00
|
|
|
jnz short LoopDotEven
|
|
|
|
|
|
|
|
|
|
cmp r9d, byte 0
|
|
|
|
|
je DotFinal
|
|
|
|
|
|
|
|
|
|
movdqu xmm0, [rcx] ;pA
|
|
|
|
|
pmaddwd xmm0, [rdx] ;pB
|
|
|
|
|
paddd xmm7, xmm0
|
|
|
|
|
movdqu xmm1, [rcx + 16]
|
|
|
|
|
pmaddwd xmm1, [rdx + 16]
|
|
|
|
|
paddd xmm7, xmm1
|
|
|
|
|
|
|
|
|
|
DotFinal:
|
|
|
|
|
movdqa xmm6, xmm7
|
|
|
|
|
psrldq xmm6, 8
|
|
|
|
|
paddd xmm7, xmm6
|
|
|
|
|
movdqa xmm6, xmm7
|
|
|
|
|
psrldq xmm6, 4
|
|
|
|
|
paddd xmm7, xmm6
|
|
|
|
|
movd eax, xmm7
|
2008-10-13 19:25:11 +00:00
|
|
|
emms
|
|
|
|
|
endproc
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
;
|
|
|
|
|
; BOOL GetMMXAvailable ( void );
|
|
|
|
|
;
|
|
|
|
|
|
|
|
|
|
proc GetMMXAvailable
|
2008-10-14 00:19:30 +00:00
|
|
|
mov eax, 1
|
2008-10-13 19:25:11 +00:00
|
|
|
endproc
|
