swscale_unscaled.c 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849
  1. /*
  2. * Copyright (C) 2001-2003 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 <assert.h>
  26. #include "swscale.h"
  27. #include "swscale_internal.h"
  28. #include "rgb2rgb.h"
  29. #include "libavutil/intreadwrite.h"
  30. #include "libavutil/cpu.h"
  31. #include "libavutil/avutil.h"
  32. #include "libavutil/mathematics.h"
  33. #include "libavutil/bswap.h"
  34. #include "libavutil/pixdesc.h"
  35. #define RGB2YUV_SHIFT 15
  36. #define BY ( (int)(0.114*219/255*(1<<RGB2YUV_SHIFT)+0.5))
  37. #define BV (-(int)(0.081*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  38. #define BU ( (int)(0.500*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  39. #define GY ( (int)(0.587*219/255*(1<<RGB2YUV_SHIFT)+0.5))
  40. #define GV (-(int)(0.419*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  41. #define GU (-(int)(0.331*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  42. #define RY ( (int)(0.299*219/255*(1<<RGB2YUV_SHIFT)+0.5))
  43. #define RV ( (int)(0.500*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  44. #define RU (-(int)(0.169*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  45. static void fillPlane(uint8_t* plane, int stride, int width, int height, int y, uint8_t val)
  46. {
  47. int i;
  48. uint8_t *ptr = plane + stride*y;
  49. for (i=0; i<height; i++) {
  50. memset(ptr, val, width);
  51. ptr += stride;
  52. }
  53. }
  54. static void copyPlane(const uint8_t *src, int srcStride,
  55. int srcSliceY, int srcSliceH, int width,
  56. uint8_t *dst, int dstStride)
  57. {
  58. dst += dstStride * srcSliceY;
  59. if (dstStride == srcStride && srcStride > 0) {
  60. memcpy(dst, src, srcSliceH * dstStride);
  61. } else {
  62. int i;
  63. for (i=0; i<srcSliceH; i++) {
  64. memcpy(dst, src, width);
  65. src += srcStride;
  66. dst += dstStride;
  67. }
  68. }
  69. }
  70. static int planarToNv12Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  71. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  72. {
  73. uint8_t *dst = dstParam[1] + dstStride[1]*srcSliceY/2;
  74. copyPlane(src[0], srcStride[0], srcSliceY, srcSliceH, c->srcW,
  75. dstParam[0], dstStride[0]);
  76. if (c->dstFormat == PIX_FMT_NV12)
  77. interleaveBytes(src[1], src[2], dst, c->srcW/2, srcSliceH/2, srcStride[1], srcStride[2], dstStride[0]);
  78. else
  79. interleaveBytes(src[2], src[1], dst, c->srcW/2, srcSliceH/2, srcStride[2], srcStride[1], dstStride[0]);
  80. return srcSliceH;
  81. }
  82. static int planarToYuy2Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  83. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  84. {
  85. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  86. yv12toyuy2(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0], srcStride[1], dstStride[0]);
  87. return srcSliceH;
  88. }
  89. static int planarToUyvyWrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  90. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  91. {
  92. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  93. yv12touyvy(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0], srcStride[1], dstStride[0]);
  94. return srcSliceH;
  95. }
  96. static int yuv422pToYuy2Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  97. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  98. {
  99. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  100. yuv422ptoyuy2(src[0],src[1],src[2],dst,c->srcW,srcSliceH,srcStride[0],srcStride[1],dstStride[0]);
  101. return srcSliceH;
  102. }
  103. static int yuv422pToUyvyWrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  104. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  105. {
  106. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  107. yuv422ptouyvy(src[0],src[1],src[2],dst,c->srcW,srcSliceH,srcStride[0],srcStride[1],dstStride[0]);
  108. return srcSliceH;
  109. }
  110. static int yuyvToYuv420Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  111. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  112. {
  113. uint8_t *ydst=dstParam[0] + dstStride[0]*srcSliceY;
  114. uint8_t *udst=dstParam[1] + dstStride[1]*srcSliceY/2;
  115. uint8_t *vdst=dstParam[2] + dstStride[2]*srcSliceY/2;
  116. yuyvtoyuv420(ydst, udst, vdst, src[0], c->srcW, srcSliceH, dstStride[0], dstStride[1], srcStride[0]);
  117. if (dstParam[3])
  118. fillPlane(dstParam[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  119. return srcSliceH;
  120. }
  121. static int yuyvToYuv422Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  122. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  123. {
  124. uint8_t *ydst=dstParam[0] + dstStride[0]*srcSliceY;
  125. uint8_t *udst=dstParam[1] + dstStride[1]*srcSliceY;
  126. uint8_t *vdst=dstParam[2] + dstStride[2]*srcSliceY;
  127. yuyvtoyuv422(ydst, udst, vdst, src[0], c->srcW, srcSliceH, dstStride[0], dstStride[1], srcStride[0]);
  128. return srcSliceH;
  129. }
  130. static int uyvyToYuv420Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  131. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  132. {
  133. uint8_t *ydst=dstParam[0] + dstStride[0]*srcSliceY;
  134. uint8_t *udst=dstParam[1] + dstStride[1]*srcSliceY/2;
  135. uint8_t *vdst=dstParam[2] + dstStride[2]*srcSliceY/2;
  136. uyvytoyuv420(ydst, udst, vdst, src[0], c->srcW, srcSliceH, dstStride[0], dstStride[1], srcStride[0]);
  137. if (dstParam[3])
  138. fillPlane(dstParam[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  139. return srcSliceH;
  140. }
  141. static int uyvyToYuv422Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  142. int srcSliceH, uint8_t* dstParam[], int dstStride[])
  143. {
  144. uint8_t *ydst=dstParam[0] + dstStride[0]*srcSliceY;
  145. uint8_t *udst=dstParam[1] + dstStride[1]*srcSliceY;
  146. uint8_t *vdst=dstParam[2] + dstStride[2]*srcSliceY;
  147. uyvytoyuv422(ydst, udst, vdst, src[0], c->srcW, srcSliceH, dstStride[0], dstStride[1], srcStride[0]);
  148. return srcSliceH;
  149. }
  150. static void gray8aToPacked32(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette)
  151. {
  152. int i;
  153. for (i=0; i<num_pixels; i++)
  154. ((uint32_t *) dst)[i] = ((const uint32_t *)palette)[src[i<<1]] | (src[(i<<1)+1] << 24);
  155. }
  156. static void gray8aToPacked32_1(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette)
  157. {
  158. int i;
  159. for (i=0; i<num_pixels; i++)
  160. ((uint32_t *) dst)[i] = ((const uint32_t *)palette)[src[i<<1]] | src[(i<<1)+1];
  161. }
  162. static void gray8aToPacked24(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette)
  163. {
  164. int i;
  165. for (i=0; i<num_pixels; i++) {
  166. //FIXME slow?
  167. dst[0]= palette[src[i<<1]*4+0];
  168. dst[1]= palette[src[i<<1]*4+1];
  169. dst[2]= palette[src[i<<1]*4+2];
  170. dst+= 3;
  171. }
  172. }
  173. static int palToRgbWrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  174. int srcSliceH, uint8_t* dst[], int dstStride[])
  175. {
  176. const enum PixelFormat srcFormat= c->srcFormat;
  177. const enum PixelFormat dstFormat= c->dstFormat;
  178. void (*conv)(const uint8_t *src, uint8_t *dst, long num_pixels,
  179. const uint8_t *palette)=NULL;
  180. int i;
  181. uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
  182. const uint8_t *srcPtr= src[0];
  183. if (srcFormat == PIX_FMT_GRAY8A) {
  184. switch (dstFormat) {
  185. case PIX_FMT_RGB32 : conv = gray8aToPacked32; break;
  186. case PIX_FMT_BGR32 : conv = gray8aToPacked32; break;
  187. case PIX_FMT_BGR32_1: conv = gray8aToPacked32_1; break;
  188. case PIX_FMT_RGB32_1: conv = gray8aToPacked32_1; break;
  189. case PIX_FMT_RGB24 : conv = gray8aToPacked24; break;
  190. case PIX_FMT_BGR24 : conv = gray8aToPacked24; break;
  191. }
  192. } else if (usePal(srcFormat)) {
  193. switch (dstFormat) {
  194. case PIX_FMT_RGB32 : conv = sws_convertPalette8ToPacked32; break;
  195. case PIX_FMT_BGR32 : conv = sws_convertPalette8ToPacked32; break;
  196. case PIX_FMT_BGR32_1: conv = sws_convertPalette8ToPacked32; break;
  197. case PIX_FMT_RGB32_1: conv = sws_convertPalette8ToPacked32; break;
  198. case PIX_FMT_RGB24 : conv = sws_convertPalette8ToPacked24; break;
  199. case PIX_FMT_BGR24 : conv = sws_convertPalette8ToPacked24; break;
  200. }
  201. }
  202. if (!conv)
  203. av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  204. av_get_pix_fmt_name(srcFormat), av_get_pix_fmt_name(dstFormat));
  205. else {
  206. for (i=0; i<srcSliceH; i++) {
  207. conv(srcPtr, dstPtr, c->srcW, (uint8_t *) c->pal_rgb);
  208. srcPtr+= srcStride[0];
  209. dstPtr+= dstStride[0];
  210. }
  211. }
  212. return srcSliceH;
  213. }
  214. #define isRGBA32(x) ( \
  215. (x) == PIX_FMT_ARGB \
  216. || (x) == PIX_FMT_RGBA \
  217. || (x) == PIX_FMT_BGRA \
  218. || (x) == PIX_FMT_ABGR \
  219. )
  220. /* {RGB,BGR}{15,16,24,32,32_1} -> {RGB,BGR}{15,16,24,32} */
  221. static int rgbToRgbWrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  222. int srcSliceH, uint8_t* dst[], int dstStride[])
  223. {
  224. const enum PixelFormat srcFormat= c->srcFormat;
  225. const enum PixelFormat dstFormat= c->dstFormat;
  226. const int srcBpp= (c->srcFormatBpp + 7) >> 3;
  227. const int dstBpp= (c->dstFormatBpp + 7) >> 3;
  228. const int srcId= c->srcFormatBpp >> 2; /* 1:0, 4:1, 8:2, 15:3, 16:4, 24:6, 32:8 */
  229. const int dstId= c->dstFormatBpp >> 2;
  230. void (*conv)(const uint8_t *src, uint8_t *dst, int src_size)=NULL;
  231. #define CONV_IS(src, dst) (srcFormat == PIX_FMT_##src && dstFormat == PIX_FMT_##dst)
  232. if (isRGBA32(srcFormat) && isRGBA32(dstFormat)) {
  233. if ( CONV_IS(ABGR, RGBA)
  234. || CONV_IS(ARGB, BGRA)
  235. || CONV_IS(BGRA, ARGB)
  236. || CONV_IS(RGBA, ABGR)) conv = shuffle_bytes_3210;
  237. else if (CONV_IS(ABGR, ARGB)
  238. || CONV_IS(ARGB, ABGR)) conv = shuffle_bytes_0321;
  239. else if (CONV_IS(ABGR, BGRA)
  240. || CONV_IS(ARGB, RGBA)) conv = shuffle_bytes_1230;
  241. else if (CONV_IS(BGRA, RGBA)
  242. || CONV_IS(RGBA, BGRA)) conv = shuffle_bytes_2103;
  243. else if (CONV_IS(BGRA, ABGR)
  244. || CONV_IS(RGBA, ARGB)) conv = shuffle_bytes_3012;
  245. } else
  246. /* BGR -> BGR */
  247. if ( (isBGRinInt(srcFormat) && isBGRinInt(dstFormat))
  248. || (isRGBinInt(srcFormat) && isRGBinInt(dstFormat))) {
  249. switch(srcId | (dstId<<4)) {
  250. case 0x34: conv= rgb16to15; break;
  251. case 0x36: conv= rgb24to15; break;
  252. case 0x38: conv= rgb32to15; break;
  253. case 0x43: conv= rgb15to16; break;
  254. case 0x46: conv= rgb24to16; break;
  255. case 0x48: conv= rgb32to16; break;
  256. case 0x63: conv= rgb15to24; break;
  257. case 0x64: conv= rgb16to24; break;
  258. case 0x68: conv= rgb32to24; break;
  259. case 0x83: conv= rgb15to32; break;
  260. case 0x84: conv= rgb16to32; break;
  261. case 0x86: conv= rgb24to32; break;
  262. }
  263. } else if ( (isBGRinInt(srcFormat) && isRGBinInt(dstFormat))
  264. || (isRGBinInt(srcFormat) && isBGRinInt(dstFormat))) {
  265. switch(srcId | (dstId<<4)) {
  266. case 0x33: conv= rgb15tobgr15; break;
  267. case 0x34: conv= rgb16tobgr15; break;
  268. case 0x36: conv= rgb24tobgr15; break;
  269. case 0x38: conv= rgb32tobgr15; break;
  270. case 0x43: conv= rgb15tobgr16; break;
  271. case 0x44: conv= rgb16tobgr16; break;
  272. case 0x46: conv= rgb24tobgr16; break;
  273. case 0x48: conv= rgb32tobgr16; break;
  274. case 0x63: conv= rgb15tobgr24; break;
  275. case 0x64: conv= rgb16tobgr24; break;
  276. case 0x66: conv= rgb24tobgr24; break;
  277. case 0x68: conv= rgb32tobgr24; break;
  278. case 0x83: conv= rgb15tobgr32; break;
  279. case 0x84: conv= rgb16tobgr32; break;
  280. case 0x86: conv= rgb24tobgr32; break;
  281. }
  282. }
  283. if (!conv) {
  284. av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  285. av_get_pix_fmt_name(srcFormat), av_get_pix_fmt_name(dstFormat));
  286. } else {
  287. const uint8_t *srcPtr= src[0];
  288. uint8_t *dstPtr= dst[0];
  289. if ((srcFormat == PIX_FMT_RGB32_1 || srcFormat == PIX_FMT_BGR32_1) && !isRGBA32(dstFormat))
  290. srcPtr += ALT32_CORR;
  291. if ((dstFormat == PIX_FMT_RGB32_1 || dstFormat == PIX_FMT_BGR32_1) && !isRGBA32(srcFormat))
  292. dstPtr += ALT32_CORR;
  293. if (dstStride[0]*srcBpp == srcStride[0]*dstBpp && srcStride[0] > 0 && !(srcStride[0]%srcBpp))
  294. conv(srcPtr, dstPtr + dstStride[0]*srcSliceY, srcSliceH*srcStride[0]);
  295. else {
  296. int i;
  297. dstPtr += dstStride[0]*srcSliceY;
  298. for (i=0; i<srcSliceH; i++) {
  299. conv(srcPtr, dstPtr, c->srcW*srcBpp);
  300. srcPtr+= srcStride[0];
  301. dstPtr+= dstStride[0];
  302. }
  303. }
  304. }
  305. return srcSliceH;
  306. }
  307. static int bgr24ToYv12Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  308. int srcSliceH, uint8_t* dst[], int dstStride[])
  309. {
  310. rgb24toyv12(
  311. src[0],
  312. dst[0]+ srcSliceY *dstStride[0],
  313. dst[1]+(srcSliceY>>1)*dstStride[1],
  314. dst[2]+(srcSliceY>>1)*dstStride[2],
  315. c->srcW, srcSliceH,
  316. dstStride[0], dstStride[1], srcStride[0]);
  317. if (dst[3])
  318. fillPlane(dst[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  319. return srcSliceH;
  320. }
  321. static int yvu9ToYv12Wrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  322. int srcSliceH, uint8_t* dst[], int dstStride[])
  323. {
  324. copyPlane(src[0], srcStride[0], srcSliceY, srcSliceH, c->srcW,
  325. dst[0], dstStride[0]);
  326. planar2x(src[1], dst[1] + dstStride[1]*(srcSliceY >> 1), c->chrSrcW,
  327. srcSliceH >> 2, srcStride[1], dstStride[1]);
  328. planar2x(src[2], dst[2] + dstStride[2]*(srcSliceY >> 1), c->chrSrcW,
  329. srcSliceH >> 2, srcStride[2], dstStride[2]);
  330. if (dst[3])
  331. fillPlane(dst[3], dstStride[3], c->srcW, srcSliceH, srcSliceY, 255);
  332. return srcSliceH;
  333. }
  334. /* unscaled copy like stuff (assumes nearly identical formats) */
  335. static int packedCopyWrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  336. int srcSliceH, uint8_t* dst[], int dstStride[])
  337. {
  338. if (dstStride[0]==srcStride[0] && srcStride[0] > 0)
  339. memcpy(dst[0] + dstStride[0]*srcSliceY, src[0], srcSliceH*dstStride[0]);
  340. else {
  341. int i;
  342. const uint8_t *srcPtr= src[0];
  343. uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
  344. int length=0;
  345. /* universal length finder */
  346. while(length+c->srcW <= FFABS(dstStride[0])
  347. && length+c->srcW <= FFABS(srcStride[0])) length+= c->srcW;
  348. assert(length!=0);
  349. for (i=0; i<srcSliceH; i++) {
  350. memcpy(dstPtr, srcPtr, length);
  351. srcPtr+= srcStride[0];
  352. dstPtr+= dstStride[0];
  353. }
  354. }
  355. return srcSliceH;
  356. }
  357. #define DITHER_COPY(dst, dstStride, src, srcStride, bswap, dbswap)\
  358. uint16_t scale= dither_scale[dst_depth-1][src_depth-1];\
  359. int shift= src_depth-dst_depth + dither_scale[src_depth-2][dst_depth-1];\
  360. for (i = 0; i < height; i++) {\
  361. const uint8_t *dither= dithers[src_depth-9][i&7];\
  362. for (j = 0; j < length-7; j+=8){\
  363. dst[j+0] = dbswap((bswap(src[j+0]) + dither[0])*scale>>shift);\
  364. dst[j+1] = dbswap((bswap(src[j+1]) + dither[1])*scale>>shift);\
  365. dst[j+2] = dbswap((bswap(src[j+2]) + dither[2])*scale>>shift);\
  366. dst[j+3] = dbswap((bswap(src[j+3]) + dither[3])*scale>>shift);\
  367. dst[j+4] = dbswap((bswap(src[j+4]) + dither[4])*scale>>shift);\
  368. dst[j+5] = dbswap((bswap(src[j+5]) + dither[5])*scale>>shift);\
  369. dst[j+6] = dbswap((bswap(src[j+6]) + dither[6])*scale>>shift);\
  370. dst[j+7] = dbswap((bswap(src[j+7]) + dither[7])*scale>>shift);\
  371. }\
  372. for (; j < length; j++)\
  373. dst[j] = dbswap((bswap(src[j]) + dither[j&7])*scale>>shift);\
  374. dst += dstStride;\
  375. src += srcStride;\
  376. }
  377. static int planarCopyWrapper(SwsContext *c, const uint8_t* src[], int srcStride[], int srcSliceY,
  378. int srcSliceH, uint8_t* dst[], int dstStride[])
  379. {
  380. int plane, i, j;
  381. for (plane=0; plane<4; plane++) {
  382. int length= (plane==0 || plane==3) ? c->srcW : -((-c->srcW )>>c->chrDstHSubSample);
  383. int y= (plane==0 || plane==3) ? srcSliceY: -((-srcSliceY)>>c->chrDstVSubSample);
  384. int height= (plane==0 || plane==3) ? srcSliceH: -((-srcSliceH)>>c->chrDstVSubSample);
  385. const uint8_t *srcPtr= src[plane];
  386. uint8_t *dstPtr= dst[plane] + dstStride[plane]*y;
  387. if (!dst[plane]) continue;
  388. // ignore palette for GRAY8
  389. if (plane == 1 && !dst[2]) continue;
  390. if (!src[plane] || (plane == 1 && !src[2])) {
  391. if(is16BPS(c->dstFormat))
  392. length*=2;
  393. fillPlane(dst[plane], dstStride[plane], length, height, y, (plane==3) ? 255 : 128);
  394. } else {
  395. if(isNBPS(c->srcFormat) || isNBPS(c->dstFormat)
  396. || (is16BPS(c->srcFormat) != is16BPS(c->dstFormat))
  397. ) {
  398. const int src_depth = av_pix_fmt_descriptors[c->srcFormat].comp[plane].depth_minus1+1;
  399. const int dst_depth = av_pix_fmt_descriptors[c->dstFormat].comp[plane].depth_minus1+1;
  400. const uint16_t *srcPtr2 = (const uint16_t*)srcPtr;
  401. uint16_t *dstPtr2 = (uint16_t*)dstPtr;
  402. if (dst_depth == 8) {
  403. if(isBE(c->srcFormat) == HAVE_BIGENDIAN){
  404. DITHER_COPY(dstPtr, dstStride[plane], srcPtr2, srcStride[plane]/2, , )
  405. } else {
  406. DITHER_COPY(dstPtr, dstStride[plane], srcPtr2, srcStride[plane]/2, av_bswap16, )
  407. }
  408. } else if (src_depth == 8) {
  409. for (i = 0; i < height; i++) {
  410. if(isBE(c->dstFormat)){
  411. for (j = 0; j < length; j++)
  412. AV_WB16(&dstPtr2[j], (srcPtr[j]<<(dst_depth-8)) |
  413. (srcPtr[j]>>(2*8-dst_depth)));
  414. } else {
  415. for (j = 0; j < length; j++)
  416. AV_WL16(&dstPtr2[j], (srcPtr[j]<<(dst_depth-8)) |
  417. (srcPtr[j]>>(2*8-dst_depth)));
  418. }
  419. dstPtr2 += dstStride[plane]/2;
  420. srcPtr += srcStride[plane];
  421. }
  422. } else if (src_depth <= dst_depth) {
  423. for (i = 0; i < height; i++) {
  424. #define COPY_UP(r,w) \
  425. for (j = 0; j < length; j++){ \
  426. unsigned int v= r(&srcPtr2[j]);\
  427. w(&dstPtr2[j], (v<<(dst_depth-src_depth)) | \
  428. (v>>(2*src_depth-dst_depth)));\
  429. }
  430. if(isBE(c->srcFormat)){
  431. if(isBE(c->dstFormat)){
  432. COPY_UP(AV_RB16, AV_WB16)
  433. } else {
  434. COPY_UP(AV_RB16, AV_WL16)
  435. }
  436. } else {
  437. if(isBE(c->dstFormat)){
  438. COPY_UP(AV_RL16, AV_WB16)
  439. } else {
  440. COPY_UP(AV_RL16, AV_WL16)
  441. }
  442. }
  443. dstPtr2 += dstStride[plane]/2;
  444. srcPtr2 += srcStride[plane]/2;
  445. }
  446. } else {
  447. if(isBE(c->srcFormat) == HAVE_BIGENDIAN){
  448. if(isBE(c->dstFormat) == HAVE_BIGENDIAN){
  449. DITHER_COPY(dstPtr2, dstStride[plane]/2, srcPtr2, srcStride[plane]/2, , )
  450. } else {
  451. DITHER_COPY(dstPtr2, dstStride[plane]/2, srcPtr2, srcStride[plane]/2, , av_bswap16)
  452. }
  453. }else{
  454. if(isBE(c->dstFormat) == HAVE_BIGENDIAN){
  455. DITHER_COPY(dstPtr2, dstStride[plane]/2, srcPtr2, srcStride[plane]/2, av_bswap16, )
  456. } else {
  457. DITHER_COPY(dstPtr2, dstStride[plane]/2, srcPtr2, srcStride[plane]/2, av_bswap16, av_bswap16)
  458. }
  459. }
  460. }
  461. } else if(is16BPS(c->srcFormat) && is16BPS(c->dstFormat)
  462. && isBE(c->srcFormat) != isBE(c->dstFormat)) {
  463. for (i=0; i<height; i++) {
  464. for (j=0; j<length; j++)
  465. ((uint16_t*)dstPtr)[j] = av_bswap16(((const uint16_t*)srcPtr)[j]);
  466. srcPtr+= srcStride[plane];
  467. dstPtr+= dstStride[plane];
  468. }
  469. } else if (dstStride[plane] == srcStride[plane] &&
  470. srcStride[plane] > 0 && srcStride[plane] == length) {
  471. memcpy(dst[plane] + dstStride[plane]*y, src[plane],
  472. height*dstStride[plane]);
  473. } else {
  474. if(is16BPS(c->srcFormat) && is16BPS(c->dstFormat))
  475. length*=2;
  476. for (i=0; i<height; i++) {
  477. memcpy(dstPtr, srcPtr, length);
  478. srcPtr+= srcStride[plane];
  479. dstPtr+= dstStride[plane];
  480. }
  481. }
  482. }
  483. }
  484. return srcSliceH;
  485. }
  486. void ff_get_unscaled_swscale(SwsContext *c)
  487. {
  488. const enum PixelFormat srcFormat = c->srcFormat;
  489. const enum PixelFormat dstFormat = c->dstFormat;
  490. const int flags = c->flags;
  491. const int dstH = c->dstH;
  492. int needsDither;
  493. needsDither= isAnyRGB(dstFormat)
  494. && c->dstFormatBpp < 24
  495. && (c->dstFormatBpp < c->srcFormatBpp || (!isAnyRGB(srcFormat)));
  496. /* yv12_to_nv12 */
  497. if ((srcFormat == PIX_FMT_YUV420P || srcFormat == PIX_FMT_YUVA420P) && (dstFormat == PIX_FMT_NV12 || dstFormat == PIX_FMT_NV21)) {
  498. c->swScale= planarToNv12Wrapper;
  499. }
  500. /* yuv2bgr */
  501. if ((srcFormat==PIX_FMT_YUV420P || srcFormat==PIX_FMT_YUV422P || srcFormat==PIX_FMT_YUVA420P) && isAnyRGB(dstFormat)
  502. && !(flags & SWS_ACCURATE_RND) && !(dstH&1)) {
  503. c->swScale= ff_yuv2rgb_get_func_ptr(c);
  504. }
  505. if (srcFormat==PIX_FMT_YUV410P && (dstFormat==PIX_FMT_YUV420P || dstFormat==PIX_FMT_YUVA420P) && !(flags & SWS_BITEXACT)) {
  506. c->swScale= yvu9ToYv12Wrapper;
  507. }
  508. /* bgr24toYV12 */
  509. if (srcFormat==PIX_FMT_BGR24 && (dstFormat==PIX_FMT_YUV420P || dstFormat==PIX_FMT_YUVA420P) && !(flags & SWS_ACCURATE_RND))
  510. c->swScale= bgr24ToYv12Wrapper;
  511. /* RGB/BGR -> RGB/BGR (no dither needed forms) */
  512. if ( isAnyRGB(srcFormat)
  513. && isAnyRGB(dstFormat)
  514. && srcFormat != PIX_FMT_BGR8 && dstFormat != PIX_FMT_BGR8
  515. && srcFormat != PIX_FMT_RGB8 && dstFormat != PIX_FMT_RGB8
  516. && srcFormat != PIX_FMT_BGR4 && dstFormat != PIX_FMT_BGR4
  517. && srcFormat != PIX_FMT_RGB4 && dstFormat != PIX_FMT_RGB4
  518. && srcFormat != PIX_FMT_BGR4_BYTE && dstFormat != PIX_FMT_BGR4_BYTE
  519. && srcFormat != PIX_FMT_RGB4_BYTE && dstFormat != PIX_FMT_RGB4_BYTE
  520. && srcFormat != PIX_FMT_MONOBLACK && dstFormat != PIX_FMT_MONOBLACK
  521. && srcFormat != PIX_FMT_MONOWHITE && dstFormat != PIX_FMT_MONOWHITE
  522. && srcFormat != PIX_FMT_RGB48LE && dstFormat != PIX_FMT_RGB48LE
  523. && srcFormat != PIX_FMT_RGB48BE && dstFormat != PIX_FMT_RGB48BE
  524. && srcFormat != PIX_FMT_BGR48LE && dstFormat != PIX_FMT_BGR48LE
  525. && srcFormat != PIX_FMT_BGR48BE && dstFormat != PIX_FMT_BGR48BE
  526. && (!needsDither || (c->flags&(SWS_FAST_BILINEAR|SWS_POINT))))
  527. c->swScale= rgbToRgbWrapper;
  528. if ((usePal(srcFormat) && (
  529. dstFormat == PIX_FMT_RGB32 ||
  530. dstFormat == PIX_FMT_RGB32_1 ||
  531. dstFormat == PIX_FMT_RGB24 ||
  532. dstFormat == PIX_FMT_BGR32 ||
  533. dstFormat == PIX_FMT_BGR32_1 ||
  534. dstFormat == PIX_FMT_BGR24)))
  535. c->swScale= palToRgbWrapper;
  536. if (srcFormat == PIX_FMT_YUV422P) {
  537. if (dstFormat == PIX_FMT_YUYV422)
  538. c->swScale= yuv422pToYuy2Wrapper;
  539. else if (dstFormat == PIX_FMT_UYVY422)
  540. c->swScale= yuv422pToUyvyWrapper;
  541. }
  542. /* LQ converters if -sws 0 or -sws 4*/
  543. if (c->flags&(SWS_FAST_BILINEAR|SWS_POINT)) {
  544. /* yv12_to_yuy2 */
  545. if (srcFormat == PIX_FMT_YUV420P || srcFormat == PIX_FMT_YUVA420P) {
  546. if (dstFormat == PIX_FMT_YUYV422)
  547. c->swScale= planarToYuy2Wrapper;
  548. else if (dstFormat == PIX_FMT_UYVY422)
  549. c->swScale= planarToUyvyWrapper;
  550. }
  551. }
  552. if(srcFormat == PIX_FMT_YUYV422 && (dstFormat == PIX_FMT_YUV420P || dstFormat == PIX_FMT_YUVA420P))
  553. c->swScale= yuyvToYuv420Wrapper;
  554. if(srcFormat == PIX_FMT_UYVY422 && (dstFormat == PIX_FMT_YUV420P || dstFormat == PIX_FMT_YUVA420P))
  555. c->swScale= uyvyToYuv420Wrapper;
  556. if(srcFormat == PIX_FMT_YUYV422 && dstFormat == PIX_FMT_YUV422P)
  557. c->swScale= yuyvToYuv422Wrapper;
  558. if(srcFormat == PIX_FMT_UYVY422 && dstFormat == PIX_FMT_YUV422P)
  559. c->swScale= uyvyToYuv422Wrapper;
  560. /* simple copy */
  561. if ( srcFormat == dstFormat
  562. || (srcFormat == PIX_FMT_YUVA420P && dstFormat == PIX_FMT_YUV420P)
  563. || (srcFormat == PIX_FMT_YUV420P && dstFormat == PIX_FMT_YUVA420P)
  564. || (isPlanarYUV(srcFormat) && isGray(dstFormat))
  565. || (isPlanarYUV(dstFormat) && isGray(srcFormat))
  566. || (isGray(dstFormat) && isGray(srcFormat))
  567. || (isPlanarYUV(srcFormat) && isPlanarYUV(dstFormat)
  568. && c->chrDstHSubSample == c->chrSrcHSubSample
  569. && c->chrDstVSubSample == c->chrSrcVSubSample
  570. && dstFormat != PIX_FMT_NV12 && dstFormat != PIX_FMT_NV21
  571. && srcFormat != PIX_FMT_NV12 && srcFormat != PIX_FMT_NV21))
  572. {
  573. if (isPacked(c->srcFormat))
  574. c->swScale= packedCopyWrapper;
  575. else /* Planar YUV or gray */
  576. c->swScale= planarCopyWrapper;
  577. }
  578. if (ARCH_BFIN)
  579. ff_bfin_get_unscaled_swscale(c);
  580. if (HAVE_ALTIVEC)
  581. ff_swscale_get_unscaled_altivec(c);
  582. }
  583. static void reset_ptr(const uint8_t* src[], int format)
  584. {
  585. if(!isALPHA(format))
  586. src[3]=NULL;
  587. if(!isPlanarYUV(format)) {
  588. src[3]=src[2]=NULL;
  589. if (!usePal(format))
  590. src[1]= NULL;
  591. }
  592. }
  593. static int check_image_pointers(uint8_t *data[4], enum PixelFormat pix_fmt,
  594. const int linesizes[4])
  595. {
  596. const AVPixFmtDescriptor *desc = &av_pix_fmt_descriptors[pix_fmt];
  597. int i;
  598. for (i = 0; i < 4; i++) {
  599. int plane = desc->comp[i].plane;
  600. if (!data[plane] || !linesizes[plane])
  601. return 0;
  602. }
  603. return 1;
  604. }
  605. /**
  606. * swscale wrapper, so we don't need to export the SwsContext.
  607. * Assumes planar YUV to be in YUV order instead of YVU.
  608. */
  609. int sws_scale(SwsContext *c, const uint8_t* const src[], const int srcStride[], int srcSliceY,
  610. int srcSliceH, uint8_t* const dst[], const int dstStride[])
  611. {
  612. int i;
  613. const uint8_t* src2[4]= {src[0], src[1], src[2], src[3]};
  614. uint8_t* dst2[4]= {dst[0], dst[1], dst[2], dst[3]};
  615. // do not mess up sliceDir if we have a "trailing" 0-size slice
  616. if (srcSliceH == 0)
  617. return 0;
  618. if (!check_image_pointers(src, c->srcFormat, srcStride)) {
  619. av_log(c, AV_LOG_ERROR, "bad src image pointers\n");
  620. return 0;
  621. }
  622. if (!check_image_pointers(dst, c->dstFormat, dstStride)) {
  623. av_log(c, AV_LOG_ERROR, "bad dst image pointers\n");
  624. return 0;
  625. }
  626. if (c->sliceDir == 0 && srcSliceY != 0 && srcSliceY + srcSliceH != c->srcH) {
  627. av_log(c, AV_LOG_ERROR, "Slices start in the middle!\n");
  628. return 0;
  629. }
  630. if (c->sliceDir == 0) {
  631. if (srcSliceY == 0) c->sliceDir = 1; else c->sliceDir = -1;
  632. }
  633. if (usePal(c->srcFormat)) {
  634. for (i=0; i<256; i++) {
  635. int p, r, g, b, y, u, v, a = 0xff;
  636. if(c->srcFormat == PIX_FMT_PAL8) {
  637. p=((const uint32_t*)(src[1]))[i];
  638. a= (p>>24)&0xFF;
  639. r= (p>>16)&0xFF;
  640. g= (p>> 8)&0xFF;
  641. b= p &0xFF;
  642. } else if(c->srcFormat == PIX_FMT_RGB8) {
  643. r= (i>>5 )*36;
  644. g= ((i>>2)&7)*36;
  645. b= (i&3 )*85;
  646. } else if(c->srcFormat == PIX_FMT_BGR8) {
  647. b= (i>>6 )*85;
  648. g= ((i>>3)&7)*36;
  649. r= (i&7 )*36;
  650. } else if(c->srcFormat == PIX_FMT_RGB4_BYTE) {
  651. r= (i>>3 )*255;
  652. g= ((i>>1)&3)*85;
  653. b= (i&1 )*255;
  654. } else if(c->srcFormat == PIX_FMT_GRAY8 || c->srcFormat == PIX_FMT_GRAY8A) {
  655. r = g = b = i;
  656. } else {
  657. assert(c->srcFormat == PIX_FMT_BGR4_BYTE);
  658. b= (i>>3 )*255;
  659. g= ((i>>1)&3)*85;
  660. r= (i&1 )*255;
  661. }
  662. y= av_clip_uint8((RY*r + GY*g + BY*b + ( 33<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
  663. u= av_clip_uint8((RU*r + GU*g + BU*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
  664. v= av_clip_uint8((RV*r + GV*g + BV*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
  665. c->pal_yuv[i]= y + (u<<8) + (v<<16) + (a<<24);
  666. switch(c->dstFormat) {
  667. case PIX_FMT_BGR32:
  668. #if !HAVE_BIGENDIAN
  669. case PIX_FMT_RGB24:
  670. #endif
  671. c->pal_rgb[i]= r + (g<<8) + (b<<16) + (a<<24);
  672. break;
  673. case PIX_FMT_BGR32_1:
  674. #if HAVE_BIGENDIAN
  675. case PIX_FMT_BGR24:
  676. #endif
  677. c->pal_rgb[i]= a + (r<<8) + (g<<16) + (b<<24);
  678. break;
  679. case PIX_FMT_RGB32_1:
  680. #if HAVE_BIGENDIAN
  681. case PIX_FMT_RGB24:
  682. #endif
  683. c->pal_rgb[i]= a + (b<<8) + (g<<16) + (r<<24);
  684. break;
  685. case PIX_FMT_RGB32:
  686. #if !HAVE_BIGENDIAN
  687. case PIX_FMT_BGR24:
  688. #endif
  689. default:
  690. c->pal_rgb[i]= b + (g<<8) + (r<<16) + (a<<24);
  691. }
  692. }
  693. }
  694. // copy strides, so they can safely be modified
  695. if (c->sliceDir == 1) {
  696. // slices go from top to bottom
  697. int srcStride2[4]= {srcStride[0], srcStride[1], srcStride[2], srcStride[3]};
  698. int dstStride2[4]= {dstStride[0], dstStride[1], dstStride[2], dstStride[3]};
  699. reset_ptr(src2, c->srcFormat);
  700. reset_ptr((const uint8_t**)dst2, c->dstFormat);
  701. /* reset slice direction at end of frame */
  702. if (srcSliceY + srcSliceH == c->srcH)
  703. c->sliceDir = 0;
  704. return c->swScale(c, src2, srcStride2, srcSliceY, srcSliceH, dst2, dstStride2);
  705. } else {
  706. // slices go from bottom to top => we flip the image internally
  707. int srcStride2[4]= {-srcStride[0], -srcStride[1], -srcStride[2], -srcStride[3]};
  708. int dstStride2[4]= {-dstStride[0], -dstStride[1], -dstStride[2], -dstStride[3]};
  709. src2[0] += (srcSliceH-1)*srcStride[0];
  710. if (!usePal(c->srcFormat))
  711. src2[1] += ((srcSliceH>>c->chrSrcVSubSample)-1)*srcStride[1];
  712. src2[2] += ((srcSliceH>>c->chrSrcVSubSample)-1)*srcStride[2];
  713. src2[3] += (srcSliceH-1)*srcStride[3];
  714. dst2[0] += ( c->dstH -1)*dstStride[0];
  715. dst2[1] += ((c->dstH>>c->chrDstVSubSample)-1)*dstStride[1];
  716. dst2[2] += ((c->dstH>>c->chrDstVSubSample)-1)*dstStride[2];
  717. dst2[3] += ( c->dstH -1)*dstStride[3];
  718. reset_ptr(src2, c->srcFormat);
  719. reset_ptr((const uint8_t**)dst2, c->dstFormat);
  720. /* reset slice direction at end of frame */
  721. if (!srcSliceY)
  722. c->sliceDir = 0;
  723. return c->swScale(c, src2, srcStride2, c->srcH-srcSliceY-srcSliceH, srcSliceH, dst2, dstStride2);
  724. }
  725. }
  726. #if LIBSWSCALE_VERSION_MAJOR < 1
  727. int sws_scale_ordered(SwsContext *c, const uint8_t* const src[], int srcStride[], int srcSliceY,
  728. int srcSliceH, uint8_t* dst[], int dstStride[])
  729. {
  730. return sws_scale(c, src, srcStride, srcSliceY, srcSliceH, dst, dstStride);
  731. }
  732. #endif
  733. /* Convert the palette to the same packed 32-bit format as the palette */
  734. void sws_convertPalette8ToPacked32(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette)
  735. {
  736. int i;
  737. for (i=0; i<num_pixels; i++)
  738. ((uint32_t *) dst)[i] = ((const uint32_t *) palette)[src[i]];
  739. }
  740. /* Palette format: ABCD -> dst format: ABC */
  741. void sws_convertPalette8ToPacked24(const uint8_t *src, uint8_t *dst, long num_pixels, const uint8_t *palette)
  742. {
  743. int i;
  744. for (i=0; i<num_pixels; i++) {
  745. //FIXME slow?
  746. dst[0]= palette[src[i]*4+0];
  747. dst[1]= palette[src[i]*4+1];
  748. dst[2]= palette[src[i]*4+2];
  749. dst+= 3;
  750. }
  751. }