935 lines
23 KiB
NASM
935 lines
23 KiB
NASM
|
;*****************************************************************************
|
||
|
;* SIMD-optimized motion compensation estimation
|
||
|
;*****************************************************************************
|
||
|
;* Copyright (c) 2000, 2001 Fabrice Bellard
|
||
|
;* Copyright (c) 2002-2004 Michael Niedermayer <michaelni@gmx.at>
|
||
|
;*
|
||
|
;* This file is part of FFmpeg.
|
||
|
;*
|
||
|
;* FFmpeg is free software; you can redistribute it and/or
|
||
|
;* modify it under the terms of the GNU Lesser General Public
|
||
|
;* License as published by the Free Software Foundation; either
|
||
|
;* version 2.1 of the License, or (at your option) any later version.
|
||
|
;*
|
||
|
;* FFmpeg 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
|
||
|
;* Lesser General Public License for more details.
|
||
|
;*
|
||
|
;* You should have received a copy of the GNU Lesser General Public
|
||
|
;* License along with FFmpeg; if not, write to the Free Software
|
||
|
;* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
||
|
;*****************************************************************************
|
||
|
|
||
|
%include "libavutil/x86/x86util.asm"
|
||
|
|
||
|
SECTION_RODATA
|
||
|
|
||
|
cextern pb_1
|
||
|
cextern pb_80
|
||
|
|
||
|
SECTION .text
|
||
|
|
||
|
%macro DIFF_PIXELS_1 4
|
||
|
movh %1, %3
|
||
|
movh %2, %4
|
||
|
punpcklbw %2, %1
|
||
|
punpcklbw %1, %1
|
||
|
psubw %1, %2
|
||
|
%endmacro
|
||
|
|
||
|
; %1=uint8_t *pix1, %2=uint8_t *pix2, %3=static offset, %4=stride, %5=stride*3
|
||
|
; %6=temporary storage location
|
||
|
; this macro requires $mmsize stack space (aligned) on %6 (except on SSE+x86-64)
|
||
|
%macro DIFF_PIXELS_8 6
|
||
|
DIFF_PIXELS_1 m0, m7, [%1 +%3], [%2 +%3]
|
||
|
DIFF_PIXELS_1 m1, m7, [%1+%4 +%3], [%2+%4 +%3]
|
||
|
DIFF_PIXELS_1 m2, m7, [%1+%4*2+%3], [%2+%4*2+%3]
|
||
|
add %1, %5
|
||
|
add %2, %5
|
||
|
DIFF_PIXELS_1 m3, m7, [%1 +%3], [%2 +%3]
|
||
|
DIFF_PIXELS_1 m4, m7, [%1+%4 +%3], [%2+%4 +%3]
|
||
|
DIFF_PIXELS_1 m5, m7, [%1+%4*2+%3], [%2+%4*2+%3]
|
||
|
DIFF_PIXELS_1 m6, m7, [%1+%5 +%3], [%2+%5 +%3]
|
||
|
%ifdef m8
|
||
|
DIFF_PIXELS_1 m7, m8, [%1+%4*4+%3], [%2+%4*4+%3]
|
||
|
%else
|
||
|
mova [%6], m0
|
||
|
DIFF_PIXELS_1 m7, m0, [%1+%4*4+%3], [%2+%4*4+%3]
|
||
|
mova m0, [%6]
|
||
|
%endif
|
||
|
sub %1, %5
|
||
|
sub %2, %5
|
||
|
%endmacro
|
||
|
|
||
|
%macro HADAMARD8 0
|
||
|
SUMSUB_BADC w, 0, 1, 2, 3
|
||
|
SUMSUB_BADC w, 4, 5, 6, 7
|
||
|
SUMSUB_BADC w, 0, 2, 1, 3
|
||
|
SUMSUB_BADC w, 4, 6, 5, 7
|
||
|
SUMSUB_BADC w, 0, 4, 1, 5
|
||
|
SUMSUB_BADC w, 2, 6, 3, 7
|
||
|
%endmacro
|
||
|
|
||
|
%macro ABS1_SUM 3
|
||
|
ABS1 %1, %2
|
||
|
paddusw %3, %1
|
||
|
%endmacro
|
||
|
|
||
|
%macro ABS2_SUM 6
|
||
|
ABS2 %1, %2, %3, %4
|
||
|
paddusw %5, %1
|
||
|
paddusw %6, %2
|
||
|
%endmacro
|
||
|
|
||
|
%macro ABS_SUM_8x8_64 1
|
||
|
ABS2 m0, m1, m8, m9
|
||
|
ABS2_SUM m2, m3, m8, m9, m0, m1
|
||
|
ABS2_SUM m4, m5, m8, m9, m0, m1
|
||
|
ABS2_SUM m6, m7, m8, m9, m0, m1
|
||
|
paddusw m0, m1
|
||
|
%endmacro
|
||
|
|
||
|
%macro ABS_SUM_8x8_32 1
|
||
|
mova [%1], m7
|
||
|
ABS1 m0, m7
|
||
|
ABS1 m1, m7
|
||
|
ABS1_SUM m2, m7, m0
|
||
|
ABS1_SUM m3, m7, m1
|
||
|
ABS1_SUM m4, m7, m0
|
||
|
ABS1_SUM m5, m7, m1
|
||
|
ABS1_SUM m6, m7, m0
|
||
|
mova m2, [%1]
|
||
|
ABS1_SUM m2, m7, m1
|
||
|
paddusw m0, m1
|
||
|
%endmacro
|
||
|
|
||
|
; FIXME: HSUM saturates at 64k, while an 8x8 hadamard or dct block can get up to
|
||
|
; about 100k on extreme inputs. But that's very unlikely to occur in natural video,
|
||
|
; and it's even more unlikely to not have any alternative mvs/modes with lower cost.
|
||
|
%macro HSUM 3
|
||
|
%if cpuflag(sse2)
|
||
|
movhlps %2, %1
|
||
|
paddusw %1, %2
|
||
|
pshuflw %2, %1, 0xE
|
||
|
paddusw %1, %2
|
||
|
pshuflw %2, %1, 0x1
|
||
|
paddusw %1, %2
|
||
|
movd %3, %1
|
||
|
%elif cpuflag(mmxext)
|
||
|
pshufw %2, %1, 0xE
|
||
|
paddusw %1, %2
|
||
|
pshufw %2, %1, 0x1
|
||
|
paddusw %1, %2
|
||
|
movd %3, %1
|
||
|
%elif cpuflag(mmx)
|
||
|
mova %2, %1
|
||
|
psrlq %1, 32
|
||
|
paddusw %1, %2
|
||
|
mova %2, %1
|
||
|
psrlq %1, 16
|
||
|
paddusw %1, %2
|
||
|
movd %3, %1
|
||
|
%endif
|
||
|
%endmacro
|
||
|
|
||
|
%macro STORE4 5
|
||
|
mova [%1+mmsize*0], %2
|
||
|
mova [%1+mmsize*1], %3
|
||
|
mova [%1+mmsize*2], %4
|
||
|
mova [%1+mmsize*3], %5
|
||
|
%endmacro
|
||
|
|
||
|
%macro LOAD4 5
|
||
|
mova %2, [%1+mmsize*0]
|
||
|
mova %3, [%1+mmsize*1]
|
||
|
mova %4, [%1+mmsize*2]
|
||
|
mova %5, [%1+mmsize*3]
|
||
|
%endmacro
|
||
|
|
||
|
%macro hadamard8_16_wrapper 2
|
||
|
cglobal hadamard8_diff, 4, 4, %1
|
||
|
%ifndef m8
|
||
|
%assign pad %2*mmsize-(4+stack_offset&(mmsize-1))
|
||
|
SUB rsp, pad
|
||
|
%endif
|
||
|
call hadamard8x8_diff %+ SUFFIX
|
||
|
%ifndef m8
|
||
|
ADD rsp, pad
|
||
|
%endif
|
||
|
RET
|
||
|
|
||
|
cglobal hadamard8_diff16, 5, 6, %1
|
||
|
%ifndef m8
|
||
|
%assign pad %2*mmsize-(4+stack_offset&(mmsize-1))
|
||
|
SUB rsp, pad
|
||
|
%endif
|
||
|
|
||
|
call hadamard8x8_diff %+ SUFFIX
|
||
|
mov r5d, eax
|
||
|
|
||
|
add r1, 8
|
||
|
add r2, 8
|
||
|
call hadamard8x8_diff %+ SUFFIX
|
||
|
add r5d, eax
|
||
|
|
||
|
cmp r4d, 16
|
||
|
jne .done
|
||
|
|
||
|
lea r1, [r1+r3*8-8]
|
||
|
lea r2, [r2+r3*8-8]
|
||
|
call hadamard8x8_diff %+ SUFFIX
|
||
|
add r5d, eax
|
||
|
|
||
|
add r1, 8
|
||
|
add r2, 8
|
||
|
call hadamard8x8_diff %+ SUFFIX
|
||
|
add r5d, eax
|
||
|
|
||
|
.done:
|
||
|
mov eax, r5d
|
||
|
%ifndef m8
|
||
|
ADD rsp, pad
|
||
|
%endif
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
%macro HADAMARD8_DIFF 0-1
|
||
|
%if cpuflag(sse2)
|
||
|
hadamard8x8_diff %+ SUFFIX:
|
||
|
lea r0, [r3*3]
|
||
|
DIFF_PIXELS_8 r1, r2, 0, r3, r0, rsp+gprsize
|
||
|
HADAMARD8
|
||
|
%if ARCH_X86_64
|
||
|
TRANSPOSE8x8W 0, 1, 2, 3, 4, 5, 6, 7, 8
|
||
|
%else
|
||
|
TRANSPOSE8x8W 0, 1, 2, 3, 4, 5, 6, 7, [rsp+gprsize], [rsp+mmsize+gprsize]
|
||
|
%endif
|
||
|
HADAMARD8
|
||
|
ABS_SUM_8x8 rsp+gprsize
|
||
|
HSUM m0, m1, eax
|
||
|
and eax, 0xFFFF
|
||
|
ret
|
||
|
|
||
|
hadamard8_16_wrapper %1, 3
|
||
|
%elif cpuflag(mmx)
|
||
|
ALIGN 16
|
||
|
; int ff_hadamard8_diff_ ## cpu(MpegEncContext *s, uint8_t *src1,
|
||
|
; uint8_t *src2, ptrdiff_t stride, int h)
|
||
|
; r0 = void *s = unused, int h = unused (always 8)
|
||
|
; note how r1, r2 and r3 are not clobbered in this function, so 16x16
|
||
|
; can simply call this 2x2x (and that's why we access rsp+gprsize
|
||
|
; everywhere, which is rsp of calling func
|
||
|
hadamard8x8_diff %+ SUFFIX:
|
||
|
lea r0, [r3*3]
|
||
|
|
||
|
; first 4x8 pixels
|
||
|
DIFF_PIXELS_8 r1, r2, 0, r3, r0, rsp+gprsize+0x60
|
||
|
HADAMARD8
|
||
|
mova [rsp+gprsize+0x60], m7
|
||
|
TRANSPOSE4x4W 0, 1, 2, 3, 7
|
||
|
STORE4 rsp+gprsize, m0, m1, m2, m3
|
||
|
mova m7, [rsp+gprsize+0x60]
|
||
|
TRANSPOSE4x4W 4, 5, 6, 7, 0
|
||
|
STORE4 rsp+gprsize+0x40, m4, m5, m6, m7
|
||
|
|
||
|
; second 4x8 pixels
|
||
|
DIFF_PIXELS_8 r1, r2, 4, r3, r0, rsp+gprsize+0x60
|
||
|
HADAMARD8
|
||
|
mova [rsp+gprsize+0x60], m7
|
||
|
TRANSPOSE4x4W 0, 1, 2, 3, 7
|
||
|
STORE4 rsp+gprsize+0x20, m0, m1, m2, m3
|
||
|
mova m7, [rsp+gprsize+0x60]
|
||
|
TRANSPOSE4x4W 4, 5, 6, 7, 0
|
||
|
|
||
|
LOAD4 rsp+gprsize+0x40, m0, m1, m2, m3
|
||
|
HADAMARD8
|
||
|
ABS_SUM_8x8_32 rsp+gprsize+0x60
|
||
|
mova [rsp+gprsize+0x60], m0
|
||
|
|
||
|
LOAD4 rsp+gprsize , m0, m1, m2, m3
|
||
|
LOAD4 rsp+gprsize+0x20, m4, m5, m6, m7
|
||
|
HADAMARD8
|
||
|
ABS_SUM_8x8_32 rsp+gprsize
|
||
|
paddusw m0, [rsp+gprsize+0x60]
|
||
|
|
||
|
HSUM m0, m1, eax
|
||
|
and rax, 0xFFFF
|
||
|
ret
|
||
|
|
||
|
hadamard8_16_wrapper 0, 14
|
||
|
%endif
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmx
|
||
|
HADAMARD8_DIFF
|
||
|
|
||
|
INIT_MMX mmxext
|
||
|
HADAMARD8_DIFF
|
||
|
|
||
|
INIT_XMM sse2
|
||
|
%if ARCH_X86_64
|
||
|
%define ABS_SUM_8x8 ABS_SUM_8x8_64
|
||
|
%else
|
||
|
%define ABS_SUM_8x8 ABS_SUM_8x8_32
|
||
|
%endif
|
||
|
HADAMARD8_DIFF 10
|
||
|
|
||
|
INIT_XMM ssse3
|
||
|
%define ABS_SUM_8x8 ABS_SUM_8x8_64
|
||
|
HADAMARD8_DIFF 9
|
||
|
|
||
|
; int ff_sse*_*(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
|
||
|
; ptrdiff_t line_size, int h)
|
||
|
|
||
|
%macro SUM_SQUARED_ERRORS 1
|
||
|
cglobal sse%1, 5,5,8, v, pix1, pix2, lsize, h
|
||
|
%if %1 == mmsize
|
||
|
shr hd, 1
|
||
|
%endif
|
||
|
pxor m0, m0 ; mm0 = 0
|
||
|
pxor m7, m7 ; mm7 holds the sum
|
||
|
|
||
|
.next2lines: ; FIXME why are these unaligned movs? pix1[] is aligned
|
||
|
movu m1, [pix1q] ; m1 = pix1[0][0-15], [0-7] for mmx
|
||
|
movu m2, [pix2q] ; m2 = pix2[0][0-15], [0-7] for mmx
|
||
|
%if %1 == mmsize
|
||
|
movu m3, [pix1q+lsizeq] ; m3 = pix1[1][0-15], [0-7] for mmx
|
||
|
movu m4, [pix2q+lsizeq] ; m4 = pix2[1][0-15], [0-7] for mmx
|
||
|
%else ; %1 / 2 == mmsize; mmx only
|
||
|
mova m3, [pix1q+8] ; m3 = pix1[0][8-15]
|
||
|
mova m4, [pix2q+8] ; m4 = pix2[0][8-15]
|
||
|
%endif
|
||
|
|
||
|
; todo: mm1-mm2, mm3-mm4
|
||
|
; algo: subtract mm1 from mm2 with saturation and vice versa
|
||
|
; OR the result to get the absolute difference
|
||
|
mova m5, m1
|
||
|
mova m6, m3
|
||
|
psubusb m1, m2
|
||
|
psubusb m3, m4
|
||
|
psubusb m2, m5
|
||
|
psubusb m4, m6
|
||
|
|
||
|
por m2, m1
|
||
|
por m4, m3
|
||
|
|
||
|
; now convert to 16-bit vectors so we can square them
|
||
|
mova m1, m2
|
||
|
mova m3, m4
|
||
|
|
||
|
punpckhbw m2, m0
|
||
|
punpckhbw m4, m0
|
||
|
punpcklbw m1, m0 ; mm1 not spread over (mm1,mm2)
|
||
|
punpcklbw m3, m0 ; mm4 not spread over (mm3,mm4)
|
||
|
|
||
|
pmaddwd m2, m2
|
||
|
pmaddwd m4, m4
|
||
|
pmaddwd m1, m1
|
||
|
pmaddwd m3, m3
|
||
|
|
||
|
paddd m1, m2
|
||
|
paddd m3, m4
|
||
|
paddd m7, m1
|
||
|
paddd m7, m3
|
||
|
|
||
|
%if %1 == mmsize
|
||
|
lea pix1q, [pix1q + 2*lsizeq]
|
||
|
lea pix2q, [pix2q + 2*lsizeq]
|
||
|
%else
|
||
|
add pix1q, lsizeq
|
||
|
add pix2q, lsizeq
|
||
|
%endif
|
||
|
dec hd
|
||
|
jnz .next2lines
|
||
|
|
||
|
HADDD m7, m1
|
||
|
movd eax, m7 ; return value
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmx
|
||
|
SUM_SQUARED_ERRORS 8
|
||
|
|
||
|
INIT_MMX mmx
|
||
|
SUM_SQUARED_ERRORS 16
|
||
|
|
||
|
INIT_XMM sse2
|
||
|
SUM_SQUARED_ERRORS 16
|
||
|
|
||
|
;-----------------------------------------------
|
||
|
;int ff_sum_abs_dctelem(int16_t *block)
|
||
|
;-----------------------------------------------
|
||
|
; %1 = number of xmm registers used
|
||
|
; %2 = number of inline loops
|
||
|
|
||
|
%macro SUM_ABS_DCTELEM 2
|
||
|
cglobal sum_abs_dctelem, 1, 1, %1, block
|
||
|
pxor m0, m0
|
||
|
pxor m1, m1
|
||
|
%assign %%i 0
|
||
|
%rep %2
|
||
|
mova m2, [blockq+mmsize*(0+%%i)]
|
||
|
mova m3, [blockq+mmsize*(1+%%i)]
|
||
|
mova m4, [blockq+mmsize*(2+%%i)]
|
||
|
mova m5, [blockq+mmsize*(3+%%i)]
|
||
|
ABS1_SUM m2, m6, m0
|
||
|
ABS1_SUM m3, m6, m1
|
||
|
ABS1_SUM m4, m6, m0
|
||
|
ABS1_SUM m5, m6, m1
|
||
|
%assign %%i %%i+4
|
||
|
%endrep
|
||
|
paddusw m0, m1
|
||
|
HSUM m0, m1, eax
|
||
|
and eax, 0xFFFF
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmx
|
||
|
SUM_ABS_DCTELEM 0, 4
|
||
|
INIT_MMX mmxext
|
||
|
SUM_ABS_DCTELEM 0, 4
|
||
|
INIT_XMM sse2
|
||
|
SUM_ABS_DCTELEM 7, 2
|
||
|
INIT_XMM ssse3
|
||
|
SUM_ABS_DCTELEM 6, 2
|
||
|
|
||
|
;------------------------------------------------------------------------------
|
||
|
; int ff_hf_noise*_mmx(uint8_t *pix1, ptrdiff_t lsize, int h)
|
||
|
;------------------------------------------------------------------------------
|
||
|
; %1 = 8/16. %2-5=m#
|
||
|
%macro HF_NOISE_PART1 5
|
||
|
mova m%2, [pix1q]
|
||
|
%if %1 == 8
|
||
|
mova m%3, m%2
|
||
|
psllq m%2, 8
|
||
|
psrlq m%3, 8
|
||
|
psrlq m%2, 8
|
||
|
%else
|
||
|
mova m%3, [pix1q+1]
|
||
|
%endif
|
||
|
mova m%4, m%2
|
||
|
mova m%5, m%3
|
||
|
punpcklbw m%2, m7
|
||
|
punpcklbw m%3, m7
|
||
|
punpckhbw m%4, m7
|
||
|
punpckhbw m%5, m7
|
||
|
psubw m%2, m%3
|
||
|
psubw m%4, m%5
|
||
|
%endmacro
|
||
|
|
||
|
; %1-2 = m#
|
||
|
%macro HF_NOISE_PART2 4
|
||
|
psubw m%1, m%3
|
||
|
psubw m%2, m%4
|
||
|
pxor m3, m3
|
||
|
pxor m1, m1
|
||
|
pcmpgtw m3, m%1
|
||
|
pcmpgtw m1, m%2
|
||
|
pxor m%1, m3
|
||
|
pxor m%2, m1
|
||
|
psubw m%1, m3
|
||
|
psubw m%2, m1
|
||
|
paddw m%2, m%1
|
||
|
paddw m6, m%2
|
||
|
%endmacro
|
||
|
|
||
|
; %1 = 8/16
|
||
|
%macro HF_NOISE 1
|
||
|
cglobal hf_noise%1, 3,3,0, pix1, lsize, h
|
||
|
sub hd, 2
|
||
|
pxor m7, m7
|
||
|
pxor m6, m6
|
||
|
HF_NOISE_PART1 %1, 0, 1, 2, 3
|
||
|
add pix1q, lsizeq
|
||
|
HF_NOISE_PART1 %1, 4, 1, 5, 3
|
||
|
HF_NOISE_PART2 0, 2, 4, 5
|
||
|
add pix1q, lsizeq
|
||
|
.loop:
|
||
|
HF_NOISE_PART1 %1, 0, 1, 2, 3
|
||
|
HF_NOISE_PART2 4, 5, 0, 2
|
||
|
add pix1q, lsizeq
|
||
|
HF_NOISE_PART1 %1, 4, 1, 5, 3
|
||
|
HF_NOISE_PART2 0, 2, 4, 5
|
||
|
add pix1q, lsizeq
|
||
|
sub hd, 2
|
||
|
jne .loop
|
||
|
|
||
|
mova m0, m6
|
||
|
punpcklwd m0, m7
|
||
|
punpckhwd m6, m7
|
||
|
paddd m6, m0
|
||
|
mova m0, m6
|
||
|
psrlq m6, 32
|
||
|
paddd m0, m6
|
||
|
movd eax, m0 ; eax = result of hf_noise8;
|
||
|
REP_RET ; return eax;
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmx
|
||
|
HF_NOISE 8
|
||
|
HF_NOISE 16
|
||
|
|
||
|
;---------------------------------------------------------------------------------------
|
||
|
;int ff_sad_<opt>(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t stride, int h);
|
||
|
;---------------------------------------------------------------------------------------
|
||
|
;%1 = 8/16
|
||
|
%macro SAD 1
|
||
|
cglobal sad%1, 5, 5, 3, v, pix1, pix2, stride, h
|
||
|
movu m2, [pix2q]
|
||
|
movu m1, [pix2q+strideq]
|
||
|
psadbw m2, [pix1q]
|
||
|
psadbw m1, [pix1q+strideq]
|
||
|
paddw m2, m1
|
||
|
%if %1 != mmsize
|
||
|
movu m0, [pix2q+8]
|
||
|
movu m1, [pix2q+strideq+8]
|
||
|
psadbw m0, [pix1q+8]
|
||
|
psadbw m1, [pix1q+strideq+8]
|
||
|
paddw m2, m0
|
||
|
paddw m2, m1
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
|
||
|
align 16
|
||
|
.loop:
|
||
|
lea pix1q, [pix1q+strideq*2]
|
||
|
lea pix2q, [pix2q+strideq*2]
|
||
|
movu m0, [pix2q]
|
||
|
movu m1, [pix2q+strideq]
|
||
|
psadbw m0, [pix1q]
|
||
|
psadbw m1, [pix1q+strideq]
|
||
|
paddw m2, m0
|
||
|
paddw m2, m1
|
||
|
%if %1 != mmsize
|
||
|
movu m0, [pix2q+8]
|
||
|
movu m1, [pix2q+strideq+8]
|
||
|
psadbw m0, [pix1q+8]
|
||
|
psadbw m1, [pix1q+strideq+8]
|
||
|
paddw m2, m0
|
||
|
paddw m2, m1
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
jg .loop
|
||
|
%if mmsize == 16
|
||
|
movhlps m0, m2
|
||
|
paddw m2, m0
|
||
|
%endif
|
||
|
movd eax, m2
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmxext
|
||
|
SAD 8
|
||
|
SAD 16
|
||
|
INIT_XMM sse2
|
||
|
SAD 16
|
||
|
|
||
|
;------------------------------------------------------------------------------------------
|
||
|
;int ff_sad_x2_<opt>(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t stride, int h);
|
||
|
;------------------------------------------------------------------------------------------
|
||
|
;%1 = 8/16
|
||
|
%macro SAD_X2 1
|
||
|
cglobal sad%1_x2, 5, 5, 5, v, pix1, pix2, stride, h
|
||
|
movu m0, [pix2q]
|
||
|
movu m2, [pix2q+strideq]
|
||
|
%if mmsize == 16
|
||
|
movu m3, [pix2q+1]
|
||
|
movu m4, [pix2q+strideq+1]
|
||
|
pavgb m0, m3
|
||
|
pavgb m2, m4
|
||
|
%else
|
||
|
pavgb m0, [pix2q+1]
|
||
|
pavgb m2, [pix2q+strideq+1]
|
||
|
%endif
|
||
|
psadbw m0, [pix1q]
|
||
|
psadbw m2, [pix1q+strideq]
|
||
|
paddw m0, m2
|
||
|
%if %1 != mmsize
|
||
|
movu m1, [pix2q+8]
|
||
|
movu m2, [pix2q+strideq+8]
|
||
|
pavgb m1, [pix2q+9]
|
||
|
pavgb m2, [pix2q+strideq+9]
|
||
|
psadbw m1, [pix1q+8]
|
||
|
psadbw m2, [pix1q+strideq+8]
|
||
|
paddw m0, m1
|
||
|
paddw m0, m2
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
|
||
|
align 16
|
||
|
.loop:
|
||
|
lea pix1q, [pix1q+2*strideq]
|
||
|
lea pix2q, [pix2q+2*strideq]
|
||
|
movu m1, [pix2q]
|
||
|
movu m2, [pix2q+strideq]
|
||
|
%if mmsize == 16
|
||
|
movu m3, [pix2q+1]
|
||
|
movu m4, [pix2q+strideq+1]
|
||
|
pavgb m1, m3
|
||
|
pavgb m2, m4
|
||
|
%else
|
||
|
pavgb m1, [pix2q+1]
|
||
|
pavgb m2, [pix2q+strideq+1]
|
||
|
%endif
|
||
|
psadbw m1, [pix1q]
|
||
|
psadbw m2, [pix1q+strideq]
|
||
|
paddw m0, m1
|
||
|
paddw m0, m2
|
||
|
%if %1 != mmsize
|
||
|
movu m1, [pix2q+8]
|
||
|
movu m2, [pix2q+strideq+8]
|
||
|
pavgb m1, [pix2q+9]
|
||
|
pavgb m2, [pix2q+strideq+9]
|
||
|
psadbw m1, [pix1q+8]
|
||
|
psadbw m2, [pix1q+strideq+8]
|
||
|
paddw m0, m1
|
||
|
paddw m0, m2
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
jg .loop
|
||
|
%if mmsize == 16
|
||
|
movhlps m1, m0
|
||
|
paddw m0, m1
|
||
|
%endif
|
||
|
movd eax, m0
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmxext
|
||
|
SAD_X2 8
|
||
|
SAD_X2 16
|
||
|
INIT_XMM sse2
|
||
|
SAD_X2 16
|
||
|
|
||
|
;------------------------------------------------------------------------------------------
|
||
|
;int ff_sad_y2_<opt>(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t stride, int h);
|
||
|
;------------------------------------------------------------------------------------------
|
||
|
;%1 = 8/16
|
||
|
%macro SAD_Y2 1
|
||
|
cglobal sad%1_y2, 5, 5, 4, v, pix1, pix2, stride, h
|
||
|
movu m1, [pix2q]
|
||
|
movu m0, [pix2q+strideq]
|
||
|
movu m3, [pix2q+2*strideq]
|
||
|
pavgb m1, m0
|
||
|
pavgb m0, m3
|
||
|
psadbw m1, [pix1q]
|
||
|
psadbw m0, [pix1q+strideq]
|
||
|
paddw m0, m1
|
||
|
mova m1, m3
|
||
|
%if %1 != mmsize
|
||
|
movu m4, [pix2q+8]
|
||
|
movu m5, [pix2q+strideq+8]
|
||
|
movu m6, [pix2q+2*strideq+8]
|
||
|
pavgb m4, m5
|
||
|
pavgb m5, m6
|
||
|
psadbw m4, [pix1q+8]
|
||
|
psadbw m5, [pix1q+strideq+8]
|
||
|
paddw m0, m4
|
||
|
paddw m0, m5
|
||
|
mova m4, m6
|
||
|
%endif
|
||
|
add pix2q, strideq
|
||
|
sub hd, 2
|
||
|
|
||
|
align 16
|
||
|
.loop:
|
||
|
lea pix1q, [pix1q+2*strideq]
|
||
|
lea pix2q, [pix2q+2*strideq]
|
||
|
movu m2, [pix2q]
|
||
|
movu m3, [pix2q+strideq]
|
||
|
pavgb m1, m2
|
||
|
pavgb m2, m3
|
||
|
psadbw m1, [pix1q]
|
||
|
psadbw m2, [pix1q+strideq]
|
||
|
paddw m0, m1
|
||
|
paddw m0, m2
|
||
|
mova m1, m3
|
||
|
%if %1 != mmsize
|
||
|
movu m5, [pix2q+8]
|
||
|
movu m6, [pix2q+strideq+8]
|
||
|
pavgb m4, m5
|
||
|
pavgb m5, m6
|
||
|
psadbw m4, [pix1q+8]
|
||
|
psadbw m5, [pix1q+strideq+8]
|
||
|
paddw m0, m4
|
||
|
paddw m0, m5
|
||
|
mova m4, m6
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
jg .loop
|
||
|
%if mmsize == 16
|
||
|
movhlps m1, m0
|
||
|
paddw m0, m1
|
||
|
%endif
|
||
|
movd eax, m0
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmxext
|
||
|
SAD_Y2 8
|
||
|
SAD_Y2 16
|
||
|
INIT_XMM sse2
|
||
|
SAD_Y2 16
|
||
|
|
||
|
;-------------------------------------------------------------------------------------------
|
||
|
;int ff_sad_approx_xy2_<opt>(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t stride, int h);
|
||
|
;-------------------------------------------------------------------------------------------
|
||
|
;%1 = 8/16
|
||
|
%macro SAD_APPROX_XY2 1
|
||
|
cglobal sad%1_approx_xy2, 5, 5, 7, v, pix1, pix2, stride, h
|
||
|
mova m4, [pb_1]
|
||
|
movu m1, [pix2q]
|
||
|
movu m0, [pix2q+strideq]
|
||
|
movu m3, [pix2q+2*strideq]
|
||
|
%if mmsize == 16
|
||
|
movu m5, [pix2q+1]
|
||
|
movu m6, [pix2q+strideq+1]
|
||
|
movu m2, [pix2q+2*strideq+1]
|
||
|
pavgb m1, m5
|
||
|
pavgb m0, m6
|
||
|
pavgb m3, m2
|
||
|
%else
|
||
|
pavgb m1, [pix2q+1]
|
||
|
pavgb m0, [pix2q+strideq+1]
|
||
|
pavgb m3, [pix2q+2*strideq+1]
|
||
|
%endif
|
||
|
psubusb m0, m4
|
||
|
pavgb m1, m0
|
||
|
pavgb m0, m3
|
||
|
psadbw m1, [pix1q]
|
||
|
psadbw m0, [pix1q+strideq]
|
||
|
paddw m0, m1
|
||
|
mova m1, m3
|
||
|
%if %1 != mmsize
|
||
|
movu m5, [pix2q+8]
|
||
|
movu m6, [pix2q+strideq+8]
|
||
|
movu m7, [pix2q+2*strideq+8]
|
||
|
pavgb m5, [pix2q+1+8]
|
||
|
pavgb m6, [pix2q+strideq+1+8]
|
||
|
pavgb m7, [pix2q+2*strideq+1+8]
|
||
|
psubusb m6, m4
|
||
|
pavgb m5, m6
|
||
|
pavgb m6, m7
|
||
|
psadbw m5, [pix1q+8]
|
||
|
psadbw m6, [pix1q+strideq+8]
|
||
|
paddw m0, m5
|
||
|
paddw m0, m6
|
||
|
mova m5, m7
|
||
|
%endif
|
||
|
add pix2q, strideq
|
||
|
sub hd, 2
|
||
|
|
||
|
align 16
|
||
|
.loop:
|
||
|
lea pix1q, [pix1q+2*strideq]
|
||
|
lea pix2q, [pix2q+2*strideq]
|
||
|
movu m2, [pix2q]
|
||
|
movu m3, [pix2q+strideq]
|
||
|
%if mmsize == 16
|
||
|
movu m5, [pix2q+1]
|
||
|
movu m6, [pix2q+strideq+1]
|
||
|
pavgb m2, m5
|
||
|
pavgb m3, m6
|
||
|
%else
|
||
|
pavgb m2, [pix2q+1]
|
||
|
pavgb m3, [pix2q+strideq+1]
|
||
|
%endif
|
||
|
psubusb m2, m4
|
||
|
pavgb m1, m2
|
||
|
pavgb m2, m3
|
||
|
psadbw m1, [pix1q]
|
||
|
psadbw m2, [pix1q+strideq]
|
||
|
paddw m0, m1
|
||
|
paddw m0, m2
|
||
|
mova m1, m3
|
||
|
%if %1 != mmsize
|
||
|
movu m6, [pix2q+8]
|
||
|
movu m7, [pix2q+strideq+8]
|
||
|
pavgb m6, [pix2q+8+1]
|
||
|
pavgb m7, [pix2q+strideq+8+1]
|
||
|
psubusb m6, m4
|
||
|
pavgb m5, m6
|
||
|
pavgb m6, m7
|
||
|
psadbw m5, [pix1q+8]
|
||
|
psadbw m6, [pix1q+strideq+8]
|
||
|
paddw m0, m5
|
||
|
paddw m0, m6
|
||
|
mova m5, m7
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
jg .loop
|
||
|
%if mmsize == 16
|
||
|
movhlps m1, m0
|
||
|
paddw m0, m1
|
||
|
%endif
|
||
|
movd eax, m0
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmxext
|
||
|
SAD_APPROX_XY2 8
|
||
|
SAD_APPROX_XY2 16
|
||
|
INIT_XMM sse2
|
||
|
SAD_APPROX_XY2 16
|
||
|
|
||
|
;--------------------------------------------------------------------
|
||
|
;int ff_vsad_intra(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
|
||
|
; ptrdiff_t line_size, int h);
|
||
|
;--------------------------------------------------------------------
|
||
|
; %1 = 8/16
|
||
|
%macro VSAD_INTRA 1
|
||
|
cglobal vsad_intra%1, 5, 5, 3, v, pix1, pix2, lsize, h
|
||
|
mova m0, [pix1q]
|
||
|
%if %1 == mmsize
|
||
|
mova m2, [pix1q+lsizeq]
|
||
|
psadbw m0, m2
|
||
|
%else
|
||
|
mova m2, [pix1q+lsizeq]
|
||
|
mova m3, [pix1q+8]
|
||
|
mova m4, [pix1q+lsizeq+8]
|
||
|
psadbw m0, m2
|
||
|
psadbw m3, m4
|
||
|
paddw m0, m3
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
|
||
|
.loop:
|
||
|
lea pix1q, [pix1q + 2*lsizeq]
|
||
|
%if %1 == mmsize
|
||
|
mova m1, [pix1q]
|
||
|
psadbw m2, m1
|
||
|
paddw m0, m2
|
||
|
mova m2, [pix1q+lsizeq]
|
||
|
psadbw m1, m2
|
||
|
paddw m0, m1
|
||
|
%else
|
||
|
mova m1, [pix1q]
|
||
|
mova m3, [pix1q+8]
|
||
|
psadbw m2, m1
|
||
|
psadbw m4, m3
|
||
|
paddw m0, m2
|
||
|
paddw m0, m4
|
||
|
mova m2, [pix1q+lsizeq]
|
||
|
mova m4, [pix1q+lsizeq+8]
|
||
|
psadbw m1, m2
|
||
|
psadbw m3, m4
|
||
|
paddw m0, m1
|
||
|
paddw m0, m3
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
jg .loop
|
||
|
|
||
|
%if mmsize == 16
|
||
|
pshufd m1, m0, 0xe
|
||
|
paddd m0, m1
|
||
|
%endif
|
||
|
movd eax, m0
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmxext
|
||
|
VSAD_INTRA 8
|
||
|
VSAD_INTRA 16
|
||
|
INIT_XMM sse2
|
||
|
VSAD_INTRA 16
|
||
|
|
||
|
;---------------------------------------------------------------------
|
||
|
;int ff_vsad_approx(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
|
||
|
; ptrdiff_t line_size, int h);
|
||
|
;---------------------------------------------------------------------
|
||
|
; %1 = 8/16
|
||
|
%macro VSAD_APPROX 1
|
||
|
cglobal vsad%1_approx, 5, 5, 5, v, pix1, pix2, lsize, h
|
||
|
mova m1, [pb_80]
|
||
|
mova m0, [pix1q]
|
||
|
%if %1 == mmsize ; vsad8_mmxext, vsad16_sse2
|
||
|
mova m4, [pix1q+lsizeq]
|
||
|
%if mmsize == 16
|
||
|
movu m3, [pix2q]
|
||
|
movu m2, [pix2q+lsizeq]
|
||
|
psubb m0, m3
|
||
|
psubb m4, m2
|
||
|
%else
|
||
|
psubb m0, [pix2q]
|
||
|
psubb m4, [pix2q+lsizeq]
|
||
|
%endif
|
||
|
pxor m0, m1
|
||
|
pxor m4, m1
|
||
|
psadbw m0, m4
|
||
|
%else ; vsad16_mmxext
|
||
|
mova m3, [pix1q+8]
|
||
|
psubb m0, [pix2q]
|
||
|
psubb m3, [pix2q+8]
|
||
|
pxor m0, m1
|
||
|
pxor m3, m1
|
||
|
mova m4, [pix1q+lsizeq]
|
||
|
mova m5, [pix1q+lsizeq+8]
|
||
|
psubb m4, [pix2q+lsizeq]
|
||
|
psubb m5, [pix2q+lsizeq+8]
|
||
|
pxor m4, m1
|
||
|
pxor m5, m1
|
||
|
psadbw m0, m4
|
||
|
psadbw m3, m5
|
||
|
paddw m0, m3
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
|
||
|
.loop:
|
||
|
lea pix1q, [pix1q + 2*lsizeq]
|
||
|
lea pix2q, [pix2q + 2*lsizeq]
|
||
|
mova m2, [pix1q]
|
||
|
%if %1 == mmsize ; vsad8_mmxext, vsad16_sse2
|
||
|
%if mmsize == 16
|
||
|
movu m3, [pix2q]
|
||
|
psubb m2, m3
|
||
|
%else
|
||
|
psubb m2, [pix2q]
|
||
|
%endif
|
||
|
pxor m2, m1
|
||
|
psadbw m4, m2
|
||
|
paddw m0, m4
|
||
|
mova m4, [pix1q+lsizeq]
|
||
|
movu m3, [pix2q+lsizeq]
|
||
|
psubb m4, m3
|
||
|
pxor m4, m1
|
||
|
psadbw m2, m4
|
||
|
paddw m0, m2
|
||
|
%else ; vsad16_mmxext
|
||
|
mova m3, [pix1q+8]
|
||
|
psubb m2, [pix2q]
|
||
|
psubb m3, [pix2q+8]
|
||
|
pxor m2, m1
|
||
|
pxor m3, m1
|
||
|
psadbw m4, m2
|
||
|
psadbw m5, m3
|
||
|
paddw m0, m4
|
||
|
paddw m0, m5
|
||
|
mova m4, [pix1q+lsizeq]
|
||
|
mova m5, [pix1q+lsizeq+8]
|
||
|
psubb m4, [pix2q+lsizeq]
|
||
|
psubb m5, [pix2q+lsizeq+8]
|
||
|
pxor m4, m1
|
||
|
pxor m5, m1
|
||
|
psadbw m2, m4
|
||
|
psadbw m3, m5
|
||
|
paddw m0, m2
|
||
|
paddw m0, m3
|
||
|
%endif
|
||
|
sub hd, 2
|
||
|
jg .loop
|
||
|
|
||
|
%if mmsize == 16
|
||
|
pshufd m1, m0, 0xe
|
||
|
paddd m0, m1
|
||
|
%endif
|
||
|
movd eax, m0
|
||
|
RET
|
||
|
%endmacro
|
||
|
|
||
|
INIT_MMX mmxext
|
||
|
VSAD_APPROX 8
|
||
|
VSAD_APPROX 16
|
||
|
INIT_XMM sse2
|
||
|
VSAD_APPROX 16
|