jccolext-sse2.asm 19 KB

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