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.

629 lines
26KB

  1. /*
  2. * RV40 decoder motion compensation functions
  3. * Copyright (c) 2008 Konstantin Shishkov
  4. *
  5. * This file is part of Libav.
  6. *
  7. * Libav is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU Lesser General Public
  9. * License as published by the Free Software Foundation; either
  10. * version 2.1 of the License, or (at your option) any later version.
  11. *
  12. * Libav is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15. * Lesser General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU Lesser General Public
  18. * License along with Libav; if not, write to the Free Software
  19. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  20. */
  21. /**
  22. * @file
  23. * RV40 decoder motion compensation functions
  24. */
  25. #include "avcodec.h"
  26. #include "h264qpel.h"
  27. #include "mathops.h"
  28. #include "rv34dsp.h"
  29. #include "libavutil/common.h"
  30. #define RV40_LOWPASS(OPNAME, OP) \
  31. static av_unused void OPNAME ## rv40_qpel8_h_lowpass(uint8_t *dst, uint8_t *src, int dstStride, int srcStride,\
  32. const int h, const int C1, const int C2, const int SHIFT){\
  33. const uint8_t *cm = ff_crop_tab + MAX_NEG_CROP;\
  34. int i;\
  35. for(i = 0; i < h; i++)\
  36. {\
  37. OP(dst[0], (src[-2] + src[ 3] - 5*(src[-1]+src[2]) + src[0]*C1 + src[1]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  38. OP(dst[1], (src[-1] + src[ 4] - 5*(src[ 0]+src[3]) + src[1]*C1 + src[2]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  39. OP(dst[2], (src[ 0] + src[ 5] - 5*(src[ 1]+src[4]) + src[2]*C1 + src[3]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  40. OP(dst[3], (src[ 1] + src[ 6] - 5*(src[ 2]+src[5]) + src[3]*C1 + src[4]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  41. OP(dst[4], (src[ 2] + src[ 7] - 5*(src[ 3]+src[6]) + src[4]*C1 + src[5]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  42. OP(dst[5], (src[ 3] + src[ 8] - 5*(src[ 4]+src[7]) + src[5]*C1 + src[6]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  43. OP(dst[6], (src[ 4] + src[ 9] - 5*(src[ 5]+src[8]) + src[6]*C1 + src[7]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  44. OP(dst[7], (src[ 5] + src[10] - 5*(src[ 6]+src[9]) + src[7]*C1 + src[8]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  45. dst += dstStride;\
  46. src += srcStride;\
  47. }\
  48. }\
  49. \
  50. static void OPNAME ## rv40_qpel8_v_lowpass(uint8_t *dst, uint8_t *src, int dstStride, int srcStride,\
  51. const int w, const int C1, const int C2, const int SHIFT){\
  52. const uint8_t *cm = ff_crop_tab + MAX_NEG_CROP;\
  53. int i;\
  54. for(i = 0; i < w; i++)\
  55. {\
  56. const int srcB = src[-2*srcStride];\
  57. const int srcA = src[-1*srcStride];\
  58. const int src0 = src[0 *srcStride];\
  59. const int src1 = src[1 *srcStride];\
  60. const int src2 = src[2 *srcStride];\
  61. const int src3 = src[3 *srcStride];\
  62. const int src4 = src[4 *srcStride];\
  63. const int src5 = src[5 *srcStride];\
  64. const int src6 = src[6 *srcStride];\
  65. const int src7 = src[7 *srcStride];\
  66. const int src8 = src[8 *srcStride];\
  67. const int src9 = src[9 *srcStride];\
  68. const int src10 = src[10*srcStride];\
  69. OP(dst[0*dstStride], (srcB + src3 - 5*(srcA+src2) + src0*C1 + src1*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  70. OP(dst[1*dstStride], (srcA + src4 - 5*(src0+src3) + src1*C1 + src2*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  71. OP(dst[2*dstStride], (src0 + src5 - 5*(src1+src4) + src2*C1 + src3*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  72. OP(dst[3*dstStride], (src1 + src6 - 5*(src2+src5) + src3*C1 + src4*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  73. OP(dst[4*dstStride], (src2 + src7 - 5*(src3+src6) + src4*C1 + src5*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  74. OP(dst[5*dstStride], (src3 + src8 - 5*(src4+src7) + src5*C1 + src6*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  75. OP(dst[6*dstStride], (src4 + src9 - 5*(src5+src8) + src6*C1 + src7*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  76. OP(dst[7*dstStride], (src5 + src10 - 5*(src6+src9) + src7*C1 + src8*C2 + (1<<(SHIFT-1))) >> SHIFT);\
  77. dst++;\
  78. src++;\
  79. }\
  80. }\
  81. \
  82. static void OPNAME ## rv40_qpel16_v_lowpass(uint8_t *dst, uint8_t *src, int dstStride, int srcStride,\
  83. const int w, const int C1, const int C2, const int SHIFT){\
  84. OPNAME ## rv40_qpel8_v_lowpass(dst , src , dstStride, srcStride, 8, C1, C2, SHIFT);\
  85. OPNAME ## rv40_qpel8_v_lowpass(dst+8, src+8, dstStride, srcStride, 8, C1, C2, SHIFT);\
  86. src += 8*srcStride;\
  87. dst += 8*dstStride;\
  88. OPNAME ## rv40_qpel8_v_lowpass(dst , src , dstStride, srcStride, w-8, C1, C2, SHIFT);\
  89. OPNAME ## rv40_qpel8_v_lowpass(dst+8, src+8, dstStride, srcStride, w-8, C1, C2, SHIFT);\
  90. }\
  91. \
  92. static void OPNAME ## rv40_qpel16_h_lowpass(uint8_t *dst, uint8_t *src, int dstStride, int srcStride,\
  93. const int h, const int C1, const int C2, const int SHIFT){\
  94. OPNAME ## rv40_qpel8_h_lowpass(dst , src , dstStride, srcStride, 8, C1, C2, SHIFT);\
  95. OPNAME ## rv40_qpel8_h_lowpass(dst+8, src+8, dstStride, srcStride, 8, C1, C2, SHIFT);\
  96. src += 8*srcStride;\
  97. dst += 8*dstStride;\
  98. OPNAME ## rv40_qpel8_h_lowpass(dst , src , dstStride, srcStride, h-8, C1, C2, SHIFT);\
  99. OPNAME ## rv40_qpel8_h_lowpass(dst+8, src+8, dstStride, srcStride, h-8, C1, C2, SHIFT);\
  100. }\
  101. \
  102. #define RV40_MC(OPNAME, SIZE) \
  103. static void OPNAME ## rv40_qpel ## SIZE ## _mc10_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  104. {\
  105. OPNAME ## rv40_qpel ## SIZE ## _h_lowpass(dst, src, stride, stride, SIZE, 52, 20, 6);\
  106. }\
  107. \
  108. static void OPNAME ## rv40_qpel ## SIZE ## _mc30_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  109. {\
  110. OPNAME ## rv40_qpel ## SIZE ## _h_lowpass(dst, src, stride, stride, SIZE, 20, 52, 6);\
  111. }\
  112. \
  113. static void OPNAME ## rv40_qpel ## SIZE ## _mc01_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  114. {\
  115. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, src, stride, stride, SIZE, 52, 20, 6);\
  116. }\
  117. \
  118. static void OPNAME ## rv40_qpel ## SIZE ## _mc11_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  119. {\
  120. uint8_t full[SIZE*(SIZE+5)];\
  121. uint8_t * const full_mid = full + SIZE*2;\
  122. put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 52, 20, 6);\
  123. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 52, 20, 6);\
  124. }\
  125. \
  126. static void OPNAME ## rv40_qpel ## SIZE ## _mc21_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  127. {\
  128. uint8_t full[SIZE*(SIZE+5)];\
  129. uint8_t * const full_mid = full + SIZE*2;\
  130. put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 20, 5);\
  131. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 52, 20, 6);\
  132. }\
  133. \
  134. static void OPNAME ## rv40_qpel ## SIZE ## _mc31_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  135. {\
  136. uint8_t full[SIZE*(SIZE+5)];\
  137. uint8_t * const full_mid = full + SIZE*2;\
  138. put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 52, 6);\
  139. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 52, 20, 6);\
  140. }\
  141. \
  142. static void OPNAME ## rv40_qpel ## SIZE ## _mc12_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  143. {\
  144. uint8_t full[SIZE*(SIZE+5)];\
  145. uint8_t * const full_mid = full + SIZE*2;\
  146. put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 52, 20, 6);\
  147. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 20, 5);\
  148. }\
  149. \
  150. static void OPNAME ## rv40_qpel ## SIZE ## _mc22_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  151. {\
  152. uint8_t full[SIZE*(SIZE+5)];\
  153. uint8_t * const full_mid = full + SIZE*2;\
  154. put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 20, 5);\
  155. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 20, 5);\
  156. }\
  157. \
  158. static void OPNAME ## rv40_qpel ## SIZE ## _mc32_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  159. {\
  160. uint8_t full[SIZE*(SIZE+5)];\
  161. uint8_t * const full_mid = full + SIZE*2;\
  162. put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 52, 6);\
  163. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 20, 5);\
  164. }\
  165. \
  166. static void OPNAME ## rv40_qpel ## SIZE ## _mc03_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  167. {\
  168. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, src, stride, stride, SIZE, 20, 52, 6);\
  169. }\
  170. \
  171. static void OPNAME ## rv40_qpel ## SIZE ## _mc13_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  172. {\
  173. uint8_t full[SIZE*(SIZE+5)];\
  174. uint8_t * const full_mid = full + SIZE*2;\
  175. put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 52, 20, 6);\
  176. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 52, 6);\
  177. }\
  178. \
  179. static void OPNAME ## rv40_qpel ## SIZE ## _mc23_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
  180. {\
  181. uint8_t full[SIZE*(SIZE+5)];\
  182. uint8_t * const full_mid = full + SIZE*2;\
  183. put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 20, 5);\
  184. OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 52, 6);\
  185. }\
  186. \
  187. #define op_avg(a, b) a = (((a)+cm[b]+1)>>1)
  188. #define op_put(a, b) a = cm[b]
  189. RV40_LOWPASS(put_ , op_put)
  190. RV40_LOWPASS(avg_ , op_avg)
  191. #undef op_avg
  192. #undef op_put
  193. RV40_MC(put_, 8)
  194. RV40_MC(put_, 16)
  195. RV40_MC(avg_, 8)
  196. RV40_MC(avg_, 16)
  197. static const int rv40_bias[4][4] = {
  198. { 0, 16, 32, 16 },
  199. { 32, 28, 32, 28 },
  200. { 0, 32, 16, 32 },
  201. { 32, 28, 32, 28 }
  202. };
  203. #define RV40_CHROMA_MC(OPNAME, OP)\
  204. static void OPNAME ## rv40_chroma_mc4_c(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y){\
  205. const int A = (8-x) * (8-y);\
  206. const int B = ( x) * (8-y);\
  207. const int C = (8-x) * ( y);\
  208. const int D = ( x) * ( y);\
  209. int i;\
  210. int bias = rv40_bias[y>>1][x>>1];\
  211. \
  212. assert(x<8 && y<8 && x>=0 && y>=0);\
  213. \
  214. if(D){\
  215. for(i = 0; i < h; i++){\
  216. OP(dst[0], (A*src[0] + B*src[1] + C*src[stride+0] + D*src[stride+1] + bias));\
  217. OP(dst[1], (A*src[1] + B*src[2] + C*src[stride+1] + D*src[stride+2] + bias));\
  218. OP(dst[2], (A*src[2] + B*src[3] + C*src[stride+2] + D*src[stride+3] + bias));\
  219. OP(dst[3], (A*src[3] + B*src[4] + C*src[stride+3] + D*src[stride+4] + bias));\
  220. dst += stride;\
  221. src += stride;\
  222. }\
  223. }else{\
  224. const int E = B + C;\
  225. const int step = C ? stride : 1;\
  226. for(i = 0; i < h; i++){\
  227. OP(dst[0], (A*src[0] + E*src[step+0] + bias));\
  228. OP(dst[1], (A*src[1] + E*src[step+1] + bias));\
  229. OP(dst[2], (A*src[2] + E*src[step+2] + bias));\
  230. OP(dst[3], (A*src[3] + E*src[step+3] + bias));\
  231. dst += stride;\
  232. src += stride;\
  233. }\
  234. }\
  235. }\
  236. \
  237. static void OPNAME ## rv40_chroma_mc8_c(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y){\
  238. const int A = (8-x) * (8-y);\
  239. const int B = ( x) * (8-y);\
  240. const int C = (8-x) * ( y);\
  241. const int D = ( x) * ( y);\
  242. int i;\
  243. int bias = rv40_bias[y>>1][x>>1];\
  244. \
  245. assert(x<8 && y<8 && x>=0 && y>=0);\
  246. \
  247. if(D){\
  248. for(i = 0; i < h; i++){\
  249. OP(dst[0], (A*src[0] + B*src[1] + C*src[stride+0] + D*src[stride+1] + bias));\
  250. OP(dst[1], (A*src[1] + B*src[2] + C*src[stride+1] + D*src[stride+2] + bias));\
  251. OP(dst[2], (A*src[2] + B*src[3] + C*src[stride+2] + D*src[stride+3] + bias));\
  252. OP(dst[3], (A*src[3] + B*src[4] + C*src[stride+3] + D*src[stride+4] + bias));\
  253. OP(dst[4], (A*src[4] + B*src[5] + C*src[stride+4] + D*src[stride+5] + bias));\
  254. OP(dst[5], (A*src[5] + B*src[6] + C*src[stride+5] + D*src[stride+6] + bias));\
  255. OP(dst[6], (A*src[6] + B*src[7] + C*src[stride+6] + D*src[stride+7] + bias));\
  256. OP(dst[7], (A*src[7] + B*src[8] + C*src[stride+7] + D*src[stride+8] + bias));\
  257. dst += stride;\
  258. src += stride;\
  259. }\
  260. }else{\
  261. const int E = B + C;\
  262. const int step = C ? stride : 1;\
  263. for(i = 0; i < h; i++){\
  264. OP(dst[0], (A*src[0] + E*src[step+0] + bias));\
  265. OP(dst[1], (A*src[1] + E*src[step+1] + bias));\
  266. OP(dst[2], (A*src[2] + E*src[step+2] + bias));\
  267. OP(dst[3], (A*src[3] + E*src[step+3] + bias));\
  268. OP(dst[4], (A*src[4] + E*src[step+4] + bias));\
  269. OP(dst[5], (A*src[5] + E*src[step+5] + bias));\
  270. OP(dst[6], (A*src[6] + E*src[step+6] + bias));\
  271. OP(dst[7], (A*src[7] + E*src[step+7] + bias));\
  272. dst += stride;\
  273. src += stride;\
  274. }\
  275. }\
  276. }
  277. #define op_avg(a, b) a = (((a)+((b)>>6)+1)>>1)
  278. #define op_put(a, b) a = ((b)>>6)
  279. RV40_CHROMA_MC(put_, op_put)
  280. RV40_CHROMA_MC(avg_, op_avg)
  281. #define RV40_WEIGHT_FUNC(size) \
  282. static void rv40_weight_func_rnd_ ## size (uint8_t *dst, uint8_t *src1, uint8_t *src2, int w1, int w2, ptrdiff_t stride)\
  283. {\
  284. int i, j;\
  285. \
  286. for (j = 0; j < size; j++) {\
  287. for (i = 0; i < size; i++)\
  288. dst[i] = (((w2 * src1[i]) >> 9) + ((w1 * src2[i]) >> 9) + 0x10) >> 5;\
  289. src1 += stride;\
  290. src2 += stride;\
  291. dst += stride;\
  292. }\
  293. }\
  294. static void rv40_weight_func_nornd_ ## size (uint8_t *dst, uint8_t *src1, uint8_t *src2, int w1, int w2, ptrdiff_t stride)\
  295. {\
  296. int i, j;\
  297. \
  298. for (j = 0; j < size; j++) {\
  299. for (i = 0; i < size; i++)\
  300. dst[i] = (w2 * src1[i] + w1 * src2[i] + 0x10) >> 5;\
  301. src1 += stride;\
  302. src2 += stride;\
  303. dst += stride;\
  304. }\
  305. }
  306. RV40_WEIGHT_FUNC(16)
  307. RV40_WEIGHT_FUNC(8)
  308. /**
  309. * dither values for deblocking filter - left/top values
  310. */
  311. static const uint8_t rv40_dither_l[16] = {
  312. 0x40, 0x50, 0x20, 0x60, 0x30, 0x50, 0x40, 0x30,
  313. 0x50, 0x40, 0x50, 0x30, 0x60, 0x20, 0x50, 0x40
  314. };
  315. /**
  316. * dither values for deblocking filter - right/bottom values
  317. */
  318. static const uint8_t rv40_dither_r[16] = {
  319. 0x40, 0x30, 0x60, 0x20, 0x50, 0x30, 0x30, 0x40,
  320. 0x40, 0x40, 0x50, 0x30, 0x20, 0x60, 0x30, 0x40
  321. };
  322. #define CLIP_SYMM(a, b) av_clip(a, -(b), b)
  323. /**
  324. * weaker deblocking very similar to the one described in 4.4.2 of JVT-A003r1
  325. */
  326. static av_always_inline void rv40_weak_loop_filter(uint8_t *src,
  327. const int step,
  328. const ptrdiff_t stride,
  329. const int filter_p1,
  330. const int filter_q1,
  331. const int alpha,
  332. const int beta,
  333. const int lim_p0q0,
  334. const int lim_q1,
  335. const int lim_p1)
  336. {
  337. const uint8_t *cm = ff_crop_tab + MAX_NEG_CROP;
  338. int i, t, u, diff;
  339. for (i = 0; i < 4; i++, src += stride) {
  340. int diff_p1p0 = src[-2*step] - src[-1*step];
  341. int diff_q1q0 = src[ 1*step] - src[ 0*step];
  342. int diff_p1p2 = src[-2*step] - src[-3*step];
  343. int diff_q1q2 = src[ 1*step] - src[ 2*step];
  344. t = src[0*step] - src[-1*step];
  345. if (!t)
  346. continue;
  347. u = (alpha * FFABS(t)) >> 7;
  348. if (u > 3 - (filter_p1 && filter_q1))
  349. continue;
  350. t <<= 2;
  351. if (filter_p1 && filter_q1)
  352. t += src[-2*step] - src[1*step];
  353. diff = CLIP_SYMM((t + 4) >> 3, lim_p0q0);
  354. src[-1*step] = cm[src[-1*step] + diff];
  355. src[ 0*step] = cm[src[ 0*step] - diff];
  356. if (filter_p1 && FFABS(diff_p1p2) <= beta) {
  357. t = (diff_p1p0 + diff_p1p2 - diff) >> 1;
  358. src[-2*step] = cm[src[-2*step] - CLIP_SYMM(t, lim_p1)];
  359. }
  360. if (filter_q1 && FFABS(diff_q1q2) <= beta) {
  361. t = (diff_q1q0 + diff_q1q2 + diff) >> 1;
  362. src[ 1*step] = cm[src[ 1*step] - CLIP_SYMM(t, lim_q1)];
  363. }
  364. }
  365. }
  366. static void rv40_h_weak_loop_filter(uint8_t *src, const ptrdiff_t stride,
  367. const int filter_p1, const int filter_q1,
  368. const int alpha, const int beta,
  369. const int lim_p0q0, const int lim_q1,
  370. const int lim_p1)
  371. {
  372. rv40_weak_loop_filter(src, stride, 1, filter_p1, filter_q1,
  373. alpha, beta, lim_p0q0, lim_q1, lim_p1);
  374. }
  375. static void rv40_v_weak_loop_filter(uint8_t *src, const ptrdiff_t stride,
  376. const int filter_p1, const int filter_q1,
  377. const int alpha, const int beta,
  378. const int lim_p0q0, const int lim_q1,
  379. const int lim_p1)
  380. {
  381. rv40_weak_loop_filter(src, 1, stride, filter_p1, filter_q1,
  382. alpha, beta, lim_p0q0, lim_q1, lim_p1);
  383. }
  384. static av_always_inline void rv40_strong_loop_filter(uint8_t *src,
  385. const int step,
  386. const ptrdiff_t stride,
  387. const int alpha,
  388. const int lims,
  389. const int dmode,
  390. const int chroma)
  391. {
  392. int i;
  393. for(i = 0; i < 4; i++, src += stride){
  394. int sflag, p0, q0, p1, q1;
  395. int t = src[0*step] - src[-1*step];
  396. if (!t)
  397. continue;
  398. sflag = (alpha * FFABS(t)) >> 7;
  399. if (sflag > 1)
  400. continue;
  401. p0 = (25*src[-3*step] + 26*src[-2*step] + 26*src[-1*step] +
  402. 26*src[ 0*step] + 25*src[ 1*step] +
  403. rv40_dither_l[dmode + i]) >> 7;
  404. q0 = (25*src[-2*step] + 26*src[-1*step] + 26*src[ 0*step] +
  405. 26*src[ 1*step] + 25*src[ 2*step] +
  406. rv40_dither_r[dmode + i]) >> 7;
  407. if (sflag) {
  408. p0 = av_clip(p0, src[-1*step] - lims, src[-1*step] + lims);
  409. q0 = av_clip(q0, src[ 0*step] - lims, src[ 0*step] + lims);
  410. }
  411. p1 = (25*src[-4*step] + 26*src[-3*step] + 26*src[-2*step] + 26*p0 +
  412. 25*src[ 0*step] + rv40_dither_l[dmode + i]) >> 7;
  413. q1 = (25*src[-1*step] + 26*q0 + 26*src[ 1*step] + 26*src[ 2*step] +
  414. 25*src[ 3*step] + rv40_dither_r[dmode + i]) >> 7;
  415. if (sflag) {
  416. p1 = av_clip(p1, src[-2*step] - lims, src[-2*step] + lims);
  417. q1 = av_clip(q1, src[ 1*step] - lims, src[ 1*step] + lims);
  418. }
  419. src[-2*step] = p1;
  420. src[-1*step] = p0;
  421. src[ 0*step] = q0;
  422. src[ 1*step] = q1;
  423. if(!chroma){
  424. src[-3*step] = (25*src[-1*step] + 26*src[-2*step] +
  425. 51*src[-3*step] + 26*src[-4*step] + 64) >> 7;
  426. src[ 2*step] = (25*src[ 0*step] + 26*src[ 1*step] +
  427. 51*src[ 2*step] + 26*src[ 3*step] + 64) >> 7;
  428. }
  429. }
  430. }
  431. static void rv40_h_strong_loop_filter(uint8_t *src, const ptrdiff_t stride,
  432. const int alpha, const int lims,
  433. const int dmode, const int chroma)
  434. {
  435. rv40_strong_loop_filter(src, stride, 1, alpha, lims, dmode, chroma);
  436. }
  437. static void rv40_v_strong_loop_filter(uint8_t *src, const ptrdiff_t stride,
  438. const int alpha, const int lims,
  439. const int dmode, const int chroma)
  440. {
  441. rv40_strong_loop_filter(src, 1, stride, alpha, lims, dmode, chroma);
  442. }
  443. static av_always_inline int rv40_loop_filter_strength(uint8_t *src,
  444. int step, ptrdiff_t stride,
  445. int beta, int beta2,
  446. int edge,
  447. int *p1, int *q1)
  448. {
  449. int sum_p1p0 = 0, sum_q1q0 = 0, sum_p1p2 = 0, sum_q1q2 = 0;
  450. int strong0 = 0, strong1 = 0;
  451. uint8_t *ptr;
  452. int i;
  453. for (i = 0, ptr = src; i < 4; i++, ptr += stride) {
  454. sum_p1p0 += ptr[-2*step] - ptr[-1*step];
  455. sum_q1q0 += ptr[ 1*step] - ptr[ 0*step];
  456. }
  457. *p1 = FFABS(sum_p1p0) < (beta << 2);
  458. *q1 = FFABS(sum_q1q0) < (beta << 2);
  459. if(!*p1 && !*q1)
  460. return 0;
  461. if (!edge)
  462. return 0;
  463. for (i = 0, ptr = src; i < 4; i++, ptr += stride) {
  464. sum_p1p2 += ptr[-2*step] - ptr[-3*step];
  465. sum_q1q2 += ptr[ 1*step] - ptr[ 2*step];
  466. }
  467. strong0 = *p1 && (FFABS(sum_p1p2) < beta2);
  468. strong1 = *q1 && (FFABS(sum_q1q2) < beta2);
  469. return strong0 && strong1;
  470. }
  471. static int rv40_h_loop_filter_strength(uint8_t *src, ptrdiff_t stride,
  472. int beta, int beta2, int edge,
  473. int *p1, int *q1)
  474. {
  475. return rv40_loop_filter_strength(src, stride, 1, beta, beta2, edge, p1, q1);
  476. }
  477. static int rv40_v_loop_filter_strength(uint8_t *src, ptrdiff_t stride,
  478. int beta, int beta2, int edge,
  479. int *p1, int *q1)
  480. {
  481. return rv40_loop_filter_strength(src, 1, stride, beta, beta2, edge, p1, q1);
  482. }
  483. av_cold void ff_rv40dsp_init(RV34DSPContext *c)
  484. {
  485. H264QpelContext qpel;
  486. ff_rv34dsp_init(c);
  487. ff_h264qpel_init(&qpel, 8);
  488. c->put_pixels_tab[0][ 0] = qpel.put_h264_qpel_pixels_tab[0][0];
  489. c->put_pixels_tab[0][ 1] = put_rv40_qpel16_mc10_c;
  490. c->put_pixels_tab[0][ 2] = qpel.put_h264_qpel_pixels_tab[0][2];
  491. c->put_pixels_tab[0][ 3] = put_rv40_qpel16_mc30_c;
  492. c->put_pixels_tab[0][ 4] = put_rv40_qpel16_mc01_c;
  493. c->put_pixels_tab[0][ 5] = put_rv40_qpel16_mc11_c;
  494. c->put_pixels_tab[0][ 6] = put_rv40_qpel16_mc21_c;
  495. c->put_pixels_tab[0][ 7] = put_rv40_qpel16_mc31_c;
  496. c->put_pixels_tab[0][ 8] = qpel.put_h264_qpel_pixels_tab[0][8];
  497. c->put_pixels_tab[0][ 9] = put_rv40_qpel16_mc12_c;
  498. c->put_pixels_tab[0][10] = put_rv40_qpel16_mc22_c;
  499. c->put_pixels_tab[0][11] = put_rv40_qpel16_mc32_c;
  500. c->put_pixels_tab[0][12] = put_rv40_qpel16_mc03_c;
  501. c->put_pixels_tab[0][13] = put_rv40_qpel16_mc13_c;
  502. c->put_pixels_tab[0][14] = put_rv40_qpel16_mc23_c;
  503. c->put_pixels_tab[0][15] = ff_put_rv40_qpel16_mc33_c;
  504. c->avg_pixels_tab[0][ 0] = qpel.avg_h264_qpel_pixels_tab[0][0];
  505. c->avg_pixels_tab[0][ 1] = avg_rv40_qpel16_mc10_c;
  506. c->avg_pixels_tab[0][ 2] = qpel.avg_h264_qpel_pixels_tab[0][2];
  507. c->avg_pixels_tab[0][ 3] = avg_rv40_qpel16_mc30_c;
  508. c->avg_pixels_tab[0][ 4] = avg_rv40_qpel16_mc01_c;
  509. c->avg_pixels_tab[0][ 5] = avg_rv40_qpel16_mc11_c;
  510. c->avg_pixels_tab[0][ 6] = avg_rv40_qpel16_mc21_c;
  511. c->avg_pixels_tab[0][ 7] = avg_rv40_qpel16_mc31_c;
  512. c->avg_pixels_tab[0][ 8] = qpel.avg_h264_qpel_pixels_tab[0][8];
  513. c->avg_pixels_tab[0][ 9] = avg_rv40_qpel16_mc12_c;
  514. c->avg_pixels_tab[0][10] = avg_rv40_qpel16_mc22_c;
  515. c->avg_pixels_tab[0][11] = avg_rv40_qpel16_mc32_c;
  516. c->avg_pixels_tab[0][12] = avg_rv40_qpel16_mc03_c;
  517. c->avg_pixels_tab[0][13] = avg_rv40_qpel16_mc13_c;
  518. c->avg_pixels_tab[0][14] = avg_rv40_qpel16_mc23_c;
  519. c->avg_pixels_tab[0][15] = ff_avg_rv40_qpel16_mc33_c;
  520. c->put_pixels_tab[1][ 0] = qpel.put_h264_qpel_pixels_tab[1][0];
  521. c->put_pixels_tab[1][ 1] = put_rv40_qpel8_mc10_c;
  522. c->put_pixels_tab[1][ 2] = qpel.put_h264_qpel_pixels_tab[1][2];
  523. c->put_pixels_tab[1][ 3] = put_rv40_qpel8_mc30_c;
  524. c->put_pixels_tab[1][ 4] = put_rv40_qpel8_mc01_c;
  525. c->put_pixels_tab[1][ 5] = put_rv40_qpel8_mc11_c;
  526. c->put_pixels_tab[1][ 6] = put_rv40_qpel8_mc21_c;
  527. c->put_pixels_tab[1][ 7] = put_rv40_qpel8_mc31_c;
  528. c->put_pixels_tab[1][ 8] = qpel.put_h264_qpel_pixels_tab[1][8];
  529. c->put_pixels_tab[1][ 9] = put_rv40_qpel8_mc12_c;
  530. c->put_pixels_tab[1][10] = put_rv40_qpel8_mc22_c;
  531. c->put_pixels_tab[1][11] = put_rv40_qpel8_mc32_c;
  532. c->put_pixels_tab[1][12] = put_rv40_qpel8_mc03_c;
  533. c->put_pixels_tab[1][13] = put_rv40_qpel8_mc13_c;
  534. c->put_pixels_tab[1][14] = put_rv40_qpel8_mc23_c;
  535. c->put_pixels_tab[1][15] = ff_put_rv40_qpel8_mc33_c;
  536. c->avg_pixels_tab[1][ 0] = qpel.avg_h264_qpel_pixels_tab[1][0];
  537. c->avg_pixels_tab[1][ 1] = avg_rv40_qpel8_mc10_c;
  538. c->avg_pixels_tab[1][ 2] = qpel.avg_h264_qpel_pixels_tab[1][2];
  539. c->avg_pixels_tab[1][ 3] = avg_rv40_qpel8_mc30_c;
  540. c->avg_pixels_tab[1][ 4] = avg_rv40_qpel8_mc01_c;
  541. c->avg_pixels_tab[1][ 5] = avg_rv40_qpel8_mc11_c;
  542. c->avg_pixels_tab[1][ 6] = avg_rv40_qpel8_mc21_c;
  543. c->avg_pixels_tab[1][ 7] = avg_rv40_qpel8_mc31_c;
  544. c->avg_pixels_tab[1][ 8] = qpel.avg_h264_qpel_pixels_tab[1][8];
  545. c->avg_pixels_tab[1][ 9] = avg_rv40_qpel8_mc12_c;
  546. c->avg_pixels_tab[1][10] = avg_rv40_qpel8_mc22_c;
  547. c->avg_pixels_tab[1][11] = avg_rv40_qpel8_mc32_c;
  548. c->avg_pixels_tab[1][12] = avg_rv40_qpel8_mc03_c;
  549. c->avg_pixels_tab[1][13] = avg_rv40_qpel8_mc13_c;
  550. c->avg_pixels_tab[1][14] = avg_rv40_qpel8_mc23_c;
  551. c->avg_pixels_tab[1][15] = ff_avg_rv40_qpel8_mc33_c;
  552. c->put_chroma_pixels_tab[0] = put_rv40_chroma_mc8_c;
  553. c->put_chroma_pixels_tab[1] = put_rv40_chroma_mc4_c;
  554. c->avg_chroma_pixels_tab[0] = avg_rv40_chroma_mc8_c;
  555. c->avg_chroma_pixels_tab[1] = avg_rv40_chroma_mc4_c;
  556. c->rv40_weight_pixels_tab[0][0] = rv40_weight_func_rnd_16;
  557. c->rv40_weight_pixels_tab[0][1] = rv40_weight_func_rnd_8;
  558. c->rv40_weight_pixels_tab[1][0] = rv40_weight_func_nornd_16;
  559. c->rv40_weight_pixels_tab[1][1] = rv40_weight_func_nornd_8;
  560. c->rv40_weak_loop_filter[0] = rv40_h_weak_loop_filter;
  561. c->rv40_weak_loop_filter[1] = rv40_v_weak_loop_filter;
  562. c->rv40_strong_loop_filter[0] = rv40_h_strong_loop_filter;
  563. c->rv40_strong_loop_filter[1] = rv40_v_strong_loop_filter;
  564. c->rv40_loop_filter_strength[0] = rv40_h_loop_filter_strength;
  565. c->rv40_loop_filter_strength[1] = rv40_v_loop_filter_strength;
  566. if (ARCH_AARCH64)
  567. ff_rv40dsp_init_aarch64(c);
  568. if (ARCH_ARM)
  569. ff_rv40dsp_init_arm(c);
  570. if (ARCH_X86)
  571. ff_rv40dsp_init_x86(c);
  572. }