media/libjpeg/simd/jdmrgss2.asm

Thu, 22 Jan 2015 13:21:57 +0100

author
Michael Schloh von Bennewitz <michael@schloh.com>
date
Thu, 22 Jan 2015 13:21:57 +0100
branch
TOR_BUG_9701
changeset 15
b8a032363ba2
permissions
-rw-r--r--

Incorporate requested changes from Mozilla in review:
https://bugzilla.mozilla.org/show_bug.cgi?id=1123480#c6

     1 ;
     2 ; jdmrgss2.asm - merged upsampling/color conversion (SSE2)
     3 ;
     4 ; Copyright 2009, 2012 Pierre Ossman <ossman@cendio.se> for Cendio AB
     5 ; Copyright 2012 D. R. Commander
     6 ;
     7 ; Based on
     8 ; x86 SIMD extension for IJG JPEG library
     9 ; Copyright (C) 1999-2006, MIYASAKA Masaru.
    10 ; For conditions of distribution and use, see copyright notice in jsimdext.inc
    11 ;
    12 ; This file should be assembled with NASM (Netwide Assembler),
    13 ; can *not* be assembled with Microsoft's MASM or any compatible
    14 ; assembler (including Borland's Turbo Assembler).
    15 ; NASM is available from http://nasm.sourceforge.net/ or
    16 ; http://sourceforge.net/project/showfiles.php?group_id=6208
    17 ;
    18 ; [TAB8]
    20 %include "jcolsamp.inc"
    22 ; --------------------------------------------------------------------------
    23 ;
    24 ; Upsample and color convert for the case of 2:1 horizontal and 1:1 vertical.
    25 ;
    26 ; GLOBAL(void)
    27 ; jsimd_h2v1_merged_upsample_sse2 (JDIMENSION output_width,
    28 ;                                  JSAMPIMAGE input_buf,
    29 ;                                  JDIMENSION in_row_group_ctr,
    30 ;                                  JSAMPARRAY output_buf);
    31 ;
    33 %define output_width(b)	(b)+8			; JDIMENSION output_width
    34 %define input_buf(b)		(b)+12		; JSAMPIMAGE input_buf
    35 %define in_row_group_ctr(b)	(b)+16		; JDIMENSION in_row_group_ctr
    36 %define output_buf(b)		(b)+20		; JSAMPARRAY output_buf
    38 %define original_ebp	ebp+0
    39 %define wk(i)		ebp-(WK_NUM-(i))*SIZEOF_XMMWORD	; xmmword wk[WK_NUM]
    40 %define WK_NUM		3
    41 %define gotptr		wk(0)-SIZEOF_POINTER	; void * gotptr
    43 	align	16
    44 	global	EXTN(jsimd_h2v1_merged_upsample_sse2)
    46 EXTN(jsimd_h2v1_merged_upsample_sse2):
    47 	push	ebp
    48 	mov	eax,esp				; eax = original ebp
    49 	sub	esp, byte 4
    50 	and	esp, byte (-SIZEOF_XMMWORD)	; align to 128 bits
    51 	mov	[esp],eax
    52 	mov	ebp,esp				; ebp = aligned ebp
    53 	lea	esp, [wk(0)]
    54 	pushpic	eax		; make a room for GOT address
    55 	push	ebx
    56 ;	push	ecx		; need not be preserved
    57 ;	push	edx		; need not be preserved
    58 	push	esi
    59 	push	edi
    61 	get_GOT	ebx			; get GOT address
    62 	movpic	POINTER [gotptr], ebx	; save GOT address
    64 	mov	ecx, JDIMENSION [output_width(eax)]	; col
    65 	test	ecx,ecx
    66 	jz	near .return
    68 	push	ecx
    70 	mov	edi, JSAMPIMAGE [input_buf(eax)]
    71 	mov	ecx, JDIMENSION [in_row_group_ctr(eax)]
    72 	mov	esi, JSAMPARRAY [edi+0*SIZEOF_JSAMPARRAY]
    73 	mov	ebx, JSAMPARRAY [edi+1*SIZEOF_JSAMPARRAY]
    74 	mov	edx, JSAMPARRAY [edi+2*SIZEOF_JSAMPARRAY]
    75 	mov	edi, JSAMPARRAY [output_buf(eax)]
    76 	mov	esi, JSAMPROW [esi+ecx*SIZEOF_JSAMPROW]		; inptr0
    77 	mov	ebx, JSAMPROW [ebx+ecx*SIZEOF_JSAMPROW]		; inptr1
    78 	mov	edx, JSAMPROW [edx+ecx*SIZEOF_JSAMPROW]		; inptr2
    79 	mov	edi, JSAMPROW [edi]				; outptr
    81 	pop	ecx			; col
    83 	alignx	16,7
    84 .columnloop:
    85 	movpic	eax, POINTER [gotptr]	; load GOT address (eax)
    87 	movdqa    xmm6, XMMWORD [ebx]	; xmm6=Cb(0123456789ABCDEF)
    88 	movdqa    xmm7, XMMWORD [edx]	; xmm7=Cr(0123456789ABCDEF)
    90 	pxor      xmm1,xmm1		; xmm1=(all 0's)
    91 	pcmpeqw   xmm3,xmm3
    92 	psllw     xmm3,7		; xmm3={0xFF80 0xFF80 0xFF80 0xFF80 ..}
    94 	movdqa    xmm4,xmm6
    95 	punpckhbw xmm6,xmm1		; xmm6=Cb(89ABCDEF)=CbH
    96 	punpcklbw xmm4,xmm1		; xmm4=Cb(01234567)=CbL
    97 	movdqa    xmm0,xmm7
    98 	punpckhbw xmm7,xmm1		; xmm7=Cr(89ABCDEF)=CrH
    99 	punpcklbw xmm0,xmm1		; xmm0=Cr(01234567)=CrL
   101 	paddw     xmm6,xmm3
   102 	paddw     xmm4,xmm3
   103 	paddw     xmm7,xmm3
   104 	paddw     xmm0,xmm3
   106 	; (Original)
   107 	; R = Y                + 1.40200 * Cr
   108 	; G = Y - 0.34414 * Cb - 0.71414 * Cr
   109 	; B = Y + 1.77200 * Cb
   110 	;
   111 	; (This implementation)
   112 	; R = Y                + 0.40200 * Cr + Cr
   113 	; G = Y - 0.34414 * Cb + 0.28586 * Cr - Cr
   114 	; B = Y - 0.22800 * Cb + Cb + Cb
   116 	movdqa	xmm5,xmm6		; xmm5=CbH
   117 	movdqa	xmm2,xmm4		; xmm2=CbL
   118 	paddw	xmm6,xmm6		; xmm6=2*CbH
   119 	paddw	xmm4,xmm4		; xmm4=2*CbL
   120 	movdqa	xmm1,xmm7		; xmm1=CrH
   121 	movdqa	xmm3,xmm0		; xmm3=CrL
   122 	paddw	xmm7,xmm7		; xmm7=2*CrH
   123 	paddw	xmm0,xmm0		; xmm0=2*CrL
   125 	pmulhw	xmm6,[GOTOFF(eax,PW_MF0228)]	; xmm6=(2*CbH * -FIX(0.22800))
   126 	pmulhw	xmm4,[GOTOFF(eax,PW_MF0228)]	; xmm4=(2*CbL * -FIX(0.22800))
   127 	pmulhw	xmm7,[GOTOFF(eax,PW_F0402)]	; xmm7=(2*CrH * FIX(0.40200))
   128 	pmulhw	xmm0,[GOTOFF(eax,PW_F0402)]	; xmm0=(2*CrL * FIX(0.40200))
   130 	paddw	xmm6,[GOTOFF(eax,PW_ONE)]
   131 	paddw	xmm4,[GOTOFF(eax,PW_ONE)]
   132 	psraw	xmm6,1			; xmm6=(CbH * -FIX(0.22800))
   133 	psraw	xmm4,1			; xmm4=(CbL * -FIX(0.22800))
   134 	paddw	xmm7,[GOTOFF(eax,PW_ONE)]
   135 	paddw	xmm0,[GOTOFF(eax,PW_ONE)]
   136 	psraw	xmm7,1			; xmm7=(CrH * FIX(0.40200))
   137 	psraw	xmm0,1			; xmm0=(CrL * FIX(0.40200))
   139 	paddw	xmm6,xmm5
   140 	paddw	xmm4,xmm2
   141 	paddw	xmm6,xmm5		; xmm6=(CbH * FIX(1.77200))=(B-Y)H
   142 	paddw	xmm4,xmm2		; xmm4=(CbL * FIX(1.77200))=(B-Y)L
   143 	paddw	xmm7,xmm1		; xmm7=(CrH * FIX(1.40200))=(R-Y)H
   144 	paddw	xmm0,xmm3		; xmm0=(CrL * FIX(1.40200))=(R-Y)L
   146 	movdqa	XMMWORD [wk(0)], xmm6	; wk(0)=(B-Y)H
   147 	movdqa	XMMWORD [wk(1)], xmm7	; wk(1)=(R-Y)H
   149 	movdqa    xmm6,xmm5
   150 	movdqa    xmm7,xmm2
   151 	punpcklwd xmm5,xmm1
   152 	punpckhwd xmm6,xmm1
   153 	pmaddwd   xmm5,[GOTOFF(eax,PW_MF0344_F0285)]
   154 	pmaddwd   xmm6,[GOTOFF(eax,PW_MF0344_F0285)]
   155 	punpcklwd xmm2,xmm3
   156 	punpckhwd xmm7,xmm3
   157 	pmaddwd   xmm2,[GOTOFF(eax,PW_MF0344_F0285)]
   158 	pmaddwd   xmm7,[GOTOFF(eax,PW_MF0344_F0285)]
   160 	paddd     xmm5,[GOTOFF(eax,PD_ONEHALF)]
   161 	paddd     xmm6,[GOTOFF(eax,PD_ONEHALF)]
   162 	psrad     xmm5,SCALEBITS
   163 	psrad     xmm6,SCALEBITS
   164 	paddd     xmm2,[GOTOFF(eax,PD_ONEHALF)]
   165 	paddd     xmm7,[GOTOFF(eax,PD_ONEHALF)]
   166 	psrad     xmm2,SCALEBITS
   167 	psrad     xmm7,SCALEBITS
   169 	packssdw  xmm5,xmm6	; xmm5=CbH*-FIX(0.344)+CrH*FIX(0.285)
   170 	packssdw  xmm2,xmm7	; xmm2=CbL*-FIX(0.344)+CrL*FIX(0.285)
   171 	psubw     xmm5,xmm1	; xmm5=CbH*-FIX(0.344)+CrH*-FIX(0.714)=(G-Y)H
   172 	psubw     xmm2,xmm3	; xmm2=CbL*-FIX(0.344)+CrL*-FIX(0.714)=(G-Y)L
   174 	movdqa	XMMWORD [wk(2)], xmm5	; wk(2)=(G-Y)H
   176 	mov	al,2			; Yctr
   177 	jmp	short .Yloop_1st
   178 	alignx	16,7
   180 .Yloop_2nd:
   181 	movdqa	xmm0, XMMWORD [wk(1)]	; xmm0=(R-Y)H
   182 	movdqa	xmm2, XMMWORD [wk(2)]	; xmm2=(G-Y)H
   183 	movdqa	xmm4, XMMWORD [wk(0)]	; xmm4=(B-Y)H
   184 	alignx	16,7
   186 .Yloop_1st:
   187 	movdqa	xmm7, XMMWORD [esi]	; xmm7=Y(0123456789ABCDEF)
   189 	pcmpeqw	xmm6,xmm6
   190 	psrlw	xmm6,BYTE_BIT		; xmm6={0xFF 0x00 0xFF 0x00 ..}
   191 	pand	xmm6,xmm7		; xmm6=Y(02468ACE)=YE
   192 	psrlw	xmm7,BYTE_BIT		; xmm7=Y(13579BDF)=YO
   194 	movdqa	xmm1,xmm0		; xmm1=xmm0=(R-Y)(L/H)
   195 	movdqa	xmm3,xmm2		; xmm3=xmm2=(G-Y)(L/H)
   196 	movdqa	xmm5,xmm4		; xmm5=xmm4=(B-Y)(L/H)
   198 	paddw     xmm0,xmm6		; xmm0=((R-Y)+YE)=RE=R(02468ACE)
   199 	paddw     xmm1,xmm7		; xmm1=((R-Y)+YO)=RO=R(13579BDF)
   200 	packuswb  xmm0,xmm0		; xmm0=R(02468ACE********)
   201 	packuswb  xmm1,xmm1		; xmm1=R(13579BDF********)
   203 	paddw     xmm2,xmm6		; xmm2=((G-Y)+YE)=GE=G(02468ACE)
   204 	paddw     xmm3,xmm7		; xmm3=((G-Y)+YO)=GO=G(13579BDF)
   205 	packuswb  xmm2,xmm2		; xmm2=G(02468ACE********)
   206 	packuswb  xmm3,xmm3		; xmm3=G(13579BDF********)
   208 	paddw     xmm4,xmm6		; xmm4=((B-Y)+YE)=BE=B(02468ACE)
   209 	paddw     xmm5,xmm7		; xmm5=((B-Y)+YO)=BO=B(13579BDF)
   210 	packuswb  xmm4,xmm4		; xmm4=B(02468ACE********)
   211 	packuswb  xmm5,xmm5		; xmm5=B(13579BDF********)
   213 %if RGB_PIXELSIZE == 3 ; ---------------
   215 	; xmmA=(00 02 04 06 08 0A 0C 0E **), xmmB=(01 03 05 07 09 0B 0D 0F **)
   216 	; xmmC=(10 12 14 16 18 1A 1C 1E **), xmmD=(11 13 15 17 19 1B 1D 1F **)
   217 	; xmmE=(20 22 24 26 28 2A 2C 2E **), xmmF=(21 23 25 27 29 2B 2D 2F **)
   218 	; xmmG=(** ** ** ** ** ** ** ** **), xmmH=(** ** ** ** ** ** ** ** **)
   220 	punpcklbw xmmA,xmmC	; xmmA=(00 10 02 12 04 14 06 16 08 18 0A 1A 0C 1C 0E 1E)
   221 	punpcklbw xmmE,xmmB	; xmmE=(20 01 22 03 24 05 26 07 28 09 2A 0B 2C 0D 2E 0F)
   222 	punpcklbw xmmD,xmmF	; xmmD=(11 21 13 23 15 25 17 27 19 29 1B 2B 1D 2D 1F 2F)
   224 	movdqa    xmmG,xmmA
   225 	movdqa    xmmH,xmmA
   226 	punpcklwd xmmA,xmmE	; xmmA=(00 10 20 01 02 12 22 03 04 14 24 05 06 16 26 07)
   227 	punpckhwd xmmG,xmmE	; xmmG=(08 18 28 09 0A 1A 2A 0B 0C 1C 2C 0D 0E 1E 2E 0F)
   229 	psrldq    xmmH,2	; xmmH=(02 12 04 14 06 16 08 18 0A 1A 0C 1C 0E 1E -- --)
   230 	psrldq    xmmE,2	; xmmE=(22 03 24 05 26 07 28 09 2A 0B 2C 0D 2E 0F -- --)
   232 	movdqa    xmmC,xmmD
   233 	movdqa    xmmB,xmmD
   234 	punpcklwd xmmD,xmmH	; xmmD=(11 21 02 12 13 23 04 14 15 25 06 16 17 27 08 18)
   235 	punpckhwd xmmC,xmmH	; xmmC=(19 29 0A 1A 1B 2B 0C 1C 1D 2D 0E 1E 1F 2F -- --)
   237 	psrldq    xmmB,2	; xmmB=(13 23 15 25 17 27 19 29 1B 2B 1D 2D 1F 2F -- --)
   239 	movdqa    xmmF,xmmE
   240 	punpcklwd xmmE,xmmB	; xmmE=(22 03 13 23 24 05 15 25 26 07 17 27 28 09 19 29)
   241 	punpckhwd xmmF,xmmB	; xmmF=(2A 0B 1B 2B 2C 0D 1D 2D 2E 0F 1F 2F -- -- -- --)
   243 	pshufd    xmmH,xmmA,0x4E; xmmH=(04 14 24 05 06 16 26 07 00 10 20 01 02 12 22 03)
   244 	movdqa    xmmB,xmmE
   245 	punpckldq xmmA,xmmD	; xmmA=(00 10 20 01 11 21 02 12 02 12 22 03 13 23 04 14)
   246 	punpckldq xmmE,xmmH	; xmmE=(22 03 13 23 04 14 24 05 24 05 15 25 06 16 26 07)
   247 	punpckhdq xmmD,xmmB	; xmmD=(15 25 06 16 26 07 17 27 17 27 08 18 28 09 19 29)
   249 	pshufd    xmmH,xmmG,0x4E; xmmH=(0C 1C 2C 0D 0E 1E 2E 0F 08 18 28 09 0A 1A 2A 0B)
   250 	movdqa    xmmB,xmmF
   251 	punpckldq xmmG,xmmC	; xmmG=(08 18 28 09 19 29 0A 1A 0A 1A 2A 0B 1B 2B 0C 1C)
   252 	punpckldq xmmF,xmmH	; xmmF=(2A 0B 1B 2B 0C 1C 2C 0D 2C 0D 1D 2D 0E 1E 2E 0F)
   253 	punpckhdq xmmC,xmmB	; xmmC=(1D 2D 0E 1E 2E 0F 1F 2F 1F 2F -- -- -- -- -- --)
   255 	punpcklqdq xmmA,xmmE	; xmmA=(00 10 20 01 11 21 02 12 22 03 13 23 04 14 24 05)
   256 	punpcklqdq xmmD,xmmG	; xmmD=(15 25 06 16 26 07 17 27 08 18 28 09 19 29 0A 1A)
   257 	punpcklqdq xmmF,xmmC	; xmmF=(2A 0B 1B 2B 0C 1C 2C 0D 1D 2D 0E 1E 2E 0F 1F 2F)
   259 	cmp	ecx, byte SIZEOF_XMMWORD
   260 	jb	short .column_st32
   262 	test	edi, SIZEOF_XMMWORD-1
   263 	jnz	short .out1
   264 	; --(aligned)-------------------
   265 	movntdq	XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA
   266 	movntdq	XMMWORD [edi+1*SIZEOF_XMMWORD], xmmD
   267 	movntdq	XMMWORD [edi+2*SIZEOF_XMMWORD], xmmF
   268 	jmp	short .out0
   269 .out1:	; --(unaligned)-----------------
   270 	movdqu	XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA
   271 	movdqu	XMMWORD [edi+1*SIZEOF_XMMWORD], xmmD
   272 	movdqu	XMMWORD [edi+2*SIZEOF_XMMWORD], xmmF
   273 .out0:
   274 	add	edi, byte RGB_PIXELSIZE*SIZEOF_XMMWORD	; outptr
   275 	sub	ecx, byte SIZEOF_XMMWORD
   276 	jz	near .endcolumn
   278 	add	esi, byte SIZEOF_XMMWORD	; inptr0
   279 	dec	al			; Yctr
   280 	jnz	near .Yloop_2nd
   282 	add	ebx, byte SIZEOF_XMMWORD	; inptr1
   283 	add	edx, byte SIZEOF_XMMWORD	; inptr2
   284 	jmp	near .columnloop
   285 	alignx	16,7
   287 .column_st32:
   288 	lea	ecx, [ecx+ecx*2]		; imul ecx, RGB_PIXELSIZE
   289 	cmp	ecx, byte 2*SIZEOF_XMMWORD
   290 	jb	short .column_st16
   291 	movdqu	XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA
   292 	movdqu	XMMWORD [edi+1*SIZEOF_XMMWORD], xmmD
   293 	add	edi, byte 2*SIZEOF_XMMWORD	; outptr
   294 	movdqa	xmmA,xmmF
   295 	sub	ecx, byte 2*SIZEOF_XMMWORD
   296 	jmp	short .column_st15
   297 .column_st16:
   298 	cmp	ecx, byte SIZEOF_XMMWORD
   299 	jb	short .column_st15
   300 	movdqu	XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA
   301 	add	edi, byte SIZEOF_XMMWORD	; outptr
   302 	movdqa	xmmA,xmmD
   303 	sub	ecx, byte SIZEOF_XMMWORD
   304 .column_st15:
   305 	; Store the lower 8 bytes of xmmA to the output when it has enough
   306 	; space.
   307 	cmp	ecx, byte SIZEOF_MMWORD
   308 	jb	short .column_st7
   309 	movq	XMM_MMWORD [edi], xmmA
   310 	add	edi, byte SIZEOF_MMWORD
   311 	sub	ecx, byte SIZEOF_MMWORD
   312 	psrldq	xmmA, SIZEOF_MMWORD
   313 .column_st7:
   314 	; Store the lower 4 bytes of xmmA to the output when it has enough
   315 	; space.
   316 	cmp	ecx, byte SIZEOF_DWORD
   317 	jb	short .column_st3
   318 	movd	XMM_DWORD [edi], xmmA
   319 	add	edi, byte SIZEOF_DWORD
   320 	sub	ecx, byte SIZEOF_DWORD
   321 	psrldq	xmmA, SIZEOF_DWORD
   322 .column_st3:
   323 	; Store the lower 2 bytes of eax to the output when it has enough
   324 	; space.
   325 	movd	eax, xmmA
   326 	cmp	ecx, byte SIZEOF_WORD
   327 	jb	short .column_st1
   328 	mov	WORD [edi], ax
   329 	add	edi, byte SIZEOF_WORD
   330 	sub	ecx, byte SIZEOF_WORD
   331 	shr	eax, 16
   332 .column_st1:
   333 	; Store the lower 1 byte of eax to the output when it has enough
   334 	; space.
   335 	test	ecx, ecx
   336 	jz	short .endcolumn
   337 	mov	BYTE [edi], al
   339 %else ; RGB_PIXELSIZE == 4 ; -----------
   341 %ifdef RGBX_FILLER_0XFF
   342 	pcmpeqb   xmm6,xmm6		; xmm6=XE=X(02468ACE********)
   343 	pcmpeqb   xmm7,xmm7		; xmm7=XO=X(13579BDF********)
   344 %else
   345 	pxor      xmm6,xmm6		; xmm6=XE=X(02468ACE********)
   346 	pxor      xmm7,xmm7		; xmm7=XO=X(13579BDF********)
   347 %endif
   348 	; xmmA=(00 02 04 06 08 0A 0C 0E **), xmmB=(01 03 05 07 09 0B 0D 0F **)
   349 	; xmmC=(10 12 14 16 18 1A 1C 1E **), xmmD=(11 13 15 17 19 1B 1D 1F **)
   350 	; xmmE=(20 22 24 26 28 2A 2C 2E **), xmmF=(21 23 25 27 29 2B 2D 2F **)
   351 	; xmmG=(30 32 34 36 38 3A 3C 3E **), xmmH=(31 33 35 37 39 3B 3D 3F **)
   353 	punpcklbw xmmA,xmmC	; xmmA=(00 10 02 12 04 14 06 16 08 18 0A 1A 0C 1C 0E 1E)
   354 	punpcklbw xmmE,xmmG	; xmmE=(20 30 22 32 24 34 26 36 28 38 2A 3A 2C 3C 2E 3E)
   355 	punpcklbw xmmB,xmmD	; xmmB=(01 11 03 13 05 15 07 17 09 19 0B 1B 0D 1D 0F 1F)
   356 	punpcklbw xmmF,xmmH	; xmmF=(21 31 23 33 25 35 27 37 29 39 2B 3B 2D 3D 2F 3F)
   358 	movdqa    xmmC,xmmA
   359 	punpcklwd xmmA,xmmE	; xmmA=(00 10 20 30 02 12 22 32 04 14 24 34 06 16 26 36)
   360 	punpckhwd xmmC,xmmE	; xmmC=(08 18 28 38 0A 1A 2A 3A 0C 1C 2C 3C 0E 1E 2E 3E)
   361 	movdqa    xmmG,xmmB
   362 	punpcklwd xmmB,xmmF	; xmmB=(01 11 21 31 03 13 23 33 05 15 25 35 07 17 27 37)
   363 	punpckhwd xmmG,xmmF	; xmmG=(09 19 29 39 0B 1B 2B 3B 0D 1D 2D 3D 0F 1F 2F 3F)
   365 	movdqa    xmmD,xmmA
   366 	punpckldq xmmA,xmmB	; xmmA=(00 10 20 30 01 11 21 31 02 12 22 32 03 13 23 33)
   367 	punpckhdq xmmD,xmmB	; xmmD=(04 14 24 34 05 15 25 35 06 16 26 36 07 17 27 37)
   368 	movdqa    xmmH,xmmC
   369 	punpckldq xmmC,xmmG	; xmmC=(08 18 28 38 09 19 29 39 0A 1A 2A 3A 0B 1B 2B 3B)
   370 	punpckhdq xmmH,xmmG	; xmmH=(0C 1C 2C 3C 0D 1D 2D 3D 0E 1E 2E 3E 0F 1F 2F 3F)
   372 	cmp	ecx, byte SIZEOF_XMMWORD
   373 	jb	short .column_st32
   375 	test	edi, SIZEOF_XMMWORD-1
   376 	jnz	short .out1
   377 	; --(aligned)-------------------
   378 	movntdq	XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA
   379 	movntdq	XMMWORD [edi+1*SIZEOF_XMMWORD], xmmD
   380 	movntdq	XMMWORD [edi+2*SIZEOF_XMMWORD], xmmC
   381 	movntdq	XMMWORD [edi+3*SIZEOF_XMMWORD], xmmH
   382 	jmp	short .out0
   383 .out1:	; --(unaligned)-----------------
   384 	movdqu	XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA
   385 	movdqu	XMMWORD [edi+1*SIZEOF_XMMWORD], xmmD
   386 	movdqu	XMMWORD [edi+2*SIZEOF_XMMWORD], xmmC
   387 	movdqu	XMMWORD [edi+3*SIZEOF_XMMWORD], xmmH
   388 .out0:
   389 	add	edi, byte RGB_PIXELSIZE*SIZEOF_XMMWORD	; outptr
   390 	sub	ecx, byte SIZEOF_XMMWORD
   391 	jz	near .endcolumn
   393 	add	esi, byte SIZEOF_XMMWORD	; inptr0
   394 	dec	al			; Yctr
   395 	jnz	near .Yloop_2nd
   397 	add	ebx, byte SIZEOF_XMMWORD	; inptr1
   398 	add	edx, byte SIZEOF_XMMWORD	; inptr2
   399 	jmp	near .columnloop
   400 	alignx	16,7
   402 .column_st32:
   403 	cmp	ecx, byte SIZEOF_XMMWORD/2
   404 	jb	short .column_st16
   405 	movdqu	XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA
   406 	movdqu	XMMWORD [edi+1*SIZEOF_XMMWORD], xmmD
   407 	add	edi, byte 2*SIZEOF_XMMWORD	; outptr
   408 	movdqa	xmmA,xmmC
   409 	movdqa	xmmD,xmmH
   410 	sub	ecx, byte SIZEOF_XMMWORD/2
   411 .column_st16:
   412 	cmp	ecx, byte SIZEOF_XMMWORD/4
   413 	jb	short .column_st15
   414 	movdqu	XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA
   415 	add	edi, byte SIZEOF_XMMWORD	; outptr
   416 	movdqa	xmmA,xmmD
   417 	sub	ecx, byte SIZEOF_XMMWORD/4
   418 .column_st15:
   419 	; Store two pixels (8 bytes) of xmmA to the output when it has enough
   420 	; space.
   421 	cmp	ecx, byte SIZEOF_XMMWORD/8
   422 	jb	short .column_st7
   423 	movq	XMM_MMWORD [edi], xmmA
   424 	add	edi, byte SIZEOF_XMMWORD/8*4
   425 	sub	ecx, byte SIZEOF_XMMWORD/8
   426 	psrldq	xmmA, SIZEOF_XMMWORD/8*4
   427 .column_st7:
   428 	; Store one pixel (4 bytes) of xmmA to the output when it has enough
   429 	; space.
   430 	test	ecx, ecx
   431 	jz	short .endcolumn
   432 	movd	XMM_DWORD [edi], xmmA
   434 %endif ; RGB_PIXELSIZE ; ---------------
   436 .endcolumn:
   437 	sfence		; flush the write buffer
   439 .return:
   440 	pop	edi
   441 	pop	esi
   442 ;	pop	edx		; need not be preserved
   443 ;	pop	ecx		; need not be preserved
   444 	pop	ebx
   445 	mov	esp,ebp		; esp <- aligned ebp
   446 	pop	esp		; esp <- original ebp
   447 	pop	ebp
   448 	ret
   450 ; --------------------------------------------------------------------------
   451 ;
   452 ; Upsample and color convert for the case of 2:1 horizontal and 2:1 vertical.
   453 ;
   454 ; GLOBAL(void)
   455 ; jsimd_h2v2_merged_upsample_sse2 (JDIMENSION output_width,
   456 ;                                  JSAMPIMAGE input_buf,
   457 ;                                  JDIMENSION in_row_group_ctr,
   458 ;                                  JSAMPARRAY output_buf);
   459 ;
   461 %define output_width(b)	(b)+8			; JDIMENSION output_width
   462 %define input_buf(b)		(b)+12		; JSAMPIMAGE input_buf
   463 %define in_row_group_ctr(b)	(b)+16		; JDIMENSION in_row_group_ctr
   464 %define output_buf(b)		(b)+20		; JSAMPARRAY output_buf
   466 	align	16
   467 	global	EXTN(jsimd_h2v2_merged_upsample_sse2)
   469 EXTN(jsimd_h2v2_merged_upsample_sse2):
   470 	push	ebp
   471 	mov	ebp,esp
   472 	push	ebx
   473 ;	push	ecx		; need not be preserved
   474 ;	push	edx		; need not be preserved
   475 	push	esi
   476 	push	edi
   478 	mov	eax, POINTER [output_width(ebp)]
   480 	mov	edi, JSAMPIMAGE [input_buf(ebp)]
   481 	mov	ecx, JDIMENSION [in_row_group_ctr(ebp)]
   482 	mov	esi, JSAMPARRAY [edi+0*SIZEOF_JSAMPARRAY]
   483 	mov	ebx, JSAMPARRAY [edi+1*SIZEOF_JSAMPARRAY]
   484 	mov	edx, JSAMPARRAY [edi+2*SIZEOF_JSAMPARRAY]
   485 	mov	edi, JSAMPARRAY [output_buf(ebp)]
   486 	lea	esi, [esi+ecx*SIZEOF_JSAMPROW]
   488 	push	edx			; inptr2
   489 	push	ebx			; inptr1
   490 	push	esi			; inptr00
   491 	mov	ebx,esp
   493 	push	edi			; output_buf (outptr0)
   494 	push	ecx			; in_row_group_ctr
   495 	push	ebx			; input_buf
   496 	push	eax			; output_width
   498 	call	near EXTN(jsimd_h2v1_merged_upsample_sse2)
   500 	add	esi, byte SIZEOF_JSAMPROW	; inptr01
   501 	add	edi, byte SIZEOF_JSAMPROW	; outptr1
   502 	mov	POINTER [ebx+0*SIZEOF_POINTER], esi
   503 	mov	POINTER [ebx-1*SIZEOF_POINTER], edi
   505 	call	near EXTN(jsimd_h2v1_merged_upsample_sse2)
   507 	add	esp, byte 7*SIZEOF_DWORD
   509 	pop	edi
   510 	pop	esi
   511 ;	pop	edx		; need not be preserved
   512 ;	pop	ecx		; need not be preserved
   513 	pop	ebx
   514 	pop	ebp
   515 	ret
   517 ; For some reason, the OS X linker does not honor the request to align the
   518 ; segment unless we do this.
   519 	align	16

mercurial