347 lines
16 KiB
NASM
347 lines
16 KiB
NASM
|
;
|
||
|
; jchuff-sse2.asm - Huffman entropy encoding (64-bit SSE2)
|
||
|
;
|
||
|
; Copyright (C) 2009-2011, 2014-2016, D. R. Commander.
|
||
|
; Copyright (C) 2015, Matthieu Darbois.
|
||
|
;
|
||
|
; Based on the x86 SIMD extension for IJG JPEG library
|
||
|
; Copyright (C) 1999-2006, MIYASAKA Masaru.
|
||
|
; For conditions of distribution and use, see copyright notice in jsimdext.inc
|
||
|
;
|
||
|
; This file should be assembled with NASM (Netwide Assembler),
|
||
|
; can *not* be assembled with Microsoft's MASM or any compatible
|
||
|
; assembler (including Borland's Turbo Assembler).
|
||
|
; NASM is available from http://nasm.sourceforge.net/ or
|
||
|
; http://sourceforge.net/project/showfiles.php?group_id=6208
|
||
|
;
|
||
|
; This file contains an SSE2 implementation for Huffman coding of one block.
|
||
|
; The following code is based directly on jchuff.c; see jchuff.c for more
|
||
|
; details.
|
||
|
|
||
|
%include "jsimdext.inc"
|
||
|
|
||
|
; --------------------------------------------------------------------------
|
||
|
SECTION SEG_CONST
|
||
|
|
||
|
alignz 32
|
||
|
GLOBAL_DATA(jconst_huff_encode_one_block)
|
||
|
|
||
|
EXTN(jconst_huff_encode_one_block):
|
||
|
|
||
|
%include "jpeg_nbits_table.inc"
|
||
|
|
||
|
alignz 32
|
||
|
|
||
|
; --------------------------------------------------------------------------
|
||
|
SECTION SEG_TEXT
|
||
|
BITS 64
|
||
|
|
||
|
; These macros perform the same task as the emit_bits() function in the
|
||
|
; original libjpeg code. In addition to reducing overhead by explicitly
|
||
|
; inlining the code, additional performance is achieved by taking into
|
||
|
; account the size of the bit buffer and waiting until it is almost full
|
||
|
; before emptying it. This mostly benefits 64-bit platforms, since 6
|
||
|
; bytes can be stored in a 64-bit bit buffer before it has to be emptied.
|
||
|
|
||
|
%macro EMIT_BYTE 0
|
||
|
sub put_bits, 8 ; put_bits -= 8;
|
||
|
mov rdx, put_buffer
|
||
|
mov ecx, put_bits
|
||
|
shr rdx, cl ; c = (JOCTET)GETJOCTET(put_buffer >> put_bits);
|
||
|
mov byte [buffer], dl ; *buffer++ = c;
|
||
|
add buffer, 1
|
||
|
cmp dl, 0xFF ; need to stuff a zero byte?
|
||
|
jne %%.EMIT_BYTE_END
|
||
|
mov byte [buffer], 0 ; *buffer++ = 0;
|
||
|
add buffer, 1
|
||
|
%%.EMIT_BYTE_END:
|
||
|
%endmacro
|
||
|
|
||
|
%macro PUT_BITS 1
|
||
|
add put_bits, ecx ; put_bits += size;
|
||
|
shl put_buffer, cl ; put_buffer = (put_buffer << size);
|
||
|
or put_buffer, %1
|
||
|
%endmacro
|
||
|
|
||
|
%macro CHECKBUF31 0
|
||
|
cmp put_bits, 32 ; if (put_bits > 31) {
|
||
|
jl %%.CHECKBUF31_END
|
||
|
EMIT_BYTE
|
||
|
EMIT_BYTE
|
||
|
EMIT_BYTE
|
||
|
EMIT_BYTE
|
||
|
%%.CHECKBUF31_END:
|
||
|
%endmacro
|
||
|
|
||
|
%macro CHECKBUF47 0
|
||
|
cmp put_bits, 48 ; if (put_bits > 47) {
|
||
|
jl %%.CHECKBUF47_END
|
||
|
EMIT_BYTE
|
||
|
EMIT_BYTE
|
||
|
EMIT_BYTE
|
||
|
EMIT_BYTE
|
||
|
EMIT_BYTE
|
||
|
EMIT_BYTE
|
||
|
%%.CHECKBUF47_END:
|
||
|
%endmacro
|
||
|
|
||
|
%macro EMIT_BITS 2
|
||
|
CHECKBUF47
|
||
|
mov ecx, %2
|
||
|
PUT_BITS %1
|
||
|
%endmacro
|
||
|
|
||
|
%macro kloop_prepare 37 ;(ko, jno0, ..., jno31, xmm0, xmm1, xmm2, xmm3)
|
||
|
pxor xmm8, xmm8 ; __m128i neg = _mm_setzero_si128();
|
||
|
pxor xmm9, xmm9 ; __m128i neg = _mm_setzero_si128();
|
||
|
pxor xmm10, xmm10 ; __m128i neg = _mm_setzero_si128();
|
||
|
pxor xmm11, xmm11 ; __m128i neg = _mm_setzero_si128();
|
||
|
pinsrw %34, word [r12 + %2 * SIZEOF_WORD], 0 ; xmm_shadow[0] = block[jno0];
|
||
|
pinsrw %35, word [r12 + %10 * SIZEOF_WORD], 0 ; xmm_shadow[8] = block[jno8];
|
||
|
pinsrw %36, word [r12 + %18 * SIZEOF_WORD], 0 ; xmm_shadow[16] = block[jno16];
|
||
|
pinsrw %37, word [r12 + %26 * SIZEOF_WORD], 0 ; xmm_shadow[24] = block[jno24];
|
||
|
pinsrw %34, word [r12 + %3 * SIZEOF_WORD], 1 ; xmm_shadow[1] = block[jno1];
|
||
|
pinsrw %35, word [r12 + %11 * SIZEOF_WORD], 1 ; xmm_shadow[9] = block[jno9];
|
||
|
pinsrw %36, word [r12 + %19 * SIZEOF_WORD], 1 ; xmm_shadow[17] = block[jno17];
|
||
|
pinsrw %37, word [r12 + %27 * SIZEOF_WORD], 1 ; xmm_shadow[25] = block[jno25];
|
||
|
pinsrw %34, word [r12 + %4 * SIZEOF_WORD], 2 ; xmm_shadow[2] = block[jno2];
|
||
|
pinsrw %35, word [r12 + %12 * SIZEOF_WORD], 2 ; xmm_shadow[10] = block[jno10];
|
||
|
pinsrw %36, word [r12 + %20 * SIZEOF_WORD], 2 ; xmm_shadow[18] = block[jno18];
|
||
|
pinsrw %37, word [r12 + %28 * SIZEOF_WORD], 2 ; xmm_shadow[26] = block[jno26];
|
||
|
pinsrw %34, word [r12 + %5 * SIZEOF_WORD], 3 ; xmm_shadow[3] = block[jno3];
|
||
|
pinsrw %35, word [r12 + %13 * SIZEOF_WORD], 3 ; xmm_shadow[11] = block[jno11];
|
||
|
pinsrw %36, word [r12 + %21 * SIZEOF_WORD], 3 ; xmm_shadow[19] = block[jno19];
|
||
|
pinsrw %37, word [r12 + %29 * SIZEOF_WORD], 3 ; xmm_shadow[27] = block[jno27];
|
||
|
pinsrw %34, word [r12 + %6 * SIZEOF_WORD], 4 ; xmm_shadow[4] = block[jno4];
|
||
|
pinsrw %35, word [r12 + %14 * SIZEOF_WORD], 4 ; xmm_shadow[12] = block[jno12];
|
||
|
pinsrw %36, word [r12 + %22 * SIZEOF_WORD], 4 ; xmm_shadow[20] = block[jno20];
|
||
|
pinsrw %37, word [r12 + %30 * SIZEOF_WORD], 4 ; xmm_shadow[28] = block[jno28];
|
||
|
pinsrw %34, word [r12 + %7 * SIZEOF_WORD], 5 ; xmm_shadow[5] = block[jno5];
|
||
|
pinsrw %35, word [r12 + %15 * SIZEOF_WORD], 5 ; xmm_shadow[13] = block[jno13];
|
||
|
pinsrw %36, word [r12 + %23 * SIZEOF_WORD], 5 ; xmm_shadow[21] = block[jno21];
|
||
|
pinsrw %37, word [r12 + %31 * SIZEOF_WORD], 5 ; xmm_shadow[29] = block[jno29];
|
||
|
pinsrw %34, word [r12 + %8 * SIZEOF_WORD], 6 ; xmm_shadow[6] = block[jno6];
|
||
|
pinsrw %35, word [r12 + %16 * SIZEOF_WORD], 6 ; xmm_shadow[14] = block[jno14];
|
||
|
pinsrw %36, word [r12 + %24 * SIZEOF_WORD], 6 ; xmm_shadow[22] = block[jno22];
|
||
|
pinsrw %37, word [r12 + %32 * SIZEOF_WORD], 6 ; xmm_shadow[30] = block[jno30];
|
||
|
pinsrw %34, word [r12 + %9 * SIZEOF_WORD], 7 ; xmm_shadow[7] = block[jno7];
|
||
|
pinsrw %35, word [r12 + %17 * SIZEOF_WORD], 7 ; xmm_shadow[15] = block[jno15];
|
||
|
pinsrw %36, word [r12 + %25 * SIZEOF_WORD], 7 ; xmm_shadow[23] = block[jno23];
|
||
|
%if %1 != 32
|
||
|
pinsrw %37, word [r12 + %33 * SIZEOF_WORD], 7 ; xmm_shadow[31] = block[jno31];
|
||
|
%else
|
||
|
pinsrw %37, ebx, 7 ; xmm_shadow[31] = block[jno31];
|
||
|
%endif
|
||
|
pcmpgtw xmm8, %34 ; neg = _mm_cmpgt_epi16(neg, x1);
|
||
|
pcmpgtw xmm9, %35 ; neg = _mm_cmpgt_epi16(neg, x1);
|
||
|
pcmpgtw xmm10, %36 ; neg = _mm_cmpgt_epi16(neg, x1);
|
||
|
pcmpgtw xmm11, %37 ; neg = _mm_cmpgt_epi16(neg, x1);
|
||
|
paddw %34, xmm8 ; x1 = _mm_add_epi16(x1, neg);
|
||
|
paddw %35, xmm9 ; x1 = _mm_add_epi16(x1, neg);
|
||
|
paddw %36, xmm10 ; x1 = _mm_add_epi16(x1, neg);
|
||
|
paddw %37, xmm11 ; x1 = _mm_add_epi16(x1, neg);
|
||
|
pxor %34, xmm8 ; x1 = _mm_xor_si128(x1, neg);
|
||
|
pxor %35, xmm9 ; x1 = _mm_xor_si128(x1, neg);
|
||
|
pxor %36, xmm10 ; x1 = _mm_xor_si128(x1, neg);
|
||
|
pxor %37, xmm11 ; x1 = _mm_xor_si128(x1, neg);
|
||
|
pxor xmm8, %34 ; neg = _mm_xor_si128(neg, x1);
|
||
|
pxor xmm9, %35 ; neg = _mm_xor_si128(neg, x1);
|
||
|
pxor xmm10, %36 ; neg = _mm_xor_si128(neg, x1);
|
||
|
pxor xmm11, %37 ; neg = _mm_xor_si128(neg, x1);
|
||
|
movdqa XMMWORD [t1 + %1 * SIZEOF_WORD], %34 ; _mm_storeu_si128((__m128i *)(t1 + ko), x1);
|
||
|
movdqa XMMWORD [t1 + (%1 + 8) * SIZEOF_WORD], %35 ; _mm_storeu_si128((__m128i *)(t1 + ko + 8), x1);
|
||
|
movdqa XMMWORD [t1 + (%1 + 16) * SIZEOF_WORD], %36 ; _mm_storeu_si128((__m128i *)(t1 + ko + 16), x1);
|
||
|
movdqa XMMWORD [t1 + (%1 + 24) * SIZEOF_WORD], %37 ; _mm_storeu_si128((__m128i *)(t1 + ko + 24), x1);
|
||
|
movdqa XMMWORD [t2 + %1 * SIZEOF_WORD], xmm8 ; _mm_storeu_si128((__m128i *)(t2 + ko), neg);
|
||
|
movdqa XMMWORD [t2 + (%1 + 8) * SIZEOF_WORD], xmm9 ; _mm_storeu_si128((__m128i *)(t2 + ko + 8), neg);
|
||
|
movdqa XMMWORD [t2 + (%1 + 16) * SIZEOF_WORD], xmm10 ; _mm_storeu_si128((__m128i *)(t2 + ko + 16), neg);
|
||
|
movdqa XMMWORD [t2 + (%1 + 24) * SIZEOF_WORD], xmm11 ; _mm_storeu_si128((__m128i *)(t2 + ko + 24), neg);
|
||
|
%endmacro
|
||
|
|
||
|
;
|
||
|
; Encode a single block's worth of coefficients.
|
||
|
;
|
||
|
; GLOBAL(JOCTET *)
|
||
|
; jsimd_huff_encode_one_block_sse2(working_state *state, JOCTET *buffer,
|
||
|
; JCOEFPTR block, int last_dc_val,
|
||
|
; c_derived_tbl *dctbl, c_derived_tbl *actbl)
|
||
|
;
|
||
|
|
||
|
; r10 = working_state *state
|
||
|
; r11 = JOCTET *buffer
|
||
|
; r12 = JCOEFPTR block
|
||
|
; r13d = int last_dc_val
|
||
|
; r14 = c_derived_tbl *dctbl
|
||
|
; r15 = c_derived_tbl *actbl
|
||
|
|
||
|
%define t1 rbp - (DCTSIZE2 * SIZEOF_WORD)
|
||
|
%define t2 t1 - (DCTSIZE2 * SIZEOF_WORD)
|
||
|
%define put_buffer r8
|
||
|
%define put_bits r9d
|
||
|
%define buffer rax
|
||
|
|
||
|
align 32
|
||
|
GLOBAL_FUNCTION(jsimd_huff_encode_one_block_sse2)
|
||
|
|
||
|
EXTN(jsimd_huff_encode_one_block_sse2):
|
||
|
push rbp
|
||
|
mov rax, rsp ; rax = original rbp
|
||
|
sub rsp, byte 4
|
||
|
and rsp, byte (-SIZEOF_XMMWORD) ; align to 128 bits
|
||
|
mov [rsp], rax
|
||
|
mov rbp, rsp ; rbp = aligned rbp
|
||
|
lea rsp, [t2]
|
||
|
push_xmm 4
|
||
|
collect_args 6
|
||
|
push rbx
|
||
|
|
||
|
mov buffer, r11 ; r11 is now sratch
|
||
|
|
||
|
mov put_buffer, MMWORD [r10+16] ; put_buffer = state->cur.put_buffer;
|
||
|
mov put_bits, dword [r10+24] ; put_bits = state->cur.put_bits;
|
||
|
push r10 ; r10 is now scratch
|
||
|
|
||
|
; Encode the DC coefficient difference per section F.1.2.1
|
||
|
movsx edi, word [r12] ; temp = temp2 = block[0] - last_dc_val;
|
||
|
sub edi, r13d ; r13 is not used anymore
|
||
|
mov ebx, edi
|
||
|
|
||
|
; This is a well-known technique for obtaining the absolute value
|
||
|
; without a branch. It is derived from an assembly language technique
|
||
|
; presented in "How to Optimize for the Pentium Processors",
|
||
|
; Copyright (c) 1996, 1997 by Agner Fog.
|
||
|
mov esi, edi
|
||
|
sar esi, 31 ; temp3 = temp >> (CHAR_BIT * sizeof(int) - 1);
|
||
|
xor edi, esi ; temp ^= temp3;
|
||
|
sub edi, esi ; temp -= temp3;
|
||
|
|
||
|
; For a negative input, want temp2 = bitwise complement of abs(input)
|
||
|
; This code assumes we are on a two's complement machine
|
||
|
add ebx, esi ; temp2 += temp3;
|
||
|
|
||
|
; Find the number of bits needed for the magnitude of the coefficient
|
||
|
lea r11, [rel jpeg_nbits_table]
|
||
|
movzx rdi, byte [r11 + rdi] ; nbits = JPEG_NBITS(temp);
|
||
|
; Emit the Huffman-coded symbol for the number of bits
|
||
|
mov r11d, INT [r14 + rdi * 4] ; code = dctbl->ehufco[nbits];
|
||
|
movzx esi, byte [r14 + rdi + 1024] ; size = dctbl->ehufsi[nbits];
|
||
|
EMIT_BITS r11, esi ; EMIT_BITS(code, size)
|
||
|
|
||
|
; Mask off any extra bits in code
|
||
|
mov esi, 1
|
||
|
mov ecx, edi
|
||
|
shl esi, cl
|
||
|
dec esi
|
||
|
and ebx, esi ; temp2 &= (((JLONG)1)<<nbits) - 1;
|
||
|
|
||
|
; Emit that number of bits of the value, if positive,
|
||
|
; or the complement of its magnitude, if negative.
|
||
|
EMIT_BITS rbx, edi ; EMIT_BITS(temp2, nbits)
|
||
|
|
||
|
; Prepare data
|
||
|
xor ebx, ebx
|
||
|
kloop_prepare 0, 1, 8, 16, 9, 2, 3, 10, 17, 24, 32, 25, \
|
||
|
18, 11, 4, 5, 12, 19, 26, 33, 40, 48, 41, 34, \
|
||
|
27, 20, 13, 6, 7, 14, 21, 28, 35, \
|
||
|
xmm0, xmm1, xmm2, xmm3
|
||
|
kloop_prepare 32, 42, 49, 56, 57, 50, 43, 36, 29, 22, 15, 23, \
|
||
|
30, 37, 44, 51, 58, 59, 52, 45, 38, 31, 39, 46, \
|
||
|
53, 60, 61, 54, 47, 55, 62, 63, 63, \
|
||
|
xmm4, xmm5, xmm6, xmm7
|
||
|
|
||
|
pxor xmm8, xmm8
|
||
|
pcmpeqw xmm0, xmm8 ; tmp0 = _mm_cmpeq_epi16(tmp0, zero);
|
||
|
pcmpeqw xmm1, xmm8 ; tmp1 = _mm_cmpeq_epi16(tmp1, zero);
|
||
|
pcmpeqw xmm2, xmm8 ; tmp2 = _mm_cmpeq_epi16(tmp2, zero);
|
||
|
pcmpeqw xmm3, xmm8 ; tmp3 = _mm_cmpeq_epi16(tmp3, zero);
|
||
|
pcmpeqw xmm4, xmm8 ; tmp4 = _mm_cmpeq_epi16(tmp4, zero);
|
||
|
pcmpeqw xmm5, xmm8 ; tmp5 = _mm_cmpeq_epi16(tmp5, zero);
|
||
|
pcmpeqw xmm6, xmm8 ; tmp6 = _mm_cmpeq_epi16(tmp6, zero);
|
||
|
pcmpeqw xmm7, xmm8 ; tmp7 = _mm_cmpeq_epi16(tmp7, zero);
|
||
|
packsswb xmm0, xmm1 ; tmp0 = _mm_packs_epi16(tmp0, tmp1);
|
||
|
packsswb xmm2, xmm3 ; tmp2 = _mm_packs_epi16(tmp2, tmp3);
|
||
|
packsswb xmm4, xmm5 ; tmp4 = _mm_packs_epi16(tmp4, tmp5);
|
||
|
packsswb xmm6, xmm7 ; tmp6 = _mm_packs_epi16(tmp6, tmp7);
|
||
|
pmovmskb r11d, xmm0 ; index = ((uint64_t)_mm_movemask_epi8(tmp0)) << 0;
|
||
|
pmovmskb r12d, xmm2 ; index = ((uint64_t)_mm_movemask_epi8(tmp2)) << 16;
|
||
|
pmovmskb r13d, xmm4 ; index = ((uint64_t)_mm_movemask_epi8(tmp4)) << 32;
|
||
|
pmovmskb r14d, xmm6 ; index = ((uint64_t)_mm_movemask_epi8(tmp6)) << 48;
|
||
|
shl r12, 16
|
||
|
shl r14, 16
|
||
|
or r11, r12
|
||
|
or r13, r14
|
||
|
shl r13, 32
|
||
|
or r11, r13
|
||
|
not r11 ; index = ~index;
|
||
|
|
||
|
;mov MMWORD [ t1 + DCTSIZE2 * SIZEOF_WORD ], r11
|
||
|
;jmp .EFN
|
||
|
|
||
|
mov r13d, INT [r15 + 240 * 4] ; code_0xf0 = actbl->ehufco[0xf0];
|
||
|
movzx r14d, byte [r15 + 1024 + 240] ; size_0xf0 = actbl->ehufsi[0xf0];
|
||
|
lea rsi, [t1]
|
||
|
.BLOOP:
|
||
|
bsf r12, r11 ; r = __builtin_ctzl(index);
|
||
|
jz .ELOOP
|
||
|
mov rcx, r12
|
||
|
lea rsi, [rsi+r12*2] ; k += r;
|
||
|
shr r11, cl ; index >>= r;
|
||
|
movzx rdi, word [rsi] ; temp = t1[k];
|
||
|
lea rbx, [rel jpeg_nbits_table]
|
||
|
movzx rdi, byte [rbx + rdi] ; nbits = JPEG_NBITS(temp);
|
||
|
.BRLOOP:
|
||
|
cmp r12, 16 ; while (r > 15) {
|
||
|
jl .ERLOOP
|
||
|
EMIT_BITS r13, r14d ; EMIT_BITS(code_0xf0, size_0xf0)
|
||
|
sub r12, 16 ; r -= 16;
|
||
|
jmp .BRLOOP
|
||
|
.ERLOOP:
|
||
|
; Emit Huffman symbol for run length / number of bits
|
||
|
CHECKBUF31 ; uses rcx, rdx
|
||
|
|
||
|
shl r12, 4 ; temp3 = (r << 4) + nbits;
|
||
|
add r12, rdi
|
||
|
mov ebx, INT [r15 + r12 * 4] ; code = actbl->ehufco[temp3];
|
||
|
movzx ecx, byte [r15 + r12 + 1024] ; size = actbl->ehufsi[temp3];
|
||
|
PUT_BITS rbx
|
||
|
|
||
|
;EMIT_CODE(code, size)
|
||
|
|
||
|
movsx ebx, word [rsi-DCTSIZE2*2] ; temp2 = t2[k];
|
||
|
; Mask off any extra bits in code
|
||
|
mov rcx, rdi
|
||
|
mov rdx, 1
|
||
|
shl rdx, cl
|
||
|
dec rdx
|
||
|
and rbx, rdx ; temp2 &= (((JLONG)1)<<nbits) - 1;
|
||
|
PUT_BITS rbx ; PUT_BITS(temp2, nbits)
|
||
|
|
||
|
shr r11, 1 ; index >>= 1;
|
||
|
add rsi, 2 ; ++k;
|
||
|
jmp .BLOOP
|
||
|
.ELOOP:
|
||
|
; If the last coef(s) were zero, emit an end-of-block code
|
||
|
lea rdi, [t1 + (DCTSIZE2-1) * 2] ; r = DCTSIZE2-1-k;
|
||
|
cmp rdi, rsi ; if (r > 0) {
|
||
|
je .EFN
|
||
|
mov ebx, INT [r15] ; code = actbl->ehufco[0];
|
||
|
movzx r12d, byte [r15 + 1024] ; size = actbl->ehufsi[0];
|
||
|
EMIT_BITS rbx, r12d
|
||
|
.EFN:
|
||
|
pop r10
|
||
|
; Save put_buffer & put_bits
|
||
|
mov MMWORD [r10+16], put_buffer ; state->cur.put_buffer = put_buffer;
|
||
|
mov dword [r10+24], put_bits ; state->cur.put_bits = put_bits;
|
||
|
|
||
|
pop rbx
|
||
|
uncollect_args 6
|
||
|
pop_xmm 4
|
||
|
mov rsp, rbp ; rsp <- aligned rbp
|
||
|
pop rsp ; rsp <- original rbp
|
||
|
pop rbp
|
||
|
ret
|
||
|
|
||
|
; For some reason, the OS X linker does not honor the request to align the
|
||
|
; segment unless we do this.
|
||
|
align 32
|