mirror of
https://bitbucket.org/CPMADevs/cnq3
synced 2024-11-14 08:20:48 +00:00
366 lines
13 KiB
NASM
366 lines
13 KiB
NASM
|
;
|
||
|
; jcgryext.asm - grayscale colorspace conversion (64-bit SSE2)
|
||
|
;
|
||
|
; Copyright (C) 2011, D. R. Commander.
|
||
|
;
|
||
|
; 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
|
||
|
;
|
||
|
; [TAB8]
|
||
|
|
||
|
%include "jcolsamp.inc"
|
||
|
|
||
|
; --------------------------------------------------------------------------
|
||
|
;
|
||
|
; Convert some rows of samples to the output colorspace.
|
||
|
;
|
||
|
; GLOBAL(void)
|
||
|
; jsimd_rgb_gray_convert_sse2 (JDIMENSION img_width,
|
||
|
; JSAMPARRAY input_buf, JSAMPIMAGE output_buf,
|
||
|
; JDIMENSION output_row, int num_rows);
|
||
|
;
|
||
|
|
||
|
; r10 = JDIMENSION img_width
|
||
|
; r11 = JSAMPARRAY input_buf
|
||
|
; r12 = JSAMPIMAGE output_buf
|
||
|
; r13 = JDIMENSION output_row
|
||
|
; r14 = int num_rows
|
||
|
|
||
|
%define wk(i) rbp-(WK_NUM-(i))*SIZEOF_XMMWORD ; xmmword wk[WK_NUM]
|
||
|
%define WK_NUM 2
|
||
|
|
||
|
align 16
|
||
|
|
||
|
global EXTN(jsimd_rgb_gray_convert_sse2)
|
||
|
|
||
|
EXTN(jsimd_rgb_gray_convert_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, [wk(0)]
|
||
|
collect_args
|
||
|
push rbx
|
||
|
|
||
|
mov ecx, r10d
|
||
|
test rcx,rcx
|
||
|
jz near .return
|
||
|
|
||
|
push rcx
|
||
|
|
||
|
mov rsi, r12
|
||
|
mov ecx, r13d
|
||
|
mov rdi, JSAMPARRAY [rsi+0*SIZEOF_JSAMPARRAY]
|
||
|
lea rdi, [rdi+rcx*SIZEOF_JSAMPROW]
|
||
|
|
||
|
pop rcx
|
||
|
|
||
|
mov rsi, r11
|
||
|
mov eax, r14d
|
||
|
test rax,rax
|
||
|
jle near .return
|
||
|
.rowloop:
|
||
|
push rdi
|
||
|
push rsi
|
||
|
push rcx ; col
|
||
|
|
||
|
mov rsi, JSAMPROW [rsi] ; inptr
|
||
|
mov rdi, JSAMPROW [rdi] ; outptr0
|
||
|
|
||
|
cmp rcx, byte SIZEOF_XMMWORD
|
||
|
jae near .columnloop
|
||
|
|
||
|
%if RGB_PIXELSIZE == 3 ; ---------------
|
||
|
|
||
|
.column_ld1:
|
||
|
push rax
|
||
|
push rdx
|
||
|
lea rcx,[rcx+rcx*2] ; imul ecx,RGB_PIXELSIZE
|
||
|
test cl, SIZEOF_BYTE
|
||
|
jz short .column_ld2
|
||
|
sub rcx, byte SIZEOF_BYTE
|
||
|
movzx rax, BYTE [rsi+rcx]
|
||
|
.column_ld2:
|
||
|
test cl, SIZEOF_WORD
|
||
|
jz short .column_ld4
|
||
|
sub rcx, byte SIZEOF_WORD
|
||
|
movzx rdx, WORD [rsi+rcx]
|
||
|
shl rax, WORD_BIT
|
||
|
or rax,rdx
|
||
|
.column_ld4:
|
||
|
movd xmmA,eax
|
||
|
pop rdx
|
||
|
pop rax
|
||
|
test cl, SIZEOF_DWORD
|
||
|
jz short .column_ld8
|
||
|
sub rcx, byte SIZEOF_DWORD
|
||
|
movd xmmF, XMM_DWORD [rsi+rcx]
|
||
|
pslldq xmmA, SIZEOF_DWORD
|
||
|
por xmmA,xmmF
|
||
|
.column_ld8:
|
||
|
test cl, SIZEOF_MMWORD
|
||
|
jz short .column_ld16
|
||
|
sub rcx, byte SIZEOF_MMWORD
|
||
|
movq xmmB, XMM_MMWORD [rsi+rcx]
|
||
|
pslldq xmmA, SIZEOF_MMWORD
|
||
|
por xmmA,xmmB
|
||
|
.column_ld16:
|
||
|
test cl, SIZEOF_XMMWORD
|
||
|
jz short .column_ld32
|
||
|
movdqa xmmF,xmmA
|
||
|
movdqu xmmA, XMMWORD [rsi+0*SIZEOF_XMMWORD]
|
||
|
mov rcx, SIZEOF_XMMWORD
|
||
|
jmp short .rgb_gray_cnv
|
||
|
.column_ld32:
|
||
|
test cl, 2*SIZEOF_XMMWORD
|
||
|
mov rcx, SIZEOF_XMMWORD
|
||
|
jz short .rgb_gray_cnv
|
||
|
movdqa xmmB,xmmA
|
||
|
movdqu xmmA, XMMWORD [rsi+0*SIZEOF_XMMWORD]
|
||
|
movdqu xmmF, XMMWORD [rsi+1*SIZEOF_XMMWORD]
|
||
|
jmp short .rgb_gray_cnv
|
||
|
|
||
|
.columnloop:
|
||
|
movdqu xmmA, XMMWORD [rsi+0*SIZEOF_XMMWORD]
|
||
|
movdqu xmmF, XMMWORD [rsi+1*SIZEOF_XMMWORD]
|
||
|
movdqu xmmB, XMMWORD [rsi+2*SIZEOF_XMMWORD]
|
||
|
|
||
|
.rgb_gray_cnv:
|
||
|
; xmmA=(00 10 20 01 11 21 02 12 22 03 13 23 04 14 24 05)
|
||
|
; xmmF=(15 25 06 16 26 07 17 27 08 18 28 09 19 29 0A 1A)
|
||
|
; xmmB=(2A 0B 1B 2B 0C 1C 2C 0D 1D 2D 0E 1E 2E 0F 1F 2F)
|
||
|
|
||
|
movdqa xmmG,xmmA
|
||
|
pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 10 20 01 11 21 02 12)
|
||
|
psrldq xmmG,8 ; xmmG=(22 03 13 23 04 14 24 05 -- -- -- -- -- -- -- --)
|
||
|
|
||
|
punpckhbw xmmA,xmmF ; xmmA=(00 08 10 18 20 28 01 09 11 19 21 29 02 0A 12 1A)
|
||
|
pslldq xmmF,8 ; xmmF=(-- -- -- -- -- -- -- -- 15 25 06 16 26 07 17 27)
|
||
|
|
||
|
punpcklbw xmmG,xmmB ; xmmG=(22 2A 03 0B 13 1B 23 2B 04 0C 14 1C 24 2C 05 0D)
|
||
|
punpckhbw xmmF,xmmB ; xmmF=(15 1D 25 2D 06 0E 16 1E 26 2E 07 0F 17 1F 27 2F)
|
||
|
|
||
|
movdqa xmmD,xmmA
|
||
|
pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 08 10 18 20 28 01 09)
|
||
|
psrldq xmmD,8 ; xmmD=(11 19 21 29 02 0A 12 1A -- -- -- -- -- -- -- --)
|
||
|
|
||
|
punpckhbw xmmA,xmmG ; xmmA=(00 04 08 0C 10 14 18 1C 20 24 28 2C 01 05 09 0D)
|
||
|
pslldq xmmG,8 ; xmmG=(-- -- -- -- -- -- -- -- 22 2A 03 0B 13 1B 23 2B)
|
||
|
|
||
|
punpcklbw xmmD,xmmF ; xmmD=(11 15 19 1D 21 25 29 2D 02 06 0A 0E 12 16 1A 1E)
|
||
|
punpckhbw xmmG,xmmF ; xmmG=(22 26 2A 2E 03 07 0B 0F 13 17 1B 1F 23 27 2B 2F)
|
||
|
|
||
|
movdqa xmmE,xmmA
|
||
|
pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 04 08 0C 10 14 18 1C)
|
||
|
psrldq xmmE,8 ; xmmE=(20 24 28 2C 01 05 09 0D -- -- -- -- -- -- -- --)
|
||
|
|
||
|
punpckhbw xmmA,xmmD ; xmmA=(00 02 04 06 08 0A 0C 0E 10 12 14 16 18 1A 1C 1E)
|
||
|
pslldq xmmD,8 ; xmmD=(-- -- -- -- -- -- -- -- 11 15 19 1D 21 25 29 2D)
|
||
|
|
||
|
punpcklbw xmmE,xmmG ; xmmE=(20 22 24 26 28 2A 2C 2E 01 03 05 07 09 0B 0D 0F)
|
||
|
punpckhbw xmmD,xmmG ; xmmD=(11 13 15 17 19 1B 1D 1F 21 23 25 27 29 2B 2D 2F)
|
||
|
|
||
|
pxor xmmH,xmmH
|
||
|
|
||
|
movdqa xmmC,xmmA
|
||
|
punpcklbw xmmA,xmmH ; xmmA=(00 02 04 06 08 0A 0C 0E)
|
||
|
punpckhbw xmmC,xmmH ; xmmC=(10 12 14 16 18 1A 1C 1E)
|
||
|
|
||
|
movdqa xmmB,xmmE
|
||
|
punpcklbw xmmE,xmmH ; xmmE=(20 22 24 26 28 2A 2C 2E)
|
||
|
punpckhbw xmmB,xmmH ; xmmB=(01 03 05 07 09 0B 0D 0F)
|
||
|
|
||
|
movdqa xmmF,xmmD
|
||
|
punpcklbw xmmD,xmmH ; xmmD=(11 13 15 17 19 1B 1D 1F)
|
||
|
punpckhbw xmmF,xmmH ; xmmF=(21 23 25 27 29 2B 2D 2F)
|
||
|
|
||
|
%else ; RGB_PIXELSIZE == 4 ; -----------
|
||
|
|
||
|
.column_ld1:
|
||
|
test cl, SIZEOF_XMMWORD/16
|
||
|
jz short .column_ld2
|
||
|
sub rcx, byte SIZEOF_XMMWORD/16
|
||
|
movd xmmA, XMM_DWORD [rsi+rcx*RGB_PIXELSIZE]
|
||
|
.column_ld2:
|
||
|
test cl, SIZEOF_XMMWORD/8
|
||
|
jz short .column_ld4
|
||
|
sub rcx, byte SIZEOF_XMMWORD/8
|
||
|
movq xmmE, XMM_MMWORD [rsi+rcx*RGB_PIXELSIZE]
|
||
|
pslldq xmmA, SIZEOF_MMWORD
|
||
|
por xmmA,xmmE
|
||
|
.column_ld4:
|
||
|
test cl, SIZEOF_XMMWORD/4
|
||
|
jz short .column_ld8
|
||
|
sub rcx, byte SIZEOF_XMMWORD/4
|
||
|
movdqa xmmE,xmmA
|
||
|
movdqu xmmA, XMMWORD [rsi+rcx*RGB_PIXELSIZE]
|
||
|
.column_ld8:
|
||
|
test cl, SIZEOF_XMMWORD/2
|
||
|
mov rcx, SIZEOF_XMMWORD
|
||
|
jz short .rgb_gray_cnv
|
||
|
movdqa xmmF,xmmA
|
||
|
movdqa xmmH,xmmE
|
||
|
movdqu xmmA, XMMWORD [rsi+0*SIZEOF_XMMWORD]
|
||
|
movdqu xmmE, XMMWORD [rsi+1*SIZEOF_XMMWORD]
|
||
|
jmp short .rgb_gray_cnv
|
||
|
|
||
|
.columnloop:
|
||
|
movdqu xmmA, XMMWORD [rsi+0*SIZEOF_XMMWORD]
|
||
|
movdqu xmmE, XMMWORD [rsi+1*SIZEOF_XMMWORD]
|
||
|
movdqu xmmF, XMMWORD [rsi+2*SIZEOF_XMMWORD]
|
||
|
movdqu xmmH, XMMWORD [rsi+3*SIZEOF_XMMWORD]
|
||
|
|
||
|
.rgb_gray_cnv:
|
||
|
; xmmA=(00 10 20 30 01 11 21 31 02 12 22 32 03 13 23 33)
|
||
|
; xmmE=(04 14 24 34 05 15 25 35 06 16 26 36 07 17 27 37)
|
||
|
; xmmF=(08 18 28 38 09 19 29 39 0A 1A 2A 3A 0B 1B 2B 3B)
|
||
|
; xmmH=(0C 1C 2C 3C 0D 1D 2D 3D 0E 1E 2E 3E 0F 1F 2F 3F)
|
||
|
|
||
|
movdqa xmmD,xmmA
|
||
|
punpcklbw xmmA,xmmE ; xmmA=(00 04 10 14 20 24 30 34 01 05 11 15 21 25 31 35)
|
||
|
punpckhbw xmmD,xmmE ; xmmD=(02 06 12 16 22 26 32 36 03 07 13 17 23 27 33 37)
|
||
|
|
||
|
movdqa xmmC,xmmF
|
||
|
punpcklbw xmmF,xmmH ; xmmF=(08 0C 18 1C 28 2C 38 3C 09 0D 19 1D 29 2D 39 3D)
|
||
|
punpckhbw xmmC,xmmH ; xmmC=(0A 0E 1A 1E 2A 2E 3A 3E 0B 0F 1B 1F 2B 2F 3B 3F)
|
||
|
|
||
|
movdqa xmmB,xmmA
|
||
|
punpcklwd xmmA,xmmF ; xmmA=(00 04 08 0C 10 14 18 1C 20 24 28 2C 30 34 38 3C)
|
||
|
punpckhwd xmmB,xmmF ; xmmB=(01 05 09 0D 11 15 19 1D 21 25 29 2D 31 35 39 3D)
|
||
|
|
||
|
movdqa xmmG,xmmD
|
||
|
punpcklwd xmmD,xmmC ; xmmD=(02 06 0A 0E 12 16 1A 1E 22 26 2A 2E 32 36 3A 3E)
|
||
|
punpckhwd xmmG,xmmC ; xmmG=(03 07 0B 0F 13 17 1B 1F 23 27 2B 2F 33 37 3B 3F)
|
||
|
|
||
|
movdqa xmmE,xmmA
|
||
|
punpcklbw xmmA,xmmD ; xmmA=(00 02 04 06 08 0A 0C 0E 10 12 14 16 18 1A 1C 1E)
|
||
|
punpckhbw xmmE,xmmD ; xmmE=(20 22 24 26 28 2A 2C 2E 30 32 34 36 38 3A 3C 3E)
|
||
|
|
||
|
movdqa xmmH,xmmB
|
||
|
punpcklbw xmmB,xmmG ; xmmB=(01 03 05 07 09 0B 0D 0F 11 13 15 17 19 1B 1D 1F)
|
||
|
punpckhbw xmmH,xmmG ; xmmH=(21 23 25 27 29 2B 2D 2F 31 33 35 37 39 3B 3D 3F)
|
||
|
|
||
|
pxor xmmF,xmmF
|
||
|
|
||
|
movdqa xmmC,xmmA
|
||
|
punpcklbw xmmA,xmmF ; xmmA=(00 02 04 06 08 0A 0C 0E)
|
||
|
punpckhbw xmmC,xmmF ; xmmC=(10 12 14 16 18 1A 1C 1E)
|
||
|
|
||
|
movdqa xmmD,xmmB
|
||
|
punpcklbw xmmB,xmmF ; xmmB=(01 03 05 07 09 0B 0D 0F)
|
||
|
punpckhbw xmmD,xmmF ; xmmD=(11 13 15 17 19 1B 1D 1F)
|
||
|
|
||
|
movdqa xmmG,xmmE
|
||
|
punpcklbw xmmE,xmmF ; xmmE=(20 22 24 26 28 2A 2C 2E)
|
||
|
punpckhbw xmmG,xmmF ; xmmG=(30 32 34 36 38 3A 3C 3E)
|
||
|
|
||
|
punpcklbw xmmF,xmmH
|
||
|
punpckhbw xmmH,xmmH
|
||
|
psrlw xmmF,BYTE_BIT ; xmmF=(21 23 25 27 29 2B 2D 2F)
|
||
|
psrlw xmmH,BYTE_BIT ; xmmH=(31 33 35 37 39 3B 3D 3F)
|
||
|
|
||
|
%endif ; RGB_PIXELSIZE ; ---------------
|
||
|
|
||
|
; xmm0=R(02468ACE)=RE, xmm2=G(02468ACE)=GE, xmm4=B(02468ACE)=BE
|
||
|
; xmm1=R(13579BDF)=RO, xmm3=G(13579BDF)=GO, xmm5=B(13579BDF)=BO
|
||
|
|
||
|
; (Original)
|
||
|
; Y = 0.29900 * R + 0.58700 * G + 0.11400 * B
|
||
|
;
|
||
|
; (This implementation)
|
||
|
; Y = 0.29900 * R + 0.33700 * G + 0.11400 * B + 0.25000 * G
|
||
|
|
||
|
movdqa xmm6,xmm1
|
||
|
punpcklwd xmm1,xmm3
|
||
|
punpckhwd xmm6,xmm3
|
||
|
pmaddwd xmm1,[rel PW_F0299_F0337] ; xmm1=ROL*FIX(0.299)+GOL*FIX(0.337)
|
||
|
pmaddwd xmm6,[rel PW_F0299_F0337] ; xmm6=ROH*FIX(0.299)+GOH*FIX(0.337)
|
||
|
|
||
|
movdqa xmm7, xmm6 ; xmm7=ROH*FIX(0.299)+GOH*FIX(0.337)
|
||
|
|
||
|
movdqa xmm6,xmm0
|
||
|
punpcklwd xmm0,xmm2
|
||
|
punpckhwd xmm6,xmm2
|
||
|
pmaddwd xmm0,[rel PW_F0299_F0337] ; xmm0=REL*FIX(0.299)+GEL*FIX(0.337)
|
||
|
pmaddwd xmm6,[rel PW_F0299_F0337] ; xmm6=REH*FIX(0.299)+GEH*FIX(0.337)
|
||
|
|
||
|
movdqa XMMWORD [wk(0)], xmm0 ; wk(0)=REL*FIX(0.299)+GEL*FIX(0.337)
|
||
|
movdqa XMMWORD [wk(1)], xmm6 ; wk(1)=REH*FIX(0.299)+GEH*FIX(0.337)
|
||
|
|
||
|
movdqa xmm0, xmm5 ; xmm0=BO
|
||
|
movdqa xmm6, xmm4 ; xmm6=BE
|
||
|
|
||
|
movdqa xmm4,xmm0
|
||
|
punpcklwd xmm0,xmm3
|
||
|
punpckhwd xmm4,xmm3
|
||
|
pmaddwd xmm0,[rel PW_F0114_F0250] ; xmm0=BOL*FIX(0.114)+GOL*FIX(0.250)
|
||
|
pmaddwd xmm4,[rel PW_F0114_F0250] ; xmm4=BOH*FIX(0.114)+GOH*FIX(0.250)
|
||
|
|
||
|
movdqa xmm3,[rel PD_ONEHALF] ; xmm3=[PD_ONEHALF]
|
||
|
|
||
|
paddd xmm0, xmm1
|
||
|
paddd xmm4, xmm7
|
||
|
paddd xmm0,xmm3
|
||
|
paddd xmm4,xmm3
|
||
|
psrld xmm0,SCALEBITS ; xmm0=YOL
|
||
|
psrld xmm4,SCALEBITS ; xmm4=YOH
|
||
|
packssdw xmm0,xmm4 ; xmm0=YO
|
||
|
|
||
|
movdqa xmm4,xmm6
|
||
|
punpcklwd xmm6,xmm2
|
||
|
punpckhwd xmm4,xmm2
|
||
|
pmaddwd xmm6,[rel PW_F0114_F0250] ; xmm6=BEL*FIX(0.114)+GEL*FIX(0.250)
|
||
|
pmaddwd xmm4,[rel PW_F0114_F0250] ; xmm4=BEH*FIX(0.114)+GEH*FIX(0.250)
|
||
|
|
||
|
movdqa xmm2,[rel PD_ONEHALF] ; xmm2=[PD_ONEHALF]
|
||
|
|
||
|
paddd xmm6, XMMWORD [wk(0)]
|
||
|
paddd xmm4, XMMWORD [wk(1)]
|
||
|
paddd xmm6,xmm2
|
||
|
paddd xmm4,xmm2
|
||
|
psrld xmm6,SCALEBITS ; xmm6=YEL
|
||
|
psrld xmm4,SCALEBITS ; xmm4=YEH
|
||
|
packssdw xmm6,xmm4 ; xmm6=YE
|
||
|
|
||
|
psllw xmm0,BYTE_BIT
|
||
|
por xmm6,xmm0 ; xmm6=Y
|
||
|
movdqa XMMWORD [rdi], xmm6 ; Save Y
|
||
|
|
||
|
sub rcx, byte SIZEOF_XMMWORD
|
||
|
add rsi, byte RGB_PIXELSIZE*SIZEOF_XMMWORD ; inptr
|
||
|
add rdi, byte SIZEOF_XMMWORD ; outptr0
|
||
|
cmp rcx, byte SIZEOF_XMMWORD
|
||
|
jae near .columnloop
|
||
|
test rcx,rcx
|
||
|
jnz near .column_ld1
|
||
|
|
||
|
pop rcx ; col
|
||
|
pop rsi
|
||
|
pop rdi
|
||
|
|
||
|
add rsi, byte SIZEOF_JSAMPROW ; input_buf
|
||
|
add rdi, byte SIZEOF_JSAMPROW
|
||
|
dec rax ; num_rows
|
||
|
jg near .rowloop
|
||
|
|
||
|
.return:
|
||
|
pop rbx
|
||
|
uncollect_args
|
||
|
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 16
|