2 ; jcgryext.asm - grayscale colorspace conversion (SSE2)
4 ; Copyright (C) 2011, D. R. Commander.
6 ; Based on the x86 SIMD extension for IJG JPEG library
7 ; Copyright (C) 1999-2006, MIYASAKA Masaru.
8 ; For conditions of distribution and use, see copyright notice in jsimdext.inc
10 ; This file should be assembled with NASM (Netwide Assembler),
11 ; can *not* be assembled with Microsoft's MASM or any compatible
12 ; assembler (including Borland's Turbo Assembler).
13 ; NASM is available from http://nasm.sourceforge.net/ or
14 ; http://sourceforge.net/project/showfiles.php?group_id=6208
18 %include "jcolsamp.inc"
20 ; --------------------------------------------------------------------------
22 ; Convert some rows of samples to the output colorspace.
25 ; jsimd_rgb_gray_convert_sse2 (JDIMENSION img_width,
26 ; JSAMPARRAY input_buf, JSAMPIMAGE output_buf,
27 ; JDIMENSION output_row, int num_rows);
30 %define img_width(b) (b)+8 ; JDIMENSION img_width
31 %define input_buf(b) (b)+12 ; JSAMPARRAY input_buf
32 %define output_buf(b) (b)+16 ; JSAMPIMAGE output_buf
33 %define output_row(b) (b)+20 ; JDIMENSION output_row
34 %define num_rows(b) (b)+24 ; int num_rows
36 %define original_ebp ebp+0
37 %define wk(i) ebp-(WK_NUM-(i))*SIZEOF_XMMWORD ; xmmword wk[WK_NUM]
39 %define gotptr wk(0)-SIZEOF_POINTER ; void * gotptr
43 global EXTN(jsimd_rgb_gray_convert_sse2)
45 EXTN(jsimd_rgb_gray_convert_sse2):
47 mov eax,esp ; eax = original ebp
49 and esp, byte (-SIZEOF_XMMWORD) ; align to 128 bits
51 mov ebp,esp ; ebp = aligned ebp
53 pushpic eax ; make a room for GOT address
55 ; push ecx ; need not be preserved
56 ; push edx ; need not be preserved
60 get_GOT ebx ; get GOT address
61 movpic POINTER [gotptr], ebx ; save GOT address
63 mov ecx, JDIMENSION [img_width(eax)]
69 mov esi, JSAMPIMAGE [output_buf(eax)]
70 mov ecx, JDIMENSION [output_row(eax)]
71 mov edi, JSAMPARRAY [esi+0*SIZEOF_JSAMPARRAY]
72 lea edi, [edi+ecx*SIZEOF_JSAMPROW]
76 mov esi, JSAMPARRAY [input_buf(eax)]
77 mov eax, INT [num_rows(eax)]
87 mov esi, JSAMPROW [esi] ; inptr
88 mov edi, JSAMPROW [edi] ; outptr0
89 movpic eax, POINTER [gotptr] ; load GOT address (eax)
91 cmp ecx, byte SIZEOF_XMMWORD
95 %if RGB_PIXELSIZE == 3 ; ---------------
100 lea ecx,[ecx+ecx*2] ; imul ecx,RGB_PIXELSIZE
103 sub ecx, byte SIZEOF_BYTE
104 movzx eax, BYTE [esi+ecx]
108 sub ecx, byte SIZEOF_WORD
109 movzx edx, WORD [esi+ecx]
116 test cl, SIZEOF_DWORD
118 sub ecx, byte SIZEOF_DWORD
119 movd xmmF, XMM_DWORD [esi+ecx]
120 pslldq xmmA, SIZEOF_DWORD
123 test cl, SIZEOF_MMWORD
124 jz short .column_ld16
125 sub ecx, byte SIZEOF_MMWORD
126 movq xmmB, XMM_MMWORD [esi+ecx]
127 pslldq xmmA, SIZEOF_MMWORD
130 test cl, SIZEOF_XMMWORD
131 jz short .column_ld32
133 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD]
134 mov ecx, SIZEOF_XMMWORD
135 jmp short .rgb_gray_cnv
137 test cl, 2*SIZEOF_XMMWORD
138 mov ecx, SIZEOF_XMMWORD
139 jz short .rgb_gray_cnv
141 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD]
142 movdqu xmmF, XMMWORD [esi+1*SIZEOF_XMMWORD]
143 jmp short .rgb_gray_cnv
147 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD]
148 movdqu xmmF, XMMWORD [esi+1*SIZEOF_XMMWORD]
149 movdqu xmmB, XMMWORD [esi+2*SIZEOF_XMMWORD]
152 ; xmmA=(00 10 20 01 11 21 02 12 22 03 13 23 04 14 24 05)
153 ; xmmF=(15 25 06 16 26 07 17 27 08 18 28 09 19 29 0A 1A)
154 ; xmmB=(2A 0B 1B 2B 0C 1C 2C 0D 1D 2D 0E 1E 2E 0F 1F 2F)
157 pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 10 20 01 11 21 02 12)
158 psrldq xmmG,8 ; xmmG=(22 03 13 23 04 14 24 05 -- -- -- -- -- -- -- --)
160 punpckhbw xmmA,xmmF ; xmmA=(00 08 10 18 20 28 01 09 11 19 21 29 02 0A 12 1A)
161 pslldq xmmF,8 ; xmmF=(-- -- -- -- -- -- -- -- 15 25 06 16 26 07 17 27)
163 punpcklbw xmmG,xmmB ; xmmG=(22 2A 03 0B 13 1B 23 2B 04 0C 14 1C 24 2C 05 0D)
164 punpckhbw xmmF,xmmB ; xmmF=(15 1D 25 2D 06 0E 16 1E 26 2E 07 0F 17 1F 27 2F)
167 pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 08 10 18 20 28 01 09)
168 psrldq xmmD,8 ; xmmD=(11 19 21 29 02 0A 12 1A -- -- -- -- -- -- -- --)
170 punpckhbw xmmA,xmmG ; xmmA=(00 04 08 0C 10 14 18 1C 20 24 28 2C 01 05 09 0D)
171 pslldq xmmG,8 ; xmmG=(-- -- -- -- -- -- -- -- 22 2A 03 0B 13 1B 23 2B)
173 punpcklbw xmmD,xmmF ; xmmD=(11 15 19 1D 21 25 29 2D 02 06 0A 0E 12 16 1A 1E)
174 punpckhbw xmmG,xmmF ; xmmG=(22 26 2A 2E 03 07 0B 0F 13 17 1B 1F 23 27 2B 2F)
177 pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 04 08 0C 10 14 18 1C)
178 psrldq xmmE,8 ; xmmE=(20 24 28 2C 01 05 09 0D -- -- -- -- -- -- -- --)
180 punpckhbw xmmA,xmmD ; xmmA=(00 02 04 06 08 0A 0C 0E 10 12 14 16 18 1A 1C 1E)
181 pslldq xmmD,8 ; xmmD=(-- -- -- -- -- -- -- -- 11 15 19 1D 21 25 29 2D)
183 punpcklbw xmmE,xmmG ; xmmE=(20 22 24 26 28 2A 2C 2E 01 03 05 07 09 0B 0D 0F)
184 punpckhbw xmmD,xmmG ; xmmD=(11 13 15 17 19 1B 1D 1F 21 23 25 27 29 2B 2D 2F)
189 punpcklbw xmmA,xmmH ; xmmA=(00 02 04 06 08 0A 0C 0E)
190 punpckhbw xmmC,xmmH ; xmmC=(10 12 14 16 18 1A 1C 1E)
193 punpcklbw xmmE,xmmH ; xmmE=(20 22 24 26 28 2A 2C 2E)
194 punpckhbw xmmB,xmmH ; xmmB=(01 03 05 07 09 0B 0D 0F)
197 punpcklbw xmmD,xmmH ; xmmD=(11 13 15 17 19 1B 1D 1F)
198 punpckhbw xmmF,xmmH ; xmmF=(21 23 25 27 29 2B 2D 2F)
200 %else ; RGB_PIXELSIZE == 4 ; -----------
203 test cl, SIZEOF_XMMWORD/16
205 sub ecx, byte SIZEOF_XMMWORD/16
206 movd xmmA, XMM_DWORD [esi+ecx*RGB_PIXELSIZE]
208 test cl, SIZEOF_XMMWORD/8
210 sub ecx, byte SIZEOF_XMMWORD/8
211 movq xmmE, XMM_MMWORD [esi+ecx*RGB_PIXELSIZE]
212 pslldq xmmA, SIZEOF_MMWORD
215 test cl, SIZEOF_XMMWORD/4
217 sub ecx, byte SIZEOF_XMMWORD/4
219 movdqu xmmA, XMMWORD [esi+ecx*RGB_PIXELSIZE]
221 test cl, SIZEOF_XMMWORD/2
222 mov ecx, SIZEOF_XMMWORD
223 jz short .rgb_gray_cnv
226 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD]
227 movdqu xmmE, XMMWORD [esi+1*SIZEOF_XMMWORD]
228 jmp short .rgb_gray_cnv
232 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD]
233 movdqu xmmE, XMMWORD [esi+1*SIZEOF_XMMWORD]
234 movdqu xmmF, XMMWORD [esi+2*SIZEOF_XMMWORD]
235 movdqu xmmH, XMMWORD [esi+3*SIZEOF_XMMWORD]
238 ; xmmA=(00 10 20 30 01 11 21 31 02 12 22 32 03 13 23 33)
239 ; xmmE=(04 14 24 34 05 15 25 35 06 16 26 36 07 17 27 37)
240 ; xmmF=(08 18 28 38 09 19 29 39 0A 1A 2A 3A 0B 1B 2B 3B)
241 ; xmmH=(0C 1C 2C 3C 0D 1D 2D 3D 0E 1E 2E 3E 0F 1F 2F 3F)
244 punpcklbw xmmA,xmmE ; xmmA=(00 04 10 14 20 24 30 34 01 05 11 15 21 25 31 35)
245 punpckhbw xmmD,xmmE ; xmmD=(02 06 12 16 22 26 32 36 03 07 13 17 23 27 33 37)
248 punpcklbw xmmF,xmmH ; xmmF=(08 0C 18 1C 28 2C 38 3C 09 0D 19 1D 29 2D 39 3D)
249 punpckhbw xmmC,xmmH ; xmmC=(0A 0E 1A 1E 2A 2E 3A 3E 0B 0F 1B 1F 2B 2F 3B 3F)
252 punpcklwd xmmA,xmmF ; xmmA=(00 04 08 0C 10 14 18 1C 20 24 28 2C 30 34 38 3C)
253 punpckhwd xmmB,xmmF ; xmmB=(01 05 09 0D 11 15 19 1D 21 25 29 2D 31 35 39 3D)
256 punpcklwd xmmD,xmmC ; xmmD=(02 06 0A 0E 12 16 1A 1E 22 26 2A 2E 32 36 3A 3E)
257 punpckhwd xmmG,xmmC ; xmmG=(03 07 0B 0F 13 17 1B 1F 23 27 2B 2F 33 37 3B 3F)
260 punpcklbw xmmA,xmmD ; xmmA=(00 02 04 06 08 0A 0C 0E 10 12 14 16 18 1A 1C 1E)
261 punpckhbw xmmE,xmmD ; xmmE=(20 22 24 26 28 2A 2C 2E 30 32 34 36 38 3A 3C 3E)
264 punpcklbw xmmB,xmmG ; xmmB=(01 03 05 07 09 0B 0D 0F 11 13 15 17 19 1B 1D 1F)
265 punpckhbw xmmH,xmmG ; xmmH=(21 23 25 27 29 2B 2D 2F 31 33 35 37 39 3B 3D 3F)
270 punpcklbw xmmA,xmmF ; xmmA=(00 02 04 06 08 0A 0C 0E)
271 punpckhbw xmmC,xmmF ; xmmC=(10 12 14 16 18 1A 1C 1E)
274 punpcklbw xmmB,xmmF ; xmmB=(01 03 05 07 09 0B 0D 0F)
275 punpckhbw xmmD,xmmF ; xmmD=(11 13 15 17 19 1B 1D 1F)
278 punpcklbw xmmE,xmmF ; xmmE=(20 22 24 26 28 2A 2C 2E)
279 punpckhbw xmmG,xmmF ; xmmG=(30 32 34 36 38 3A 3C 3E)
283 psrlw xmmF,BYTE_BIT ; xmmF=(21 23 25 27 29 2B 2D 2F)
284 psrlw xmmH,BYTE_BIT ; xmmH=(31 33 35 37 39 3B 3D 3F)
286 %endif ; RGB_PIXELSIZE ; ---------------
288 ; xmm0=R(02468ACE)=RE, xmm2=G(02468ACE)=GE, xmm4=B(02468ACE)=BE
289 ; xmm1=R(13579BDF)=RO, xmm3=G(13579BDF)=GO, xmm5=B(13579BDF)=BO
292 ; Y = 0.29900 * R + 0.58700 * G + 0.11400 * B
294 ; (This implementation)
295 ; Y = 0.29900 * R + 0.33700 * G + 0.11400 * B + 0.25000 * G
300 pmaddwd xmm1,[GOTOFF(eax,PW_F0299_F0337)] ; xmm1=ROL*FIX(0.299)+GOL*FIX(0.337)
301 pmaddwd xmm6,[GOTOFF(eax,PW_F0299_F0337)] ; xmm6=ROH*FIX(0.299)+GOH*FIX(0.337)
303 movdqa xmm7, xmm6 ; xmm7=ROH*FIX(0.299)+GOH*FIX(0.337)
308 pmaddwd xmm0,[GOTOFF(eax,PW_F0299_F0337)] ; xmm0=REL*FIX(0.299)+GEL*FIX(0.337)
309 pmaddwd xmm6,[GOTOFF(eax,PW_F0299_F0337)] ; xmm6=REH*FIX(0.299)+GEH*FIX(0.337)
311 movdqa XMMWORD [wk(0)], xmm0 ; wk(0)=REL*FIX(0.299)+GEL*FIX(0.337)
312 movdqa XMMWORD [wk(1)], xmm6 ; wk(1)=REH*FIX(0.299)+GEH*FIX(0.337)
314 movdqa xmm0, xmm5 ; xmm0=BO
315 movdqa xmm6, xmm4 ; xmm6=BE
320 pmaddwd xmm0,[GOTOFF(eax,PW_F0114_F0250)] ; xmm0=BOL*FIX(0.114)+GOL*FIX(0.250)
321 pmaddwd xmm4,[GOTOFF(eax,PW_F0114_F0250)] ; xmm4=BOH*FIX(0.114)+GOH*FIX(0.250)
323 movdqa xmm3,[GOTOFF(eax,PD_ONEHALF)] ; xmm3=[PD_ONEHALF]
329 psrld xmm0,SCALEBITS ; xmm0=YOL
330 psrld xmm4,SCALEBITS ; xmm4=YOH
331 packssdw xmm0,xmm4 ; xmm0=YO
336 pmaddwd xmm6,[GOTOFF(eax,PW_F0114_F0250)] ; xmm6=BEL*FIX(0.114)+GEL*FIX(0.250)
337 pmaddwd xmm4,[GOTOFF(eax,PW_F0114_F0250)] ; xmm4=BEH*FIX(0.114)+GEH*FIX(0.250)
339 movdqa xmm2,[GOTOFF(eax,PD_ONEHALF)] ; xmm2=[PD_ONEHALF]
341 paddd xmm6, XMMWORD [wk(0)]
342 paddd xmm4, XMMWORD [wk(1)]
345 psrld xmm6,SCALEBITS ; xmm6=YEL
346 psrld xmm4,SCALEBITS ; xmm4=YEH
347 packssdw xmm6,xmm4 ; xmm6=YE
350 por xmm6,xmm0 ; xmm6=Y
351 movdqa XMMWORD [edi], xmm6 ; Save Y
353 sub ecx, byte SIZEOF_XMMWORD
354 add esi, byte RGB_PIXELSIZE*SIZEOF_XMMWORD ; inptr
355 add edi, byte SIZEOF_XMMWORD ; outptr0
356 cmp ecx, byte SIZEOF_XMMWORD
366 add esi, byte SIZEOF_JSAMPROW ; input_buf
367 add edi, byte SIZEOF_JSAMPROW
374 ; pop edx ; need not be preserved
375 ; pop ecx ; need not be preserved
377 mov esp,ebp ; esp <- aligned ebp
378 pop esp ; esp <- original ebp
382 ; For some reason, the OS X linker does not honor the request to align the
383 ; segment unless we do this.