jdcolext-avx2.asm (24842B)
1 ; 2 ; jdcolext.asm - colorspace conversion (AVX2) 3 ; 4 ; Copyright 2009, 2012 Pierre Ossman <ossman@cendio.se> for Cendio AB 5 ; Copyright (C) 2012, 2016, 2024, D. R. Commander. 6 ; Copyright (C) 2015, Intel Corporation. 7 ; 8 ; Based on the 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) or Yasm. 13 14 %include "jcolsamp.inc" 15 16 ; -------------------------------------------------------------------------- 17 ; 18 ; Convert some rows of samples to the output colorspace. 19 ; 20 ; GLOBAL(void) 21 ; jsimd_ycc_rgb_convert_avx2(JDIMENSION out_width, JSAMPIMAGE input_buf, 22 ; JDIMENSION input_row, JSAMPARRAY output_buf, 23 ; int num_rows) 24 ; 25 26 %define out_width(b) (b) + 8 ; JDIMENSION out_width 27 %define input_buf(b) (b) + 12 ; JSAMPIMAGE input_buf 28 %define input_row(b) (b) + 16 ; JDIMENSION input_row 29 %define output_buf(b) (b) + 20 ; JSAMPARRAY output_buf 30 %define num_rows(b) (b) + 24 ; int num_rows 31 32 %define original_ebp ebp + 0 33 %define wk(i) ebp - (WK_NUM - (i)) * SIZEOF_YMMWORD 34 ; ymmword wk[WK_NUM] 35 %define WK_NUM 2 36 %define gotptr wk(0) - SIZEOF_POINTER ; void * gotptr 37 38 align 32 39 GLOBAL_FUNCTION(jsimd_ycc_rgb_convert_avx2) 40 41 EXTN(jsimd_ycc_rgb_convert_avx2): 42 push ebp 43 mov eax, esp ; eax = original ebp 44 sub esp, byte 4 45 and esp, byte (-SIZEOF_YMMWORD) ; align to 256 bits 46 mov [esp], eax 47 mov ebp, esp ; ebp = aligned ebp 48 lea esp, [wk(0)] 49 PUSHPIC eax ; make a room for GOT address 50 push ebx 51 ; push ecx ; need not be preserved 52 ; push edx ; need not be preserved 53 push esi 54 push edi 55 56 GET_GOT ebx ; get GOT address 57 MOVPIC POINTER [gotptr], ebx ; save GOT address 58 59 mov ecx, JDIMENSION [out_width(eax)] ; num_cols 60 test ecx, ecx 61 jz near .return 62 63 push ecx 64 65 mov edi, JSAMPIMAGE [input_buf(eax)] 66 mov ecx, JDIMENSION [input_row(eax)] 67 mov esi, JSAMPARRAY [edi+0*SIZEOF_JSAMPARRAY] 68 mov ebx, JSAMPARRAY [edi+1*SIZEOF_JSAMPARRAY] 69 mov edx, JSAMPARRAY [edi+2*SIZEOF_JSAMPARRAY] 70 lea esi, [esi+ecx*SIZEOF_JSAMPROW] 71 lea ebx, [ebx+ecx*SIZEOF_JSAMPROW] 72 lea edx, [edx+ecx*SIZEOF_JSAMPROW] 73 74 pop ecx 75 76 mov edi, JSAMPARRAY [output_buf(eax)] 77 mov eax, INT [num_rows(eax)] 78 test eax, eax 79 jle near .return 80 ALIGNX 16, 7 81 .rowloop: 82 push eax 83 push edi 84 push edx 85 push ebx 86 push esi 87 push ecx ; col 88 89 mov esi, JSAMPROW [esi] ; inptr0 90 mov ebx, JSAMPROW [ebx] ; inptr1 91 mov edx, JSAMPROW [edx] ; inptr2 92 mov edi, JSAMPROW [edi] ; outptr 93 MOVPIC eax, POINTER [gotptr] ; load GOT address (eax) 94 ALIGNX 16, 7 95 .columnloop: 96 97 vmovdqu ymm5, YMMWORD [ebx] ; ymm5=Cb(0123456789ABCDEFGHIJKLMNOPQRSTUV) 98 vmovdqu ymm1, YMMWORD [edx] ; ymm1=Cr(0123456789ABCDEFGHIJKLMNOPQRSTUV) 99 100 vpcmpeqw ymm0, ymm0, ymm0 101 vpcmpeqw ymm7, ymm7, ymm7 102 vpsrlw ymm0, ymm0, BYTE_BIT ; ymm0={0xFF 0x00 0xFF 0x00 ..} 103 vpsllw ymm7, ymm7, 7 ; ymm7={0xFF80 0xFF80 0xFF80 0xFF80 ..} 104 105 vpand ymm4, ymm0, ymm5 ; ymm4=Cb(02468ACEGIKMOQSU)=CbE 106 vpsrlw ymm5, ymm5, BYTE_BIT ; ymm5=Cb(13579BDFHJLNPRTV)=CbO 107 vpand ymm0, ymm0, ymm1 ; ymm0=Cr(02468ACEGIKMOQSU)=CrE 108 vpsrlw ymm1, ymm1, BYTE_BIT ; ymm1=Cr(13579BDFHJLNPRTV)=CrO 109 110 vpaddw ymm2, ymm4, ymm7 111 vpaddw ymm3, ymm5, ymm7 112 vpaddw ymm6, ymm0, ymm7 113 vpaddw ymm7, ymm1, ymm7 114 115 ; (Original) 116 ; R = Y + 1.40200 * Cr 117 ; G = Y - 0.34414 * Cb - 0.71414 * Cr 118 ; B = Y + 1.77200 * Cb 119 ; 120 ; (This implementation) 121 ; R = Y + 0.40200 * Cr + Cr 122 ; G = Y - 0.34414 * Cb + 0.28586 * Cr - Cr 123 ; B = Y - 0.22800 * Cb + Cb + Cb 124 125 vpaddw ymm4, ymm2, ymm2 ; ymm4=2*CbE 126 vpaddw ymm5, ymm3, ymm3 ; ymm5=2*CbO 127 vpaddw ymm0, ymm6, ymm6 ; ymm0=2*CrE 128 vpaddw ymm1, ymm7, ymm7 ; ymm1=2*CrO 129 130 vpmulhw ymm4, ymm4, [GOTOFF(eax,PW_MF0228)] ; ymm4=(2*CbE * -FIX(0.22800)) 131 vpmulhw ymm5, ymm5, [GOTOFF(eax,PW_MF0228)] ; ymm5=(2*CbO * -FIX(0.22800)) 132 vpmulhw ymm0, ymm0, [GOTOFF(eax,PW_F0402)] ; ymm0=(2*CrE * FIX(0.40200)) 133 vpmulhw ymm1, ymm1, [GOTOFF(eax,PW_F0402)] ; ymm1=(2*CrO * FIX(0.40200)) 134 135 vpaddw ymm4, ymm4, [GOTOFF(eax,PW_ONE)] 136 vpaddw ymm5, ymm5, [GOTOFF(eax,PW_ONE)] 137 vpsraw ymm4, ymm4, 1 ; ymm4=(CbE * -FIX(0.22800)) 138 vpsraw ymm5, ymm5, 1 ; ymm5=(CbO * -FIX(0.22800)) 139 vpaddw ymm0, ymm0, [GOTOFF(eax,PW_ONE)] 140 vpaddw ymm1, ymm1, [GOTOFF(eax,PW_ONE)] 141 vpsraw ymm0, ymm0, 1 ; ymm0=(CrE * FIX(0.40200)) 142 vpsraw ymm1, ymm1, 1 ; ymm1=(CrO * FIX(0.40200)) 143 144 vpaddw ymm4, ymm4, ymm2 145 vpaddw ymm5, ymm5, ymm3 146 vpaddw ymm4, ymm4, ymm2 ; ymm4=(CbE * FIX(1.77200))=(B-Y)E 147 vpaddw ymm5, ymm5, ymm3 ; ymm5=(CbO * FIX(1.77200))=(B-Y)O 148 vpaddw ymm0, ymm0, ymm6 ; ymm0=(CrE * FIX(1.40200))=(R-Y)E 149 vpaddw ymm1, ymm1, ymm7 ; ymm1=(CrO * FIX(1.40200))=(R-Y)O 150 151 vmovdqa YMMWORD [wk(0)], ymm4 ; wk(0)=(B-Y)E 152 vmovdqa YMMWORD [wk(1)], ymm5 ; wk(1)=(B-Y)O 153 154 vpunpckhwd ymm4, ymm2, ymm6 155 vpunpcklwd ymm2, ymm2, ymm6 156 vpmaddwd ymm2, ymm2, [GOTOFF(eax,PW_MF0344_F0285)] 157 vpmaddwd ymm4, ymm4, [GOTOFF(eax,PW_MF0344_F0285)] 158 vpunpckhwd ymm5, ymm3, ymm7 159 vpunpcklwd ymm3, ymm3, ymm7 160 vpmaddwd ymm3, ymm3, [GOTOFF(eax,PW_MF0344_F0285)] 161 vpmaddwd ymm5, ymm5, [GOTOFF(eax,PW_MF0344_F0285)] 162 163 vpaddd ymm2, ymm2, [GOTOFF(eax,PD_ONEHALF)] 164 vpaddd ymm4, ymm4, [GOTOFF(eax,PD_ONEHALF)] 165 vpsrad ymm2, ymm2, SCALEBITS 166 vpsrad ymm4, ymm4, SCALEBITS 167 vpaddd ymm3, ymm3, [GOTOFF(eax,PD_ONEHALF)] 168 vpaddd ymm5, ymm5, [GOTOFF(eax,PD_ONEHALF)] 169 vpsrad ymm3, ymm3, SCALEBITS 170 vpsrad ymm5, ymm5, SCALEBITS 171 172 vpackssdw ymm2, ymm2, ymm4 ; ymm2=CbE*-FIX(0.344)+CrE*FIX(0.285) 173 vpackssdw ymm3, ymm3, ymm5 ; ymm3=CbO*-FIX(0.344)+CrO*FIX(0.285) 174 vpsubw ymm2, ymm2, ymm6 ; ymm2=CbE*-FIX(0.344)+CrE*-FIX(0.714)=(G-Y)E 175 vpsubw ymm3, ymm3, ymm7 ; ymm3=CbO*-FIX(0.344)+CrO*-FIX(0.714)=(G-Y)O 176 177 vmovdqu ymm5, YMMWORD [esi] ; ymm5=Y(0123456789ABCDEFGHIJKLMNOPQRSTUV) 178 179 vpcmpeqw ymm4, ymm4, ymm4 180 vpsrlw ymm4, ymm4, BYTE_BIT ; ymm4={0xFF 0x00 0xFF 0x00 ..} 181 vpand ymm4, ymm4, ymm5 ; ymm4=Y(02468ACEGIKMOQSU)=YE 182 vpsrlw ymm5, ymm5, BYTE_BIT ; ymm5=Y(13579BDFHJLNPRTV)=YO 183 184 vpaddw ymm0, ymm0, ymm4 ; ymm0=((R-Y)E+YE)=RE=R(02468ACEGIKMOQSU) 185 vpaddw ymm1, ymm1, ymm5 ; ymm1=((R-Y)O+YO)=RO=R(13579BDFHJLNPRTV) 186 vpackuswb ymm0, ymm0, ymm0 ; ymm0=R(02468ACE********GIKMOQSU********) 187 vpackuswb ymm1, ymm1, ymm1 ; ymm1=R(13579BDF********HJLNPRTV********) 188 189 vpaddw ymm2, ymm2, ymm4 ; ymm2=((G-Y)E+YE)=GE=G(02468ACEGIKMOQSU) 190 vpaddw ymm3, ymm3, ymm5 ; ymm3=((G-Y)O+YO)=GO=G(13579BDFHJLNPRTV) 191 vpackuswb ymm2, ymm2, ymm2 ; ymm2=G(02468ACE********GIKMOQSU********) 192 vpackuswb ymm3, ymm3, ymm3 ; ymm3=G(13579BDF********HJLNPRTV********) 193 194 vpaddw ymm4, ymm4, YMMWORD [wk(0)] ; ymm4=(YE+(B-Y)E)=BE=B(02468ACEGIKMOQSU) 195 vpaddw ymm5, ymm5, YMMWORD [wk(1)] ; ymm5=(YO+(B-Y)O)=BO=B(13579BDFHJLNPRTV) 196 vpackuswb ymm4, ymm4, ymm4 ; ymm4=B(02468ACE********GIKMOQSU********) 197 vpackuswb ymm5, ymm5, ymm5 ; ymm5=B(13579BDF********HJLNPRTV********) 198 199 %if RGB_PIXELSIZE == 3 ; --------------- 200 201 ; ymmA=(00 02 04 06 08 0A 0C 0E ** 0G 0I 0K 0M 0O 0Q 0S 0U **) 202 ; ymmB=(01 03 05 07 09 0B 0D 0F ** 0H 0J 0L 0N 0P 0R 0T 0V **) 203 ; ymmC=(10 12 14 16 18 1A 1C 1E ** 1G 1I 1K 1M 1O 1Q 1S 1U **) 204 ; ymmD=(11 13 15 17 19 1B 1D 1F ** 1H 1J 1L 1N 1P 1R 1T 1V **) 205 ; ymmE=(20 22 24 26 28 2A 2C 2E ** 2G 2I 2K 2M 2O 2Q 2S 2U **) 206 ; ymmF=(21 23 25 27 29 2B 2D 2F ** 2H 2J 2L 2N 2P 2R 2T 2V **) 207 ; ymmG=(** ** ** ** ** ** ** ** ** ** ** ** ** ** ** ** ** **) 208 ; ymmH=(** ** ** ** ** ** ** ** ** ** ** ** ** ** ** ** ** **) 209 210 vpunpcklbw ymmA, ymmA, ymmC ; ymmA=(00 10 02 12 04 14 06 16 08 18 0A 1A 0C 1C 0E 1E 211 ; 0G 1G 0I 1I 0K 1K 0M 1M 0O 1O 0Q 1Q 0S 1S 0U 1U) 212 vpunpcklbw ymmE, ymmE, ymmB ; ymmE=(20 01 22 03 24 05 26 07 28 09 2A 0B 2C 0D 2E 0F 213 ; 2G 0H 2I 0J 2K 0L 2M 0N 2O 0P 2Q 0R 2S 0T 2U 0V) 214 vpunpcklbw ymmD, ymmD, ymmF ; ymmD=(11 21 13 23 15 25 17 27 19 29 1B 2B 1D 2D 1F 2F 215 ; 1H 2H 1J 2J 1L 2L 1N 2N 1P 2P 1R 2R 1T 2T 1V 2V) 216 217 vpsrldq ymmH, ymmA, 2 ; ymmH=(02 12 04 14 06 16 08 18 0A 1A 0C 1C 0E 1E 0G 1G 218 ; 0I 1I 0K 1K 0M 1M 0O 1O 0Q 1Q 0S 1S 0U 1U -- --) 219 vpunpckhwd ymmG, ymmA, ymmE ; ymmG=(08 18 28 09 0A 1A 2A 0B 0C 1C 2C 0D 0E 1E 2E 0F 220 ; 0O 1O 2O 0P 0Q 1Q 2Q 0R 0S 1S 2S 0T 0U 1U 2U 0V) 221 vpunpcklwd ymmA, ymmA, ymmE ; ymmA=(00 10 20 01 02 12 22 03 04 14 24 05 06 16 26 07 222 ; 0G 1G 2G 0H 0I 1I 2I 0J 0K 1K 2K 0L 0M 1M 2M 0N) 223 224 vpsrldq ymmE, ymmE, 2 ; ymmE=(22 03 24 05 26 07 28 09 2A 0B 2C 0D 2E 0F 2G 0H 225 ; 2I 0J 2K 0L 2M 0N 2O 0P 2Q 0R 2S 0T 2U 0V -- --) 226 227 vpsrldq ymmB, ymmD, 2 ; ymmB=(13 23 15 25 17 27 19 29 1B 2B 1D 2D 1F 2F 1H 2H 228 ; 1J 2J 1L 2L 1N 2N 1P 2P 1R 2R 1T 2T 1V 2V -- --) 229 vpunpckhwd ymmC, ymmD, ymmH ; ymmC=(19 29 0A 1A 1B 2B 0C 1C 1D 2D 0E 1E 1F 2F 0G 1G 230 ; 1P 2P 0Q 1Q 1R 2R 0S 1S 1T 2T 0U 1U 1V 2V -- --) 231 vpunpcklwd ymmD, ymmD, ymmH ; ymmD=(11 21 02 12 13 23 04 14 15 25 06 16 17 27 08 18 232 ; 1H 2H 0I 1I 1J 2J 0K 1K 1L 2L 0M 1M 1N 2N 0O 1O) 233 234 vpunpckhwd ymmF, ymmE, ymmB ; ymmF=(2A 0B 1B 2B 2C 0D 1D 2D 2E 0F 1F 2F 2G 0H 1H 2H 235 ; 2Q 0R 1R 2R 2S 0T 1T 2T 2U 0V 1V 2V -- -- -- --) 236 vpunpcklwd ymmE, ymmE, ymmB ; ymmE=(22 03 13 23 24 05 15 25 26 07 17 27 28 09 19 29 237 ; 2I 0J 1J 2J 2K 0L 1L 2L 2M 0N 1N 2N 2O 0P 1P 2P) 238 239 vpshufd ymmH, ymmA, 0x4E ; ymmH=(04 14 24 05 06 16 26 07 00 10 20 01 02 12 22 03 240 ; 0K 1K 2K 0L 0M 1M 2M 0N 0G 1G 2G 0H 0I 1I 2I 0J) 241 vpunpckldq ymmA, ymmA, ymmD ; ymmA=(00 10 20 01 11 21 02 12 02 12 22 03 13 23 04 14 242 ; 0G 1G 2G 0H 1H 2H 0I 1I 0I 1I 2I 0J 1J 2J 0K 1K) 243 vpunpckhdq ymmD, ymmD, ymmE ; ymmD=(15 25 06 16 26 07 17 27 17 27 08 18 28 09 19 29 244 ; 1L 2L 0M 1M 2M 0N 1N 2N 1N 2N 0O 1O 2O 0P 1P 2P) 245 vpunpckldq ymmE, ymmE, ymmH ; ymmE=(22 03 13 23 04 14 24 05 24 05 15 25 06 16 26 07 246 ; 2I 0J 1J 2J 0K 1K 2K 0L 2K 0L 1L 2L 0M 1M 2M 0N) 247 248 vpshufd ymmH, ymmG, 0x4E ; ymmH=(0C 1C 2C 0D 0E 1E 2E 0F 08 18 28 09 0A 1A 2A 0B 249 ; 0S 1S 2S 0T 0U 1U 2U 0V 0O 1O 2O 0P 0Q 1Q 2Q 0R) 250 vpunpckldq ymmG, ymmG, ymmC ; ymmG=(08 18 28 09 19 29 0A 1A 0A 1A 2A 0B 1B 2B 0C 1C 251 ; 0O 1O 2O 0P 1P 2P 0Q 1Q 0Q 1Q 2Q 0R 1R 2R 0S 1S) 252 vpunpckhdq ymmC, ymmC, ymmF ; ymmC=(1D 2D 0E 1E 2E 0F 1F 2F 1F 2F 0G 1G 2G 0H 1H 2H 253 ; 1T 2T 0U 1U 2U 0V 1V 2V 1V 2V -- -- -- -- -- --) 254 vpunpckldq ymmF, ymmF, ymmH ; ymmF=(2A 0B 1B 2B 0C 1C 2C 0D 2C 0D 1D 2D 0E 1E 2E 0F 255 ; 2Q 0R 1R 2R 0S 1S 2S 0T 2S 0T 1T 2T 0U 1U 2U 0V) 256 257 vpunpcklqdq ymmH, ymmA, ymmE ; ymmH=(00 10 20 01 11 21 02 12 22 03 13 23 04 14 24 05 258 ; 0G 1G 2G 0H 1H 2H 0I 1I 2I 0J 1J 2J 0K 1K 2K 0L) 259 vpunpcklqdq ymmG, ymmD, ymmG ; ymmG=(15 25 06 16 26 07 17 27 08 18 28 09 19 29 0A 1A 260 ; 1L 2L 0M 1M 2M 0N 1N 2N 0O 1O 2O 0P 1P 2P 0Q 1Q) 261 vpunpcklqdq ymmC, ymmF, ymmC ; ymmC=(2A 0B 1B 2B 0C 1C 2C 0D 1D 2D 0E 1E 2E 0F 1F 2F 262 ; 2Q 0R 1R 2R 0S 1S 2S 0T 1T 2T 0U 1U 2U 0V 1V 2V) 263 264 vperm2i128 ymmA, ymmH, ymmG, 0x20 ; ymmA=(00 10 20 01 11 21 02 12 22 03 13 23 04 14 24 05 265 ; 15 25 06 16 26 07 17 27 08 18 28 09 19 29 0A 1A) 266 vperm2i128 ymmD, ymmC, ymmH, 0x30 ; ymmD=(2A 0B 1B 2B 0C 1C 2C 0D 1D 2D 0E 1E 2E 0F 1F 2F 267 ; 0G 1G 2G 0H 1H 2H 0I 1I 2I 0J 1J 2J 0K 1K 2K 0L) 268 vperm2i128 ymmF, ymmG, ymmC, 0x31 ; ymmF=(1L 2L 0M 1M 2M 0N 1N 2N 0O 1O 2O 0P 1P 2P 0Q 1Q 269 ; 2Q 0R 1R 2R 0S 1S 2S 0T 1T 2T 0U 1U 2U 0V 1V 2V) 270 271 cmp ecx, byte SIZEOF_YMMWORD 272 jb short .column_st64 273 274 test edi, SIZEOF_YMMWORD-1 275 jnz short .out1 276 ; --(aligned)------------------- 277 vmovntdq YMMWORD [edi+0*SIZEOF_YMMWORD], ymmA 278 vmovntdq YMMWORD [edi+1*SIZEOF_YMMWORD], ymmD 279 vmovntdq YMMWORD [edi+2*SIZEOF_YMMWORD], ymmF 280 jmp short .out0 281 .out1: ; --(unaligned)----------------- 282 vmovdqu YMMWORD [edi+0*SIZEOF_YMMWORD], ymmA 283 vmovdqu YMMWORD [edi+1*SIZEOF_YMMWORD], ymmD 284 vmovdqu YMMWORD [edi+2*SIZEOF_YMMWORD], ymmF 285 .out0: 286 add edi, byte RGB_PIXELSIZE*SIZEOF_YMMWORD ; outptr 287 sub ecx, byte SIZEOF_YMMWORD 288 jz near .nextrow 289 290 add esi, byte SIZEOF_YMMWORD ; inptr0 291 add ebx, byte SIZEOF_YMMWORD ; inptr1 292 add edx, byte SIZEOF_YMMWORD ; inptr2 293 jmp near .columnloop 294 ALIGNX 16, 7 295 296 .column_st64: 297 lea ecx, [ecx+ecx*2] ; imul ecx, RGB_PIXELSIZE 298 cmp ecx, byte 2*SIZEOF_YMMWORD 299 jb short .column_st32 300 vmovdqu YMMWORD [edi+0*SIZEOF_YMMWORD], ymmA 301 vmovdqu YMMWORD [edi+1*SIZEOF_YMMWORD], ymmD 302 add edi, byte 2*SIZEOF_YMMWORD ; outptr 303 vmovdqa ymmA, ymmF 304 sub ecx, byte 2*SIZEOF_YMMWORD 305 jmp short .column_st31 306 .column_st32: 307 cmp ecx, byte SIZEOF_YMMWORD 308 jb short .column_st31 309 vmovdqu YMMWORD [edi+0*SIZEOF_YMMWORD], ymmA 310 add edi, byte SIZEOF_YMMWORD ; outptr 311 vmovdqa ymmA, ymmD 312 sub ecx, byte SIZEOF_YMMWORD 313 jmp short .column_st31 314 .column_st31: 315 cmp ecx, byte SIZEOF_XMMWORD 316 jb short .column_st15 317 vmovdqu XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA 318 add edi, byte SIZEOF_XMMWORD ; outptr 319 vperm2i128 ymmA, ymmA, ymmA, 1 320 sub ecx, byte SIZEOF_XMMWORD 321 .column_st15: 322 ; Store the lower 8 bytes of xmmA to the output when it has enough 323 ; space. 324 cmp ecx, byte SIZEOF_MMWORD 325 jb short .column_st7 326 vmovq XMM_MMWORD [edi], xmmA 327 add edi, byte SIZEOF_MMWORD 328 sub ecx, byte SIZEOF_MMWORD 329 vpsrldq xmmA, xmmA, SIZEOF_MMWORD 330 .column_st7: 331 ; Store the lower 4 bytes of xmmA to the output when it has enough 332 ; space. 333 cmp ecx, byte SIZEOF_DWORD 334 jb short .column_st3 335 vmovd XMM_DWORD [edi], xmmA 336 add edi, byte SIZEOF_DWORD 337 sub ecx, byte SIZEOF_DWORD 338 vpsrldq xmmA, xmmA, SIZEOF_DWORD 339 .column_st3: 340 ; Store the lower 2 bytes of eax to the output when it has enough 341 ; space. 342 vmovd eax, xmmA 343 cmp ecx, byte SIZEOF_WORD 344 jb short .column_st1 345 mov word [edi], ax 346 add edi, byte SIZEOF_WORD 347 sub ecx, byte SIZEOF_WORD 348 shr eax, 16 349 .column_st1: 350 ; Store the lower 1 byte of eax to the output when it has enough 351 ; space. 352 test ecx, ecx 353 jz short .nextrow 354 mov byte [edi], al 355 356 %else ; RGB_PIXELSIZE == 4 ; ----------- 357 358 %ifdef RGBX_FILLER_0XFF 359 vpcmpeqb ymm6, ymm6, ymm6 ; ymm6=XE=X(02468ACE********GIKMOQSU********) 360 vpcmpeqb ymm7, ymm7, ymm7 ; ymm7=XO=X(13579BDF********HJLNPRTV********) 361 %else 362 vpxor ymm6, ymm6, ymm6 ; ymm6=XE=X(02468ACE********GIKMOQSU********) 363 vpxor ymm7, ymm7, ymm7 ; ymm7=XO=X(13579BDF********HJLNPRTV********) 364 %endif 365 ; ymmA=(00 02 04 06 08 0A 0C 0E ** 0G 0I 0K 0M 0O 0Q 0S 0U **) 366 ; ymmB=(01 03 05 07 09 0B 0D 0F ** 0H 0J 0L 0N 0P 0R 0T 0V **) 367 ; ymmC=(10 12 14 16 18 1A 1C 1E ** 1G 1I 1K 1M 1O 1Q 1S 1U **) 368 ; ymmD=(11 13 15 17 19 1B 1D 1F ** 1H 1J 1L 1N 1P 1R 1T 1V **) 369 ; ymmE=(20 22 24 26 28 2A 2C 2E ** 2G 2I 2K 2M 2O 2Q 2S 2U **) 370 ; ymmF=(21 23 25 27 29 2B 2D 2F ** 2H 2J 2L 2N 2P 2R 2T 2V **) 371 ; ymmG=(30 32 34 36 38 3A 3C 3E ** 3G 3I 3K 3M 3O 3Q 3S 3U **) 372 ; ymmH=(31 33 35 37 39 3B 3D 3F ** 3H 3J 3L 3N 3P 3R 3T 3V **) 373 374 vpunpcklbw ymmA, ymmA, ymmC ; ymmA=(00 10 02 12 04 14 06 16 08 18 0A 1A 0C 1C 0E 1E 375 ; 0G 1G 0I 1I 0K 1K 0M 1M 0O 1O 0Q 1Q 0S 1S 0U 1U) 376 vpunpcklbw ymmE, ymmE, ymmG ; ymmE=(20 30 22 32 24 34 26 36 28 38 2A 3A 2C 3C 2E 3E 377 ; 2G 3G 2I 3I 2K 3K 2M 3M 2O 3O 2Q 3Q 2S 3S 2U 3U) 378 vpunpcklbw ymmB, ymmB, ymmD ; ymmB=(01 11 03 13 05 15 07 17 09 19 0B 1B 0D 1D 0F 1F 379 ; 0H 1H 0J 1J 0L 1L 0N 1N 0P 1P 0R 1R 0T 1T 0V 1V) 380 vpunpcklbw ymmF, ymmF, ymmH ; ymmF=(21 31 23 33 25 35 27 37 29 39 2B 3B 2D 3D 2F 3F 381 ; 2H 3H 2J 3J 2L 3L 2N 3N 2P 3P 2R 3R 2T 3T 2V 3V) 382 383 vpunpckhwd ymmC, ymmA, ymmE ; ymmC=(08 18 28 38 0A 1A 2A 3A 0C 1C 2C 3C 0E 1E 2E 3E 384 ; 0O 1O 2O 3O 0Q 1Q 2Q 3Q 0S 1S 2S 3S 0U 1U 2U 3U) 385 vpunpcklwd ymmA, ymmA, ymmE ; ymmA=(00 10 20 30 02 12 22 32 04 14 24 34 06 16 26 36 386 ; 0G 1G 2G 3G 0I 1I 2I 3I 0K 1K 2K 3K 0M 1M 2M 3M) 387 vpunpckhwd ymmG, ymmB, ymmF ; ymmG=(09 19 29 39 0B 1B 2B 3B 0D 1D 2D 3D 0F 1F 2F 3F 388 ; 0P 1P 2P 3P 0R 1R 2R 3R 0T 1T 2T 3T 0V 1V 2V 3V) 389 vpunpcklwd ymmB, ymmB, ymmF ; ymmB=(01 11 21 31 03 13 23 33 05 15 25 35 07 17 27 37 390 ; 0H 1H 2H 3H 0J 1J 2J 3J 0L 1L 2L 3L 0N 1N 2N 3N) 391 392 vpunpckhdq ymmE, ymmA, ymmB ; ymmE=(04 14 24 34 05 15 25 35 06 16 26 36 07 17 27 37 393 ; 0K 1K 2K 3K 0L 1L 2L 3L 0M 1M 2M 3M 0N 1N 2N 3N) 394 vpunpckldq ymmB, ymmA, ymmB ; ymmB=(00 10 20 30 01 11 21 31 02 12 22 32 03 13 23 33 395 ; 0G 1G 2G 3G 0H 1H 2H 3H 0I 1I 2I 3I 0J 1J 2J 3J) 396 vpunpckhdq ymmF, ymmC, ymmG ; ymmF=(0C 1C 2C 3C 0D 1D 2D 3D 0E 1E 2E 3E 0F 1F 2F 3F 397 ; 0S 1S 2S 3S 0T 1T 2T 3T 0U 1U 2U 3U 0V 1V 2V 3V) 398 vpunpckldq ymmG, ymmC, ymmG ; ymmG=(08 18 28 38 09 19 29 39 0A 1A 2A 3A 0B 1B 2B 3B 399 ; 0O 1O 2O 3O 0P 1P 2P 3P 0Q 1Q 2Q 3Q 0R 1R 2R 3R) 400 401 vperm2i128 ymmA, ymmB, ymmE, 0x20 ; ymmA=(00 10 20 30 01 11 21 31 02 12 22 32 03 13 23 33 402 ; 04 14 24 34 05 15 25 35 06 16 26 36 07 17 27 37) 403 vperm2i128 ymmD, ymmG, ymmF, 0x20 ; ymmD=(08 18 28 38 09 19 29 39 0A 1A 2A 3A 0B 1B 2B 3B 404 ; 0C 1C 2C 3C 0D 1D 2D 3D 0E 1E 2E 3E 0F 1F 2F 3F) 405 vperm2i128 ymmC, ymmB, ymmE, 0x31 ; ymmC=(0G 1G 2G 3G 0H 1H 2H 3H 0I 1I 2I 3I 0J 1J 2J 3J 406 ; 0K 1K 2K 3K 0L 1L 2L 3L 0M 1M 2M 3M 0N 1N 2N 3N) 407 vperm2i128 ymmH, ymmG, ymmF, 0x31 ; ymmH=(0O 1O 2O 3O 0P 1P 2P 3P 0Q 1Q 2Q 3Q 0R 1R 2R 3R 408 ; 0S 1S 2S 3S 0T 1T 2T 3T 0U 1U 2U 3U 0V 1V 2V 3V) 409 410 cmp ecx, byte SIZEOF_YMMWORD 411 jb short .column_st64 412 413 test edi, SIZEOF_YMMWORD-1 414 jnz short .out1 415 ; --(aligned)------------------- 416 vmovntdq YMMWORD [edi+0*SIZEOF_YMMWORD], ymmA 417 vmovntdq YMMWORD [edi+1*SIZEOF_YMMWORD], ymmD 418 vmovntdq YMMWORD [edi+2*SIZEOF_YMMWORD], ymmC 419 vmovntdq YMMWORD [edi+3*SIZEOF_YMMWORD], ymmH 420 jmp short .out0 421 .out1: ; --(unaligned)----------------- 422 vmovdqu YMMWORD [edi+0*SIZEOF_YMMWORD], ymmA 423 vmovdqu YMMWORD [edi+1*SIZEOF_YMMWORD], ymmD 424 vmovdqu YMMWORD [edi+2*SIZEOF_YMMWORD], ymmC 425 vmovdqu YMMWORD [edi+3*SIZEOF_YMMWORD], ymmH 426 .out0: 427 add edi, RGB_PIXELSIZE*SIZEOF_YMMWORD ; outptr 428 sub ecx, byte SIZEOF_YMMWORD 429 jz near .nextrow 430 431 add esi, byte SIZEOF_YMMWORD ; inptr0 432 add ebx, byte SIZEOF_YMMWORD ; inptr1 433 add edx, byte SIZEOF_YMMWORD ; inptr2 434 jmp near .columnloop 435 ALIGNX 16, 7 436 437 .column_st64: 438 cmp ecx, byte SIZEOF_YMMWORD/2 439 jb short .column_st32 440 vmovdqu YMMWORD [edi+0*SIZEOF_YMMWORD], ymmA 441 vmovdqu YMMWORD [edi+1*SIZEOF_YMMWORD], ymmD 442 add edi, byte 2*SIZEOF_YMMWORD ; outptr 443 vmovdqa ymmA, ymmC 444 vmovdqa ymmD, ymmH 445 sub ecx, byte SIZEOF_YMMWORD/2 446 .column_st32: 447 cmp ecx, byte SIZEOF_YMMWORD/4 448 jb short .column_st16 449 vmovdqu YMMWORD [edi+0*SIZEOF_YMMWORD], ymmA 450 add edi, byte SIZEOF_YMMWORD ; outptr 451 vmovdqa ymmA, ymmD 452 sub ecx, byte SIZEOF_YMMWORD/4 453 .column_st16: 454 cmp ecx, byte SIZEOF_YMMWORD/8 455 jb short .column_st15 456 vmovdqu XMMWORD [edi+0*SIZEOF_XMMWORD], xmmA 457 vperm2i128 ymmA, ymmA, ymmA, 1 458 add edi, byte SIZEOF_XMMWORD ; outptr 459 sub ecx, byte SIZEOF_YMMWORD/8 460 .column_st15: 461 ; Store two pixels (8 bytes) of ymmA to the output when it has enough 462 ; space. 463 cmp ecx, byte SIZEOF_YMMWORD/16 464 jb short .column_st7 465 vmovq MMWORD [edi], xmmA 466 add edi, byte SIZEOF_YMMWORD/16*4 467 sub ecx, byte SIZEOF_YMMWORD/16 468 vpsrldq xmmA, SIZEOF_YMMWORD/16*4 469 .column_st7: 470 ; Store one pixel (4 bytes) of ymmA to the output when it has enough 471 ; space. 472 test ecx, ecx 473 jz short .nextrow 474 vmovd XMM_DWORD [edi], xmmA 475 476 %endif ; RGB_PIXELSIZE ; --------------- 477 478 ALIGNX 16, 7 479 480 .nextrow: 481 pop ecx 482 pop esi 483 pop ebx 484 pop edx 485 pop edi 486 pop eax 487 488 add esi, byte SIZEOF_JSAMPROW 489 add ebx, byte SIZEOF_JSAMPROW 490 add edx, byte SIZEOF_JSAMPROW 491 add edi, byte SIZEOF_JSAMPROW ; output_buf 492 dec eax ; num_rows 493 jg near .rowloop 494 495 sfence ; flush the write buffer 496 497 .return: 498 vzeroupper 499 pop edi 500 pop esi 501 ; pop edx ; need not be preserved 502 ; pop ecx ; need not be preserved 503 pop ebx 504 mov esp, ebp ; esp <- aligned ebp 505 pop esp ; esp <- original ebp 506 pop ebp 507 ret 508 509 ; For some reason, the OS X linker does not honor the request to align the 510 ; segment unless we do this. 511 align 32