OLD | NEW |
(Empty) | |
| 1 ; |
| 2 ; jcgryss2.asm - grayscale colorspace conversion (SSE2) |
| 3 ; |
| 4 ; x86 SIMD extension for IJG JPEG library |
| 5 ; Copyright (C) 1999-2006, MIYASAKA Masaru. |
| 6 ; Copyright (C) 2011, D. R. Commander. |
| 7 ; For conditions of distribution and use, see copyright notice in jsimdext.inc |
| 8 ; |
| 9 ; This file should be assembled with NASM (Netwide Assembler), |
| 10 ; can *not* be assembled with Microsoft's MASM or any compatible |
| 11 ; assembler (including Borland's Turbo Assembler). |
| 12 ; NASM is available from http://nasm.sourceforge.net/ or |
| 13 ; http://sourceforge.net/project/showfiles.php?group_id=6208 |
| 14 ; |
| 15 ; [TAB8] |
| 16 |
| 17 %include "jcolsamp.inc" |
| 18 |
| 19 ; -------------------------------------------------------------------------- |
| 20 ; |
| 21 ; Convert some rows of samples to the output colorspace. |
| 22 ; |
| 23 ; GLOBAL(void) |
| 24 ; jsimd_rgb_gray_convert_sse2 (JDIMENSION img_width, |
| 25 ; JSAMPARRAY input_buf, JSAMPIMAGE output_buf, |
| 26 ; JDIMENSION output_row, int num_rows); |
| 27 ; |
| 28 |
| 29 %define img_width(b) (b)+8 ; JDIMENSION img_width |
| 30 %define input_buf(b) (b)+12 ; JSAMPARRAY input_buf |
| 31 %define output_buf(b) (b)+16 ; JSAMPIMAGE output_buf |
| 32 %define output_row(b) (b)+20 ; JDIMENSION output_row |
| 33 %define num_rows(b) (b)+24 ; int num_rows |
| 34 |
| 35 %define original_ebp ebp+0 |
| 36 %define wk(i) ebp-(WK_NUM-(i))*SIZEOF_XMMWORD ; xmmword wk[WK_NUM] |
| 37 %define WK_NUM 2 |
| 38 %define gotptr wk(0)-SIZEOF_POINTER ; void * gotptr |
| 39 |
| 40 align 16 |
| 41 |
| 42 global EXTN(jsimd_rgb_gray_convert_sse2) PRIVATE |
| 43 |
| 44 EXTN(jsimd_rgb_gray_convert_sse2): |
| 45 push ebp |
| 46 mov eax,esp ; eax = original ebp |
| 47 sub esp, byte 4 |
| 48 and esp, byte (-SIZEOF_XMMWORD) ; align to 128 bits |
| 49 mov [esp],eax |
| 50 mov ebp,esp ; ebp = aligned ebp |
| 51 lea esp, [wk(0)] |
| 52 pushpic eax ; make a room for GOT address |
| 53 push ebx |
| 54 ; push ecx ; need not be preserved |
| 55 ; push edx ; need not be preserved |
| 56 push esi |
| 57 push edi |
| 58 |
| 59 get_GOT ebx ; get GOT address |
| 60 movpic POINTER [gotptr], ebx ; save GOT address |
| 61 |
| 62 mov ecx, JDIMENSION [img_width(eax)] |
| 63 test ecx,ecx |
| 64 jz near .return |
| 65 |
| 66 push ecx |
| 67 |
| 68 mov esi, JSAMPIMAGE [output_buf(eax)] |
| 69 mov ecx, JDIMENSION [output_row(eax)] |
| 70 mov edi, JSAMPARRAY [esi+0*SIZEOF_JSAMPARRAY] |
| 71 lea edi, [edi+ecx*SIZEOF_JSAMPROW] |
| 72 |
| 73 pop ecx |
| 74 |
| 75 mov esi, JSAMPARRAY [input_buf(eax)] |
| 76 mov eax, INT [num_rows(eax)] |
| 77 test eax,eax |
| 78 jle near .return |
| 79 alignx 16,7 |
| 80 .rowloop: |
| 81 pushpic eax |
| 82 push edi |
| 83 push esi |
| 84 push ecx ; col |
| 85 |
| 86 mov esi, JSAMPROW [esi] ; inptr |
| 87 mov edi, JSAMPROW [edi] ; outptr0 |
| 88 movpic eax, POINTER [gotptr] ; load GOT address (eax) |
| 89 |
| 90 cmp ecx, byte SIZEOF_XMMWORD |
| 91 jae near .columnloop |
| 92 alignx 16,7 |
| 93 |
| 94 %if RGB_PIXELSIZE == 3 ; --------------- |
| 95 |
| 96 .column_ld1: |
| 97 push eax |
| 98 push edx |
| 99 lea ecx,[ecx+ecx*2] ; imul ecx,RGB_PIXELSIZE |
| 100 test cl, SIZEOF_BYTE |
| 101 jz short .column_ld2 |
| 102 sub ecx, byte SIZEOF_BYTE |
| 103 movzx eax, BYTE [esi+ecx] |
| 104 .column_ld2: |
| 105 test cl, SIZEOF_WORD |
| 106 jz short .column_ld4 |
| 107 sub ecx, byte SIZEOF_WORD |
| 108 movzx edx, WORD [esi+ecx] |
| 109 shl eax, WORD_BIT |
| 110 or eax,edx |
| 111 .column_ld4: |
| 112 movd xmmA,eax |
| 113 pop edx |
| 114 pop eax |
| 115 test cl, SIZEOF_DWORD |
| 116 jz short .column_ld8 |
| 117 sub ecx, byte SIZEOF_DWORD |
| 118 movd xmmF, XMM_DWORD [esi+ecx] |
| 119 pslldq xmmA, SIZEOF_DWORD |
| 120 por xmmA,xmmF |
| 121 .column_ld8: |
| 122 test cl, SIZEOF_MMWORD |
| 123 jz short .column_ld16 |
| 124 sub ecx, byte SIZEOF_MMWORD |
| 125 movq xmmB, XMM_MMWORD [esi+ecx] |
| 126 pslldq xmmA, SIZEOF_MMWORD |
| 127 por xmmA,xmmB |
| 128 .column_ld16: |
| 129 test cl, SIZEOF_XMMWORD |
| 130 jz short .column_ld32 |
| 131 movdqa xmmF,xmmA |
| 132 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD] |
| 133 mov ecx, SIZEOF_XMMWORD |
| 134 jmp short .rgb_gray_cnv |
| 135 .column_ld32: |
| 136 test cl, 2*SIZEOF_XMMWORD |
| 137 mov ecx, SIZEOF_XMMWORD |
| 138 jz short .rgb_gray_cnv |
| 139 movdqa xmmB,xmmA |
| 140 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD] |
| 141 movdqu xmmF, XMMWORD [esi+1*SIZEOF_XMMWORD] |
| 142 jmp short .rgb_gray_cnv |
| 143 alignx 16,7 |
| 144 |
| 145 .columnloop: |
| 146 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD] |
| 147 movdqu xmmF, XMMWORD [esi+1*SIZEOF_XMMWORD] |
| 148 movdqu xmmB, XMMWORD [esi+2*SIZEOF_XMMWORD] |
| 149 |
| 150 .rgb_gray_cnv: |
| 151 ; xmmA=(00 10 20 01 11 21 02 12 22 03 13 23 04 14 24 05) |
| 152 ; xmmF=(15 25 06 16 26 07 17 27 08 18 28 09 19 29 0A 1A) |
| 153 ; xmmB=(2A 0B 1B 2B 0C 1C 2C 0D 1D 2D 0E 1E 2E 0F 1F 2F) |
| 154 |
| 155 movdqa xmmG,xmmA |
| 156 pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 10 20 01 11 2
1 02 12) |
| 157 psrldq xmmG,8 ; xmmG=(22 03 13 23 04 14 24 05 -- -- -- -- -- -
- -- --) |
| 158 |
| 159 punpckhbw xmmA,xmmF ; xmmA=(00 08 10 18 20 28 01 09 11 19 21 29 02 0
A 12 1A) |
| 160 pslldq xmmF,8 ; xmmF=(-- -- -- -- -- -- -- -- 15 25 06 16 26 0
7 17 27) |
| 161 |
| 162 punpcklbw xmmG,xmmB ; xmmG=(22 2A 03 0B 13 1B 23 2B 04 0C 14 1C 24 2
C 05 0D) |
| 163 punpckhbw xmmF,xmmB ; xmmF=(15 1D 25 2D 06 0E 16 1E 26 2E 07 0F 17 1
F 27 2F) |
| 164 |
| 165 movdqa xmmD,xmmA |
| 166 pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 08 10 18 20 2
8 01 09) |
| 167 psrldq xmmD,8 ; xmmD=(11 19 21 29 02 0A 12 1A -- -- -- -- -- -
- -- --) |
| 168 |
| 169 punpckhbw xmmA,xmmG ; xmmA=(00 04 08 0C 10 14 18 1C 20 24 28 2C 01 0
5 09 0D) |
| 170 pslldq xmmG,8 ; xmmG=(-- -- -- -- -- -- -- -- 22 2A 03 0B 13 1
B 23 2B) |
| 171 |
| 172 punpcklbw xmmD,xmmF ; xmmD=(11 15 19 1D 21 25 29 2D 02 06 0A 0E 12 1
6 1A 1E) |
| 173 punpckhbw xmmG,xmmF ; xmmG=(22 26 2A 2E 03 07 0B 0F 13 17 1B 1F 23 2
7 2B 2F) |
| 174 |
| 175 movdqa xmmE,xmmA |
| 176 pslldq xmmA,8 ; xmmA=(-- -- -- -- -- -- -- -- 00 04 08 0C 10 1
4 18 1C) |
| 177 psrldq xmmE,8 ; xmmE=(20 24 28 2C 01 05 09 0D -- -- -- -- -- -
- -- --) |
| 178 |
| 179 punpckhbw xmmA,xmmD ; xmmA=(00 02 04 06 08 0A 0C 0E 10 12 14 16 18 1
A 1C 1E) |
| 180 pslldq xmmD,8 ; xmmD=(-- -- -- -- -- -- -- -- 11 15 19 1D 21 2
5 29 2D) |
| 181 |
| 182 punpcklbw xmmE,xmmG ; xmmE=(20 22 24 26 28 2A 2C 2E 01 03 05 07 09 0
B 0D 0F) |
| 183 punpckhbw xmmD,xmmG ; xmmD=(11 13 15 17 19 1B 1D 1F 21 23 25 27 29 2
B 2D 2F) |
| 184 |
| 185 pxor xmmH,xmmH |
| 186 |
| 187 movdqa xmmC,xmmA |
| 188 punpcklbw xmmA,xmmH ; xmmA=(00 02 04 06 08 0A 0C 0E) |
| 189 punpckhbw xmmC,xmmH ; xmmC=(10 12 14 16 18 1A 1C 1E) |
| 190 |
| 191 movdqa xmmB,xmmE |
| 192 punpcklbw xmmE,xmmH ; xmmE=(20 22 24 26 28 2A 2C 2E) |
| 193 punpckhbw xmmB,xmmH ; xmmB=(01 03 05 07 09 0B 0D 0F) |
| 194 |
| 195 movdqa xmmF,xmmD |
| 196 punpcklbw xmmD,xmmH ; xmmD=(11 13 15 17 19 1B 1D 1F) |
| 197 punpckhbw xmmF,xmmH ; xmmF=(21 23 25 27 29 2B 2D 2F) |
| 198 |
| 199 %else ; RGB_PIXELSIZE == 4 ; ----------- |
| 200 |
| 201 .column_ld1: |
| 202 test cl, SIZEOF_XMMWORD/16 |
| 203 jz short .column_ld2 |
| 204 sub ecx, byte SIZEOF_XMMWORD/16 |
| 205 movd xmmA, XMM_DWORD [esi+ecx*RGB_PIXELSIZE] |
| 206 .column_ld2: |
| 207 test cl, SIZEOF_XMMWORD/8 |
| 208 jz short .column_ld4 |
| 209 sub ecx, byte SIZEOF_XMMWORD/8 |
| 210 movq xmmE, XMM_MMWORD [esi+ecx*RGB_PIXELSIZE] |
| 211 pslldq xmmA, SIZEOF_MMWORD |
| 212 por xmmA,xmmE |
| 213 .column_ld4: |
| 214 test cl, SIZEOF_XMMWORD/4 |
| 215 jz short .column_ld8 |
| 216 sub ecx, byte SIZEOF_XMMWORD/4 |
| 217 movdqa xmmE,xmmA |
| 218 movdqu xmmA, XMMWORD [esi+ecx*RGB_PIXELSIZE] |
| 219 .column_ld8: |
| 220 test cl, SIZEOF_XMMWORD/2 |
| 221 mov ecx, SIZEOF_XMMWORD |
| 222 jz short .rgb_gray_cnv |
| 223 movdqa xmmF,xmmA |
| 224 movdqa xmmH,xmmE |
| 225 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD] |
| 226 movdqu xmmE, XMMWORD [esi+1*SIZEOF_XMMWORD] |
| 227 jmp short .rgb_gray_cnv |
| 228 alignx 16,7 |
| 229 |
| 230 .columnloop: |
| 231 movdqu xmmA, XMMWORD [esi+0*SIZEOF_XMMWORD] |
| 232 movdqu xmmE, XMMWORD [esi+1*SIZEOF_XMMWORD] |
| 233 movdqu xmmF, XMMWORD [esi+2*SIZEOF_XMMWORD] |
| 234 movdqu xmmH, XMMWORD [esi+3*SIZEOF_XMMWORD] |
| 235 |
| 236 .rgb_gray_cnv: |
| 237 ; xmmA=(00 10 20 30 01 11 21 31 02 12 22 32 03 13 23 33) |
| 238 ; xmmE=(04 14 24 34 05 15 25 35 06 16 26 36 07 17 27 37) |
| 239 ; xmmF=(08 18 28 38 09 19 29 39 0A 1A 2A 3A 0B 1B 2B 3B) |
| 240 ; xmmH=(0C 1C 2C 3C 0D 1D 2D 3D 0E 1E 2E 3E 0F 1F 2F 3F) |
| 241 |
| 242 movdqa xmmD,xmmA |
| 243 punpcklbw xmmA,xmmE ; xmmA=(00 04 10 14 20 24 30 34 01 05 11 15 21 2
5 31 35) |
| 244 punpckhbw xmmD,xmmE ; xmmD=(02 06 12 16 22 26 32 36 03 07 13 17 23 2
7 33 37) |
| 245 |
| 246 movdqa xmmC,xmmF |
| 247 punpcklbw xmmF,xmmH ; xmmF=(08 0C 18 1C 28 2C 38 3C 09 0D 19 1D 29 2
D 39 3D) |
| 248 punpckhbw xmmC,xmmH ; xmmC=(0A 0E 1A 1E 2A 2E 3A 3E 0B 0F 1B 1F 2B 2
F 3B 3F) |
| 249 |
| 250 movdqa xmmB,xmmA |
| 251 punpcklwd xmmA,xmmF ; xmmA=(00 04 08 0C 10 14 18 1C 20 24 28 2C 30 3
4 38 3C) |
| 252 punpckhwd xmmB,xmmF ; xmmB=(01 05 09 0D 11 15 19 1D 21 25 29 2D 31 3
5 39 3D) |
| 253 |
| 254 movdqa xmmG,xmmD |
| 255 punpcklwd xmmD,xmmC ; xmmD=(02 06 0A 0E 12 16 1A 1E 22 26 2A 2E 32 3
6 3A 3E) |
| 256 punpckhwd xmmG,xmmC ; xmmG=(03 07 0B 0F 13 17 1B 1F 23 27 2B 2F 33 3
7 3B 3F) |
| 257 |
| 258 movdqa xmmE,xmmA |
| 259 punpcklbw xmmA,xmmD ; xmmA=(00 02 04 06 08 0A 0C 0E 10 12 14 16 18 1
A 1C 1E) |
| 260 punpckhbw xmmE,xmmD ; xmmE=(20 22 24 26 28 2A 2C 2E 30 32 34 36 38 3
A 3C 3E) |
| 261 |
| 262 movdqa xmmH,xmmB |
| 263 punpcklbw xmmB,xmmG ; xmmB=(01 03 05 07 09 0B 0D 0F 11 13 15 17 19 1
B 1D 1F) |
| 264 punpckhbw xmmH,xmmG ; xmmH=(21 23 25 27 29 2B 2D 2F 31 33 35 37 39 3
B 3D 3F) |
| 265 |
| 266 pxor xmmF,xmmF |
| 267 |
| 268 movdqa xmmC,xmmA |
| 269 punpcklbw xmmA,xmmF ; xmmA=(00 02 04 06 08 0A 0C 0E) |
| 270 punpckhbw xmmC,xmmF ; xmmC=(10 12 14 16 18 1A 1C 1E) |
| 271 |
| 272 movdqa xmmD,xmmB |
| 273 punpcklbw xmmB,xmmF ; xmmB=(01 03 05 07 09 0B 0D 0F) |
| 274 punpckhbw xmmD,xmmF ; xmmD=(11 13 15 17 19 1B 1D 1F) |
| 275 |
| 276 movdqa xmmG,xmmE |
| 277 punpcklbw xmmE,xmmF ; xmmE=(20 22 24 26 28 2A 2C 2E) |
| 278 punpckhbw xmmG,xmmF ; xmmG=(30 32 34 36 38 3A 3C 3E) |
| 279 |
| 280 punpcklbw xmmF,xmmH |
| 281 punpckhbw xmmH,xmmH |
| 282 psrlw xmmF,BYTE_BIT ; xmmF=(21 23 25 27 29 2B 2D 2F) |
| 283 psrlw xmmH,BYTE_BIT ; xmmH=(31 33 35 37 39 3B 3D 3F) |
| 284 |
| 285 %endif ; RGB_PIXELSIZE ; --------------- |
| 286 |
| 287 ; xmm0=R(02468ACE)=RE, xmm2=G(02468ACE)=GE, xmm4=B(02468ACE)=BE |
| 288 ; xmm1=R(13579BDF)=RO, xmm3=G(13579BDF)=GO, xmm5=B(13579BDF)=BO |
| 289 |
| 290 ; (Original) |
| 291 ; Y = 0.29900 * R + 0.58700 * G + 0.11400 * B |
| 292 ; |
| 293 ; (This implementation) |
| 294 ; Y = 0.29900 * R + 0.33700 * G + 0.11400 * B + 0.25000 * G |
| 295 |
| 296 movdqa xmm6,xmm1 |
| 297 punpcklwd xmm1,xmm3 |
| 298 punpckhwd xmm6,xmm3 |
| 299 pmaddwd xmm1,[GOTOFF(eax,PW_F0299_F0337)] ; xmm1=ROL*FIX(0.299)+GOL*FI
X(0.337) |
| 300 pmaddwd xmm6,[GOTOFF(eax,PW_F0299_F0337)] ; xmm6=ROH*FIX(0.299)+GOH*FI
X(0.337) |
| 301 |
| 302 movdqa xmm7, xmm6 ; xmm7=ROH*FIX(0.299)+GOH*FIX(0.337) |
| 303 |
| 304 movdqa xmm6,xmm0 |
| 305 punpcklwd xmm0,xmm2 |
| 306 punpckhwd xmm6,xmm2 |
| 307 pmaddwd xmm0,[GOTOFF(eax,PW_F0299_F0337)] ; xmm0=REL*FIX(0.299)+GEL*FI
X(0.337) |
| 308 pmaddwd xmm6,[GOTOFF(eax,PW_F0299_F0337)] ; xmm6=REH*FIX(0.299)+GEH*FI
X(0.337) |
| 309 |
| 310 movdqa XMMWORD [wk(0)], xmm0 ; wk(0)=REL*FIX(0.299)+GEL*FIX(0.337) |
| 311 movdqa XMMWORD [wk(1)], xmm6 ; wk(1)=REH*FIX(0.299)+GEH*FIX(0.337) |
| 312 |
| 313 movdqa xmm0, xmm5 ; xmm0=BO |
| 314 movdqa xmm6, xmm4 ; xmm6=BE |
| 315 |
| 316 movdqa xmm4,xmm0 |
| 317 punpcklwd xmm0,xmm3 |
| 318 punpckhwd xmm4,xmm3 |
| 319 pmaddwd xmm0,[GOTOFF(eax,PW_F0114_F0250)] ; xmm0=BOL*FIX(0.114)+GOL*FI
X(0.250) |
| 320 pmaddwd xmm4,[GOTOFF(eax,PW_F0114_F0250)] ; xmm4=BOH*FIX(0.114)+GOH*FI
X(0.250) |
| 321 |
| 322 movdqa xmm3,[GOTOFF(eax,PD_ONEHALF)] ; xmm3=[PD_ONEHALF] |
| 323 |
| 324 paddd xmm0, xmm1 |
| 325 paddd xmm4, xmm7 |
| 326 paddd xmm0,xmm3 |
| 327 paddd xmm4,xmm3 |
| 328 psrld xmm0,SCALEBITS ; xmm0=YOL |
| 329 psrld xmm4,SCALEBITS ; xmm4=YOH |
| 330 packssdw xmm0,xmm4 ; xmm0=YO |
| 331 |
| 332 movdqa xmm4,xmm6 |
| 333 punpcklwd xmm6,xmm2 |
| 334 punpckhwd xmm4,xmm2 |
| 335 pmaddwd xmm6,[GOTOFF(eax,PW_F0114_F0250)] ; xmm6=BEL*FIX(0.114)+GEL*FI
X(0.250) |
| 336 pmaddwd xmm4,[GOTOFF(eax,PW_F0114_F0250)] ; xmm4=BEH*FIX(0.114)+GEH*FI
X(0.250) |
| 337 |
| 338 movdqa xmm2,[GOTOFF(eax,PD_ONEHALF)] ; xmm2=[PD_ONEHALF] |
| 339 |
| 340 paddd xmm6, XMMWORD [wk(0)] |
| 341 paddd xmm4, XMMWORD [wk(1)] |
| 342 paddd xmm6,xmm2 |
| 343 paddd xmm4,xmm2 |
| 344 psrld xmm6,SCALEBITS ; xmm6=YEL |
| 345 psrld xmm4,SCALEBITS ; xmm4=YEH |
| 346 packssdw xmm6,xmm4 ; xmm6=YE |
| 347 |
| 348 psllw xmm0,BYTE_BIT |
| 349 por xmm6,xmm0 ; xmm6=Y |
| 350 movdqa XMMWORD [edi], xmm6 ; Save Y |
| 351 |
| 352 sub ecx, byte SIZEOF_XMMWORD |
| 353 add esi, byte RGB_PIXELSIZE*SIZEOF_XMMWORD ; inptr |
| 354 add edi, byte SIZEOF_XMMWORD ; outptr0 |
| 355 cmp ecx, byte SIZEOF_XMMWORD |
| 356 jae near .columnloop |
| 357 test ecx,ecx |
| 358 jnz near .column_ld1 |
| 359 |
| 360 pop ecx ; col |
| 361 pop esi |
| 362 pop edi |
| 363 poppic eax |
| 364 |
| 365 add esi, byte SIZEOF_JSAMPROW ; input_buf |
| 366 add edi, byte SIZEOF_JSAMPROW |
| 367 dec eax ; num_rows |
| 368 jg near .rowloop |
| 369 |
| 370 .return: |
| 371 pop edi |
| 372 pop esi |
| 373 ; pop edx ; need not be preserved |
| 374 ; pop ecx ; need not be preserved |
| 375 pop ebx |
| 376 mov esp,ebp ; esp <- aligned ebp |
| 377 pop esp ; esp <- original ebp |
| 378 pop ebp |
| 379 ret |
| 380 |
| 381 ; For some reason, the OS X linker does not honor the request to align the |
| 382 ; segment unless we do this. |
| 383 align 16 |
OLD | NEW |