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