576 lines
8.4 KiB
NASM
576 lines
8.4 KiB
NASM
|
;*****************************************************************************
|
||
|
|
;*
|
||
|
|
;* This program is free software ; you can redistribute it and/or modify
|
||
|
|
;* it under the terms of the GNU General Public License as published by
|
||
|
|
;* the Free Software Foundation; either version 2 of the License, or
|
||
|
|
;* (at your option) any later version.
|
||
|
|
;*
|
||
|
|
;* This program is distributed in the hope that it will be useful,
|
||
|
|
;* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
;* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
|
;* GNU General Public License for more details.
|
||
|
|
;*
|
||
|
|
;* You should have received a copy of the GNU General Public License
|
||
|
|
;* along with this program; if not, write to the Free Software
|
||
|
|
;* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||
|
|
;*
|
||
|
|
;* $Id: mcomp_mmx.asm 323 2005-11-01 20:52:32Z picard $
|
||
|
|
;*
|
||
|
|
;* The Core Pocket Media Player
|
||
|
|
;* Copyright (c) 2004-2005 Gabor Kovacs
|
||
|
|
;*
|
||
|
|
;*****************************************************************************
|
||
|
|
|
||
|
|
BITS 32
|
||
|
|
%if 0
|
||
|
|
|
||
|
|
SECTION .rdata
|
||
|
|
round7: dd 07070707h,07070707h
|
||
|
|
round8: dd 08080808h,08080808h
|
||
|
|
|
||
|
|
SECTION .text
|
||
|
|
|
||
|
|
%macro cglobal 2
|
||
|
|
%define %1 _%1@%2
|
||
|
|
global %1
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
cglobal AddBlock4x4_00,12
|
||
|
|
cglobal AddBlock4x4_01,12
|
||
|
|
cglobal AddBlock4x4_02,12
|
||
|
|
cglobal AddBlock4x4_03,12
|
||
|
|
cglobal AddBlock4x4_10,12
|
||
|
|
cglobal AddBlock4x4_11,12
|
||
|
|
cglobal AddBlock4x4_12,12
|
||
|
|
cglobal AddBlock4x4_13,12
|
||
|
|
cglobal AddBlock4x4_20,12
|
||
|
|
cglobal AddBlock4x4_21,12
|
||
|
|
cglobal AddBlock4x4_22,12
|
||
|
|
cglobal AddBlock4x4_23,12
|
||
|
|
cglobal AddBlock4x4_30,12
|
||
|
|
cglobal AddBlock4x4_31,12
|
||
|
|
cglobal AddBlock4x4_32,12
|
||
|
|
cglobal AddBlock4x4_33,12
|
||
|
|
cglobal CopyBlock4x4,16
|
||
|
|
cglobal CopyBlock4x4_01,16
|
||
|
|
cglobal CopyBlock4x4_02,16
|
||
|
|
cglobal CopyBlock4x4_03,16
|
||
|
|
cglobal CopyBlock4x4_10,16
|
||
|
|
cglobal CopyBlock4x4_11,16
|
||
|
|
cglobal CopyBlock4x4_12,16
|
||
|
|
cglobal CopyBlock4x4_13,16
|
||
|
|
cglobal CopyBlock4x4_20,16
|
||
|
|
cglobal CopyBlock4x4_21,16
|
||
|
|
cglobal CopyBlock4x4_22,16
|
||
|
|
cglobal CopyBlock4x4_23,16
|
||
|
|
cglobal CopyBlock4x4_20,16
|
||
|
|
cglobal CopyBlock4x4_21,16
|
||
|
|
cglobal CopyBlock4x4_22,16
|
||
|
|
cglobal CopyBlock4x4_23,16
|
||
|
|
cglobal CopyBlock4x4_01R,16
|
||
|
|
cglobal CopyBlock4x4_02R,16
|
||
|
|
cglobal CopyBlock4x4_03R,16
|
||
|
|
cglobal CopyBlock4x4_10R,16
|
||
|
|
cglobal CopyBlock4x4_11R,16
|
||
|
|
cglobal CopyBlock4x4_12R,16
|
||
|
|
cglobal CopyBlock4x4_13R,16
|
||
|
|
cglobal CopyBlock4x4_20R,16
|
||
|
|
cglobal CopyBlock4x4_21R,16
|
||
|
|
cglobal CopyBlock4x4_22R,16
|
||
|
|
cglobal CopyBlock4x4_23R,16
|
||
|
|
cglobal CopyBlock4x4_20R,16
|
||
|
|
cglobal CopyBlock4x4_21R,16
|
||
|
|
cglobal CopyBlock4x4_22R,16
|
||
|
|
cglobal CopyBlock4x4_23R,16
|
||
|
|
|
||
|
|
%macro loadparam 1
|
||
|
|
mov esi,[esp+12] ;src
|
||
|
|
mov edi,[esp+12+4] ;dst
|
||
|
|
mov eax,[esp+12+8] ;src pitch
|
||
|
|
%if %1>0
|
||
|
|
mov edx,8 ;dst pitch (fixed for AddBlock)
|
||
|
|
%else
|
||
|
|
mov edx,[esp+12+12] ;dst pitch
|
||
|
|
%endif
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro loadmask1 0
|
||
|
|
mov ecx,0x01010101
|
||
|
|
movd mm6,ecx
|
||
|
|
pcmpeqb mm7,mm7
|
||
|
|
punpckldq mm6,mm6
|
||
|
|
pxor mm7,mm6
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro loadmask4 0
|
||
|
|
mov ecx,0x03030303
|
||
|
|
movd mm6,ecx
|
||
|
|
pcmpeqb mm7,mm7
|
||
|
|
punpckldq mm6,mm6
|
||
|
|
pxor mm7,mm6
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro loadmask16 0
|
||
|
|
mov ecx,0x0F0F0F0F
|
||
|
|
movd mm6,ecx
|
||
|
|
pcmpeqb mm7,mm7
|
||
|
|
punpckldq mm6,mm6
|
||
|
|
pxor mm7,mm6
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro load1 2
|
||
|
|
movd mm0,[esi+%1]
|
||
|
|
%if %2>0
|
||
|
|
add esi,eax
|
||
|
|
%endif
|
||
|
|
movq mm1,mm0
|
||
|
|
pand mm1,mm7
|
||
|
|
psrlq mm1,1
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro load2 2
|
||
|
|
movd mm2,[esi+%1]
|
||
|
|
%if %2>0
|
||
|
|
add esi,eax
|
||
|
|
%endif
|
||
|
|
movq mm3,mm2
|
||
|
|
pand mm3,mm7
|
||
|
|
psrlq mm3,1
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro load1hv 1
|
||
|
|
movd mm0,[esi]
|
||
|
|
movd mm4,[esi+1]
|
||
|
|
add esi,eax
|
||
|
|
movq mm1,mm0
|
||
|
|
movq mm5,mm4
|
||
|
|
pand mm0,mm6
|
||
|
|
pand mm4,mm6
|
||
|
|
pand mm1,mm7
|
||
|
|
pand mm5,mm7
|
||
|
|
psrlq mm1,%0
|
||
|
|
psrlq mm5,%0
|
||
|
|
paddb mm0,mm4
|
||
|
|
paddb mm1,mm5
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro load2hv 1
|
||
|
|
movd mm2,[esi]
|
||
|
|
movd mm4,[esi+1]
|
||
|
|
add esi,eax
|
||
|
|
movq mm3,mm2
|
||
|
|
movq mm5,mm4
|
||
|
|
pand mm2,mm6
|
||
|
|
pand mm4,mm6
|
||
|
|
pand mm3,mm7
|
||
|
|
pand mm5,mm7
|
||
|
|
psrlq mm3,%0
|
||
|
|
psrlq mm5,%0
|
||
|
|
paddb mm2,mm4
|
||
|
|
paddb mm3,mm5
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro avg1 0
|
||
|
|
por mm0,mm2
|
||
|
|
pand mm0,mm6
|
||
|
|
paddb mm0,mm1
|
||
|
|
paddb mm0,mm3
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro avg2 0
|
||
|
|
por mm2,mm0
|
||
|
|
pand mm2,mm6
|
||
|
|
paddb mm2,mm3
|
||
|
|
paddb mm2,mm1
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro avground1 0
|
||
|
|
pand mm0,mm2
|
||
|
|
pand mm0,mm6
|
||
|
|
paddb mm0,mm1
|
||
|
|
paddb mm0,mm3
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro avground2 0
|
||
|
|
pand mm2,mm0
|
||
|
|
pand mm2,mm6
|
||
|
|
paddb mm2,mm3
|
||
|
|
paddb mm2,mm1
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro save1 0
|
||
|
|
movd [edi],mm0
|
||
|
|
add edi,edx
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro save2 0
|
||
|
|
movd [edi],mm2
|
||
|
|
add edi,edx
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro saveadd1 0
|
||
|
|
movd mm4,[edi]
|
||
|
|
movq mm1,mm0
|
||
|
|
pand mm0,mm7
|
||
|
|
por mm1,mm4
|
||
|
|
pand mm4,mm7
|
||
|
|
pand mm1,mm6
|
||
|
|
psrlq mm0,1
|
||
|
|
psrlq mm4,1
|
||
|
|
paddb mm1,mm0
|
||
|
|
paddb mm1,mm4
|
||
|
|
movd [edi],mm1
|
||
|
|
add edi,edx
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro saveadd2 0
|
||
|
|
movd mm4,[edi]
|
||
|
|
movq mm3,mm2
|
||
|
|
pand mm2,mm7
|
||
|
|
por mm3,mm4
|
||
|
|
pand mm4,mm7
|
||
|
|
pand mm3,mm6
|
||
|
|
psrlq mm2,1
|
||
|
|
psrlq mm4,1
|
||
|
|
paddb mm3,mm2
|
||
|
|
paddb mm3,mm4
|
||
|
|
movd [edi],mm3
|
||
|
|
add edi,edx
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
%macro CopyBlock4x4_NN 4
|
||
|
|
ALIGN 16
|
||
|
|
CopyBlock4x4_%0%1%2:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 0
|
||
|
|
loadmask16
|
||
|
|
|
||
|
|
load1hv 4
|
||
|
|
%rep 2
|
||
|
|
load2hv 4
|
||
|
|
|
||
|
|
movq mm4,[%3]
|
||
|
|
paddb mm0,mm2
|
||
|
|
paddb mm1,mm3
|
||
|
|
paddb mm0,mm4 ;+7
|
||
|
|
pand mm0,mm7
|
||
|
|
psrlq mm0,2
|
||
|
|
paddb mm0,mm1
|
||
|
|
|
||
|
|
save1
|
||
|
|
|
||
|
|
load1hv 4
|
||
|
|
|
||
|
|
movq mm4,[%3]
|
||
|
|
paddb mm2,mm0
|
||
|
|
paddb mm3,mm1
|
||
|
|
paddb mm2,mm4 ;+7
|
||
|
|
pand mm2,mm7
|
||
|
|
psrlq mm2,2
|
||
|
|
paddb mm2,mm3
|
||
|
|
|
||
|
|
save2
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 16
|
||
|
|
%endmacro
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
CopyBlock4x4:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
loadparam 0
|
||
|
|
push ebx
|
||
|
|
push ecx
|
||
|
|
|
||
|
|
mov ebx,[esi]
|
||
|
|
mov ecx,[esi+eax]
|
||
|
|
add esi,eax
|
||
|
|
mov [edi],ebx
|
||
|
|
mov [edi+edx],ecx
|
||
|
|
add edi,edx
|
||
|
|
mov ebx,[esi+eax]
|
||
|
|
mov ecx,[esi+eax*2]
|
||
|
|
mov [edi+edx],ebx
|
||
|
|
mov [edi+edx*2],ecx
|
||
|
|
|
||
|
|
pop ecx
|
||
|
|
pop ebx
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 16
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
CopyBlock4x4_02:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 0
|
||
|
|
loadmask1
|
||
|
|
|
||
|
|
%rep 4
|
||
|
|
load1 0,0
|
||
|
|
load2 1,1
|
||
|
|
avg1
|
||
|
|
save1
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 16
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
CopyBlock4x4_20:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 0
|
||
|
|
loadmask1
|
||
|
|
load1 0,1
|
||
|
|
%rep 2
|
||
|
|
load2 0,1
|
||
|
|
avg1
|
||
|
|
save1
|
||
|
|
load1 0,1
|
||
|
|
avg2
|
||
|
|
save2
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 16
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
CopyBlock4x4_22:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 0
|
||
|
|
loadmask4
|
||
|
|
|
||
|
|
load1hv 2
|
||
|
|
%rep 2
|
||
|
|
load2hv 2
|
||
|
|
|
||
|
|
pcmpeqb mm4,mm4 ;-1
|
||
|
|
paddb mm0,mm2
|
||
|
|
paddb mm4,mm4 ;-2
|
||
|
|
paddb mm1,mm3
|
||
|
|
psubb mm0,mm4 ;+2
|
||
|
|
pand mm0,mm7
|
||
|
|
psrlq mm0,2
|
||
|
|
paddb mm0,mm1
|
||
|
|
|
||
|
|
save1
|
||
|
|
|
||
|
|
load1hv 2
|
||
|
|
|
||
|
|
pcmpeqb mm4,mm4 ;-1
|
||
|
|
paddb mm2,mm0
|
||
|
|
paddb mm4,mm4 ;-2
|
||
|
|
paddb mm3,mm1
|
||
|
|
psubb mm2,mm4 ;+2
|
||
|
|
pand mm2,mm7
|
||
|
|
psrlq mm2,2
|
||
|
|
paddb mm2,mm3
|
||
|
|
|
||
|
|
save2
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 16
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
CopyBlock4x4_02R:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 0
|
||
|
|
loadmask1
|
||
|
|
|
||
|
|
%rep 4
|
||
|
|
load1 0,0
|
||
|
|
load2 1,1
|
||
|
|
avground1
|
||
|
|
save1
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 16
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
CopyBlock4x4_20R:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 0
|
||
|
|
loadmask1
|
||
|
|
load1 0,1
|
||
|
|
%rep 2
|
||
|
|
load2 0,1
|
||
|
|
avground1
|
||
|
|
save1
|
||
|
|
load1 0,1
|
||
|
|
avground2
|
||
|
|
save2
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 16
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
CopyBlock4x4_22R:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 0
|
||
|
|
loadmask4
|
||
|
|
|
||
|
|
load1hv 2
|
||
|
|
%rep 2
|
||
|
|
load2hv 2
|
||
|
|
|
||
|
|
pcmpeqb mm4,mm4 ;-1
|
||
|
|
paddb mm0,mm2
|
||
|
|
paddb mm1,mm3
|
||
|
|
psubb mm0,mm4 ;+1
|
||
|
|
pand mm0,mm7
|
||
|
|
psrlq mm0,2
|
||
|
|
paddb mm0,mm1
|
||
|
|
|
||
|
|
save1
|
||
|
|
|
||
|
|
load1hv 2
|
||
|
|
|
||
|
|
pcmpeqb mm4,mm4 ;-1
|
||
|
|
paddb mm2,mm0
|
||
|
|
paddb mm3,mm1
|
||
|
|
psubb mm2,mm4 ;+1
|
||
|
|
pand mm2,mm7
|
||
|
|
psrlq mm2,2
|
||
|
|
paddb mm2,mm3
|
||
|
|
|
||
|
|
save2
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 16
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
AddBlock4x4:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 1
|
||
|
|
loadmask1
|
||
|
|
|
||
|
|
%rep 4
|
||
|
|
movd mm0,[esi]
|
||
|
|
add esi,eax
|
||
|
|
saveadd1
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 12
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
AddBlock4x4_02:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 1
|
||
|
|
loadmask1
|
||
|
|
|
||
|
|
%rep 4
|
||
|
|
load1 0,0
|
||
|
|
load2 1,1
|
||
|
|
avg1
|
||
|
|
saveadd1
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 12
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
AddBlock4x4_20:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 1
|
||
|
|
loadmask1
|
||
|
|
load1 0,1
|
||
|
|
%rep 2
|
||
|
|
load2 0,1
|
||
|
|
avg1
|
||
|
|
saveadd1
|
||
|
|
load1 0,1
|
||
|
|
avg2
|
||
|
|
saveadd2
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 12
|
||
|
|
|
||
|
|
ALIGN 16
|
||
|
|
AddBlock4x4_22:
|
||
|
|
push esi
|
||
|
|
push edi
|
||
|
|
|
||
|
|
loadparam 1
|
||
|
|
loadmask4
|
||
|
|
|
||
|
|
load1hv 2
|
||
|
|
%rep 2
|
||
|
|
load2hv 2
|
||
|
|
|
||
|
|
pcmpeqb mm5,mm5 ;-1
|
||
|
|
paddb mm0,mm2
|
||
|
|
paddb mm5,mm5 ;-2
|
||
|
|
paddb mm1,mm3
|
||
|
|
psubb mm0,mm5 ;+=2
|
||
|
|
pand mm0,mm7
|
||
|
|
psrlq mm0,2
|
||
|
|
paddb mm0,mm1
|
||
|
|
|
||
|
|
paddb mm6,mm5 ;0x03-2=0x01
|
||
|
|
psubb mm7,mm5 ;0xFD+2=0xFF
|
||
|
|
saveadd1
|
||
|
|
psubb mm6,mm5 ;restore mask
|
||
|
|
paddb mm7,mm5 ;restore mask
|
||
|
|
|
||
|
|
load1hv 2
|
||
|
|
|
||
|
|
pcmpeqb mm5,mm5 ;-1
|
||
|
|
paddb mm2,mm0
|
||
|
|
paddb mm5,mm5 ;-2
|
||
|
|
paddb mm3,mm1
|
||
|
|
psubb mm2,mm5 ;+=2
|
||
|
|
pand mm2,mm7
|
||
|
|
psrlq mm2,2
|
||
|
|
paddb mm2,mm3
|
||
|
|
|
||
|
|
paddb mm6,mm5 ;0x03-2=0x01
|
||
|
|
psubb mm7,mm5 ;0xFD+2=0xFF
|
||
|
|
saveadd2
|
||
|
|
psubb mm6,mm5 ;restore mask
|
||
|
|
paddb mm7,mm5 ;restore mask
|
||
|
|
|
||
|
|
%endrep
|
||
|
|
|
||
|
|
pop edi
|
||
|
|
pop esi
|
||
|
|
ret 12
|
||
|
|
|
||
|
|
%endif
|