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.

1106 lines
37KB

  1. /*
  2. * DSP utils
  3. * Copyright (c) 2000, 2001 Fabrice Bellard
  4. * Copyright (c) 2002-2004 Michael Niedermayer <michaelni@gmx.at>
  5. *
  6. * This file is part of FFmpeg.
  7. *
  8. * FFmpeg is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU Lesser General Public
  10. * License as published by the Free Software Foundation; either
  11. * version 2.1 of the License, or (at your option) any later version.
  12. *
  13. * FFmpeg is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16. * Lesser General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU Lesser General Public
  19. * License along with FFmpeg; if not, write to the Free Software
  20. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  21. */
  22. /**
  23. * @file
  24. * DSP utils
  25. */
  26. #include "libavutil/attributes.h"
  27. #include "libavutil/internal.h"
  28. #include "avcodec.h"
  29. #include "copy_block.h"
  30. #include "dct.h"
  31. #include "dsputil.h"
  32. #include "simple_idct.h"
  33. #include "faandct.h"
  34. #include "mpegvideo.h"
  35. #include "config.h"
  36. uint32_t ff_square_tab[512] = { 0, };
  37. #define BIT_DEPTH 16
  38. #include "dsputilenc_template.c"
  39. #undef BIT_DEPTH
  40. #define BIT_DEPTH 8
  41. #include "dsputilenc_template.c"
  42. static int sse4_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  43. int line_size, int h)
  44. {
  45. int s = 0, i;
  46. uint32_t *sq = ff_square_tab + 256;
  47. for (i = 0; i < h; i++) {
  48. s += sq[pix1[0] - pix2[0]];
  49. s += sq[pix1[1] - pix2[1]];
  50. s += sq[pix1[2] - pix2[2]];
  51. s += sq[pix1[3] - pix2[3]];
  52. pix1 += line_size;
  53. pix2 += line_size;
  54. }
  55. return s;
  56. }
  57. static int sse8_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  58. int line_size, int h)
  59. {
  60. int s = 0, i;
  61. uint32_t *sq = ff_square_tab + 256;
  62. for (i = 0; i < h; i++) {
  63. s += sq[pix1[0] - pix2[0]];
  64. s += sq[pix1[1] - pix2[1]];
  65. s += sq[pix1[2] - pix2[2]];
  66. s += sq[pix1[3] - pix2[3]];
  67. s += sq[pix1[4] - pix2[4]];
  68. s += sq[pix1[5] - pix2[5]];
  69. s += sq[pix1[6] - pix2[6]];
  70. s += sq[pix1[7] - pix2[7]];
  71. pix1 += line_size;
  72. pix2 += line_size;
  73. }
  74. return s;
  75. }
  76. static int sse16_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  77. int line_size, int h)
  78. {
  79. int s = 0, i;
  80. uint32_t *sq = ff_square_tab + 256;
  81. for (i = 0; i < h; i++) {
  82. s += sq[pix1[0] - pix2[0]];
  83. s += sq[pix1[1] - pix2[1]];
  84. s += sq[pix1[2] - pix2[2]];
  85. s += sq[pix1[3] - pix2[3]];
  86. s += sq[pix1[4] - pix2[4]];
  87. s += sq[pix1[5] - pix2[5]];
  88. s += sq[pix1[6] - pix2[6]];
  89. s += sq[pix1[7] - pix2[7]];
  90. s += sq[pix1[8] - pix2[8]];
  91. s += sq[pix1[9] - pix2[9]];
  92. s += sq[pix1[10] - pix2[10]];
  93. s += sq[pix1[11] - pix2[11]];
  94. s += sq[pix1[12] - pix2[12]];
  95. s += sq[pix1[13] - pix2[13]];
  96. s += sq[pix1[14] - pix2[14]];
  97. s += sq[pix1[15] - pix2[15]];
  98. pix1 += line_size;
  99. pix2 += line_size;
  100. }
  101. return s;
  102. }
  103. static void diff_pixels_c(int16_t *av_restrict block, const uint8_t *s1,
  104. const uint8_t *s2, int stride)
  105. {
  106. int i;
  107. /* read the pixels */
  108. for (i = 0; i < 8; i++) {
  109. block[0] = s1[0] - s2[0];
  110. block[1] = s1[1] - s2[1];
  111. block[2] = s1[2] - s2[2];
  112. block[3] = s1[3] - s2[3];
  113. block[4] = s1[4] - s2[4];
  114. block[5] = s1[5] - s2[5];
  115. block[6] = s1[6] - s2[6];
  116. block[7] = s1[7] - s2[7];
  117. s1 += stride;
  118. s2 += stride;
  119. block += 8;
  120. }
  121. }
  122. static int sum_abs_dctelem_c(int16_t *block)
  123. {
  124. int sum = 0, i;
  125. for (i = 0; i < 64; i++)
  126. sum += FFABS(block[i]);
  127. return sum;
  128. }
  129. #define avg2(a, b) ((a + b + 1) >> 1)
  130. #define avg4(a, b, c, d) ((a + b + c + d + 2) >> 2)
  131. static inline int pix_abs16_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  132. int line_size, int h)
  133. {
  134. int s = 0, i;
  135. for (i = 0; i < h; i++) {
  136. s += abs(pix1[0] - pix2[0]);
  137. s += abs(pix1[1] - pix2[1]);
  138. s += abs(pix1[2] - pix2[2]);
  139. s += abs(pix1[3] - pix2[3]);
  140. s += abs(pix1[4] - pix2[4]);
  141. s += abs(pix1[5] - pix2[5]);
  142. s += abs(pix1[6] - pix2[6]);
  143. s += abs(pix1[7] - pix2[7]);
  144. s += abs(pix1[8] - pix2[8]);
  145. s += abs(pix1[9] - pix2[9]);
  146. s += abs(pix1[10] - pix2[10]);
  147. s += abs(pix1[11] - pix2[11]);
  148. s += abs(pix1[12] - pix2[12]);
  149. s += abs(pix1[13] - pix2[13]);
  150. s += abs(pix1[14] - pix2[14]);
  151. s += abs(pix1[15] - pix2[15]);
  152. pix1 += line_size;
  153. pix2 += line_size;
  154. }
  155. return s;
  156. }
  157. static int pix_abs16_x2_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  158. int line_size, int h)
  159. {
  160. int s = 0, i;
  161. for (i = 0; i < h; i++) {
  162. s += abs(pix1[0] - avg2(pix2[0], pix2[1]));
  163. s += abs(pix1[1] - avg2(pix2[1], pix2[2]));
  164. s += abs(pix1[2] - avg2(pix2[2], pix2[3]));
  165. s += abs(pix1[3] - avg2(pix2[3], pix2[4]));
  166. s += abs(pix1[4] - avg2(pix2[4], pix2[5]));
  167. s += abs(pix1[5] - avg2(pix2[5], pix2[6]));
  168. s += abs(pix1[6] - avg2(pix2[6], pix2[7]));
  169. s += abs(pix1[7] - avg2(pix2[7], pix2[8]));
  170. s += abs(pix1[8] - avg2(pix2[8], pix2[9]));
  171. s += abs(pix1[9] - avg2(pix2[9], pix2[10]));
  172. s += abs(pix1[10] - avg2(pix2[10], pix2[11]));
  173. s += abs(pix1[11] - avg2(pix2[11], pix2[12]));
  174. s += abs(pix1[12] - avg2(pix2[12], pix2[13]));
  175. s += abs(pix1[13] - avg2(pix2[13], pix2[14]));
  176. s += abs(pix1[14] - avg2(pix2[14], pix2[15]));
  177. s += abs(pix1[15] - avg2(pix2[15], pix2[16]));
  178. pix1 += line_size;
  179. pix2 += line_size;
  180. }
  181. return s;
  182. }
  183. static int pix_abs16_y2_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  184. int line_size, int h)
  185. {
  186. int s = 0, i;
  187. uint8_t *pix3 = pix2 + line_size;
  188. for (i = 0; i < h; i++) {
  189. s += abs(pix1[0] - avg2(pix2[0], pix3[0]));
  190. s += abs(pix1[1] - avg2(pix2[1], pix3[1]));
  191. s += abs(pix1[2] - avg2(pix2[2], pix3[2]));
  192. s += abs(pix1[3] - avg2(pix2[3], pix3[3]));
  193. s += abs(pix1[4] - avg2(pix2[4], pix3[4]));
  194. s += abs(pix1[5] - avg2(pix2[5], pix3[5]));
  195. s += abs(pix1[6] - avg2(pix2[6], pix3[6]));
  196. s += abs(pix1[7] - avg2(pix2[7], pix3[7]));
  197. s += abs(pix1[8] - avg2(pix2[8], pix3[8]));
  198. s += abs(pix1[9] - avg2(pix2[9], pix3[9]));
  199. s += abs(pix1[10] - avg2(pix2[10], pix3[10]));
  200. s += abs(pix1[11] - avg2(pix2[11], pix3[11]));
  201. s += abs(pix1[12] - avg2(pix2[12], pix3[12]));
  202. s += abs(pix1[13] - avg2(pix2[13], pix3[13]));
  203. s += abs(pix1[14] - avg2(pix2[14], pix3[14]));
  204. s += abs(pix1[15] - avg2(pix2[15], pix3[15]));
  205. pix1 += line_size;
  206. pix2 += line_size;
  207. pix3 += line_size;
  208. }
  209. return s;
  210. }
  211. static int pix_abs16_xy2_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  212. int line_size, int h)
  213. {
  214. int s = 0, i;
  215. uint8_t *pix3 = pix2 + line_size;
  216. for (i = 0; i < h; i++) {
  217. s += abs(pix1[0] - avg4(pix2[0], pix2[1], pix3[0], pix3[1]));
  218. s += abs(pix1[1] - avg4(pix2[1], pix2[2], pix3[1], pix3[2]));
  219. s += abs(pix1[2] - avg4(pix2[2], pix2[3], pix3[2], pix3[3]));
  220. s += abs(pix1[3] - avg4(pix2[3], pix2[4], pix3[3], pix3[4]));
  221. s += abs(pix1[4] - avg4(pix2[4], pix2[5], pix3[4], pix3[5]));
  222. s += abs(pix1[5] - avg4(pix2[5], pix2[6], pix3[5], pix3[6]));
  223. s += abs(pix1[6] - avg4(pix2[6], pix2[7], pix3[6], pix3[7]));
  224. s += abs(pix1[7] - avg4(pix2[7], pix2[8], pix3[7], pix3[8]));
  225. s += abs(pix1[8] - avg4(pix2[8], pix2[9], pix3[8], pix3[9]));
  226. s += abs(pix1[9] - avg4(pix2[9], pix2[10], pix3[9], pix3[10]));
  227. s += abs(pix1[10] - avg4(pix2[10], pix2[11], pix3[10], pix3[11]));
  228. s += abs(pix1[11] - avg4(pix2[11], pix2[12], pix3[11], pix3[12]));
  229. s += abs(pix1[12] - avg4(pix2[12], pix2[13], pix3[12], pix3[13]));
  230. s += abs(pix1[13] - avg4(pix2[13], pix2[14], pix3[13], pix3[14]));
  231. s += abs(pix1[14] - avg4(pix2[14], pix2[15], pix3[14], pix3[15]));
  232. s += abs(pix1[15] - avg4(pix2[15], pix2[16], pix3[15], pix3[16]));
  233. pix1 += line_size;
  234. pix2 += line_size;
  235. pix3 += line_size;
  236. }
  237. return s;
  238. }
  239. static inline int pix_abs8_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  240. int line_size, int h)
  241. {
  242. int s = 0, i;
  243. for (i = 0; i < h; i++) {
  244. s += abs(pix1[0] - pix2[0]);
  245. s += abs(pix1[1] - pix2[1]);
  246. s += abs(pix1[2] - pix2[2]);
  247. s += abs(pix1[3] - pix2[3]);
  248. s += abs(pix1[4] - pix2[4]);
  249. s += abs(pix1[5] - pix2[5]);
  250. s += abs(pix1[6] - pix2[6]);
  251. s += abs(pix1[7] - pix2[7]);
  252. pix1 += line_size;
  253. pix2 += line_size;
  254. }
  255. return s;
  256. }
  257. static int pix_abs8_x2_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  258. int line_size, int h)
  259. {
  260. int s = 0, i;
  261. for (i = 0; i < h; i++) {
  262. s += abs(pix1[0] - avg2(pix2[0], pix2[1]));
  263. s += abs(pix1[1] - avg2(pix2[1], pix2[2]));
  264. s += abs(pix1[2] - avg2(pix2[2], pix2[3]));
  265. s += abs(pix1[3] - avg2(pix2[3], pix2[4]));
  266. s += abs(pix1[4] - avg2(pix2[4], pix2[5]));
  267. s += abs(pix1[5] - avg2(pix2[5], pix2[6]));
  268. s += abs(pix1[6] - avg2(pix2[6], pix2[7]));
  269. s += abs(pix1[7] - avg2(pix2[7], pix2[8]));
  270. pix1 += line_size;
  271. pix2 += line_size;
  272. }
  273. return s;
  274. }
  275. static int pix_abs8_y2_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  276. int line_size, int h)
  277. {
  278. int s = 0, i;
  279. uint8_t *pix3 = pix2 + line_size;
  280. for (i = 0; i < h; i++) {
  281. s += abs(pix1[0] - avg2(pix2[0], pix3[0]));
  282. s += abs(pix1[1] - avg2(pix2[1], pix3[1]));
  283. s += abs(pix1[2] - avg2(pix2[2], pix3[2]));
  284. s += abs(pix1[3] - avg2(pix2[3], pix3[3]));
  285. s += abs(pix1[4] - avg2(pix2[4], pix3[4]));
  286. s += abs(pix1[5] - avg2(pix2[5], pix3[5]));
  287. s += abs(pix1[6] - avg2(pix2[6], pix3[6]));
  288. s += abs(pix1[7] - avg2(pix2[7], pix3[7]));
  289. pix1 += line_size;
  290. pix2 += line_size;
  291. pix3 += line_size;
  292. }
  293. return s;
  294. }
  295. static int pix_abs8_xy2_c(MpegEncContext *v, uint8_t *pix1, uint8_t *pix2,
  296. int line_size, int h)
  297. {
  298. int s = 0, i;
  299. uint8_t *pix3 = pix2 + line_size;
  300. for (i = 0; i < h; i++) {
  301. s += abs(pix1[0] - avg4(pix2[0], pix2[1], pix3[0], pix3[1]));
  302. s += abs(pix1[1] - avg4(pix2[1], pix2[2], pix3[1], pix3[2]));
  303. s += abs(pix1[2] - avg4(pix2[2], pix2[3], pix3[2], pix3[3]));
  304. s += abs(pix1[3] - avg4(pix2[3], pix2[4], pix3[3], pix3[4]));
  305. s += abs(pix1[4] - avg4(pix2[4], pix2[5], pix3[4], pix3[5]));
  306. s += abs(pix1[5] - avg4(pix2[5], pix2[6], pix3[5], pix3[6]));
  307. s += abs(pix1[6] - avg4(pix2[6], pix2[7], pix3[6], pix3[7]));
  308. s += abs(pix1[7] - avg4(pix2[7], pix2[8], pix3[7], pix3[8]));
  309. pix1 += line_size;
  310. pix2 += line_size;
  311. pix3 += line_size;
  312. }
  313. return s;
  314. }
  315. static int nsse16_c(MpegEncContext *c, uint8_t *s1, uint8_t *s2, int stride, int h)
  316. {
  317. int score1 = 0, score2 = 0, x, y;
  318. for (y = 0; y < h; y++) {
  319. for (x = 0; x < 16; x++)
  320. score1 += (s1[x] - s2[x]) * (s1[x] - s2[x]);
  321. if (y + 1 < h) {
  322. for (x = 0; x < 15; x++)
  323. score2 += FFABS(s1[x] - s1[x + stride] -
  324. s1[x + 1] + s1[x + stride + 1]) -
  325. FFABS(s2[x] - s2[x + stride] -
  326. s2[x + 1] + s2[x + stride + 1]);
  327. }
  328. s1 += stride;
  329. s2 += stride;
  330. }
  331. if (c)
  332. return score1 + FFABS(score2) * c->avctx->nsse_weight;
  333. else
  334. return score1 + FFABS(score2) * 8;
  335. }
  336. static int nsse8_c(MpegEncContext *c, uint8_t *s1, uint8_t *s2, int stride, int h)
  337. {
  338. int score1 = 0, score2 = 0, x, y;
  339. for (y = 0; y < h; y++) {
  340. for (x = 0; x < 8; x++)
  341. score1 += (s1[x] - s2[x]) * (s1[x] - s2[x]);
  342. if (y + 1 < h) {
  343. for (x = 0; x < 7; x++)
  344. score2 += FFABS(s1[x] - s1[x + stride] -
  345. s1[x + 1] + s1[x + stride + 1]) -
  346. FFABS(s2[x] - s2[x + stride] -
  347. s2[x + 1] + s2[x + stride + 1]);
  348. }
  349. s1 += stride;
  350. s2 += stride;
  351. }
  352. if (c)
  353. return score1 + FFABS(score2) * c->avctx->nsse_weight;
  354. else
  355. return score1 + FFABS(score2) * 8;
  356. }
  357. static int zero_cmp(MpegEncContext *s, uint8_t *a, uint8_t *b,
  358. int stride, int h)
  359. {
  360. return 0;
  361. }
  362. void ff_set_cmp(DSPContext *c, me_cmp_func *cmp, int type)
  363. {
  364. int i;
  365. memset(cmp, 0, sizeof(void *) * 6);
  366. for (i = 0; i < 6; i++) {
  367. switch (type & 0xFF) {
  368. case FF_CMP_SAD:
  369. cmp[i] = c->sad[i];
  370. break;
  371. case FF_CMP_SATD:
  372. cmp[i] = c->hadamard8_diff[i];
  373. break;
  374. case FF_CMP_SSE:
  375. cmp[i] = c->sse[i];
  376. break;
  377. case FF_CMP_DCT:
  378. cmp[i] = c->dct_sad[i];
  379. break;
  380. case FF_CMP_DCT264:
  381. cmp[i] = c->dct264_sad[i];
  382. break;
  383. case FF_CMP_DCTMAX:
  384. cmp[i] = c->dct_max[i];
  385. break;
  386. case FF_CMP_PSNR:
  387. cmp[i] = c->quant_psnr[i];
  388. break;
  389. case FF_CMP_BIT:
  390. cmp[i] = c->bit[i];
  391. break;
  392. case FF_CMP_RD:
  393. cmp[i] = c->rd[i];
  394. break;
  395. case FF_CMP_VSAD:
  396. cmp[i] = c->vsad[i];
  397. break;
  398. case FF_CMP_VSSE:
  399. cmp[i] = c->vsse[i];
  400. break;
  401. case FF_CMP_ZERO:
  402. cmp[i] = zero_cmp;
  403. break;
  404. case FF_CMP_NSSE:
  405. cmp[i] = c->nsse[i];
  406. break;
  407. #if CONFIG_DWT
  408. case FF_CMP_W53:
  409. cmp[i]= c->w53[i];
  410. break;
  411. case FF_CMP_W97:
  412. cmp[i]= c->w97[i];
  413. break;
  414. #endif
  415. default:
  416. av_log(NULL, AV_LOG_ERROR,
  417. "internal error in cmp function selection\n");
  418. }
  419. }
  420. }
  421. #define BUTTERFLY2(o1, o2, i1, i2) \
  422. o1 = (i1) + (i2); \
  423. o2 = (i1) - (i2);
  424. #define BUTTERFLY1(x, y) \
  425. { \
  426. int a, b; \
  427. a = x; \
  428. b = y; \
  429. x = a + b; \
  430. y = a - b; \
  431. }
  432. #define BUTTERFLYA(x, y) (FFABS((x) + (y)) + FFABS((x) - (y)))
  433. static int hadamard8_diff8x8_c(MpegEncContext *s, uint8_t *dst,
  434. uint8_t *src, int stride, int h)
  435. {
  436. int i, temp[64], sum = 0;
  437. av_assert2(h == 8);
  438. for (i = 0; i < 8; i++) {
  439. // FIXME: try pointer walks
  440. BUTTERFLY2(temp[8 * i + 0], temp[8 * i + 1],
  441. src[stride * i + 0] - dst[stride * i + 0],
  442. src[stride * i + 1] - dst[stride * i + 1]);
  443. BUTTERFLY2(temp[8 * i + 2], temp[8 * i + 3],
  444. src[stride * i + 2] - dst[stride * i + 2],
  445. src[stride * i + 3] - dst[stride * i + 3]);
  446. BUTTERFLY2(temp[8 * i + 4], temp[8 * i + 5],
  447. src[stride * i + 4] - dst[stride * i + 4],
  448. src[stride * i + 5] - dst[stride * i + 5]);
  449. BUTTERFLY2(temp[8 * i + 6], temp[8 * i + 7],
  450. src[stride * i + 6] - dst[stride * i + 6],
  451. src[stride * i + 7] - dst[stride * i + 7]);
  452. BUTTERFLY1(temp[8 * i + 0], temp[8 * i + 2]);
  453. BUTTERFLY1(temp[8 * i + 1], temp[8 * i + 3]);
  454. BUTTERFLY1(temp[8 * i + 4], temp[8 * i + 6]);
  455. BUTTERFLY1(temp[8 * i + 5], temp[8 * i + 7]);
  456. BUTTERFLY1(temp[8 * i + 0], temp[8 * i + 4]);
  457. BUTTERFLY1(temp[8 * i + 1], temp[8 * i + 5]);
  458. BUTTERFLY1(temp[8 * i + 2], temp[8 * i + 6]);
  459. BUTTERFLY1(temp[8 * i + 3], temp[8 * i + 7]);
  460. }
  461. for (i = 0; i < 8; i++) {
  462. BUTTERFLY1(temp[8 * 0 + i], temp[8 * 1 + i]);
  463. BUTTERFLY1(temp[8 * 2 + i], temp[8 * 3 + i]);
  464. BUTTERFLY1(temp[8 * 4 + i], temp[8 * 5 + i]);
  465. BUTTERFLY1(temp[8 * 6 + i], temp[8 * 7 + i]);
  466. BUTTERFLY1(temp[8 * 0 + i], temp[8 * 2 + i]);
  467. BUTTERFLY1(temp[8 * 1 + i], temp[8 * 3 + i]);
  468. BUTTERFLY1(temp[8 * 4 + i], temp[8 * 6 + i]);
  469. BUTTERFLY1(temp[8 * 5 + i], temp[8 * 7 + i]);
  470. sum += BUTTERFLYA(temp[8 * 0 + i], temp[8 * 4 + i]) +
  471. BUTTERFLYA(temp[8 * 1 + i], temp[8 * 5 + i]) +
  472. BUTTERFLYA(temp[8 * 2 + i], temp[8 * 6 + i]) +
  473. BUTTERFLYA(temp[8 * 3 + i], temp[8 * 7 + i]);
  474. }
  475. return sum;
  476. }
  477. static int hadamard8_intra8x8_c(MpegEncContext *s, uint8_t *src,
  478. uint8_t *dummy, int stride, int h)
  479. {
  480. int i, temp[64], sum = 0;
  481. av_assert2(h == 8);
  482. for (i = 0; i < 8; i++) {
  483. // FIXME: try pointer walks
  484. BUTTERFLY2(temp[8 * i + 0], temp[8 * i + 1],
  485. src[stride * i + 0], src[stride * i + 1]);
  486. BUTTERFLY2(temp[8 * i + 2], temp[8 * i + 3],
  487. src[stride * i + 2], src[stride * i + 3]);
  488. BUTTERFLY2(temp[8 * i + 4], temp[8 * i + 5],
  489. src[stride * i + 4], src[stride * i + 5]);
  490. BUTTERFLY2(temp[8 * i + 6], temp[8 * i + 7],
  491. src[stride * i + 6], src[stride * i + 7]);
  492. BUTTERFLY1(temp[8 * i + 0], temp[8 * i + 2]);
  493. BUTTERFLY1(temp[8 * i + 1], temp[8 * i + 3]);
  494. BUTTERFLY1(temp[8 * i + 4], temp[8 * i + 6]);
  495. BUTTERFLY1(temp[8 * i + 5], temp[8 * i + 7]);
  496. BUTTERFLY1(temp[8 * i + 0], temp[8 * i + 4]);
  497. BUTTERFLY1(temp[8 * i + 1], temp[8 * i + 5]);
  498. BUTTERFLY1(temp[8 * i + 2], temp[8 * i + 6]);
  499. BUTTERFLY1(temp[8 * i + 3], temp[8 * i + 7]);
  500. }
  501. for (i = 0; i < 8; i++) {
  502. BUTTERFLY1(temp[8 * 0 + i], temp[8 * 1 + i]);
  503. BUTTERFLY1(temp[8 * 2 + i], temp[8 * 3 + i]);
  504. BUTTERFLY1(temp[8 * 4 + i], temp[8 * 5 + i]);
  505. BUTTERFLY1(temp[8 * 6 + i], temp[8 * 7 + i]);
  506. BUTTERFLY1(temp[8 * 0 + i], temp[8 * 2 + i]);
  507. BUTTERFLY1(temp[8 * 1 + i], temp[8 * 3 + i]);
  508. BUTTERFLY1(temp[8 * 4 + i], temp[8 * 6 + i]);
  509. BUTTERFLY1(temp[8 * 5 + i], temp[8 * 7 + i]);
  510. sum +=
  511. BUTTERFLYA(temp[8 * 0 + i], temp[8 * 4 + i])
  512. + BUTTERFLYA(temp[8 * 1 + i], temp[8 * 5 + i])
  513. + BUTTERFLYA(temp[8 * 2 + i], temp[8 * 6 + i])
  514. + BUTTERFLYA(temp[8 * 3 + i], temp[8 * 7 + i]);
  515. }
  516. sum -= FFABS(temp[8 * 0] + temp[8 * 4]); // -mean
  517. return sum;
  518. }
  519. static int dct_sad8x8_c(MpegEncContext *s, uint8_t *src1,
  520. uint8_t *src2, int stride, int h)
  521. {
  522. LOCAL_ALIGNED_16(int16_t, temp, [64]);
  523. av_assert2(h == 8);
  524. s->dsp.diff_pixels(temp, src1, src2, stride);
  525. s->dsp.fdct(temp);
  526. return s->dsp.sum_abs_dctelem(temp);
  527. }
  528. #if CONFIG_GPL
  529. #define DCT8_1D \
  530. { \
  531. const int s07 = SRC(0) + SRC(7); \
  532. const int s16 = SRC(1) + SRC(6); \
  533. const int s25 = SRC(2) + SRC(5); \
  534. const int s34 = SRC(3) + SRC(4); \
  535. const int a0 = s07 + s34; \
  536. const int a1 = s16 + s25; \
  537. const int a2 = s07 - s34; \
  538. const int a3 = s16 - s25; \
  539. const int d07 = SRC(0) - SRC(7); \
  540. const int d16 = SRC(1) - SRC(6); \
  541. const int d25 = SRC(2) - SRC(5); \
  542. const int d34 = SRC(3) - SRC(4); \
  543. const int a4 = d16 + d25 + (d07 + (d07 >> 1)); \
  544. const int a5 = d07 - d34 - (d25 + (d25 >> 1)); \
  545. const int a6 = d07 + d34 - (d16 + (d16 >> 1)); \
  546. const int a7 = d16 - d25 + (d34 + (d34 >> 1)); \
  547. DST(0, a0 + a1); \
  548. DST(1, a4 + (a7 >> 2)); \
  549. DST(2, a2 + (a3 >> 1)); \
  550. DST(3, a5 + (a6 >> 2)); \
  551. DST(4, a0 - a1); \
  552. DST(5, a6 - (a5 >> 2)); \
  553. DST(6, (a2 >> 1) - a3); \
  554. DST(7, (a4 >> 2) - a7); \
  555. }
  556. static int dct264_sad8x8_c(MpegEncContext *s, uint8_t *src1,
  557. uint8_t *src2, int stride, int h)
  558. {
  559. int16_t dct[8][8];
  560. int i, sum = 0;
  561. s->dsp.diff_pixels(dct[0], src1, src2, stride);
  562. #define SRC(x) dct[i][x]
  563. #define DST(x, v) dct[i][x] = v
  564. for (i = 0; i < 8; i++)
  565. DCT8_1D
  566. #undef SRC
  567. #undef DST
  568. #define SRC(x) dct[x][i]
  569. #define DST(x, v) sum += FFABS(v)
  570. for (i = 0; i < 8; i++)
  571. DCT8_1D
  572. #undef SRC
  573. #undef DST
  574. return sum;
  575. }
  576. #endif
  577. static int dct_max8x8_c(MpegEncContext *s, uint8_t *src1,
  578. uint8_t *src2, int stride, int h)
  579. {
  580. LOCAL_ALIGNED_16(int16_t, temp, [64]);
  581. int sum = 0, i;
  582. av_assert2(h == 8);
  583. s->dsp.diff_pixels(temp, src1, src2, stride);
  584. s->dsp.fdct(temp);
  585. for (i = 0; i < 64; i++)
  586. sum = FFMAX(sum, FFABS(temp[i]));
  587. return sum;
  588. }
  589. static int quant_psnr8x8_c(MpegEncContext *s, uint8_t *src1,
  590. uint8_t *src2, int stride, int h)
  591. {
  592. LOCAL_ALIGNED_16(int16_t, temp, [64 * 2]);
  593. int16_t *const bak = temp + 64;
  594. int sum = 0, i;
  595. av_assert2(h == 8);
  596. s->mb_intra = 0;
  597. s->dsp.diff_pixels(temp, src1, src2, stride);
  598. memcpy(bak, temp, 64 * sizeof(int16_t));
  599. s->block_last_index[0 /* FIXME */] =
  600. s->fast_dct_quantize(s, temp, 0 /* FIXME */, s->qscale, &i);
  601. s->dct_unquantize_inter(s, temp, 0, s->qscale);
  602. ff_simple_idct_8(temp); // FIXME
  603. for (i = 0; i < 64; i++)
  604. sum += (temp[i] - bak[i]) * (temp[i] - bak[i]);
  605. return sum;
  606. }
  607. static int rd8x8_c(MpegEncContext *s, uint8_t *src1, uint8_t *src2,
  608. int stride, int h)
  609. {
  610. const uint8_t *scantable = s->intra_scantable.permutated;
  611. LOCAL_ALIGNED_16(int16_t, temp, [64]);
  612. LOCAL_ALIGNED_16(uint8_t, lsrc1, [64]);
  613. LOCAL_ALIGNED_16(uint8_t, lsrc2, [64]);
  614. int i, last, run, bits, level, distortion, start_i;
  615. const int esc_length = s->ac_esc_length;
  616. uint8_t *length, *last_length;
  617. av_assert2(h == 8);
  618. copy_block8(lsrc1, src1, 8, stride, 8);
  619. copy_block8(lsrc2, src2, 8, stride, 8);
  620. s->dsp.diff_pixels(temp, lsrc1, lsrc2, 8);
  621. s->block_last_index[0 /* FIXME */] =
  622. last =
  623. s->fast_dct_quantize(s, temp, 0 /* FIXME */, s->qscale, &i);
  624. bits = 0;
  625. if (s->mb_intra) {
  626. start_i = 1;
  627. length = s->intra_ac_vlc_length;
  628. last_length = s->intra_ac_vlc_last_length;
  629. bits += s->luma_dc_vlc_length[temp[0] + 256]; // FIXME: chroma
  630. } else {
  631. start_i = 0;
  632. length = s->inter_ac_vlc_length;
  633. last_length = s->inter_ac_vlc_last_length;
  634. }
  635. if (last >= start_i) {
  636. run = 0;
  637. for (i = start_i; i < last; i++) {
  638. int j = scantable[i];
  639. level = temp[j];
  640. if (level) {
  641. level += 64;
  642. if ((level & (~127)) == 0)
  643. bits += length[UNI_AC_ENC_INDEX(run, level)];
  644. else
  645. bits += esc_length;
  646. run = 0;
  647. } else
  648. run++;
  649. }
  650. i = scantable[last];
  651. level = temp[i] + 64;
  652. av_assert2(level - 64);
  653. if ((level & (~127)) == 0) {
  654. bits += last_length[UNI_AC_ENC_INDEX(run, level)];
  655. } else
  656. bits += esc_length;
  657. }
  658. if (last >= 0) {
  659. if (s->mb_intra)
  660. s->dct_unquantize_intra(s, temp, 0, s->qscale);
  661. else
  662. s->dct_unquantize_inter(s, temp, 0, s->qscale);
  663. }
  664. s->idsp.idct_add(lsrc2, 8, temp);
  665. distortion = s->dsp.sse[1](NULL, lsrc2, lsrc1, 8, 8);
  666. return distortion + ((bits * s->qscale * s->qscale * 109 + 64) >> 7);
  667. }
  668. static int bit8x8_c(MpegEncContext *s, uint8_t *src1, uint8_t *src2,
  669. int stride, int h)
  670. {
  671. const uint8_t *scantable = s->intra_scantable.permutated;
  672. LOCAL_ALIGNED_16(int16_t, temp, [64]);
  673. int i, last, run, bits, level, start_i;
  674. const int esc_length = s->ac_esc_length;
  675. uint8_t *length, *last_length;
  676. av_assert2(h == 8);
  677. s->dsp.diff_pixels(temp, src1, src2, stride);
  678. s->block_last_index[0 /* FIXME */] =
  679. last =
  680. s->fast_dct_quantize(s, temp, 0 /* FIXME */, s->qscale, &i);
  681. bits = 0;
  682. if (s->mb_intra) {
  683. start_i = 1;
  684. length = s->intra_ac_vlc_length;
  685. last_length = s->intra_ac_vlc_last_length;
  686. bits += s->luma_dc_vlc_length[temp[0] + 256]; // FIXME: chroma
  687. } else {
  688. start_i = 0;
  689. length = s->inter_ac_vlc_length;
  690. last_length = s->inter_ac_vlc_last_length;
  691. }
  692. if (last >= start_i) {
  693. run = 0;
  694. for (i = start_i; i < last; i++) {
  695. int j = scantable[i];
  696. level = temp[j];
  697. if (level) {
  698. level += 64;
  699. if ((level & (~127)) == 0)
  700. bits += length[UNI_AC_ENC_INDEX(run, level)];
  701. else
  702. bits += esc_length;
  703. run = 0;
  704. } else
  705. run++;
  706. }
  707. i = scantable[last];
  708. level = temp[i] + 64;
  709. av_assert2(level - 64);
  710. if ((level & (~127)) == 0)
  711. bits += last_length[UNI_AC_ENC_INDEX(run, level)];
  712. else
  713. bits += esc_length;
  714. }
  715. return bits;
  716. }
  717. #define VSAD_INTRA(size) \
  718. static int vsad_intra ## size ## _c(MpegEncContext *c, \
  719. uint8_t *s, uint8_t *dummy, \
  720. int stride, int h) \
  721. { \
  722. int score = 0, x, y; \
  723. \
  724. for (y = 1; y < h; y++) { \
  725. for (x = 0; x < size; x += 4) { \
  726. score += FFABS(s[x] - s[x + stride]) + \
  727. FFABS(s[x + 1] - s[x + stride + 1]) + \
  728. FFABS(s[x + 2] - s[x + 2 + stride]) + \
  729. FFABS(s[x + 3] - s[x + 3 + stride]); \
  730. } \
  731. s += stride; \
  732. } \
  733. \
  734. return score; \
  735. }
  736. VSAD_INTRA(8)
  737. VSAD_INTRA(16)
  738. #define VSAD(size) \
  739. static int vsad ## size ## _c(MpegEncContext *c, \
  740. uint8_t *s1, uint8_t *s2, \
  741. int stride, int h) \
  742. { \
  743. int score = 0, x, y; \
  744. \
  745. for (y = 1; y < h; y++) { \
  746. for (x = 0; x < size; x++) \
  747. score += FFABS(s1[x] - s2[x] - s1[x + stride] + s2[x + stride]); \
  748. s1 += stride; \
  749. s2 += stride; \
  750. } \
  751. \
  752. return score; \
  753. }
  754. VSAD(8)
  755. VSAD(16)
  756. #define SQ(a) ((a) * (a))
  757. #define VSSE_INTRA(size) \
  758. static int vsse_intra ## size ## _c(MpegEncContext *c, \
  759. uint8_t *s, uint8_t *dummy, \
  760. int stride, int h) \
  761. { \
  762. int score = 0, x, y; \
  763. \
  764. for (y = 1; y < h; y++) { \
  765. for (x = 0; x < size; x += 4) { \
  766. score += SQ(s[x] - s[x + stride]) + \
  767. SQ(s[x + 1] - s[x + stride + 1]) + \
  768. SQ(s[x + 2] - s[x + stride + 2]) + \
  769. SQ(s[x + 3] - s[x + stride + 3]); \
  770. } \
  771. s += stride; \
  772. } \
  773. \
  774. return score; \
  775. }
  776. VSSE_INTRA(8)
  777. VSSE_INTRA(16)
  778. #define VSSE(size) \
  779. static int vsse ## size ## _c(MpegEncContext *c, uint8_t *s1, uint8_t *s2, \
  780. int stride, int h) \
  781. { \
  782. int score = 0, x, y; \
  783. \
  784. for (y = 1; y < h; y++) { \
  785. for (x = 0; x < size; x++) \
  786. score += SQ(s1[x] - s2[x] - s1[x + stride] + s2[x + stride]); \
  787. s1 += stride; \
  788. s2 += stride; \
  789. } \
  790. \
  791. return score; \
  792. }
  793. VSSE(8)
  794. VSSE(16)
  795. #define WRAPPER8_16_SQ(name8, name16) \
  796. static int name16(MpegEncContext *s, uint8_t *dst, uint8_t *src, \
  797. int stride, int h) \
  798. { \
  799. int score = 0; \
  800. \
  801. score += name8(s, dst, src, stride, 8); \
  802. score += name8(s, dst + 8, src + 8, stride, 8); \
  803. if (h == 16) { \
  804. dst += 8 * stride; \
  805. src += 8 * stride; \
  806. score += name8(s, dst, src, stride, 8); \
  807. score += name8(s, dst + 8, src + 8, stride, 8); \
  808. } \
  809. return score; \
  810. }
  811. WRAPPER8_16_SQ(hadamard8_diff8x8_c, hadamard8_diff16_c)
  812. WRAPPER8_16_SQ(hadamard8_intra8x8_c, hadamard8_intra16_c)
  813. WRAPPER8_16_SQ(dct_sad8x8_c, dct_sad16_c)
  814. #if CONFIG_GPL
  815. WRAPPER8_16_SQ(dct264_sad8x8_c, dct264_sad16_c)
  816. #endif
  817. WRAPPER8_16_SQ(dct_max8x8_c, dct_max16_c)
  818. WRAPPER8_16_SQ(quant_psnr8x8_c, quant_psnr16_c)
  819. WRAPPER8_16_SQ(rd8x8_c, rd16_c)
  820. WRAPPER8_16_SQ(bit8x8_c, bit16_c)
  821. /* draw the edges of width 'w' of an image of size width, height */
  822. // FIXME: Check that this is OK for MPEG-4 interlaced.
  823. static void draw_edges_8_c(uint8_t *buf, int wrap, int width, int height,
  824. int w, int h, int sides)
  825. {
  826. uint8_t *ptr = buf, *last_line;
  827. int i;
  828. /* left and right */
  829. for (i = 0; i < height; i++) {
  830. memset(ptr - w, ptr[0], w);
  831. memset(ptr + width, ptr[width - 1], w);
  832. ptr += wrap;
  833. }
  834. /* top and bottom + corners */
  835. buf -= w;
  836. last_line = buf + (height - 1) * wrap;
  837. if (sides & EDGE_TOP)
  838. for (i = 0; i < h; i++)
  839. // top
  840. memcpy(buf - (i + 1) * wrap, buf, width + w + w);
  841. if (sides & EDGE_BOTTOM)
  842. for (i = 0; i < h; i++)
  843. // bottom
  844. memcpy(last_line + (i + 1) * wrap, last_line, width + w + w);
  845. }
  846. /* init static data */
  847. av_cold void ff_dsputil_static_init(void)
  848. {
  849. int i;
  850. for (i = 0; i < 512; i++)
  851. ff_square_tab[i] = (i - 256) * (i - 256);
  852. }
  853. int ff_check_alignment(void)
  854. {
  855. static int did_fail = 0;
  856. LOCAL_ALIGNED_16(int, aligned, [4]);
  857. if ((intptr_t)aligned & 15) {
  858. if (!did_fail) {
  859. #if HAVE_MMX || HAVE_ALTIVEC
  860. av_log(NULL, AV_LOG_ERROR,
  861. "Compiler did not align stack variables. Libavcodec has been miscompiled\n"
  862. "and may be very slow or crash. This is not a bug in libavcodec,\n"
  863. "but in the compiler. You may try recompiling using gcc >= 4.2.\n"
  864. "Do not report crashes to FFmpeg developers.\n");
  865. #endif
  866. did_fail=1;
  867. }
  868. return -1;
  869. }
  870. return 0;
  871. }
  872. av_cold void ff_dsputil_init(DSPContext *c, AVCodecContext *avctx)
  873. {
  874. const unsigned high_bit_depth = avctx->bits_per_raw_sample > 8;
  875. ff_check_alignment();
  876. #if CONFIG_ENCODERS
  877. if (avctx->bits_per_raw_sample == 10) {
  878. c->fdct = ff_jpeg_fdct_islow_10;
  879. c->fdct248 = ff_fdct248_islow_10;
  880. } else {
  881. if (avctx->dct_algo == FF_DCT_FASTINT) {
  882. c->fdct = ff_fdct_ifast;
  883. c->fdct248 = ff_fdct_ifast248;
  884. } else if (avctx->dct_algo == FF_DCT_FAAN) {
  885. c->fdct = ff_faandct;
  886. c->fdct248 = ff_faandct248;
  887. } else {
  888. c->fdct = ff_jpeg_fdct_islow_8; // slow/accurate/default
  889. c->fdct248 = ff_fdct248_islow_8;
  890. }
  891. }
  892. #endif /* CONFIG_ENCODERS */
  893. c->diff_pixels = diff_pixels_c;
  894. c->sum_abs_dctelem = sum_abs_dctelem_c;
  895. /* TODO [0] 16 [1] 8 */
  896. c->pix_abs[0][0] = pix_abs16_c;
  897. c->pix_abs[0][1] = pix_abs16_x2_c;
  898. c->pix_abs[0][2] = pix_abs16_y2_c;
  899. c->pix_abs[0][3] = pix_abs16_xy2_c;
  900. c->pix_abs[1][0] = pix_abs8_c;
  901. c->pix_abs[1][1] = pix_abs8_x2_c;
  902. c->pix_abs[1][2] = pix_abs8_y2_c;
  903. c->pix_abs[1][3] = pix_abs8_xy2_c;
  904. #define SET_CMP_FUNC(name) \
  905. c->name[0] = name ## 16_c; \
  906. c->name[1] = name ## 8x8_c;
  907. SET_CMP_FUNC(hadamard8_diff)
  908. c->hadamard8_diff[4] = hadamard8_intra16_c;
  909. c->hadamard8_diff[5] = hadamard8_intra8x8_c;
  910. SET_CMP_FUNC(dct_sad)
  911. SET_CMP_FUNC(dct_max)
  912. #if CONFIG_GPL
  913. SET_CMP_FUNC(dct264_sad)
  914. #endif
  915. c->sad[0] = pix_abs16_c;
  916. c->sad[1] = pix_abs8_c;
  917. c->sse[0] = sse16_c;
  918. c->sse[1] = sse8_c;
  919. c->sse[2] = sse4_c;
  920. SET_CMP_FUNC(quant_psnr)
  921. SET_CMP_FUNC(rd)
  922. SET_CMP_FUNC(bit)
  923. c->vsad[0] = vsad16_c;
  924. c->vsad[1] = vsad8_c;
  925. c->vsad[4] = vsad_intra16_c;
  926. c->vsad[5] = vsad_intra8_c;
  927. c->vsse[0] = vsse16_c;
  928. c->vsse[1] = vsse8_c;
  929. c->vsse[4] = vsse_intra16_c;
  930. c->vsse[5] = vsse_intra8_c;
  931. c->nsse[0] = nsse16_c;
  932. c->nsse[1] = nsse8_c;
  933. #if CONFIG_SNOW_DECODER || CONFIG_SNOW_ENCODER
  934. ff_dsputil_init_dwt(c);
  935. #endif
  936. c->draw_edges = draw_edges_8_c;
  937. switch (avctx->bits_per_raw_sample) {
  938. case 9:
  939. case 10:
  940. case 12:
  941. case 14:
  942. c->get_pixels = get_pixels_16_c;
  943. break;
  944. default:
  945. if (avctx->bits_per_raw_sample<=8 || avctx->codec_type != AVMEDIA_TYPE_VIDEO) {
  946. c->get_pixels = get_pixels_8_c;
  947. }
  948. break;
  949. }
  950. if (ARCH_ALPHA)
  951. ff_dsputil_init_alpha(c, avctx);
  952. if (ARCH_ARM)
  953. ff_dsputil_init_arm(c, avctx, high_bit_depth);
  954. if (ARCH_PPC)
  955. ff_dsputil_init_ppc(c, avctx, high_bit_depth);
  956. if (ARCH_X86)
  957. ff_dsputil_init_x86(c, avctx, high_bit_depth);
  958. }
  959. av_cold void dsputil_init(DSPContext* c, AVCodecContext *avctx)
  960. {
  961. ff_dsputil_init(c, avctx);
  962. }
  963. av_cold void avpriv_dsputil_init(DSPContext *c, AVCodecContext *avctx)
  964. {
  965. ff_dsputil_init(c, avctx);
  966. }