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.

997 lines
34KB

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