jccolext-sse2.asm 18 KB

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