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.

1350 lines
55KB

  1. /*
  2. * Copyright (C) 2001-2011 Michael Niedermayer <michaelni@gmx.at>
  3. *
  4. * This file is part of FFmpeg.
  5. *
  6. * FFmpeg is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU Lesser General Public
  8. * License as published by the Free Software Foundation; either
  9. * version 2.1 of the License, or (at your option) any later version.
  10. *
  11. * FFmpeg is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14. * Lesser General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU Lesser General Public
  17. * License along with FFmpeg; if not, write to the Free Software
  18. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  19. */
  20. #include <inttypes.h>
  21. #include <string.h>
  22. #include <math.h>
  23. #include <stdio.h>
  24. #include "config.h"
  25. #include "swscale.h"
  26. #include "swscale_internal.h"
  27. #include "rgb2rgb.h"
  28. #include "libavutil/intreadwrite.h"
  29. #include "libavutil/cpu.h"
  30. #include "libavutil/avutil.h"
  31. #include "libavutil/mathematics.h"
  32. #include "libavutil/bswap.h"
  33. #include "libavutil/pixdesc.h"
  34. #include "libavutil/avassert.h"
  35. DECLARE_ALIGNED(8, const uint8_t, dithers)[8][8][8]={
  36. {
  37. { 0, 1, 0, 1, 0, 1, 0, 1,},
  38. { 1, 0, 1, 0, 1, 0, 1, 0,},
  39. { 0, 1, 0, 1, 0, 1, 0, 1,},
  40. { 1, 0, 1, 0, 1, 0, 1, 0,},
  41. { 0, 1, 0, 1, 0, 1, 0, 1,},
  42. { 1, 0, 1, 0, 1, 0, 1, 0,},
  43. { 0, 1, 0, 1, 0, 1, 0, 1,},
  44. { 1, 0, 1, 0, 1, 0, 1, 0,},
  45. },{
  46. { 1, 2, 1, 2, 1, 2, 1, 2,},
  47. { 3, 0, 3, 0, 3, 0, 3, 0,},
  48. { 1, 2, 1, 2, 1, 2, 1, 2,},
  49. { 3, 0, 3, 0, 3, 0, 3, 0,},
  50. { 1, 2, 1, 2, 1, 2, 1, 2,},
  51. { 3, 0, 3, 0, 3, 0, 3, 0,},
  52. { 1, 2, 1, 2, 1, 2, 1, 2,},
  53. { 3, 0, 3, 0, 3, 0, 3, 0,},
  54. },{
  55. { 2, 4, 3, 5, 2, 4, 3, 5,},
  56. { 6, 0, 7, 1, 6, 0, 7, 1,},
  57. { 3, 5, 2, 4, 3, 5, 2, 4,},
  58. { 7, 1, 6, 0, 7, 1, 6, 0,},
  59. { 2, 4, 3, 5, 2, 4, 3, 5,},
  60. { 6, 0, 7, 1, 6, 0, 7, 1,},
  61. { 3, 5, 2, 4, 3, 5, 2, 4,},
  62. { 7, 1, 6, 0, 7, 1, 6, 0,},
  63. },{
  64. { 4, 8, 7, 11, 4, 8, 7, 11,},
  65. { 12, 0, 15, 3, 12, 0, 15, 3,},
  66. { 6, 10, 5, 9, 6, 10, 5, 9,},
  67. { 14, 2, 13, 1, 14, 2, 13, 1,},
  68. { 4, 8, 7, 11, 4, 8, 7, 11,},
  69. { 12, 0, 15, 3, 12, 0, 15, 3,},
  70. { 6, 10, 5, 9, 6, 10, 5, 9,},
  71. { 14, 2, 13, 1, 14, 2, 13, 1,},
  72. },{
  73. { 9, 17, 15, 23, 8, 16, 14, 22,},
  74. { 25, 1, 31, 7, 24, 0, 30, 6,},
  75. { 13, 21, 11, 19, 12, 20, 10, 18,},
  76. { 29, 5, 27, 3, 28, 4, 26, 2,},
  77. { 8, 16, 14, 22, 9, 17, 15, 23,},
  78. { 24, 0, 30, 6, 25, 1, 31, 7,},
  79. { 12, 20, 10, 18, 13, 21, 11, 19,},
  80. { 28, 4, 26, 2, 29, 5, 27, 3,},
  81. },{
  82. { 18, 34, 30, 46, 17, 33, 29, 45,},
  83. { 50, 2, 62, 14, 49, 1, 61, 13,},
  84. { 26, 42, 22, 38, 25, 41, 21, 37,},
  85. { 58, 10, 54, 6, 57, 9, 53, 5,},
  86. { 16, 32, 28, 44, 19, 35, 31, 47,},
  87. { 48, 0, 60, 12, 51, 3, 63, 15,},
  88. { 24, 40, 20, 36, 27, 43, 23, 39,},
  89. { 56, 8, 52, 4, 59, 11, 55, 7,},
  90. },{
  91. { 18, 34, 30, 46, 17, 33, 29, 45,},
  92. { 50, 2, 62, 14, 49, 1, 61, 13,},
  93. { 26, 42, 22, 38, 25, 41, 21, 37,},
  94. { 58, 10, 54, 6, 57, 9, 53, 5,},
  95. { 16, 32, 28, 44, 19, 35, 31, 47,},
  96. { 48, 0, 60, 12, 51, 3, 63, 15,},
  97. { 24, 40, 20, 36, 27, 43, 23, 39,},
  98. { 56, 8, 52, 4, 59, 11, 55, 7,},
  99. },{
  100. { 36, 68, 60, 92, 34, 66, 58, 90,},
  101. { 100, 4,124, 28, 98, 2,122, 26,},
  102. { 52, 84, 44, 76, 50, 82, 42, 74,},
  103. { 116, 20,108, 12,114, 18,106, 10,},
  104. { 32, 64, 56, 88, 38, 70, 62, 94,},
  105. { 96, 0,120, 24,102, 6,126, 30,},
  106. { 48, 80, 40, 72, 54, 86, 46, 78,},
  107. { 112, 16,104, 8,118, 22,110, 14,},
  108. }};
  109. const uint16_t dither_scale[15][16]={
  110. { 2, 3, 3, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5,},
  111. { 2, 3, 7, 7, 13, 13, 25, 25, 25, 25, 25, 25, 25, 25, 25, 25,},
  112. { 3, 3, 4, 15, 15, 29, 57, 57, 57, 113, 113, 113, 113, 113, 113, 113,},
  113. { 3, 4, 4, 5, 31, 31, 61, 121, 241, 241, 241, 241, 481, 481, 481, 481,},
  114. { 3, 4, 5, 5, 6, 63, 63, 125, 249, 497, 993, 993, 993, 993, 993, 1985,},
  115. { 3, 5, 6, 6, 6, 7, 127, 127, 253, 505, 1009, 2017, 4033, 4033, 4033, 4033,},
  116. { 3, 5, 6, 7, 7, 7, 8, 255, 255, 509, 1017, 2033, 4065, 8129,16257,16257,},
  117. { 3, 5, 6, 8, 8, 8, 8, 9, 511, 511, 1021, 2041, 4081, 8161,16321,32641,},
  118. { 3, 5, 7, 8, 9, 9, 9, 9, 10, 1023, 1023, 2045, 4089, 8177,16353,32705,},
  119. { 3, 5, 7, 8, 10, 10, 10, 10, 10, 11, 2047, 2047, 4093, 8185,16369,32737,},
  120. { 3, 5, 7, 8, 10, 11, 11, 11, 11, 11, 12, 4095, 4095, 8189,16377,32753,},
  121. { 3, 5, 7, 9, 10, 12, 12, 12, 12, 12, 12, 13, 8191, 8191,16381,32761,},
  122. { 3, 5, 7, 9, 10, 12, 13, 13, 13, 13, 13, 13, 14,16383,16383,32765,},
  123. { 3, 5, 7, 9, 10, 12, 14, 14, 14, 14, 14, 14, 14, 15,32767,32767,},
  124. { 3, 5, 7, 9, 11, 12, 14, 15, 15, 15, 15, 15, 15, 15, 16,65535,},
  125. };
  126. static void fillPlane(uint8_t *plane, int stride, int width, int height, int y,
  127. uint8_t val)
  128. {
  129. int i;
  130. uint8_t *ptr = plane + stride * y;
  131. for (i = 0; i < height; i++) {
  132. memset(ptr, val, width);
  133. ptr += stride;
  134. }
  135. }
  136. static void copyPlane(const uint8_t *src, int srcStride,
  137. int srcSliceY, int srcSliceH, int width,
  138. uint8_t *dst, int dstStride)
  139. {
  140. dst += dstStride * srcSliceY;
  141. if (dstStride == srcStride && srcStride > 0) {
  142. memcpy(dst, src, srcSliceH * dstStride);
  143. } else {
  144. int i;
  145. for (i = 0; i < srcSliceH; i++) {
  146. memcpy(dst, src, width);
  147. src += srcStride;
  148. dst += dstStride;
  149. }
  150. }
  151. }
  152. static int planarToNv12Wrapper(SwsContext *c, const uint8_t *src[],
  153. int srcStride[], int srcSliceY,
  154. int srcSliceH, uint8_t *dstParam[],
  155. int dstStride[])
  156. {
  157. uint8_t *dst = dstParam[1] + dstStride[1] * srcSliceY / 2;
  158. copyPlane(src[0], srcStride[0], srcSliceY, srcSliceH, c->srcW,
  159. dstParam[0], dstStride[0]);
  160. if (c->dstFormat == AV_PIX_FMT_NV12)
  161. interleaveBytes(src[1], src[2], dst, c->srcW / 2, srcSliceH / 2,
  162. srcStride[1], srcStride[2], dstStride[0]);
  163. else
  164. interleaveBytes(src[2], src[1], dst, c->srcW / 2, srcSliceH / 2,
  165. srcStride[2], srcStride[1], dstStride[0]);
  166. return srcSliceH;
  167. }
  168. static int planarToYuy2Wrapper(SwsContext *c, const uint8_t *src[],
  169. int srcStride[], int srcSliceY, int srcSliceH,
  170. uint8_t *dstParam[], int dstStride[])
  171. {
  172. uint8_t *dst = dstParam[0] + dstStride[0] * srcSliceY;
  173. yv12toyuy2(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0],
  174. srcStride[1], dstStride[0]);
  175. return srcSliceH;
  176. }
  177. static int planarToUyvyWrapper(SwsContext *c, const uint8_t *src[],
  178. int srcStride[], int srcSliceY, int srcSliceH,
  179. uint8_t *dstParam[], int dstStride[])
  180. {
  181. uint8_t *dst = dstParam[0] + dstStride[0] * srcSliceY;
  182. yv12touyvy(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0],
  183. srcStride[1], dstStride[0]);
  184. return srcSliceH;
  185. }
  186. static int yuv422pToYuy2Wrapper(SwsContext *c, const uint8_t *src[],
  187. int srcStride[], int srcSliceY, int srcSliceH,
  188. uint8_t *dstParam[], int dstStride[])
  189. {
  190. uint8_t *dst = dstParam[0] + dstStride[0] * srcSliceY;
  191. yuv422ptoyuy2(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0],
  192. srcStride[1], dstStride[0]);
  193. return srcSliceH;
  194. }
  195. static int yuv422pToUyvyWrapper(SwsContext *c, const uint8_t *src[],
  196. int srcStride[], int srcSliceY, int srcSliceH,
  197. uint8_t *dstParam[], int dstStride[])
  198. {
  199. uint8_t *dst = dstParam[0] + dstStride[0] * srcSliceY;
  200. yuv422ptouyvy(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0],
  201. srcStride[1], dstStride[0]);
  202. return srcSliceH;
  203. }
  204. static int yuyvToYuv420Wrapper(SwsContext *c, const uint8_t *src[],
  205. int srcStride[], int srcSliceY, int srcSliceH,
  206. uint8_t *dstParam[], int dstStride[])
  207. {
  208. uint8_t *ydst = dstParam[0] + dstStride[0] * srcSliceY;
  209. uint8_t *udst = dstParam[1] + dstStride[1] * srcSliceY / 2;
  210. uint8_t *vdst = dstParam[2] + dstStride[2] * srcSliceY / 2;
  211. yuyvtoyuv420(ydst, udst, vdst, src[0], c->srcW, srcSliceH, dstStride[0],
  212. dstStride[1], srcStride[0]);
  213. if (dstParam[3])
  214. fillPlane(dstParam[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  215. return srcSliceH;
  216. }
  217. static int yuyvToYuv422Wrapper(SwsContext *c, const uint8_t *src[],
  218. int srcStride[], int srcSliceY, int srcSliceH,
  219. uint8_t *dstParam[], int dstStride[])
  220. {
  221. uint8_t *ydst = dstParam[0] + dstStride[0] * srcSliceY;
  222. uint8_t *udst = dstParam[1] + dstStride[1] * srcSliceY;
  223. uint8_t *vdst = dstParam[2] + dstStride[2] * srcSliceY;
  224. yuyvtoyuv422(ydst, udst, vdst, src[0], c->srcW, srcSliceH, dstStride[0],
  225. dstStride[1], srcStride[0]);
  226. return srcSliceH;
  227. }
  228. static int uyvyToYuv420Wrapper(SwsContext *c, const uint8_t *src[],
  229. int srcStride[], int srcSliceY, int srcSliceH,
  230. uint8_t *dstParam[], int dstStride[])
  231. {
  232. uint8_t *ydst = dstParam[0] + dstStride[0] * srcSliceY;
  233. uint8_t *udst = dstParam[1] + dstStride[1] * srcSliceY / 2;
  234. uint8_t *vdst = dstParam[2] + dstStride[2] * srcSliceY / 2;
  235. uyvytoyuv420(ydst, udst, vdst, src[0], c->srcW, srcSliceH, dstStride[0],
  236. dstStride[1], srcStride[0]);
  237. if (dstParam[3])
  238. fillPlane(dstParam[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  239. return srcSliceH;
  240. }
  241. static int uyvyToYuv422Wrapper(SwsContext *c, const uint8_t *src[],
  242. int srcStride[], int srcSliceY, int srcSliceH,
  243. uint8_t *dstParam[], int dstStride[])
  244. {
  245. uint8_t *ydst = dstParam[0] + dstStride[0] * srcSliceY;
  246. uint8_t *udst = dstParam[1] + dstStride[1] * srcSliceY;
  247. uint8_t *vdst = dstParam[2] + dstStride[2] * srcSliceY;
  248. uyvytoyuv422(ydst, udst, vdst, src[0], c->srcW, srcSliceH, dstStride[0],
  249. dstStride[1], srcStride[0]);
  250. return srcSliceH;
  251. }
  252. static void gray8aToPacked32(const uint8_t *src, uint8_t *dst, int num_pixels,
  253. const uint8_t *palette)
  254. {
  255. int i;
  256. for (i = 0; i < num_pixels; i++)
  257. ((uint32_t *) dst)[i] = ((const uint32_t *) palette)[src[i << 1]] | (src[(i << 1) + 1] << 24);
  258. }
  259. static void gray8aToPacked32_1(const uint8_t *src, uint8_t *dst, int num_pixels,
  260. const uint8_t *palette)
  261. {
  262. int i;
  263. for (i = 0; i < num_pixels; i++)
  264. ((uint32_t *) dst)[i] = ((const uint32_t *) palette)[src[i << 1]] | src[(i << 1) + 1];
  265. }
  266. static void gray8aToPacked24(const uint8_t *src, uint8_t *dst, int num_pixels,
  267. const uint8_t *palette)
  268. {
  269. int i;
  270. for (i = 0; i < num_pixels; i++) {
  271. //FIXME slow?
  272. dst[0] = palette[src[i << 1] * 4 + 0];
  273. dst[1] = palette[src[i << 1] * 4 + 1];
  274. dst[2] = palette[src[i << 1] * 4 + 2];
  275. dst += 3;
  276. }
  277. }
  278. static int packed_16bpc_bswap(SwsContext *c, const uint8_t *src[],
  279. int srcStride[], int srcSliceY, int srcSliceH,
  280. uint8_t *dst[], int dstStride[])
  281. {
  282. int i, j, p;
  283. for (p = 0; p < 4; p++) {
  284. int srcstr = srcStride[p] / 2;
  285. int dststr = dstStride[p] / 2;
  286. uint16_t *dstPtr = (uint16_t *) dst[p];
  287. const uint16_t *srcPtr = (const uint16_t *) src[p];
  288. int min_stride = FFMIN(FFABS(srcstr), FFABS(dststr));
  289. if(!dstPtr || !srcPtr)
  290. continue;
  291. for (i = 0; i < (srcSliceH >> c->chrDstVSubSample); i++) {
  292. for (j = 0; j < min_stride; j++) {
  293. dstPtr[j] = av_bswap16(srcPtr[j]);
  294. }
  295. srcPtr += srcstr;
  296. dstPtr += dststr;
  297. }
  298. }
  299. return srcSliceH;
  300. }
  301. static int palToRgbWrapper(SwsContext *c, const uint8_t *src[], int srcStride[],
  302. int srcSliceY, int srcSliceH, uint8_t *dst[],
  303. int dstStride[])
  304. {
  305. const enum AVPixelFormat srcFormat = c->srcFormat;
  306. const enum AVPixelFormat dstFormat = c->dstFormat;
  307. void (*conv)(const uint8_t *src, uint8_t *dst, int num_pixels,
  308. const uint8_t *palette) = NULL;
  309. int i;
  310. uint8_t *dstPtr = dst[0] + dstStride[0] * srcSliceY;
  311. const uint8_t *srcPtr = src[0];
  312. if (srcFormat == AV_PIX_FMT_GRAY8A) {
  313. switch (dstFormat) {
  314. case AV_PIX_FMT_RGB32 : conv = gray8aToPacked32; break;
  315. case AV_PIX_FMT_BGR32 : conv = gray8aToPacked32; break;
  316. case AV_PIX_FMT_BGR32_1: conv = gray8aToPacked32_1; break;
  317. case AV_PIX_FMT_RGB32_1: conv = gray8aToPacked32_1; break;
  318. case AV_PIX_FMT_RGB24 : conv = gray8aToPacked24; break;
  319. case AV_PIX_FMT_BGR24 : conv = gray8aToPacked24; break;
  320. }
  321. } else if (usePal(srcFormat)) {
  322. switch (dstFormat) {
  323. case AV_PIX_FMT_RGB32 : conv = sws_convertPalette8ToPacked32; break;
  324. case AV_PIX_FMT_BGR32 : conv = sws_convertPalette8ToPacked32; break;
  325. case AV_PIX_FMT_BGR32_1: conv = sws_convertPalette8ToPacked32; break;
  326. case AV_PIX_FMT_RGB32_1: conv = sws_convertPalette8ToPacked32; break;
  327. case AV_PIX_FMT_RGB24 : conv = sws_convertPalette8ToPacked24; break;
  328. case AV_PIX_FMT_BGR24 : conv = sws_convertPalette8ToPacked24; break;
  329. }
  330. }
  331. if (!conv)
  332. av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  333. av_get_pix_fmt_name(srcFormat), av_get_pix_fmt_name(dstFormat));
  334. else {
  335. for (i = 0; i < srcSliceH; i++) {
  336. conv(srcPtr, dstPtr, c->srcW, (uint8_t *) c->pal_rgb);
  337. srcPtr += srcStride[0];
  338. dstPtr += dstStride[0];
  339. }
  340. }
  341. return srcSliceH;
  342. }
  343. static void gbr16ptopacked16(const uint16_t *src[], int srcStride[],
  344. uint8_t *dst, int dstStride, int srcSliceH,
  345. int alpha, int swap, int bpp, int width)
  346. {
  347. int x, h, i;
  348. int scale_high = 16 - bpp, scale_low = (bpp - 8) * 2;
  349. for (h = 0; h < srcSliceH; h++) {
  350. uint16_t *dest = (uint16_t *)(dst + dstStride * h);
  351. uint16_t component;
  352. switch(swap) {
  353. case 3:
  354. if (alpha) {
  355. for (x = 0; x < width; x++) {
  356. component = av_bswap16(src[0][x]);
  357. *dest++ = av_bswap16(component << scale_high | component >> scale_low);
  358. component = av_bswap16(src[1][x]);
  359. *dest++ = av_bswap16(component << scale_high | component >> scale_low);
  360. component = av_bswap16(src[2][x]);
  361. *dest++ = av_bswap16(component << scale_high | component >> scale_low);
  362. *dest++ = 0xffff;
  363. }
  364. } else {
  365. for (x = 0; x < width; x++) {
  366. component = av_bswap16(src[0][x]);
  367. *dest++ = av_bswap16(component << scale_high | component >> scale_low);
  368. component = av_bswap16(src[1][x]);
  369. *dest++ = av_bswap16(component << scale_high | component >> scale_low);
  370. component = av_bswap16(src[2][x]);
  371. *dest++ = av_bswap16(component << scale_high | component >> scale_low);
  372. }
  373. }
  374. break;
  375. case 2:
  376. if (alpha) {
  377. for (x = 0; x < width; x++) {
  378. *dest++ = av_bswap16(src[0][x] << scale_high | src[0][x] >> scale_low);
  379. *dest++ = av_bswap16(src[1][x] << scale_high | src[1][x] >> scale_low);
  380. *dest++ = av_bswap16(src[2][x] << scale_high | src[2][x] >> scale_low);
  381. *dest++ = 0xffff;
  382. }
  383. } else {
  384. for (x = 0; x < width; x++) {
  385. *dest++ = av_bswap16(src[0][x] << scale_high | src[0][x] >> scale_low);
  386. *dest++ = av_bswap16(src[1][x] << scale_high | src[1][x] >> scale_low);
  387. *dest++ = av_bswap16(src[2][x] << scale_high | src[2][x] >> scale_low);
  388. }
  389. }
  390. break;
  391. case 1:
  392. if (alpha) {
  393. for (x = 0; x < width; x++) {
  394. *dest++ = av_bswap16(src[0][x]) << scale_high | av_bswap16(src[0][x]) >> scale_low;
  395. *dest++ = av_bswap16(src[1][x]) << scale_high | av_bswap16(src[1][x]) >> scale_low;
  396. *dest++ = av_bswap16(src[2][x]) << scale_high | av_bswap16(src[2][x]) >> scale_low;
  397. *dest++ = 0xffff;
  398. }
  399. } else {
  400. for (x = 0; x < width; x++) {
  401. *dest++ = av_bswap16(src[0][x]) << scale_high | av_bswap16(src[0][x]) >> scale_low;
  402. *dest++ = av_bswap16(src[1][x]) << scale_high | av_bswap16(src[1][x]) >> scale_low;
  403. *dest++ = av_bswap16(src[2][x]) << scale_high | av_bswap16(src[2][x]) >> scale_low;
  404. }
  405. }
  406. break;
  407. default:
  408. if (alpha) {
  409. for (x = 0; x < width; x++) {
  410. *dest++ = src[0][x] << scale_high | src[0][x] >> scale_low;
  411. *dest++ = src[1][x] << scale_high | src[1][x] >> scale_low;
  412. *dest++ = src[2][x] << scale_high | src[2][x] >> scale_low;
  413. *dest++ = 0xffff;
  414. }
  415. } else {
  416. for (x = 0; x < width; x++) {
  417. *dest++ = src[0][x] << scale_high | src[0][x] >> scale_low;
  418. *dest++ = src[1][x] << scale_high | src[1][x] >> scale_low;
  419. *dest++ = src[2][x] << scale_high | src[2][x] >> scale_low;
  420. }
  421. }
  422. }
  423. for (i = 0; i < 3; i++)
  424. src[i] += srcStride[i] >> 1;
  425. }
  426. }
  427. static int planarRgb16ToRgb16Wrapper(SwsContext *c, const uint8_t *src[],
  428. int srcStride[], int srcSliceY, int srcSliceH,
  429. uint8_t *dst[], int dstStride[])
  430. {
  431. const uint16_t *src102[] = { (uint16_t *)src[1], (uint16_t *)src[0], (uint16_t *)src[2] };
  432. const uint16_t *src201[] = { (uint16_t *)src[2], (uint16_t *)src[0], (uint16_t *)src[1] };
  433. int stride102[] = { srcStride[1], srcStride[0], srcStride[2] };
  434. int stride201[] = { srcStride[2], srcStride[0], srcStride[1] };
  435. const AVPixFmtDescriptor *src_format = av_pix_fmt_desc_get(c->srcFormat);
  436. const AVPixFmtDescriptor *dst_format = av_pix_fmt_desc_get(c->dstFormat);
  437. int bits_per_sample = src_format->comp[0].depth_minus1 + 1;
  438. int swap = 0;
  439. if ( HAVE_BIGENDIAN && !(src_format->flags & AV_PIX_FMT_FLAG_BE) ||
  440. !HAVE_BIGENDIAN && src_format->flags & AV_PIX_FMT_FLAG_BE)
  441. swap++;
  442. if ( HAVE_BIGENDIAN && !(dst_format->flags & AV_PIX_FMT_FLAG_BE) ||
  443. !HAVE_BIGENDIAN && dst_format->flags & AV_PIX_FMT_FLAG_BE)
  444. swap += 2;
  445. if ((src_format->flags & (AV_PIX_FMT_FLAG_PLANAR | AV_PIX_FMT_FLAG_RGB)) !=
  446. (AV_PIX_FMT_FLAG_PLANAR | AV_PIX_FMT_FLAG_RGB)) {
  447. av_log(c, AV_LOG_ERROR, "unsupported planar RGB conversion %s -> %s\n",
  448. src_format->name, dst_format->name);
  449. return srcSliceH;
  450. }
  451. switch (c->dstFormat) {
  452. case AV_PIX_FMT_BGR48LE:
  453. case AV_PIX_FMT_BGR48BE:
  454. gbr16ptopacked16(src102, stride102,
  455. dst[0] + srcSliceY * dstStride[0], dstStride[0],
  456. srcSliceH, 0, swap, bits_per_sample, c->srcW);
  457. break;
  458. case AV_PIX_FMT_RGB48LE:
  459. case AV_PIX_FMT_RGB48BE:
  460. gbr16ptopacked16(src201, stride201,
  461. dst[0] + srcSliceY * dstStride[0], dstStride[0],
  462. srcSliceH, 0, swap, bits_per_sample, c->srcW);
  463. break;
  464. case AV_PIX_FMT_RGBA64LE:
  465. case AV_PIX_FMT_RGBA64BE:
  466. gbr16ptopacked16(src201, stride201,
  467. dst[0] + srcSliceY * dstStride[0], dstStride[0],
  468. srcSliceH, 1, swap, bits_per_sample, c->srcW);
  469. break;
  470. case AV_PIX_FMT_BGRA64LE:
  471. case AV_PIX_FMT_BGRA64BE:
  472. gbr16ptopacked16(src102, stride102,
  473. dst[0] + srcSliceY * dstStride[0], dstStride[0],
  474. srcSliceH, 1, swap, bits_per_sample, c->srcW);
  475. break;
  476. default:
  477. av_log(c, AV_LOG_ERROR,
  478. "unsupported planar RGB conversion %s -> %s\n",
  479. src_format->name, dst_format->name);
  480. }
  481. return srcSliceH;
  482. }
  483. static void gbr24ptopacked24(const uint8_t *src[], int srcStride[],
  484. uint8_t *dst, int dstStride, int srcSliceH,
  485. int width)
  486. {
  487. int x, h, i;
  488. for (h = 0; h < srcSliceH; h++) {
  489. uint8_t *dest = dst + dstStride * h;
  490. for (x = 0; x < width; x++) {
  491. *dest++ = src[0][x];
  492. *dest++ = src[1][x];
  493. *dest++ = src[2][x];
  494. }
  495. for (i = 0; i < 3; i++)
  496. src[i] += srcStride[i];
  497. }
  498. }
  499. static void gbr24ptopacked32(const uint8_t *src[], int srcStride[],
  500. uint8_t *dst, int dstStride, int srcSliceH,
  501. int alpha_first, int width)
  502. {
  503. int x, h, i;
  504. for (h = 0; h < srcSliceH; h++) {
  505. uint8_t *dest = dst + dstStride * h;
  506. if (alpha_first) {
  507. for (x = 0; x < width; x++) {
  508. *dest++ = 0xff;
  509. *dest++ = src[0][x];
  510. *dest++ = src[1][x];
  511. *dest++ = src[2][x];
  512. }
  513. } else {
  514. for (x = 0; x < width; x++) {
  515. *dest++ = src[0][x];
  516. *dest++ = src[1][x];
  517. *dest++ = src[2][x];
  518. *dest++ = 0xff;
  519. }
  520. }
  521. for (i = 0; i < 3; i++)
  522. src[i] += srcStride[i];
  523. }
  524. }
  525. static int planarRgbToRgbWrapper(SwsContext *c, const uint8_t *src[],
  526. int srcStride[], int srcSliceY, int srcSliceH,
  527. uint8_t *dst[], int dstStride[])
  528. {
  529. int alpha_first = 0;
  530. const uint8_t *src102[] = { src[1], src[0], src[2] };
  531. const uint8_t *src201[] = { src[2], src[0], src[1] };
  532. int stride102[] = { srcStride[1], srcStride[0], srcStride[2] };
  533. int stride201[] = { srcStride[2], srcStride[0], srcStride[1] };
  534. if (c->srcFormat != AV_PIX_FMT_GBRP) {
  535. av_log(c, AV_LOG_ERROR, "unsupported planar RGB conversion %s -> %s\n",
  536. av_get_pix_fmt_name(c->srcFormat),
  537. av_get_pix_fmt_name(c->dstFormat));
  538. return srcSliceH;
  539. }
  540. switch (c->dstFormat) {
  541. case AV_PIX_FMT_BGR24:
  542. gbr24ptopacked24(src102, stride102,
  543. dst[0] + srcSliceY * dstStride[0], dstStride[0],
  544. srcSliceH, c->srcW);
  545. break;
  546. case AV_PIX_FMT_RGB24:
  547. gbr24ptopacked24(src201, stride201,
  548. dst[0] + srcSliceY * dstStride[0], dstStride[0],
  549. srcSliceH, c->srcW);
  550. break;
  551. case AV_PIX_FMT_ARGB:
  552. alpha_first = 1;
  553. case AV_PIX_FMT_RGBA:
  554. gbr24ptopacked32(src201, stride201,
  555. dst[0] + srcSliceY * dstStride[0], dstStride[0],
  556. srcSliceH, alpha_first, c->srcW);
  557. break;
  558. case AV_PIX_FMT_ABGR:
  559. alpha_first = 1;
  560. case AV_PIX_FMT_BGRA:
  561. gbr24ptopacked32(src102, stride102,
  562. dst[0] + srcSliceY * dstStride[0], dstStride[0],
  563. srcSliceH, alpha_first, c->srcW);
  564. break;
  565. default:
  566. av_log(c, AV_LOG_ERROR,
  567. "unsupported planar RGB conversion %s -> %s\n",
  568. av_get_pix_fmt_name(c->srcFormat),
  569. av_get_pix_fmt_name(c->dstFormat));
  570. }
  571. return srcSliceH;
  572. }
  573. static int planarRgbToplanarRgbWrapper(SwsContext *c, const uint8_t *src[],
  574. int srcStride[], int srcSliceY, int srcSliceH,
  575. uint8_t *dst[], int dstStride[])
  576. {
  577. copyPlane(src[0], srcStride[0], srcSliceY, srcSliceH, c->srcW,
  578. dst[0], dstStride[0]);
  579. copyPlane(src[1], srcStride[1], srcSliceY, srcSliceH, c->srcW,
  580. dst[1], dstStride[1]);
  581. copyPlane(src[2], srcStride[2], srcSliceY, srcSliceH, c->srcW,
  582. dst[2], dstStride[2]);
  583. if (dst[3])
  584. fillPlane(dst[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  585. return srcSliceH;
  586. }
  587. static void packedtogbr24p(const uint8_t *src, int srcStride,
  588. uint8_t *dst[], int dstStride[], int srcSliceH,
  589. int alpha_first, int inc_size, int width)
  590. {
  591. uint8_t *dest[3];
  592. int x, h;
  593. dest[0] = dst[0];
  594. dest[1] = dst[1];
  595. dest[2] = dst[2];
  596. if (alpha_first)
  597. src++;
  598. for (h = 0; h < srcSliceH; h++) {
  599. for (x = 0; x < width; x++) {
  600. dest[0][x] = src[0];
  601. dest[1][x] = src[1];
  602. dest[2][x] = src[2];
  603. src += inc_size;
  604. }
  605. src += srcStride - width * inc_size;
  606. dest[0] += dstStride[0];
  607. dest[1] += dstStride[1];
  608. dest[2] += dstStride[2];
  609. }
  610. }
  611. static int rgbToPlanarRgbWrapper(SwsContext *c, const uint8_t *src[],
  612. int srcStride[], int srcSliceY, int srcSliceH,
  613. uint8_t *dst[], int dstStride[])
  614. {
  615. int alpha_first = 0;
  616. int stride102[] = { dstStride[1], dstStride[0], dstStride[2] };
  617. int stride201[] = { dstStride[2], dstStride[0], dstStride[1] };
  618. uint8_t *dst102[] = { dst[1] + srcSliceY * dstStride[1],
  619. dst[0] + srcSliceY * dstStride[0],
  620. dst[2] + srcSliceY * dstStride[2] };
  621. uint8_t *dst201[] = { dst[2] + srcSliceY * dstStride[2],
  622. dst[0] + srcSliceY * dstStride[0],
  623. dst[1] + srcSliceY * dstStride[1] };
  624. switch (c->srcFormat) {
  625. case AV_PIX_FMT_RGB24:
  626. packedtogbr24p((const uint8_t *) src[0], srcStride[0], dst201,
  627. stride201, srcSliceH, alpha_first, 3, c->srcW);
  628. break;
  629. case AV_PIX_FMT_BGR24:
  630. packedtogbr24p((const uint8_t *) src[0], srcStride[0], dst102,
  631. stride102, srcSliceH, alpha_first, 3, c->srcW);
  632. break;
  633. case AV_PIX_FMT_ARGB:
  634. alpha_first = 1;
  635. case AV_PIX_FMT_RGBA:
  636. packedtogbr24p((const uint8_t *) src[0], srcStride[0], dst201,
  637. stride201, srcSliceH, alpha_first, 4, c->srcW);
  638. break;
  639. case AV_PIX_FMT_ABGR:
  640. alpha_first = 1;
  641. case AV_PIX_FMT_BGRA:
  642. packedtogbr24p((const uint8_t *) src[0], srcStride[0], dst102,
  643. stride102, srcSliceH, alpha_first, 4, c->srcW);
  644. break;
  645. default:
  646. av_log(c, AV_LOG_ERROR,
  647. "unsupported planar RGB conversion %s -> %s\n",
  648. av_get_pix_fmt_name(c->srcFormat),
  649. av_get_pix_fmt_name(c->dstFormat));
  650. }
  651. return srcSliceH;
  652. }
  653. #define isRGBA32(x) ( \
  654. (x) == AV_PIX_FMT_ARGB \
  655. || (x) == AV_PIX_FMT_RGBA \
  656. || (x) == AV_PIX_FMT_BGRA \
  657. || (x) == AV_PIX_FMT_ABGR \
  658. )
  659. #define isRGBA64(x) ( \
  660. (x) == AV_PIX_FMT_RGBA64LE \
  661. || (x) == AV_PIX_FMT_RGBA64BE \
  662. || (x) == AV_PIX_FMT_BGRA64LE \
  663. || (x) == AV_PIX_FMT_BGRA64BE \
  664. )
  665. #define isRGB48(x) ( \
  666. (x) == AV_PIX_FMT_RGB48LE \
  667. || (x) == AV_PIX_FMT_RGB48BE \
  668. || (x) == AV_PIX_FMT_BGR48LE \
  669. || (x) == AV_PIX_FMT_BGR48BE \
  670. )
  671. /* {RGB,BGR}{15,16,24,32,32_1} -> {RGB,BGR}{15,16,24,32} */
  672. typedef void (* rgbConvFn) (const uint8_t *, uint8_t *, int);
  673. static rgbConvFn findRgbConvFn(SwsContext *c)
  674. {
  675. const enum AVPixelFormat srcFormat = c->srcFormat;
  676. const enum AVPixelFormat dstFormat = c->dstFormat;
  677. const int srcId = c->srcFormatBpp;
  678. const int dstId = c->dstFormatBpp;
  679. rgbConvFn conv = NULL;
  680. #define IS_NOT_NE(bpp, desc) \
  681. (((bpp + 7) >> 3) == 2 && \
  682. (!(desc->flags & AV_PIX_FMT_FLAG_BE) != !HAVE_BIGENDIAN))
  683. #define CONV_IS(src, dst) (srcFormat == AV_PIX_FMT_##src && dstFormat == AV_PIX_FMT_##dst)
  684. if (isRGBA32(srcFormat) && isRGBA32(dstFormat)) {
  685. if ( CONV_IS(ABGR, RGBA)
  686. || CONV_IS(ARGB, BGRA)
  687. || CONV_IS(BGRA, ARGB)
  688. || CONV_IS(RGBA, ABGR)) conv = shuffle_bytes_3210;
  689. else if (CONV_IS(ABGR, ARGB)
  690. || CONV_IS(ARGB, ABGR)) conv = shuffle_bytes_0321;
  691. else if (CONV_IS(ABGR, BGRA)
  692. || CONV_IS(ARGB, RGBA)) conv = shuffle_bytes_1230;
  693. else if (CONV_IS(BGRA, RGBA)
  694. || CONV_IS(RGBA, BGRA)) conv = shuffle_bytes_2103;
  695. else if (CONV_IS(BGRA, ABGR)
  696. || CONV_IS(RGBA, ARGB)) conv = shuffle_bytes_3012;
  697. } else if (isRGB48(srcFormat) && isRGB48(dstFormat)) {
  698. if (CONV_IS(RGB48LE, BGR48LE)
  699. || CONV_IS(BGR48LE, RGB48LE)
  700. || CONV_IS(RGB48BE, BGR48BE)
  701. || CONV_IS(BGR48BE, RGB48BE)) conv = rgb48tobgr48_nobswap;
  702. else if (CONV_IS(RGB48LE, BGR48BE)
  703. || CONV_IS(BGR48LE, RGB48BE)
  704. || CONV_IS(RGB48BE, BGR48LE)
  705. || CONV_IS(BGR48BE, RGB48LE)) conv = rgb48tobgr48_bswap;
  706. } else if (isRGBA64(srcFormat) && isRGB48(dstFormat)) {
  707. if (CONV_IS(RGBA64LE, BGR48LE)
  708. || CONV_IS(BGRA64LE, RGB48LE)
  709. || CONV_IS(RGBA64BE, BGR48BE)
  710. || CONV_IS(BGRA64BE, RGB48BE)) conv = rgb64tobgr48_nobswap;
  711. else if (CONV_IS(RGBA64LE, BGR48BE)
  712. || CONV_IS(BGRA64LE, RGB48BE)
  713. || CONV_IS(RGBA64BE, BGR48LE)
  714. || CONV_IS(BGRA64BE, RGB48LE)) conv = rgb64tobgr48_bswap;
  715. else if (CONV_IS(RGBA64LE, RGB48LE)
  716. || CONV_IS(BGRA64LE, BGR48LE)
  717. || CONV_IS(RGBA64BE, RGB48BE)
  718. || CONV_IS(BGRA64BE, BGR48BE)) conv = rgb64to48_nobswap;
  719. else if (CONV_IS(RGBA64LE, RGB48BE)
  720. || CONV_IS(BGRA64LE, BGR48BE)
  721. || CONV_IS(RGBA64BE, RGB48LE)
  722. || CONV_IS(BGRA64BE, BGR48LE)) conv = rgb64to48_bswap;
  723. } else
  724. /* BGR -> BGR */
  725. if ((isBGRinInt(srcFormat) && isBGRinInt(dstFormat)) ||
  726. (isRGBinInt(srcFormat) && isRGBinInt(dstFormat))) {
  727. switch (srcId | (dstId << 16)) {
  728. case 0x000F000C: conv = rgb12to15; break;
  729. case 0x000F0010: conv = rgb16to15; break;
  730. case 0x000F0018: conv = rgb24to15; break;
  731. case 0x000F0020: conv = rgb32to15; break;
  732. case 0x0010000F: conv = rgb15to16; break;
  733. case 0x00100018: conv = rgb24to16; break;
  734. case 0x00100020: conv = rgb32to16; break;
  735. case 0x0018000F: conv = rgb15to24; break;
  736. case 0x00180010: conv = rgb16to24; break;
  737. case 0x00180020: conv = rgb32to24; break;
  738. case 0x0020000F: conv = rgb15to32; break;
  739. case 0x00200010: conv = rgb16to32; break;
  740. case 0x00200018: conv = rgb24to32; break;
  741. }
  742. } else if ((isBGRinInt(srcFormat) && isRGBinInt(dstFormat)) ||
  743. (isRGBinInt(srcFormat) && isBGRinInt(dstFormat))) {
  744. switch (srcId | (dstId << 16)) {
  745. case 0x000C000C: conv = rgb12tobgr12; break;
  746. case 0x000F000F: conv = rgb15tobgr15; break;
  747. case 0x000F0010: conv = rgb16tobgr15; break;
  748. case 0x000F0018: conv = rgb24tobgr15; break;
  749. case 0x000F0020: conv = rgb32tobgr15; break;
  750. case 0x0010000F: conv = rgb15tobgr16; break;
  751. case 0x00100010: conv = rgb16tobgr16; break;
  752. case 0x00100018: conv = rgb24tobgr16; break;
  753. case 0x00100020: conv = rgb32tobgr16; break;
  754. case 0x0018000F: conv = rgb15tobgr24; break;
  755. case 0x00180010: conv = rgb16tobgr24; break;
  756. case 0x00180018: conv = rgb24tobgr24; break;
  757. case 0x00180020: conv = rgb32tobgr24; break;
  758. case 0x0020000F: conv = rgb15tobgr32; break;
  759. case 0x00200010: conv = rgb16tobgr32; break;
  760. case 0x00200018: conv = rgb24tobgr32; break;
  761. }
  762. }
  763. if ((dstFormat == AV_PIX_FMT_RGB32_1 || dstFormat == AV_PIX_FMT_BGR32_1) && !isRGBA32(srcFormat) && ALT32_CORR<0)
  764. return NULL;
  765. return conv;
  766. }
  767. /* {RGB,BGR}{15,16,24,32,32_1} -> {RGB,BGR}{15,16,24,32} */
  768. static int rgbToRgbWrapper(SwsContext *c, const uint8_t *src[], int srcStride[],
  769. int srcSliceY, int srcSliceH, uint8_t *dst[],
  770. int dstStride[])
  771. {
  772. const enum AVPixelFormat srcFormat = c->srcFormat;
  773. const enum AVPixelFormat dstFormat = c->dstFormat;
  774. const AVPixFmtDescriptor *desc_src = av_pix_fmt_desc_get(c->srcFormat);
  775. const AVPixFmtDescriptor *desc_dst = av_pix_fmt_desc_get(c->dstFormat);
  776. const int srcBpp = (c->srcFormatBpp + 7) >> 3;
  777. const int dstBpp = (c->dstFormatBpp + 7) >> 3;
  778. rgbConvFn conv = findRgbConvFn(c);
  779. if (!conv) {
  780. av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  781. av_get_pix_fmt_name(srcFormat), av_get_pix_fmt_name(dstFormat));
  782. } else {
  783. const uint8_t *srcPtr = src[0];
  784. uint8_t *dstPtr = dst[0];
  785. int src_bswap = IS_NOT_NE(c->srcFormatBpp, desc_src);
  786. int dst_bswap = IS_NOT_NE(c->dstFormatBpp, desc_dst);
  787. if ((srcFormat == AV_PIX_FMT_RGB32_1 || srcFormat == AV_PIX_FMT_BGR32_1) &&
  788. !isRGBA32(dstFormat))
  789. srcPtr += ALT32_CORR;
  790. if ((dstFormat == AV_PIX_FMT_RGB32_1 || dstFormat == AV_PIX_FMT_BGR32_1) &&
  791. !isRGBA32(srcFormat))
  792. dstPtr += ALT32_CORR;
  793. if (dstStride[0] * srcBpp == srcStride[0] * dstBpp && srcStride[0] > 0 &&
  794. !(srcStride[0] % srcBpp) && !dst_bswap && !src_bswap)
  795. conv(srcPtr, dstPtr + dstStride[0] * srcSliceY,
  796. srcSliceH * srcStride[0]);
  797. else {
  798. int i, j;
  799. dstPtr += dstStride[0] * srcSliceY;
  800. for (i = 0; i < srcSliceH; i++) {
  801. if(src_bswap) {
  802. for(j=0; j<c->srcW; j++)
  803. ((uint16_t*)c->formatConvBuffer)[j] = av_bswap16(((uint16_t*)srcPtr)[j]);
  804. conv(c->formatConvBuffer, dstPtr, c->srcW * srcBpp);
  805. }else
  806. conv(srcPtr, dstPtr, c->srcW * srcBpp);
  807. if(dst_bswap)
  808. for(j=0; j<c->srcW; j++)
  809. ((uint16_t*)dstPtr)[j] = av_bswap16(((uint16_t*)dstPtr)[j]);
  810. srcPtr += srcStride[0];
  811. dstPtr += dstStride[0];
  812. }
  813. }
  814. }
  815. return srcSliceH;
  816. }
  817. static int bgr24ToYv12Wrapper(SwsContext *c, const uint8_t *src[],
  818. int srcStride[], int srcSliceY, int srcSliceH,
  819. uint8_t *dst[], int dstStride[])
  820. {
  821. ff_rgb24toyv12(
  822. src[0],
  823. dst[0] + srcSliceY * dstStride[0],
  824. dst[1] + (srcSliceY >> 1) * dstStride[1],
  825. dst[2] + (srcSliceY >> 1) * dstStride[2],
  826. c->srcW, srcSliceH,
  827. dstStride[0], dstStride[1], srcStride[0],
  828. c->input_rgb2yuv_table);
  829. if (dst[3])
  830. fillPlane(dst[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  831. return srcSliceH;
  832. }
  833. static int yvu9ToYv12Wrapper(SwsContext *c, const uint8_t *src[],
  834. int srcStride[], int srcSliceY, int srcSliceH,
  835. uint8_t *dst[], int dstStride[])
  836. {
  837. copyPlane(src[0], srcStride[0], srcSliceY, srcSliceH, c->srcW,
  838. dst[0], dstStride[0]);
  839. planar2x(src[1], dst[1] + dstStride[1] * (srcSliceY >> 1), c->chrSrcW,
  840. srcSliceH >> 2, srcStride[1], dstStride[1]);
  841. planar2x(src[2], dst[2] + dstStride[2] * (srcSliceY >> 1), c->chrSrcW,
  842. srcSliceH >> 2, srcStride[2], dstStride[2]);
  843. if (dst[3])
  844. fillPlane(dst[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  845. return srcSliceH;
  846. }
  847. /* unscaled copy like stuff (assumes nearly identical formats) */
  848. static int packedCopyWrapper(SwsContext *c, const uint8_t *src[],
  849. int srcStride[], int srcSliceY, int srcSliceH,
  850. uint8_t *dst[], int dstStride[])
  851. {
  852. if (dstStride[0] == srcStride[0] && srcStride[0] > 0)
  853. memcpy(dst[0] + dstStride[0] * srcSliceY, src[0], srcSliceH * dstStride[0]);
  854. else {
  855. int i;
  856. const uint8_t *srcPtr = src[0];
  857. uint8_t *dstPtr = dst[0] + dstStride[0] * srcSliceY;
  858. int length = 0;
  859. /* universal length finder */
  860. while (length + c->srcW <= FFABS(dstStride[0]) &&
  861. length + c->srcW <= FFABS(srcStride[0]))
  862. length += c->srcW;
  863. av_assert1(length != 0);
  864. for (i = 0; i < srcSliceH; i++) {
  865. memcpy(dstPtr, srcPtr, length);
  866. srcPtr += srcStride[0];
  867. dstPtr += dstStride[0];
  868. }
  869. }
  870. return srcSliceH;
  871. }
  872. #define DITHER_COPY(dst, dstStride, src, srcStride, bswap, dbswap)\
  873. uint16_t scale= dither_scale[dst_depth-1][src_depth-1];\
  874. int shift= src_depth-dst_depth + dither_scale[src_depth-2][dst_depth-1];\
  875. for (i = 0; i < height; i++) {\
  876. const uint8_t *dither= dithers[src_depth-9][i&7];\
  877. for (j = 0; j < length-7; j+=8){\
  878. dst[j+0] = dbswap((bswap(src[j+0]) + dither[0])*scale>>shift);\
  879. dst[j+1] = dbswap((bswap(src[j+1]) + dither[1])*scale>>shift);\
  880. dst[j+2] = dbswap((bswap(src[j+2]) + dither[2])*scale>>shift);\
  881. dst[j+3] = dbswap((bswap(src[j+3]) + dither[3])*scale>>shift);\
  882. dst[j+4] = dbswap((bswap(src[j+4]) + dither[4])*scale>>shift);\
  883. dst[j+5] = dbswap((bswap(src[j+5]) + dither[5])*scale>>shift);\
  884. dst[j+6] = dbswap((bswap(src[j+6]) + dither[6])*scale>>shift);\
  885. dst[j+7] = dbswap((bswap(src[j+7]) + dither[7])*scale>>shift);\
  886. }\
  887. for (; j < length; j++)\
  888. dst[j] = dbswap((bswap(src[j]) + dither[j&7])*scale>>shift);\
  889. dst += dstStride;\
  890. src += srcStride;\
  891. }
  892. static int planarCopyWrapper(SwsContext *c, const uint8_t *src[],
  893. int srcStride[], int srcSliceY, int srcSliceH,
  894. uint8_t *dst[], int dstStride[])
  895. {
  896. const AVPixFmtDescriptor *desc_src = av_pix_fmt_desc_get(c->srcFormat);
  897. const AVPixFmtDescriptor *desc_dst = av_pix_fmt_desc_get(c->dstFormat);
  898. int plane, i, j;
  899. for (plane = 0; plane < 4; plane++) {
  900. int length = (plane == 0 || plane == 3) ? c->srcW : FF_CEIL_RSHIFT(c->srcW, c->chrDstHSubSample);
  901. int y = (plane == 0 || plane == 3) ? srcSliceY: FF_CEIL_RSHIFT(srcSliceY, c->chrDstVSubSample);
  902. int height = (plane == 0 || plane == 3) ? srcSliceH: FF_CEIL_RSHIFT(srcSliceH, c->chrDstVSubSample);
  903. const uint8_t *srcPtr = src[plane];
  904. uint8_t *dstPtr = dst[plane] + dstStride[plane] * y;
  905. int shiftonly= plane==1 || plane==2 || (!c->srcRange && plane==0);
  906. if (!dst[plane])
  907. continue;
  908. // ignore palette for GRAY8
  909. if (plane == 1 && !dst[2]) continue;
  910. if (!src[plane] || (plane == 1 && !src[2])) {
  911. if (is16BPS(c->dstFormat) || isNBPS(c->dstFormat)) {
  912. fillPlane16(dst[plane], dstStride[plane], length, height, y,
  913. plane == 3, desc_dst->comp[plane].depth_minus1,
  914. isBE(c->dstFormat));
  915. } else {
  916. fillPlane(dst[plane], dstStride[plane], length, height, y,
  917. (plane == 3) ? 255 : 128);
  918. }
  919. } else {
  920. if(isNBPS(c->srcFormat) || isNBPS(c->dstFormat)
  921. || (is16BPS(c->srcFormat) != is16BPS(c->dstFormat))
  922. ) {
  923. const int src_depth = desc_src->comp[plane].depth_minus1 + 1;
  924. const int dst_depth = desc_dst->comp[plane].depth_minus1 + 1;
  925. const uint16_t *srcPtr2 = (const uint16_t *) srcPtr;
  926. uint16_t *dstPtr2 = (uint16_t*)dstPtr;
  927. if (dst_depth == 8) {
  928. if(isBE(c->srcFormat) == HAVE_BIGENDIAN){
  929. DITHER_COPY(dstPtr, dstStride[plane], srcPtr2, srcStride[plane]/2, , )
  930. } else {
  931. DITHER_COPY(dstPtr, dstStride[plane], srcPtr2, srcStride[plane]/2, av_bswap16, )
  932. }
  933. } else if (src_depth == 8) {
  934. for (i = 0; i < height; i++) {
  935. #define COPY816(w)\
  936. if(shiftonly){\
  937. for (j = 0; j < length; j++)\
  938. w(&dstPtr2[j], srcPtr[j]<<(dst_depth-8));\
  939. }else{\
  940. for (j = 0; j < length; j++)\
  941. w(&dstPtr2[j], (srcPtr[j]<<(dst_depth-8)) |\
  942. (srcPtr[j]>>(2*8-dst_depth)));\
  943. }
  944. if(isBE(c->dstFormat)){
  945. COPY816(AV_WB16)
  946. } else {
  947. COPY816(AV_WL16)
  948. }
  949. dstPtr2 += dstStride[plane]/2;
  950. srcPtr += srcStride[plane];
  951. }
  952. } else if (src_depth <= dst_depth) {
  953. int orig_length = length;
  954. for (i = 0; i < height; i++) {
  955. if(isBE(c->srcFormat) == HAVE_BIGENDIAN &&
  956. isBE(c->dstFormat) == HAVE_BIGENDIAN &&
  957. shiftonly) {
  958. unsigned shift = dst_depth - src_depth;
  959. length = orig_length;
  960. #if HAVE_FAST_64BIT
  961. #define FAST_COPY_UP(shift) \
  962. for (j = 0; j < length - 3; j += 4) { \
  963. uint64_t v = AV_RN64A(srcPtr2 + j); \
  964. AV_WN64A(dstPtr2 + j, v << shift); \
  965. } \
  966. length &= 3;
  967. #else
  968. #define FAST_COPY_UP(shift) \
  969. for (j = 0; j < length - 1; j += 2) { \
  970. uint32_t v = AV_RN32A(srcPtr2 + j); \
  971. AV_WN32A(dstPtr2 + j, v << shift); \
  972. } \
  973. length &= 1;
  974. #endif
  975. switch (shift)
  976. {
  977. case 6: FAST_COPY_UP(6); break;
  978. case 7: FAST_COPY_UP(7); break;
  979. }
  980. }
  981. #define COPY_UP(r,w) \
  982. if(shiftonly){\
  983. for (j = 0; j < length; j++){ \
  984. unsigned int v= r(&srcPtr2[j]);\
  985. w(&dstPtr2[j], v<<(dst_depth-src_depth));\
  986. }\
  987. }else{\
  988. for (j = 0; j < length; j++){ \
  989. unsigned int v= r(&srcPtr2[j]);\
  990. w(&dstPtr2[j], (v<<(dst_depth-src_depth)) | \
  991. (v>>(2*src_depth-dst_depth)));\
  992. }\
  993. }
  994. if(isBE(c->srcFormat)){
  995. if(isBE(c->dstFormat)){
  996. COPY_UP(AV_RB16, AV_WB16)
  997. } else {
  998. COPY_UP(AV_RB16, AV_WL16)
  999. }
  1000. } else {
  1001. if(isBE(c->dstFormat)){
  1002. COPY_UP(AV_RL16, AV_WB16)
  1003. } else {
  1004. COPY_UP(AV_RL16, AV_WL16)
  1005. }
  1006. }
  1007. dstPtr2 += dstStride[plane]/2;
  1008. srcPtr2 += srcStride[plane]/2;
  1009. }
  1010. } else {
  1011. if(isBE(c->srcFormat) == HAVE_BIGENDIAN){
  1012. if(isBE(c->dstFormat) == HAVE_BIGENDIAN){
  1013. DITHER_COPY(dstPtr2, dstStride[plane]/2, srcPtr2, srcStride[plane]/2, , )
  1014. } else {
  1015. DITHER_COPY(dstPtr2, dstStride[plane]/2, srcPtr2, srcStride[plane]/2, , av_bswap16)
  1016. }
  1017. }else{
  1018. if(isBE(c->dstFormat) == HAVE_BIGENDIAN){
  1019. DITHER_COPY(dstPtr2, dstStride[plane]/2, srcPtr2, srcStride[plane]/2, av_bswap16, )
  1020. } else {
  1021. DITHER_COPY(dstPtr2, dstStride[plane]/2, srcPtr2, srcStride[plane]/2, av_bswap16, av_bswap16)
  1022. }
  1023. }
  1024. }
  1025. } else if (is16BPS(c->srcFormat) && is16BPS(c->dstFormat) &&
  1026. isBE(c->srcFormat) != isBE(c->dstFormat)) {
  1027. for (i = 0; i < height; i++) {
  1028. for (j = 0; j < length; j++)
  1029. ((uint16_t *) dstPtr)[j] = av_bswap16(((const uint16_t *) srcPtr)[j]);
  1030. srcPtr += srcStride[plane];
  1031. dstPtr += dstStride[plane];
  1032. }
  1033. } else if (dstStride[plane] == srcStride[plane] &&
  1034. srcStride[plane] > 0 && srcStride[plane] == length) {
  1035. memcpy(dst[plane] + dstStride[plane] * y, src[plane],
  1036. height * dstStride[plane]);
  1037. } else {
  1038. if (is16BPS(c->srcFormat) && is16BPS(c->dstFormat))
  1039. length *= 2;
  1040. else if (!desc_src->comp[0].depth_minus1)
  1041. length >>= 3; // monowhite/black
  1042. for (i = 0; i < height; i++) {
  1043. memcpy(dstPtr, srcPtr, length);
  1044. srcPtr += srcStride[plane];
  1045. dstPtr += dstStride[plane];
  1046. }
  1047. }
  1048. }
  1049. }
  1050. return srcSliceH;
  1051. }
  1052. #define IS_DIFFERENT_ENDIANESS(src_fmt, dst_fmt, pix_fmt) \
  1053. ((src_fmt == pix_fmt ## BE && dst_fmt == pix_fmt ## LE) || \
  1054. (src_fmt == pix_fmt ## LE && dst_fmt == pix_fmt ## BE))
  1055. void ff_get_unscaled_swscale(SwsContext *c)
  1056. {
  1057. const enum AVPixelFormat srcFormat = c->srcFormat;
  1058. const enum AVPixelFormat dstFormat = c->dstFormat;
  1059. const int flags = c->flags;
  1060. const int dstH = c->dstH;
  1061. int needsDither;
  1062. needsDither = isAnyRGB(dstFormat) &&
  1063. c->dstFormatBpp < 24 &&
  1064. (c->dstFormatBpp < c->srcFormatBpp || (!isAnyRGB(srcFormat)));
  1065. /* yv12_to_nv12 */
  1066. if ((srcFormat == AV_PIX_FMT_YUV420P || srcFormat == AV_PIX_FMT_YUVA420P) &&
  1067. (dstFormat == AV_PIX_FMT_NV12 || dstFormat == AV_PIX_FMT_NV21)) {
  1068. c->swScale = planarToNv12Wrapper;
  1069. }
  1070. /* yuv2bgr */
  1071. if ((srcFormat == AV_PIX_FMT_YUV420P || srcFormat == AV_PIX_FMT_YUV422P ||
  1072. srcFormat == AV_PIX_FMT_YUVA420P) && isAnyRGB(dstFormat) &&
  1073. !(flags & (SWS_ACCURATE_RND|SWS_ERROR_DIFFUSION)) && !(dstH & 1)) {
  1074. c->swScale = ff_yuv2rgb_get_func_ptr(c);
  1075. }
  1076. if (srcFormat == AV_PIX_FMT_YUV410P &&
  1077. (dstFormat == AV_PIX_FMT_YUV420P || dstFormat == AV_PIX_FMT_YUVA420P) &&
  1078. !(flags & SWS_BITEXACT)) {
  1079. c->swScale = yvu9ToYv12Wrapper;
  1080. }
  1081. /* bgr24toYV12 */
  1082. if (srcFormat == AV_PIX_FMT_BGR24 &&
  1083. (dstFormat == AV_PIX_FMT_YUV420P || dstFormat == AV_PIX_FMT_YUVA420P) &&
  1084. !(flags & SWS_ACCURATE_RND))
  1085. c->swScale = bgr24ToYv12Wrapper;
  1086. /* RGB/BGR -> RGB/BGR (no dither needed forms) */
  1087. if (isAnyRGB(srcFormat) && isAnyRGB(dstFormat) && findRgbConvFn(c)
  1088. && (!needsDither || (c->flags&(SWS_FAST_BILINEAR|SWS_POINT))))
  1089. c->swScale= rgbToRgbWrapper;
  1090. if ((srcFormat == AV_PIX_FMT_GBRP && dstFormat == AV_PIX_FMT_GBRAP) ||
  1091. (srcFormat == AV_PIX_FMT_GBRAP && dstFormat == AV_PIX_FMT_GBRP))
  1092. c->swScale = planarRgbToplanarRgbWrapper;
  1093. #define isByteRGB(f) ( \
  1094. f == AV_PIX_FMT_RGB32 || \
  1095. f == AV_PIX_FMT_RGB32_1 || \
  1096. f == AV_PIX_FMT_RGB24 || \
  1097. f == AV_PIX_FMT_BGR32 || \
  1098. f == AV_PIX_FMT_BGR32_1 || \
  1099. f == AV_PIX_FMT_BGR24)
  1100. if (srcFormat == AV_PIX_FMT_GBRP && isPlanar(srcFormat) && isByteRGB(dstFormat))
  1101. c->swScale = planarRgbToRgbWrapper;
  1102. if ((srcFormat == AV_PIX_FMT_GBRP9LE || srcFormat == AV_PIX_FMT_GBRP9BE ||
  1103. srcFormat == AV_PIX_FMT_GBRP16LE || srcFormat == AV_PIX_FMT_GBRP16BE ||
  1104. srcFormat == AV_PIX_FMT_GBRP10LE || srcFormat == AV_PIX_FMT_GBRP10BE ||
  1105. srcFormat == AV_PIX_FMT_GBRP12LE || srcFormat == AV_PIX_FMT_GBRP12BE ||
  1106. srcFormat == AV_PIX_FMT_GBRP14LE || srcFormat == AV_PIX_FMT_GBRP14BE) &&
  1107. (dstFormat == AV_PIX_FMT_RGB48LE || dstFormat == AV_PIX_FMT_RGB48BE ||
  1108. dstFormat == AV_PIX_FMT_BGR48LE || dstFormat == AV_PIX_FMT_BGR48BE ||
  1109. dstFormat == AV_PIX_FMT_RGBA64LE || dstFormat == AV_PIX_FMT_RGBA64BE ||
  1110. dstFormat == AV_PIX_FMT_BGRA64LE || dstFormat == AV_PIX_FMT_BGRA64BE))
  1111. c->swScale = planarRgb16ToRgb16Wrapper;
  1112. if (av_pix_fmt_desc_get(srcFormat)->comp[0].depth_minus1 == 7 &&
  1113. isPackedRGB(srcFormat) && dstFormat == AV_PIX_FMT_GBRP)
  1114. c->swScale = rgbToPlanarRgbWrapper;
  1115. /* bswap 16 bits per pixel/component packed formats */
  1116. if (IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_BGR444) ||
  1117. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_BGR48) ||
  1118. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_BGRA64) ||
  1119. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_BGR555) ||
  1120. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_BGR565) ||
  1121. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_GRAY16) ||
  1122. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_GBRP9) ||
  1123. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_GBRP10) ||
  1124. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_GBRP12) ||
  1125. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_GBRP14) ||
  1126. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_GBRP16) ||
  1127. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_GBRAP16) ||
  1128. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_RGB444) ||
  1129. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_RGB48) ||
  1130. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_RGBA64) ||
  1131. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_RGB555) ||
  1132. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_RGB565) ||
  1133. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_XYZ12) ||
  1134. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV420P9) ||
  1135. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV420P10) ||
  1136. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV420P12) ||
  1137. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV420P14) ||
  1138. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV420P16) ||
  1139. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV422P9) ||
  1140. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV422P10) ||
  1141. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV422P12) ||
  1142. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV422P14) ||
  1143. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV422P16) ||
  1144. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV444P9) ||
  1145. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV444P10) ||
  1146. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV444P12) ||
  1147. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV444P14) ||
  1148. IS_DIFFERENT_ENDIANESS(srcFormat, dstFormat, AV_PIX_FMT_YUV444P16))
  1149. c->swScale = packed_16bpc_bswap;
  1150. if (usePal(srcFormat) && isByteRGB(dstFormat))
  1151. c->swScale = palToRgbWrapper;
  1152. if (srcFormat == AV_PIX_FMT_YUV422P) {
  1153. if (dstFormat == AV_PIX_FMT_YUYV422)
  1154. c->swScale = yuv422pToYuy2Wrapper;
  1155. else if (dstFormat == AV_PIX_FMT_UYVY422)
  1156. c->swScale = yuv422pToUyvyWrapper;
  1157. }
  1158. /* LQ converters if -sws 0 or -sws 4*/
  1159. if (c->flags&(SWS_FAST_BILINEAR|SWS_POINT)) {
  1160. /* yv12_to_yuy2 */
  1161. if (srcFormat == AV_PIX_FMT_YUV420P || srcFormat == AV_PIX_FMT_YUVA420P) {
  1162. if (dstFormat == AV_PIX_FMT_YUYV422)
  1163. c->swScale = planarToYuy2Wrapper;
  1164. else if (dstFormat == AV_PIX_FMT_UYVY422)
  1165. c->swScale = planarToUyvyWrapper;
  1166. }
  1167. }
  1168. if (srcFormat == AV_PIX_FMT_YUYV422 &&
  1169. (dstFormat == AV_PIX_FMT_YUV420P || dstFormat == AV_PIX_FMT_YUVA420P))
  1170. c->swScale = yuyvToYuv420Wrapper;
  1171. if (srcFormat == AV_PIX_FMT_UYVY422 &&
  1172. (dstFormat == AV_PIX_FMT_YUV420P || dstFormat == AV_PIX_FMT_YUVA420P))
  1173. c->swScale = uyvyToYuv420Wrapper;
  1174. if (srcFormat == AV_PIX_FMT_YUYV422 && dstFormat == AV_PIX_FMT_YUV422P)
  1175. c->swScale = yuyvToYuv422Wrapper;
  1176. if (srcFormat == AV_PIX_FMT_UYVY422 && dstFormat == AV_PIX_FMT_YUV422P)
  1177. c->swScale = uyvyToYuv422Wrapper;
  1178. #define isPlanarGray(x) (isGray(x) && (x) != AV_PIX_FMT_GRAY8A)
  1179. /* simple copy */
  1180. if ( srcFormat == dstFormat ||
  1181. (srcFormat == AV_PIX_FMT_YUVA420P && dstFormat == AV_PIX_FMT_YUV420P) ||
  1182. (srcFormat == AV_PIX_FMT_YUV420P && dstFormat == AV_PIX_FMT_YUVA420P) ||
  1183. (isPlanarYUV(srcFormat) && isPlanarGray(dstFormat)) ||
  1184. (isPlanarYUV(dstFormat) && isPlanarGray(srcFormat)) ||
  1185. (isPlanarGray(dstFormat) && isPlanarGray(srcFormat)) ||
  1186. (isPlanarYUV(srcFormat) && isPlanarYUV(dstFormat) &&
  1187. c->chrDstHSubSample == c->chrSrcHSubSample &&
  1188. c->chrDstVSubSample == c->chrSrcVSubSample &&
  1189. dstFormat != AV_PIX_FMT_NV12 && dstFormat != AV_PIX_FMT_NV21 &&
  1190. srcFormat != AV_PIX_FMT_NV12 && srcFormat != AV_PIX_FMT_NV21))
  1191. {
  1192. if (isPacked(c->srcFormat))
  1193. c->swScale = packedCopyWrapper;
  1194. else /* Planar YUV or gray */
  1195. c->swScale = planarCopyWrapper;
  1196. }
  1197. if (ARCH_BFIN)
  1198. ff_bfin_get_unscaled_swscale(c);
  1199. if (HAVE_ALTIVEC)
  1200. ff_swscale_get_unscaled_altivec(c);
  1201. }
  1202. /* Convert the palette to the same packed 32-bit format as the palette */
  1203. void sws_convertPalette8ToPacked32(const uint8_t *src, uint8_t *dst,
  1204. int num_pixels, const uint8_t *palette)
  1205. {
  1206. int i;
  1207. for (i = 0; i < num_pixels; i++)
  1208. ((uint32_t *) dst)[i] = ((const uint32_t *) palette)[src[i]];
  1209. }
  1210. /* Palette format: ABCD -> dst format: ABC */
  1211. void sws_convertPalette8ToPacked24(const uint8_t *src, uint8_t *dst,
  1212. int num_pixels, const uint8_t *palette)
  1213. {
  1214. int i;
  1215. for (i = 0; i < num_pixels; i++) {
  1216. //FIXME slow?
  1217. dst[0] = palette[src[i] * 4 + 0];
  1218. dst[1] = palette[src[i] * 4 + 1];
  1219. dst[2] = palette[src[i] * 4 + 2];
  1220. dst += 3;
  1221. }
  1222. }