You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

897 lines
30KB

  1. /*
  2. * software YUV to RGB converter
  3. *
  4. * Copyright (C) 2009 Konstantin Shishkov
  5. *
  6. * 1,4,8bpp support and context / deglobalize stuff
  7. * by Michael Niedermayer (michaelni@gmx.at)
  8. *
  9. * This file is part of Libav.
  10. *
  11. * Libav is free software; you can redistribute it and/or
  12. * modify it under the terms of the GNU Lesser General Public
  13. * License as published by the Free Software Foundation; either
  14. * version 2.1 of the License, or (at your option) any later version.
  15. *
  16. * Libav is distributed in the hope that it will be useful,
  17. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  19. * Lesser General Public License for more details.
  20. *
  21. * You should have received a copy of the GNU Lesser General Public
  22. * License along with Libav; if not, write to the Free Software
  23. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  24. */
  25. #include <stdio.h>
  26. #include <stdlib.h>
  27. #include <inttypes.h>
  28. #include <assert.h>
  29. #include "libavutil/cpu.h"
  30. #include "libavutil/bswap.h"
  31. #include "config.h"
  32. #include "rgb2rgb.h"
  33. #include "swscale.h"
  34. #include "swscale_internal.h"
  35. /* Color space conversion coefficients for YCbCr -> RGB mapping.
  36. *
  37. * Entries are {crv, cbu, cgu, cgv}
  38. *
  39. * crv = (255 / 224) * 65536 * (1 - cr) / 0.5
  40. * cbu = (255 / 224) * 65536 * (1 - cb) / 0.5
  41. * cgu = (255 / 224) * 65536 * (cb / cg) * (1 - cb) / 0.5
  42. * cgv = (255 / 224) * 65536 * (cr / cg) * (1 - cr) / 0.5
  43. *
  44. * where Y = cr * R + cg * G + cb * B and cr + cg + cb = 1.
  45. */
  46. const int32_t ff_yuv2rgb_coeffs[8][4] = {
  47. { 117504, 138453, 13954, 34903 }, /* no sequence_display_extension */
  48. { 117504, 138453, 13954, 34903 }, /* ITU-R Rec. 709 (1990) */
  49. { 104597, 132201, 25675, 53279 }, /* unspecified */
  50. { 104597, 132201, 25675, 53279 }, /* reserved */
  51. { 104448, 132798, 24759, 53109 }, /* FCC */
  52. { 104597, 132201, 25675, 53279 }, /* ITU-R Rec. 624-4 System B, G */
  53. { 104597, 132201, 25675, 53279 }, /* SMPTE 170M */
  54. { 117579, 136230, 16907, 35559 } /* SMPTE 240M (1987) */
  55. };
  56. const int *sws_getCoefficients(int colorspace)
  57. {
  58. if (colorspace > 7 || colorspace < 0)
  59. colorspace = SWS_CS_DEFAULT;
  60. return ff_yuv2rgb_coeffs[colorspace];
  61. }
  62. #define LOADCHROMA(i) \
  63. U = pu[i]; \
  64. V = pv[i]; \
  65. r = (void *)c->table_rV[V]; \
  66. g = (void *)(c->table_gU[U] + c->table_gV[V]); \
  67. b = (void *)c->table_bU[U];
  68. #define PUTRGB(dst, src, i) \
  69. Y = src[2 * i]; \
  70. dst[2 * i] = r[Y] + g[Y] + b[Y]; \
  71. Y = src[2 * i + 1]; \
  72. dst[2 * i + 1] = r[Y] + g[Y] + b[Y];
  73. #define PUTRGB24(dst, src, i) \
  74. Y = src[2 * i]; \
  75. dst[6 * i + 0] = r[Y]; \
  76. dst[6 * i + 1] = g[Y]; \
  77. dst[6 * i + 2] = b[Y]; \
  78. Y = src[2 * i + 1]; \
  79. dst[6 * i + 3] = r[Y]; \
  80. dst[6 * i + 4] = g[Y]; \
  81. dst[6 * i + 5] = b[Y];
  82. #define PUTBGR24(dst, src, i) \
  83. Y = src[2 * i]; \
  84. dst[6 * i + 0] = b[Y]; \
  85. dst[6 * i + 1] = g[Y]; \
  86. dst[6 * i + 2] = r[Y]; \
  87. Y = src[2 * i + 1]; \
  88. dst[6 * i + 3] = b[Y]; \
  89. dst[6 * i + 4] = g[Y]; \
  90. dst[6 * i + 5] = r[Y];
  91. #define PUTRGBA(dst, ysrc, asrc, i, s) \
  92. Y = ysrc[2 * i]; \
  93. dst[2 * i] = r[Y] + g[Y] + b[Y] + (asrc[2 * i] << s); \
  94. Y = ysrc[2 * i + 1]; \
  95. dst[2 * i + 1] = r[Y] + g[Y] + b[Y] + (asrc[2 * i + 1] << s);
  96. #define PUTRGB48(dst, src, i) \
  97. Y = src[ 2 * i]; \
  98. dst[12 * i + 0] = dst[12 * i + 1] = r[Y]; \
  99. dst[12 * i + 2] = dst[12 * i + 3] = g[Y]; \
  100. dst[12 * i + 4] = dst[12 * i + 5] = b[Y]; \
  101. Y = src[ 2 * i + 1]; \
  102. dst[12 * i + 6] = dst[12 * i + 7] = r[Y]; \
  103. dst[12 * i + 8] = dst[12 * i + 9] = g[Y]; \
  104. dst[12 * i + 10] = dst[12 * i + 11] = b[Y];
  105. #define PUTBGR48(dst, src, i) \
  106. Y = src[2 * i]; \
  107. dst[12 * i + 0] = dst[12 * i + 1] = b[Y]; \
  108. dst[12 * i + 2] = dst[12 * i + 3] = g[Y]; \
  109. dst[12 * i + 4] = dst[12 * i + 5] = r[Y]; \
  110. Y = src[2 * i + 1]; \
  111. dst[12 * i + 6] = dst[12 * i + 7] = b[Y]; \
  112. dst[12 * i + 8] = dst[12 * i + 9] = g[Y]; \
  113. dst[12 * i + 10] = dst[12 * i + 11] = r[Y];
  114. #define YUV2RGBFUNC(func_name, dst_type, alpha) \
  115. static int func_name(SwsContext *c, const uint8_t *src[], \
  116. int srcStride[], int srcSliceY, int srcSliceH, \
  117. uint8_t *dst[], int dstStride[]) \
  118. { \
  119. int y; \
  120. \
  121. if (!alpha && c->srcFormat == AV_PIX_FMT_YUV422P) { \
  122. srcStride[1] *= 2; \
  123. srcStride[2] *= 2; \
  124. } \
  125. for (y = 0; y < srcSliceH; y += 2) { \
  126. dst_type *dst_1 = \
  127. (dst_type *)(dst[0] + (y + srcSliceY) * dstStride[0]); \
  128. dst_type *dst_2 = \
  129. (dst_type *)(dst[0] + (y + srcSliceY + 1) * dstStride[0]); \
  130. dst_type av_unused *r, *g, *b; \
  131. const uint8_t *py_1 = src[0] + y * srcStride[0]; \
  132. const uint8_t *py_2 = py_1 + srcStride[0]; \
  133. const uint8_t *pu = src[1] + (y >> 1) * srcStride[1]; \
  134. const uint8_t *pv = src[2] + (y >> 1) * srcStride[2]; \
  135. const uint8_t av_unused *pa_1, *pa_2; \
  136. unsigned int h_size = c->dstW >> 3; \
  137. if (alpha) { \
  138. pa_1 = src[3] + y * srcStride[3]; \
  139. pa_2 = pa_1 + srcStride[3]; \
  140. } \
  141. while (h_size--) { \
  142. int av_unused U, V, Y; \
  143. #define ENDYUV2RGBLINE(dst_delta, ss) \
  144. pu += 4 >> ss; \
  145. pv += 4 >> ss; \
  146. py_1 += 8 >> ss; \
  147. py_2 += 8 >> ss; \
  148. dst_1 += dst_delta >> ss; \
  149. dst_2 += dst_delta >> ss; \
  150. } \
  151. if (c->dstW & (4 >> ss)) { \
  152. int av_unused Y, U, V; \
  153. #define ENDYUV2RGBFUNC() \
  154. } \
  155. } \
  156. return srcSliceH; \
  157. }
  158. #define CLOSEYUV2RGBFUNC(dst_delta) \
  159. ENDYUV2RGBLINE(dst_delta, 0) \
  160. ENDYUV2RGBFUNC()
  161. YUV2RGBFUNC(yuv2rgb_c_48, uint8_t, 0)
  162. LOADCHROMA(0);
  163. PUTRGB48(dst_1, py_1, 0);
  164. PUTRGB48(dst_2, py_2, 0);
  165. LOADCHROMA(1);
  166. PUTRGB48(dst_2, py_2, 1);
  167. PUTRGB48(dst_1, py_1, 1);
  168. LOADCHROMA(2);
  169. PUTRGB48(dst_1, py_1, 2);
  170. PUTRGB48(dst_2, py_2, 2);
  171. LOADCHROMA(3);
  172. PUTRGB48(dst_2, py_2, 3);
  173. PUTRGB48(dst_1, py_1, 3);
  174. ENDYUV2RGBLINE(48, 0)
  175. LOADCHROMA(0);
  176. PUTRGB48(dst_1, py_1, 0);
  177. PUTRGB48(dst_2, py_2, 0);
  178. LOADCHROMA(1);
  179. PUTRGB48(dst_2, py_2, 1);
  180. PUTRGB48(dst_1, py_1, 1);
  181. ENDYUV2RGBLINE(48, 1)
  182. LOADCHROMA(0);
  183. PUTRGB48(dst_1, py_1, 0);
  184. PUTRGB48(dst_2, py_2, 0);
  185. ENDYUV2RGBFUNC()
  186. YUV2RGBFUNC(yuv2rgb_c_bgr48, uint8_t, 0)
  187. LOADCHROMA(0);
  188. PUTBGR48(dst_1, py_1, 0);
  189. PUTBGR48(dst_2, py_2, 0);
  190. LOADCHROMA(1);
  191. PUTBGR48(dst_2, py_2, 1);
  192. PUTBGR48(dst_1, py_1, 1);
  193. LOADCHROMA(2);
  194. PUTBGR48(dst_1, py_1, 2);
  195. PUTBGR48(dst_2, py_2, 2);
  196. LOADCHROMA(3);
  197. PUTBGR48(dst_2, py_2, 3);
  198. PUTBGR48(dst_1, py_1, 3);
  199. ENDYUV2RGBLINE(48, 0)
  200. LOADCHROMA(0);
  201. PUTBGR48(dst_1, py_1, 0);
  202. PUTBGR48(dst_2, py_2, 0);
  203. LOADCHROMA(1);
  204. PUTBGR48(dst_2, py_2, 1);
  205. PUTBGR48(dst_1, py_1, 1);
  206. ENDYUV2RGBLINE(48, 1)
  207. LOADCHROMA(0);
  208. PUTBGR48(dst_1, py_1, 0);
  209. PUTBGR48(dst_2, py_2, 0);
  210. ENDYUV2RGBFUNC()
  211. YUV2RGBFUNC(yuv2rgb_c_32, uint32_t, 0)
  212. LOADCHROMA(0);
  213. PUTRGB(dst_1, py_1, 0);
  214. PUTRGB(dst_2, py_2, 0);
  215. LOADCHROMA(1);
  216. PUTRGB(dst_2, py_2, 1);
  217. PUTRGB(dst_1, py_1, 1);
  218. LOADCHROMA(2);
  219. PUTRGB(dst_1, py_1, 2);
  220. PUTRGB(dst_2, py_2, 2);
  221. LOADCHROMA(3);
  222. PUTRGB(dst_2, py_2, 3);
  223. PUTRGB(dst_1, py_1, 3);
  224. ENDYUV2RGBLINE(8, 0)
  225. LOADCHROMA(0);
  226. PUTRGB(dst_1, py_1, 0);
  227. PUTRGB(dst_2, py_2, 0);
  228. LOADCHROMA(1);
  229. PUTRGB(dst_2, py_2, 1);
  230. PUTRGB(dst_1, py_1, 1);
  231. ENDYUV2RGBLINE(8, 1)
  232. LOADCHROMA(0);
  233. PUTRGB(dst_1, py_1, 0);
  234. PUTRGB(dst_2, py_2, 0);
  235. ENDYUV2RGBFUNC()
  236. YUV2RGBFUNC(yuva2rgba_c, uint32_t, 1)
  237. LOADCHROMA(0);
  238. PUTRGBA(dst_1, py_1, pa_1, 0, 24);
  239. PUTRGBA(dst_2, py_2, pa_2, 0, 24);
  240. LOADCHROMA(1);
  241. PUTRGBA(dst_2, py_2, pa_2, 1, 24);
  242. PUTRGBA(dst_1, py_1, pa_1, 1, 24);
  243. LOADCHROMA(2);
  244. PUTRGBA(dst_1, py_1, pa_1, 2, 24);
  245. PUTRGBA(dst_2, py_2, pa_2, 2, 24);
  246. LOADCHROMA(3);
  247. PUTRGBA(dst_2, py_2, pa_2, 3, 24);
  248. PUTRGBA(dst_1, py_1, pa_1, 3, 24);
  249. pa_1 += 8;
  250. pa_2 += 8;
  251. ENDYUV2RGBLINE(8, 0)
  252. LOADCHROMA(0);
  253. PUTRGBA(dst_1, py_1, pa_1, 0, 24);
  254. PUTRGBA(dst_2, py_2, pa_2, 0, 24);
  255. LOADCHROMA(1);
  256. PUTRGBA(dst_2, py_2, pa_2, 1, 24);
  257. PUTRGBA(dst_1, py_1, pa_1, 1, 24);
  258. pa_1 += 4;
  259. pa_2 += 4;
  260. ENDYUV2RGBLINE(8, 1)
  261. LOADCHROMA(0);
  262. PUTRGBA(dst_1, py_1, pa_1, 0, 24);
  263. PUTRGBA(dst_2, py_2, pa_2, 0, 24);
  264. ENDYUV2RGBFUNC()
  265. YUV2RGBFUNC(yuva2argb_c, uint32_t, 1)
  266. LOADCHROMA(0);
  267. PUTRGBA(dst_1, py_1, pa_1, 0, 0);
  268. PUTRGBA(dst_2, py_2, pa_2, 0, 0);
  269. LOADCHROMA(1);
  270. PUTRGBA(dst_2, py_2, pa_2, 1, 0);
  271. PUTRGBA(dst_1, py_1, pa_1, 1, 0);
  272. LOADCHROMA(2);
  273. PUTRGBA(dst_1, py_1, pa_1, 2, 0);
  274. PUTRGBA(dst_2, py_2, pa_2, 2, 0);
  275. LOADCHROMA(3);
  276. PUTRGBA(dst_2, py_2, pa_2, 3, 0);
  277. PUTRGBA(dst_1, py_1, pa_1, 3, 0);
  278. pa_1 += 8;
  279. pa_2 += 8;
  280. ENDYUV2RGBLINE(8, 0)
  281. LOADCHROMA(0);
  282. PUTRGBA(dst_1, py_1, pa_1, 0, 0);
  283. PUTRGBA(dst_2, py_2, pa_2, 0, 0);
  284. LOADCHROMA(1);
  285. PUTRGBA(dst_2, py_2, pa_2, 1, 0);
  286. PUTRGBA(dst_1, py_1, pa_1, 1, 0);
  287. pa_1 += 4;
  288. pa_2 += 4;
  289. ENDYUV2RGBLINE(8, 1)
  290. LOADCHROMA(0);
  291. PUTRGBA(dst_1, py_1, pa_1, 0, 0);
  292. PUTRGBA(dst_2, py_2, pa_2, 0, 0);
  293. ENDYUV2RGBFUNC()
  294. YUV2RGBFUNC(yuv2rgb_c_24_rgb, uint8_t, 0)
  295. LOADCHROMA(0);
  296. PUTRGB24(dst_1, py_1, 0);
  297. PUTRGB24(dst_2, py_2, 0);
  298. LOADCHROMA(1);
  299. PUTRGB24(dst_2, py_2, 1);
  300. PUTRGB24(dst_1, py_1, 1);
  301. LOADCHROMA(2);
  302. PUTRGB24(dst_1, py_1, 2);
  303. PUTRGB24(dst_2, py_2, 2);
  304. LOADCHROMA(3);
  305. PUTRGB24(dst_2, py_2, 3);
  306. PUTRGB24(dst_1, py_1, 3);
  307. ENDYUV2RGBLINE(24, 0)
  308. LOADCHROMA(0);
  309. PUTRGB24(dst_1, py_1, 0);
  310. PUTRGB24(dst_2, py_2, 0);
  311. LOADCHROMA(1);
  312. PUTRGB24(dst_2, py_2, 1);
  313. PUTRGB24(dst_1, py_1, 1);
  314. ENDYUV2RGBLINE(24, 1)
  315. LOADCHROMA(0);
  316. PUTRGB24(dst_1, py_1, 0);
  317. PUTRGB24(dst_2, py_2, 0);
  318. ENDYUV2RGBFUNC()
  319. // only trivial mods from yuv2rgb_c_24_rgb
  320. YUV2RGBFUNC(yuv2rgb_c_24_bgr, uint8_t, 0)
  321. LOADCHROMA(0);
  322. PUTBGR24(dst_1, py_1, 0);
  323. PUTBGR24(dst_2, py_2, 0);
  324. LOADCHROMA(1);
  325. PUTBGR24(dst_2, py_2, 1);
  326. PUTBGR24(dst_1, py_1, 1);
  327. LOADCHROMA(2);
  328. PUTBGR24(dst_1, py_1, 2);
  329. PUTBGR24(dst_2, py_2, 2);
  330. LOADCHROMA(3);
  331. PUTBGR24(dst_2, py_2, 3);
  332. PUTBGR24(dst_1, py_1, 3);
  333. ENDYUV2RGBLINE(24, 0)
  334. LOADCHROMA(0);
  335. PUTBGR24(dst_1, py_1, 0);
  336. PUTBGR24(dst_2, py_2, 0);
  337. LOADCHROMA(1);
  338. PUTBGR24(dst_2, py_2, 1);
  339. PUTBGR24(dst_1, py_1, 1);
  340. ENDYUV2RGBLINE(24, 1)
  341. LOADCHROMA(0);
  342. PUTBGR24(dst_1, py_1, 0);
  343. PUTBGR24(dst_2, py_2, 0);
  344. ENDYUV2RGBFUNC()
  345. // This is exactly the same code as yuv2rgb_c_32 except for the types of
  346. // r, g, b, dst_1, dst_2
  347. YUV2RGBFUNC(yuv2rgb_c_16, uint16_t, 0)
  348. LOADCHROMA(0);
  349. PUTRGB(dst_1, py_1, 0);
  350. PUTRGB(dst_2, py_2, 0);
  351. LOADCHROMA(1);
  352. PUTRGB(dst_2, py_2, 1);
  353. PUTRGB(dst_1, py_1, 1);
  354. LOADCHROMA(2);
  355. PUTRGB(dst_1, py_1, 2);
  356. PUTRGB(dst_2, py_2, 2);
  357. LOADCHROMA(3);
  358. PUTRGB(dst_2, py_2, 3);
  359. PUTRGB(dst_1, py_1, 3);
  360. CLOSEYUV2RGBFUNC(8)
  361. // r, g, b, dst_1, dst_2
  362. YUV2RGBFUNC(yuv2rgb_c_12_ordered_dither, uint16_t, 0)
  363. const uint8_t *d16 = ff_dither_4x4_16[y & 3];
  364. #define PUTRGB12(dst, src, i, o) \
  365. Y = src[2 * i]; \
  366. dst[2 * i] = r[Y + d16[0 + o]] + \
  367. g[Y + d16[0 + o]] + \
  368. b[Y + d16[0 + o]]; \
  369. Y = src[2 * i + 1]; \
  370. dst[2 * i + 1] = r[Y + d16[1 + o]] + \
  371. g[Y + d16[1 + o]] + \
  372. b[Y + d16[1 + o]];
  373. LOADCHROMA(0);
  374. PUTRGB12(dst_1, py_1, 0, 0);
  375. PUTRGB12(dst_2, py_2, 0, 0 + 8);
  376. LOADCHROMA(1);
  377. PUTRGB12(dst_2, py_2, 1, 2 + 8);
  378. PUTRGB12(dst_1, py_1, 1, 2);
  379. LOADCHROMA(2);
  380. PUTRGB12(dst_1, py_1, 2, 4);
  381. PUTRGB12(dst_2, py_2, 2, 4 + 8);
  382. LOADCHROMA(3);
  383. PUTRGB12(dst_2, py_2, 3, 6 + 8);
  384. PUTRGB12(dst_1, py_1, 3, 6);
  385. CLOSEYUV2RGBFUNC(8)
  386. // r, g, b, dst_1, dst_2
  387. YUV2RGBFUNC(yuv2rgb_c_8_ordered_dither, uint8_t, 0)
  388. const uint8_t *d32 = ff_dither_8x8_32[y & 7];
  389. const uint8_t *d64 = ff_dither_8x8_73[y & 7];
  390. #define PUTRGB8(dst, src, i, o) \
  391. Y = src[2 * i]; \
  392. dst[2 * i] = r[Y + d32[0 + o]] + \
  393. g[Y + d32[0 + o]] + \
  394. b[Y + d64[0 + o]]; \
  395. Y = src[2 * i + 1]; \
  396. dst[2 * i + 1] = r[Y + d32[1 + o]] + \
  397. g[Y + d32[1 + o]] + \
  398. b[Y + d64[1 + o]];
  399. LOADCHROMA(0);
  400. PUTRGB8(dst_1, py_1, 0, 0);
  401. PUTRGB8(dst_2, py_2, 0, 0 + 8);
  402. LOADCHROMA(1);
  403. PUTRGB8(dst_2, py_2, 1, 2 + 8);
  404. PUTRGB8(dst_1, py_1, 1, 2);
  405. LOADCHROMA(2);
  406. PUTRGB8(dst_1, py_1, 2, 4);
  407. PUTRGB8(dst_2, py_2, 2, 4 + 8);
  408. LOADCHROMA(3);
  409. PUTRGB8(dst_2, py_2, 3, 6 + 8);
  410. PUTRGB8(dst_1, py_1, 3, 6);
  411. CLOSEYUV2RGBFUNC(8)
  412. YUV2RGBFUNC(yuv2rgb_c_4_ordered_dither, uint8_t, 0)
  413. const uint8_t * d64 = ff_dither_8x8_73[y & 7];
  414. const uint8_t *d128 = ff_dither_8x8_220[y & 7];
  415. int acc;
  416. #define PUTRGB4D(dst, src, i, o) \
  417. Y = src[2 * i]; \
  418. acc = r[Y + d128[0 + o]] + \
  419. g[Y + d64[0 + o]] + \
  420. b[Y + d128[0 + o]]; \
  421. Y = src[2 * i + 1]; \
  422. acc |= (r[Y + d128[1 + o]] + \
  423. g[Y + d64[1 + o]] + \
  424. b[Y + d128[1 + o]]) << 4; \
  425. dst[i] = acc;
  426. LOADCHROMA(0);
  427. PUTRGB4D(dst_1, py_1, 0, 0);
  428. PUTRGB4D(dst_2, py_2, 0, 0 + 8);
  429. LOADCHROMA(1);
  430. PUTRGB4D(dst_2, py_2, 1, 2 + 8);
  431. PUTRGB4D(dst_1, py_1, 1, 2);
  432. LOADCHROMA(2);
  433. PUTRGB4D(dst_1, py_1, 2, 4);
  434. PUTRGB4D(dst_2, py_2, 2, 4 + 8);
  435. LOADCHROMA(3);
  436. PUTRGB4D(dst_2, py_2, 3, 6 + 8);
  437. PUTRGB4D(dst_1, py_1, 3, 6);
  438. CLOSEYUV2RGBFUNC(4)
  439. YUV2RGBFUNC(yuv2rgb_c_4b_ordered_dither, uint8_t, 0)
  440. const uint8_t *d64 = ff_dither_8x8_73[y & 7];
  441. const uint8_t *d128 = ff_dither_8x8_220[y & 7];
  442. #define PUTRGB4DB(dst, src, i, o) \
  443. Y = src[2 * i]; \
  444. dst[2 * i] = r[Y + d128[0 + o]] + \
  445. g[Y + d64[0 + o]] + \
  446. b[Y + d128[0 + o]]; \
  447. Y = src[2 * i + 1]; \
  448. dst[2 * i + 1] = r[Y + d128[1 + o]] + \
  449. g[Y + d64[1 + o]] + \
  450. b[Y + d128[1 + o]];
  451. LOADCHROMA(0);
  452. PUTRGB4DB(dst_1, py_1, 0, 0);
  453. PUTRGB4DB(dst_2, py_2, 0, 0 + 8);
  454. LOADCHROMA(1);
  455. PUTRGB4DB(dst_2, py_2, 1, 2 + 8);
  456. PUTRGB4DB(dst_1, py_1, 1, 2);
  457. LOADCHROMA(2);
  458. PUTRGB4DB(dst_1, py_1, 2, 4);
  459. PUTRGB4DB(dst_2, py_2, 2, 4 + 8);
  460. LOADCHROMA(3);
  461. PUTRGB4DB(dst_2, py_2, 3, 6 + 8);
  462. PUTRGB4DB(dst_1, py_1, 3, 6);
  463. CLOSEYUV2RGBFUNC(8)
  464. YUV2RGBFUNC(yuv2rgb_c_1_ordered_dither, uint8_t, 0)
  465. const uint8_t *d128 = ff_dither_8x8_220[y & 7];
  466. char out_1 = 0, out_2 = 0;
  467. g = c->table_gU[128] + c->table_gV[128];
  468. #define PUTRGB1(out, src, i, o) \
  469. Y = src[2 * i]; \
  470. out += out + g[Y + d128[0 + o]]; \
  471. Y = src[2 * i + 1]; \
  472. out += out + g[Y + d128[1 + o]];
  473. PUTRGB1(out_1, py_1, 0, 0);
  474. PUTRGB1(out_2, py_2, 0, 0 + 8);
  475. PUTRGB1(out_2, py_2, 1, 2 + 8);
  476. PUTRGB1(out_1, py_1, 1, 2);
  477. PUTRGB1(out_1, py_1, 2, 4);
  478. PUTRGB1(out_2, py_2, 2, 4 + 8);
  479. PUTRGB1(out_2, py_2, 3, 6 + 8);
  480. PUTRGB1(out_1, py_1, 3, 6);
  481. dst_1[0] = out_1;
  482. dst_2[0] = out_2;
  483. CLOSEYUV2RGBFUNC(1)
  484. SwsFunc ff_yuv2rgb_get_func_ptr(SwsContext *c)
  485. {
  486. SwsFunc t = NULL;
  487. if (ARCH_PPC)
  488. t = ff_yuv2rgb_init_ppc(c);
  489. if (ARCH_X86)
  490. t = ff_yuv2rgb_init_x86(c);
  491. if (t)
  492. return t;
  493. av_log(c, AV_LOG_WARNING,
  494. "No accelerated colorspace conversion found from %s to %s.\n",
  495. sws_format_name(c->srcFormat), sws_format_name(c->dstFormat));
  496. switch (c->dstFormat) {
  497. case AV_PIX_FMT_BGR48BE:
  498. case AV_PIX_FMT_BGR48LE:
  499. return yuv2rgb_c_bgr48;
  500. case AV_PIX_FMT_RGB48BE:
  501. case AV_PIX_FMT_RGB48LE:
  502. return yuv2rgb_c_48;
  503. case AV_PIX_FMT_ARGB:
  504. case AV_PIX_FMT_ABGR:
  505. if (CONFIG_SWSCALE_ALPHA && c->srcFormat == AV_PIX_FMT_YUVA420P)
  506. return yuva2argb_c;
  507. case AV_PIX_FMT_RGBA:
  508. case AV_PIX_FMT_BGRA:
  509. if (CONFIG_SWSCALE_ALPHA && c->srcFormat == AV_PIX_FMT_YUVA420P)
  510. return yuva2rgba_c;
  511. else
  512. return yuv2rgb_c_32;
  513. case AV_PIX_FMT_RGB24:
  514. return yuv2rgb_c_24_rgb;
  515. case AV_PIX_FMT_BGR24:
  516. return yuv2rgb_c_24_bgr;
  517. case AV_PIX_FMT_RGB565:
  518. case AV_PIX_FMT_BGR565:
  519. case AV_PIX_FMT_RGB555:
  520. case AV_PIX_FMT_BGR555:
  521. return yuv2rgb_c_16;
  522. case AV_PIX_FMT_RGB444:
  523. case AV_PIX_FMT_BGR444:
  524. return yuv2rgb_c_12_ordered_dither;
  525. case AV_PIX_FMT_RGB8:
  526. case AV_PIX_FMT_BGR8:
  527. return yuv2rgb_c_8_ordered_dither;
  528. case AV_PIX_FMT_RGB4:
  529. case AV_PIX_FMT_BGR4:
  530. return yuv2rgb_c_4_ordered_dither;
  531. case AV_PIX_FMT_RGB4_BYTE:
  532. case AV_PIX_FMT_BGR4_BYTE:
  533. return yuv2rgb_c_4b_ordered_dither;
  534. case AV_PIX_FMT_MONOBLACK:
  535. return yuv2rgb_c_1_ordered_dither;
  536. default:
  537. assert(0);
  538. }
  539. return NULL;
  540. }
  541. static void fill_table(uint8_t *table[256], const int elemsize,
  542. const int inc, void *y_tab)
  543. {
  544. int i;
  545. int64_t cb = 0;
  546. uint8_t *y_table = y_tab;
  547. y_table -= elemsize * (inc >> 9);
  548. for (i = 0; i < 256; i++) {
  549. table[i] = y_table + elemsize * (cb >> 16);
  550. cb += inc;
  551. }
  552. }
  553. static void fill_gv_table(int table[256], const int elemsize, const int inc)
  554. {
  555. int i;
  556. int64_t cb = 0;
  557. int off = -(inc >> 9);
  558. for (i = 0; i < 256; i++) {
  559. table[i] = elemsize * (off + (cb >> 16));
  560. cb += inc;
  561. }
  562. }
  563. static uint16_t roundToInt16(int64_t f)
  564. {
  565. int r = (f + (1 << 15)) >> 16;
  566. if (r < -0x7FFF)
  567. return 0x8000;
  568. else if (r > 0x7FFF)
  569. return 0x7FFF;
  570. else
  571. return r;
  572. }
  573. av_cold int ff_yuv2rgb_c_init_tables(SwsContext *c, const int inv_table[4],
  574. int fullRange, int brightness,
  575. int contrast, int saturation)
  576. {
  577. const int isRgb = c->dstFormat == AV_PIX_FMT_RGB32 ||
  578. c->dstFormat == AV_PIX_FMT_RGB32_1 ||
  579. c->dstFormat == AV_PIX_FMT_BGR24 ||
  580. c->dstFormat == AV_PIX_FMT_RGB565BE ||
  581. c->dstFormat == AV_PIX_FMT_RGB565LE ||
  582. c->dstFormat == AV_PIX_FMT_RGB555BE ||
  583. c->dstFormat == AV_PIX_FMT_RGB555LE ||
  584. c->dstFormat == AV_PIX_FMT_RGB444BE ||
  585. c->dstFormat == AV_PIX_FMT_RGB444LE ||
  586. c->dstFormat == AV_PIX_FMT_RGB8 ||
  587. c->dstFormat == AV_PIX_FMT_RGB4 ||
  588. c->dstFormat == AV_PIX_FMT_RGB4_BYTE ||
  589. c->dstFormat == AV_PIX_FMT_MONOBLACK;
  590. const int isNotNe = c->dstFormat == AV_PIX_FMT_NE(RGB565LE, RGB565BE) ||
  591. c->dstFormat == AV_PIX_FMT_NE(RGB555LE, RGB555BE) ||
  592. c->dstFormat == AV_PIX_FMT_NE(RGB444LE, RGB444BE) ||
  593. c->dstFormat == AV_PIX_FMT_NE(BGR565LE, BGR565BE) ||
  594. c->dstFormat == AV_PIX_FMT_NE(BGR555LE, BGR555BE) ||
  595. c->dstFormat == AV_PIX_FMT_NE(BGR444LE, BGR444BE);
  596. const int bpp = c->dstFormatBpp;
  597. uint8_t *y_table;
  598. uint16_t *y_table16;
  599. uint32_t *y_table32;
  600. int i, base, rbase, gbase, bbase, abase, needAlpha;
  601. const int yoffs = fullRange ? 384 : 326;
  602. int64_t crv = inv_table[0];
  603. int64_t cbu = inv_table[1];
  604. int64_t cgu = -inv_table[2];
  605. int64_t cgv = -inv_table[3];
  606. int64_t cy = 1 << 16;
  607. int64_t oy = 0;
  608. int64_t yb = 0;
  609. if (!fullRange) {
  610. cy = (cy * 255) / 219;
  611. oy = 16 << 16;
  612. } else {
  613. crv = (crv * 224) / 255;
  614. cbu = (cbu * 224) / 255;
  615. cgu = (cgu * 224) / 255;
  616. cgv = (cgv * 224) / 255;
  617. }
  618. cy = (cy * contrast) >> 16;
  619. crv = (crv * contrast * saturation) >> 32;
  620. cbu = (cbu * contrast * saturation) >> 32;
  621. cgu = (cgu * contrast * saturation) >> 32;
  622. cgv = (cgv * contrast * saturation) >> 32;
  623. oy -= 256 * brightness;
  624. c->uOffset = 0x0400040004000400LL;
  625. c->vOffset = 0x0400040004000400LL;
  626. c->yCoeff = roundToInt16(cy * 8192) * 0x0001000100010001ULL;
  627. c->vrCoeff = roundToInt16(crv * 8192) * 0x0001000100010001ULL;
  628. c->ubCoeff = roundToInt16(cbu * 8192) * 0x0001000100010001ULL;
  629. c->vgCoeff = roundToInt16(cgv * 8192) * 0x0001000100010001ULL;
  630. c->ugCoeff = roundToInt16(cgu * 8192) * 0x0001000100010001ULL;
  631. c->yOffset = roundToInt16(oy * 8) * 0x0001000100010001ULL;
  632. c->yuv2rgb_y_coeff = (int16_t)roundToInt16(cy << 13);
  633. c->yuv2rgb_y_offset = (int16_t)roundToInt16(oy << 9);
  634. c->yuv2rgb_v2r_coeff = (int16_t)roundToInt16(crv << 13);
  635. c->yuv2rgb_v2g_coeff = (int16_t)roundToInt16(cgv << 13);
  636. c->yuv2rgb_u2g_coeff = (int16_t)roundToInt16(cgu << 13);
  637. c->yuv2rgb_u2b_coeff = (int16_t)roundToInt16(cbu << 13);
  638. //scale coefficients by cy
  639. crv = ((crv << 16) + 0x8000) / cy;
  640. cbu = ((cbu << 16) + 0x8000) / cy;
  641. cgu = ((cgu << 16) + 0x8000) / cy;
  642. cgv = ((cgv << 16) + 0x8000) / cy;
  643. av_free(c->yuvTable);
  644. #define ALLOC_YUV_TABLE(x) \
  645. c->yuvTable = av_malloc(x); \
  646. if (!c->yuvTable) \
  647. return AVERROR(ENOMEM);
  648. switch (bpp) {
  649. case 1:
  650. ALLOC_YUV_TABLE(1024);
  651. y_table = c->yuvTable;
  652. yb = -(384 << 16) - oy;
  653. for (i = 0; i < 1024 - 110; i++) {
  654. y_table[i + 110] = av_clip_uint8((yb + 0x8000) >> 16) >> 7;
  655. yb += cy;
  656. }
  657. fill_table(c->table_gU, 1, cgu, y_table + yoffs);
  658. fill_gv_table(c->table_gV, 1, cgv);
  659. break;
  660. case 4:
  661. case 4 | 128:
  662. rbase = isRgb ? 3 : 0;
  663. gbase = 1;
  664. bbase = isRgb ? 0 : 3;
  665. ALLOC_YUV_TABLE(1024 * 3);
  666. y_table = c->yuvTable;
  667. yb = -(384 << 16) - oy;
  668. for (i = 0; i < 1024 - 110; i++) {
  669. int yval = av_clip_uint8((yb + 0x8000) >> 16);
  670. y_table[i + 110] = (yval >> 7) << rbase;
  671. y_table[i + 37 + 1024] = ((yval + 43) / 85) << gbase;
  672. y_table[i + 110 + 2048] = (yval >> 7) << bbase;
  673. yb += cy;
  674. }
  675. fill_table(c->table_rV, 1, crv, y_table + yoffs);
  676. fill_table(c->table_gU, 1, cgu, y_table + yoffs + 1024);
  677. fill_table(c->table_bU, 1, cbu, y_table + yoffs + 2048);
  678. fill_gv_table(c->table_gV, 1, cgv);
  679. break;
  680. case 8:
  681. rbase = isRgb ? 5 : 0;
  682. gbase = isRgb ? 2 : 3;
  683. bbase = isRgb ? 0 : 6;
  684. ALLOC_YUV_TABLE(1024 * 3);
  685. y_table = c->yuvTable;
  686. yb = -(384 << 16) - oy;
  687. for (i = 0; i < 1024 - 38; i++) {
  688. int yval = av_clip_uint8((yb + 0x8000) >> 16);
  689. y_table[i + 16] = ((yval + 18) / 36) << rbase;
  690. y_table[i + 16 + 1024] = ((yval + 18) / 36) << gbase;
  691. y_table[i + 37 + 2048] = ((yval + 43) / 85) << bbase;
  692. yb += cy;
  693. }
  694. fill_table(c->table_rV, 1, crv, y_table + yoffs);
  695. fill_table(c->table_gU, 1, cgu, y_table + yoffs + 1024);
  696. fill_table(c->table_bU, 1, cbu, y_table + yoffs + 2048);
  697. fill_gv_table(c->table_gV, 1, cgv);
  698. break;
  699. case 12:
  700. rbase = isRgb ? 8 : 0;
  701. gbase = 4;
  702. bbase = isRgb ? 0 : 8;
  703. ALLOC_YUV_TABLE(1024 * 3 * 2);
  704. y_table16 = c->yuvTable;
  705. yb = -(384 << 16) - oy;
  706. for (i = 0; i < 1024; i++) {
  707. uint8_t yval = av_clip_uint8((yb + 0x8000) >> 16);
  708. y_table16[i] = (yval >> 4) << rbase;
  709. y_table16[i + 1024] = (yval >> 4) << gbase;
  710. y_table16[i + 2048] = (yval >> 4) << bbase;
  711. yb += cy;
  712. }
  713. if (isNotNe)
  714. for (i = 0; i < 1024 * 3; i++)
  715. y_table16[i] = av_bswap16(y_table16[i]);
  716. fill_table(c->table_rV, 2, crv, y_table16 + yoffs);
  717. fill_table(c->table_gU, 2, cgu, y_table16 + yoffs + 1024);
  718. fill_table(c->table_bU, 2, cbu, y_table16 + yoffs + 2048);
  719. fill_gv_table(c->table_gV, 2, cgv);
  720. break;
  721. case 15:
  722. case 16:
  723. rbase = isRgb ? bpp - 5 : 0;
  724. gbase = 5;
  725. bbase = isRgb ? 0 : (bpp - 5);
  726. ALLOC_YUV_TABLE(1024 * 3 * 2);
  727. y_table16 = c->yuvTable;
  728. yb = -(384 << 16) - oy;
  729. for (i = 0; i < 1024; i++) {
  730. uint8_t yval = av_clip_uint8((yb + 0x8000) >> 16);
  731. y_table16[i] = (yval >> 3) << rbase;
  732. y_table16[i + 1024] = (yval >> (18 - bpp)) << gbase;
  733. y_table16[i + 2048] = (yval >> 3) << bbase;
  734. yb += cy;
  735. }
  736. if (isNotNe)
  737. for (i = 0; i < 1024 * 3; i++)
  738. y_table16[i] = av_bswap16(y_table16[i]);
  739. fill_table(c->table_rV, 2, crv, y_table16 + yoffs);
  740. fill_table(c->table_gU, 2, cgu, y_table16 + yoffs + 1024);
  741. fill_table(c->table_bU, 2, cbu, y_table16 + yoffs + 2048);
  742. fill_gv_table(c->table_gV, 2, cgv);
  743. break;
  744. case 24:
  745. case 48:
  746. ALLOC_YUV_TABLE(1024);
  747. y_table = c->yuvTable;
  748. yb = -(384 << 16) - oy;
  749. for (i = 0; i < 1024; i++) {
  750. y_table[i] = av_clip_uint8((yb + 0x8000) >> 16);
  751. yb += cy;
  752. }
  753. fill_table(c->table_rV, 1, crv, y_table + yoffs);
  754. fill_table(c->table_gU, 1, cgu, y_table + yoffs);
  755. fill_table(c->table_bU, 1, cbu, y_table + yoffs);
  756. fill_gv_table(c->table_gV, 1, cgv);
  757. break;
  758. case 32:
  759. base = (c->dstFormat == AV_PIX_FMT_RGB32_1 ||
  760. c->dstFormat == AV_PIX_FMT_BGR32_1) ? 8 : 0;
  761. rbase = base + (isRgb ? 16 : 0);
  762. gbase = base + 8;
  763. bbase = base + (isRgb ? 0 : 16);
  764. needAlpha = CONFIG_SWSCALE_ALPHA && isALPHA(c->srcFormat);
  765. if (!needAlpha)
  766. abase = (base + 24) & 31;
  767. ALLOC_YUV_TABLE(1024 * 3 * 4);
  768. y_table32 = c->yuvTable;
  769. yb = -(384 << 16) - oy;
  770. for (i = 0; i < 1024; i++) {
  771. unsigned yval = av_clip_uint8((yb + 0x8000) >> 16);
  772. y_table32[i] = (yval << rbase) +
  773. (needAlpha ? 0 : (255u << abase));
  774. y_table32[i + 1024] = yval << gbase;
  775. y_table32[i + 2048] = yval << bbase;
  776. yb += cy;
  777. }
  778. fill_table(c->table_rV, 4, crv, y_table32 + yoffs);
  779. fill_table(c->table_gU, 4, cgu, y_table32 + yoffs + 1024);
  780. fill_table(c->table_bU, 4, cbu, y_table32 + yoffs + 2048);
  781. fill_gv_table(c->table_gV, 4, cgv);
  782. break;
  783. default:
  784. c->yuvTable = NULL;
  785. if(!isPlanar(c->dstFormat) || bpp <= 24)
  786. av_log(c, AV_LOG_ERROR, "%ibpp not supported by yuv2rgb\n", bpp);
  787. return -1;
  788. }
  789. return 0;
  790. }