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.

596 lines
23KB

  1. /*
  2. * DSP utils mmx functions are compiled twice for rnd/no_rnd
  3. * Copyright (c) 2000, 2001 Fabrice Bellard.
  4. * Copyright (c) 2003-2004 Michael Niedermayer <michaelni@gmx.at>
  5. *
  6. * MMX optimization by Nick Kurshev <nickols_k@mail.ru>
  7. * mostly rewritten by Michael Niedermayer <michaelni@gmx.at>
  8. * and improved by Zdenek Kabelac <kabi@users.sf.net>
  9. *
  10. * This file is part of FFmpeg.
  11. *
  12. * FFmpeg is free software; you can redistribute it and/or
  13. * modify it under the terms of the GNU Lesser General Public
  14. * License as published by the Free Software Foundation; either
  15. * version 2.1 of the License, or (at your option) any later version.
  16. *
  17. * FFmpeg is distributed in the hope that it will be useful,
  18. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  20. * Lesser General Public License for more details.
  21. *
  22. * You should have received a copy of the GNU Lesser General Public
  23. * License along with FFmpeg; if not, write to the Free Software
  24. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  25. */
  26. #ifndef FFMPEG_DSPUTIL_MMX_RND_H
  27. #define FFMPEG_DSPUTIL_MMX_RND_H
  28. // put_pixels
  29. static void DEF(put, pixels8_x2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  30. {
  31. MOVQ_BFE(mm6);
  32. __asm __volatile(
  33. "lea (%3, %3), %%"REG_a" \n\t"
  34. ASMALIGN(3)
  35. "1: \n\t"
  36. "movq (%1), %%mm0 \n\t"
  37. "movq 1(%1), %%mm1 \n\t"
  38. "movq (%1, %3), %%mm2 \n\t"
  39. "movq 1(%1, %3), %%mm3 \n\t"
  40. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  41. "movq %%mm4, (%2) \n\t"
  42. "movq %%mm5, (%2, %3) \n\t"
  43. "add %%"REG_a", %1 \n\t"
  44. "add %%"REG_a", %2 \n\t"
  45. "movq (%1), %%mm0 \n\t"
  46. "movq 1(%1), %%mm1 \n\t"
  47. "movq (%1, %3), %%mm2 \n\t"
  48. "movq 1(%1, %3), %%mm3 \n\t"
  49. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  50. "movq %%mm4, (%2) \n\t"
  51. "movq %%mm5, (%2, %3) \n\t"
  52. "add %%"REG_a", %1 \n\t"
  53. "add %%"REG_a", %2 \n\t"
  54. "subl $4, %0 \n\t"
  55. "jnz 1b \n\t"
  56. :"+g"(h), "+S"(pixels), "+D"(block)
  57. :"r"((long)line_size)
  58. :REG_a, "memory");
  59. }
  60. static void av_unused DEF(put, pixels8_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
  61. {
  62. MOVQ_BFE(mm6);
  63. __asm __volatile(
  64. "testl $1, %0 \n\t"
  65. " jz 1f \n\t"
  66. "movq (%1), %%mm0 \n\t"
  67. "movq (%2), %%mm1 \n\t"
  68. "add %4, %1 \n\t"
  69. "add $8, %2 \n\t"
  70. PAVGB(%%mm0, %%mm1, %%mm4, %%mm6)
  71. "movq %%mm4, (%3) \n\t"
  72. "add %5, %3 \n\t"
  73. "decl %0 \n\t"
  74. ASMALIGN(3)
  75. "1: \n\t"
  76. "movq (%1), %%mm0 \n\t"
  77. "movq (%2), %%mm1 \n\t"
  78. "add %4, %1 \n\t"
  79. "movq (%1), %%mm2 \n\t"
  80. "movq 8(%2), %%mm3 \n\t"
  81. "add %4, %1 \n\t"
  82. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  83. "movq %%mm4, (%3) \n\t"
  84. "add %5, %3 \n\t"
  85. "movq %%mm5, (%3) \n\t"
  86. "add %5, %3 \n\t"
  87. "movq (%1), %%mm0 \n\t"
  88. "movq 16(%2), %%mm1 \n\t"
  89. "add %4, %1 \n\t"
  90. "movq (%1), %%mm2 \n\t"
  91. "movq 24(%2), %%mm3 \n\t"
  92. "add %4, %1 \n\t"
  93. "add $32, %2 \n\t"
  94. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  95. "movq %%mm4, (%3) \n\t"
  96. "add %5, %3 \n\t"
  97. "movq %%mm5, (%3) \n\t"
  98. "add %5, %3 \n\t"
  99. "subl $4, %0 \n\t"
  100. "jnz 1b \n\t"
  101. #ifdef PIC //Note "+bm" and "+mb" are buggy too (with gcc 3.2.2 at least) and cannot be used
  102. :"+m"(h), "+a"(src1), "+c"(src2), "+d"(dst)
  103. #else
  104. :"+b"(h), "+a"(src1), "+c"(src2), "+d"(dst)
  105. #endif
  106. :"S"((long)src1Stride), "D"((long)dstStride)
  107. :"memory");
  108. }
  109. static void DEF(put, pixels16_x2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  110. {
  111. MOVQ_BFE(mm6);
  112. __asm __volatile(
  113. "lea (%3, %3), %%"REG_a" \n\t"
  114. ASMALIGN(3)
  115. "1: \n\t"
  116. "movq (%1), %%mm0 \n\t"
  117. "movq 1(%1), %%mm1 \n\t"
  118. "movq (%1, %3), %%mm2 \n\t"
  119. "movq 1(%1, %3), %%mm3 \n\t"
  120. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  121. "movq %%mm4, (%2) \n\t"
  122. "movq %%mm5, (%2, %3) \n\t"
  123. "movq 8(%1), %%mm0 \n\t"
  124. "movq 9(%1), %%mm1 \n\t"
  125. "movq 8(%1, %3), %%mm2 \n\t"
  126. "movq 9(%1, %3), %%mm3 \n\t"
  127. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  128. "movq %%mm4, 8(%2) \n\t"
  129. "movq %%mm5, 8(%2, %3) \n\t"
  130. "add %%"REG_a", %1 \n\t"
  131. "add %%"REG_a", %2 \n\t"
  132. "movq (%1), %%mm0 \n\t"
  133. "movq 1(%1), %%mm1 \n\t"
  134. "movq (%1, %3), %%mm2 \n\t"
  135. "movq 1(%1, %3), %%mm3 \n\t"
  136. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  137. "movq %%mm4, (%2) \n\t"
  138. "movq %%mm5, (%2, %3) \n\t"
  139. "movq 8(%1), %%mm0 \n\t"
  140. "movq 9(%1), %%mm1 \n\t"
  141. "movq 8(%1, %3), %%mm2 \n\t"
  142. "movq 9(%1, %3), %%mm3 \n\t"
  143. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  144. "movq %%mm4, 8(%2) \n\t"
  145. "movq %%mm5, 8(%2, %3) \n\t"
  146. "add %%"REG_a", %1 \n\t"
  147. "add %%"REG_a", %2 \n\t"
  148. "subl $4, %0 \n\t"
  149. "jnz 1b \n\t"
  150. :"+g"(h), "+S"(pixels), "+D"(block)
  151. :"r"((long)line_size)
  152. :REG_a, "memory");
  153. }
  154. static void av_unused DEF(put, pixels16_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
  155. {
  156. MOVQ_BFE(mm6);
  157. __asm __volatile(
  158. "testl $1, %0 \n\t"
  159. " jz 1f \n\t"
  160. "movq (%1), %%mm0 \n\t"
  161. "movq (%2), %%mm1 \n\t"
  162. "movq 8(%1), %%mm2 \n\t"
  163. "movq 8(%2), %%mm3 \n\t"
  164. "add %4, %1 \n\t"
  165. "add $16, %2 \n\t"
  166. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  167. "movq %%mm4, (%3) \n\t"
  168. "movq %%mm5, 8(%3) \n\t"
  169. "add %5, %3 \n\t"
  170. "decl %0 \n\t"
  171. ASMALIGN(3)
  172. "1: \n\t"
  173. "movq (%1), %%mm0 \n\t"
  174. "movq (%2), %%mm1 \n\t"
  175. "movq 8(%1), %%mm2 \n\t"
  176. "movq 8(%2), %%mm3 \n\t"
  177. "add %4, %1 \n\t"
  178. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  179. "movq %%mm4, (%3) \n\t"
  180. "movq %%mm5, 8(%3) \n\t"
  181. "add %5, %3 \n\t"
  182. "movq (%1), %%mm0 \n\t"
  183. "movq 16(%2), %%mm1 \n\t"
  184. "movq 8(%1), %%mm2 \n\t"
  185. "movq 24(%2), %%mm3 \n\t"
  186. "add %4, %1 \n\t"
  187. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  188. "movq %%mm4, (%3) \n\t"
  189. "movq %%mm5, 8(%3) \n\t"
  190. "add %5, %3 \n\t"
  191. "add $32, %2 \n\t"
  192. "subl $2, %0 \n\t"
  193. "jnz 1b \n\t"
  194. #ifdef PIC //Note "+bm" and "+mb" are buggy too (with gcc 3.2.2 at least) and cannot be used
  195. :"+m"(h), "+a"(src1), "+c"(src2), "+d"(dst)
  196. #else
  197. :"+b"(h), "+a"(src1), "+c"(src2), "+d"(dst)
  198. #endif
  199. :"S"((long)src1Stride), "D"((long)dstStride)
  200. :"memory");
  201. }
  202. static void DEF(put, pixels8_y2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  203. {
  204. MOVQ_BFE(mm6);
  205. __asm __volatile(
  206. "lea (%3, %3), %%"REG_a" \n\t"
  207. "movq (%1), %%mm0 \n\t"
  208. ASMALIGN(3)
  209. "1: \n\t"
  210. "movq (%1, %3), %%mm1 \n\t"
  211. "movq (%1, %%"REG_a"),%%mm2 \n\t"
  212. PAVGBP(%%mm1, %%mm0, %%mm4, %%mm2, %%mm1, %%mm5)
  213. "movq %%mm4, (%2) \n\t"
  214. "movq %%mm5, (%2, %3) \n\t"
  215. "add %%"REG_a", %1 \n\t"
  216. "add %%"REG_a", %2 \n\t"
  217. "movq (%1, %3), %%mm1 \n\t"
  218. "movq (%1, %%"REG_a"),%%mm0 \n\t"
  219. PAVGBP(%%mm1, %%mm2, %%mm4, %%mm0, %%mm1, %%mm5)
  220. "movq %%mm4, (%2) \n\t"
  221. "movq %%mm5, (%2, %3) \n\t"
  222. "add %%"REG_a", %1 \n\t"
  223. "add %%"REG_a", %2 \n\t"
  224. "subl $4, %0 \n\t"
  225. "jnz 1b \n\t"
  226. :"+g"(h), "+S"(pixels), "+D"(block)
  227. :"r"((long)line_size)
  228. :REG_a, "memory");
  229. }
  230. static void DEF(put, pixels8_xy2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  231. {
  232. MOVQ_ZERO(mm7);
  233. SET_RND(mm6); // =2 for rnd and =1 for no_rnd version
  234. __asm __volatile(
  235. "movq (%1), %%mm0 \n\t"
  236. "movq 1(%1), %%mm4 \n\t"
  237. "movq %%mm0, %%mm1 \n\t"
  238. "movq %%mm4, %%mm5 \n\t"
  239. "punpcklbw %%mm7, %%mm0 \n\t"
  240. "punpcklbw %%mm7, %%mm4 \n\t"
  241. "punpckhbw %%mm7, %%mm1 \n\t"
  242. "punpckhbw %%mm7, %%mm5 \n\t"
  243. "paddusw %%mm0, %%mm4 \n\t"
  244. "paddusw %%mm1, %%mm5 \n\t"
  245. "xor %%"REG_a", %%"REG_a" \n\t"
  246. "add %3, %1 \n\t"
  247. ASMALIGN(3)
  248. "1: \n\t"
  249. "movq (%1, %%"REG_a"), %%mm0 \n\t"
  250. "movq 1(%1, %%"REG_a"), %%mm2 \n\t"
  251. "movq %%mm0, %%mm1 \n\t"
  252. "movq %%mm2, %%mm3 \n\t"
  253. "punpcklbw %%mm7, %%mm0 \n\t"
  254. "punpcklbw %%mm7, %%mm2 \n\t"
  255. "punpckhbw %%mm7, %%mm1 \n\t"
  256. "punpckhbw %%mm7, %%mm3 \n\t"
  257. "paddusw %%mm2, %%mm0 \n\t"
  258. "paddusw %%mm3, %%mm1 \n\t"
  259. "paddusw %%mm6, %%mm4 \n\t"
  260. "paddusw %%mm6, %%mm5 \n\t"
  261. "paddusw %%mm0, %%mm4 \n\t"
  262. "paddusw %%mm1, %%mm5 \n\t"
  263. "psrlw $2, %%mm4 \n\t"
  264. "psrlw $2, %%mm5 \n\t"
  265. "packuswb %%mm5, %%mm4 \n\t"
  266. "movq %%mm4, (%2, %%"REG_a") \n\t"
  267. "add %3, %%"REG_a" \n\t"
  268. "movq (%1, %%"REG_a"), %%mm2 \n\t" // 0 <-> 2 1 <-> 3
  269. "movq 1(%1, %%"REG_a"), %%mm4 \n\t"
  270. "movq %%mm2, %%mm3 \n\t"
  271. "movq %%mm4, %%mm5 \n\t"
  272. "punpcklbw %%mm7, %%mm2 \n\t"
  273. "punpcklbw %%mm7, %%mm4 \n\t"
  274. "punpckhbw %%mm7, %%mm3 \n\t"
  275. "punpckhbw %%mm7, %%mm5 \n\t"
  276. "paddusw %%mm2, %%mm4 \n\t"
  277. "paddusw %%mm3, %%mm5 \n\t"
  278. "paddusw %%mm6, %%mm0 \n\t"
  279. "paddusw %%mm6, %%mm1 \n\t"
  280. "paddusw %%mm4, %%mm0 \n\t"
  281. "paddusw %%mm5, %%mm1 \n\t"
  282. "psrlw $2, %%mm0 \n\t"
  283. "psrlw $2, %%mm1 \n\t"
  284. "packuswb %%mm1, %%mm0 \n\t"
  285. "movq %%mm0, (%2, %%"REG_a") \n\t"
  286. "add %3, %%"REG_a" \n\t"
  287. "subl $2, %0 \n\t"
  288. "jnz 1b \n\t"
  289. :"+g"(h), "+S"(pixels)
  290. :"D"(block), "r"((long)line_size)
  291. :REG_a, "memory");
  292. }
  293. // avg_pixels
  294. static void av_unused DEF(avg, pixels4)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  295. {
  296. MOVQ_BFE(mm6);
  297. JUMPALIGN();
  298. do {
  299. __asm __volatile(
  300. "movd %0, %%mm0 \n\t"
  301. "movd %1, %%mm1 \n\t"
  302. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  303. "movd %%mm2, %0 \n\t"
  304. :"+m"(*block)
  305. :"m"(*pixels)
  306. :"memory");
  307. pixels += line_size;
  308. block += line_size;
  309. }
  310. while (--h);
  311. }
  312. // in case more speed is needed - unroling would certainly help
  313. static void DEF(avg, pixels8)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  314. {
  315. MOVQ_BFE(mm6);
  316. JUMPALIGN();
  317. do {
  318. __asm __volatile(
  319. "movq %0, %%mm0 \n\t"
  320. "movq %1, %%mm1 \n\t"
  321. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  322. "movq %%mm2, %0 \n\t"
  323. :"+m"(*block)
  324. :"m"(*pixels)
  325. :"memory");
  326. pixels += line_size;
  327. block += line_size;
  328. }
  329. while (--h);
  330. }
  331. static void DEF(avg, pixels16)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  332. {
  333. MOVQ_BFE(mm6);
  334. JUMPALIGN();
  335. do {
  336. __asm __volatile(
  337. "movq %0, %%mm0 \n\t"
  338. "movq %1, %%mm1 \n\t"
  339. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  340. "movq %%mm2, %0 \n\t"
  341. "movq 8%0, %%mm0 \n\t"
  342. "movq 8%1, %%mm1 \n\t"
  343. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  344. "movq %%mm2, 8%0 \n\t"
  345. :"+m"(*block)
  346. :"m"(*pixels)
  347. :"memory");
  348. pixels += line_size;
  349. block += line_size;
  350. }
  351. while (--h);
  352. }
  353. static void DEF(avg, pixels8_x2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  354. {
  355. MOVQ_BFE(mm6);
  356. JUMPALIGN();
  357. do {
  358. __asm __volatile(
  359. "movq %1, %%mm0 \n\t"
  360. "movq 1%1, %%mm1 \n\t"
  361. "movq %0, %%mm3 \n\t"
  362. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  363. PAVGB(%%mm3, %%mm2, %%mm0, %%mm6)
  364. "movq %%mm0, %0 \n\t"
  365. :"+m"(*block)
  366. :"m"(*pixels)
  367. :"memory");
  368. pixels += line_size;
  369. block += line_size;
  370. } while (--h);
  371. }
  372. static av_unused void DEF(avg, pixels8_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
  373. {
  374. MOVQ_BFE(mm6);
  375. JUMPALIGN();
  376. do {
  377. __asm __volatile(
  378. "movq %1, %%mm0 \n\t"
  379. "movq %2, %%mm1 \n\t"
  380. "movq %0, %%mm3 \n\t"
  381. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  382. PAVGB(%%mm3, %%mm2, %%mm0, %%mm6)
  383. "movq %%mm0, %0 \n\t"
  384. :"+m"(*dst)
  385. :"m"(*src1), "m"(*src2)
  386. :"memory");
  387. dst += dstStride;
  388. src1 += src1Stride;
  389. src2 += 8;
  390. } while (--h);
  391. }
  392. static void DEF(avg, pixels16_x2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  393. {
  394. MOVQ_BFE(mm6);
  395. JUMPALIGN();
  396. do {
  397. __asm __volatile(
  398. "movq %1, %%mm0 \n\t"
  399. "movq 1%1, %%mm1 \n\t"
  400. "movq %0, %%mm3 \n\t"
  401. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  402. PAVGB(%%mm3, %%mm2, %%mm0, %%mm6)
  403. "movq %%mm0, %0 \n\t"
  404. "movq 8%1, %%mm0 \n\t"
  405. "movq 9%1, %%mm1 \n\t"
  406. "movq 8%0, %%mm3 \n\t"
  407. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  408. PAVGB(%%mm3, %%mm2, %%mm0, %%mm6)
  409. "movq %%mm0, 8%0 \n\t"
  410. :"+m"(*block)
  411. :"m"(*pixels)
  412. :"memory");
  413. pixels += line_size;
  414. block += line_size;
  415. } while (--h);
  416. }
  417. static av_unused void DEF(avg, pixels16_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
  418. {
  419. MOVQ_BFE(mm6);
  420. JUMPALIGN();
  421. do {
  422. __asm __volatile(
  423. "movq %1, %%mm0 \n\t"
  424. "movq %2, %%mm1 \n\t"
  425. "movq %0, %%mm3 \n\t"
  426. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  427. PAVGB(%%mm3, %%mm2, %%mm0, %%mm6)
  428. "movq %%mm0, %0 \n\t"
  429. "movq 8%1, %%mm0 \n\t"
  430. "movq 8%2, %%mm1 \n\t"
  431. "movq 8%0, %%mm3 \n\t"
  432. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  433. PAVGB(%%mm3, %%mm2, %%mm0, %%mm6)
  434. "movq %%mm0, 8%0 \n\t"
  435. :"+m"(*dst)
  436. :"m"(*src1), "m"(*src2)
  437. :"memory");
  438. dst += dstStride;
  439. src1 += src1Stride;
  440. src2 += 16;
  441. } while (--h);
  442. }
  443. static void DEF(avg, pixels8_y2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  444. {
  445. MOVQ_BFE(mm6);
  446. __asm __volatile(
  447. "lea (%3, %3), %%"REG_a" \n\t"
  448. "movq (%1), %%mm0 \n\t"
  449. ASMALIGN(3)
  450. "1: \n\t"
  451. "movq (%1, %3), %%mm1 \n\t"
  452. "movq (%1, %%"REG_a"), %%mm2 \n\t"
  453. PAVGBP(%%mm1, %%mm0, %%mm4, %%mm2, %%mm1, %%mm5)
  454. "movq (%2), %%mm3 \n\t"
  455. PAVGB(%%mm3, %%mm4, %%mm0, %%mm6)
  456. "movq (%2, %3), %%mm3 \n\t"
  457. PAVGB(%%mm3, %%mm5, %%mm1, %%mm6)
  458. "movq %%mm0, (%2) \n\t"
  459. "movq %%mm1, (%2, %3) \n\t"
  460. "add %%"REG_a", %1 \n\t"
  461. "add %%"REG_a", %2 \n\t"
  462. "movq (%1, %3), %%mm1 \n\t"
  463. "movq (%1, %%"REG_a"), %%mm0 \n\t"
  464. PAVGBP(%%mm1, %%mm2, %%mm4, %%mm0, %%mm1, %%mm5)
  465. "movq (%2), %%mm3 \n\t"
  466. PAVGB(%%mm3, %%mm4, %%mm2, %%mm6)
  467. "movq (%2, %3), %%mm3 \n\t"
  468. PAVGB(%%mm3, %%mm5, %%mm1, %%mm6)
  469. "movq %%mm2, (%2) \n\t"
  470. "movq %%mm1, (%2, %3) \n\t"
  471. "add %%"REG_a", %1 \n\t"
  472. "add %%"REG_a", %2 \n\t"
  473. "subl $4, %0 \n\t"
  474. "jnz 1b \n\t"
  475. :"+g"(h), "+S"(pixels), "+D"(block)
  476. :"r"((long)line_size)
  477. :REG_a, "memory");
  478. }
  479. // this routine is 'slightly' suboptimal but mostly unused
  480. static void DEF(avg, pixels8_xy2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
  481. {
  482. MOVQ_ZERO(mm7);
  483. SET_RND(mm6); // =2 for rnd and =1 for no_rnd version
  484. __asm __volatile(
  485. "movq (%1), %%mm0 \n\t"
  486. "movq 1(%1), %%mm4 \n\t"
  487. "movq %%mm0, %%mm1 \n\t"
  488. "movq %%mm4, %%mm5 \n\t"
  489. "punpcklbw %%mm7, %%mm0 \n\t"
  490. "punpcklbw %%mm7, %%mm4 \n\t"
  491. "punpckhbw %%mm7, %%mm1 \n\t"
  492. "punpckhbw %%mm7, %%mm5 \n\t"
  493. "paddusw %%mm0, %%mm4 \n\t"
  494. "paddusw %%mm1, %%mm5 \n\t"
  495. "xor %%"REG_a", %%"REG_a" \n\t"
  496. "add %3, %1 \n\t"
  497. ASMALIGN(3)
  498. "1: \n\t"
  499. "movq (%1, %%"REG_a"), %%mm0 \n\t"
  500. "movq 1(%1, %%"REG_a"), %%mm2 \n\t"
  501. "movq %%mm0, %%mm1 \n\t"
  502. "movq %%mm2, %%mm3 \n\t"
  503. "punpcklbw %%mm7, %%mm0 \n\t"
  504. "punpcklbw %%mm7, %%mm2 \n\t"
  505. "punpckhbw %%mm7, %%mm1 \n\t"
  506. "punpckhbw %%mm7, %%mm3 \n\t"
  507. "paddusw %%mm2, %%mm0 \n\t"
  508. "paddusw %%mm3, %%mm1 \n\t"
  509. "paddusw %%mm6, %%mm4 \n\t"
  510. "paddusw %%mm6, %%mm5 \n\t"
  511. "paddusw %%mm0, %%mm4 \n\t"
  512. "paddusw %%mm1, %%mm5 \n\t"
  513. "psrlw $2, %%mm4 \n\t"
  514. "psrlw $2, %%mm5 \n\t"
  515. "movq (%2, %%"REG_a"), %%mm3 \n\t"
  516. "packuswb %%mm5, %%mm4 \n\t"
  517. "pcmpeqd %%mm2, %%mm2 \n\t"
  518. "paddb %%mm2, %%mm2 \n\t"
  519. PAVGB(%%mm3, %%mm4, %%mm5, %%mm2)
  520. "movq %%mm5, (%2, %%"REG_a") \n\t"
  521. "add %3, %%"REG_a" \n\t"
  522. "movq (%1, %%"REG_a"), %%mm2 \n\t" // 0 <-> 2 1 <-> 3
  523. "movq 1(%1, %%"REG_a"), %%mm4 \n\t"
  524. "movq %%mm2, %%mm3 \n\t"
  525. "movq %%mm4, %%mm5 \n\t"
  526. "punpcklbw %%mm7, %%mm2 \n\t"
  527. "punpcklbw %%mm7, %%mm4 \n\t"
  528. "punpckhbw %%mm7, %%mm3 \n\t"
  529. "punpckhbw %%mm7, %%mm5 \n\t"
  530. "paddusw %%mm2, %%mm4 \n\t"
  531. "paddusw %%mm3, %%mm5 \n\t"
  532. "paddusw %%mm6, %%mm0 \n\t"
  533. "paddusw %%mm6, %%mm1 \n\t"
  534. "paddusw %%mm4, %%mm0 \n\t"
  535. "paddusw %%mm5, %%mm1 \n\t"
  536. "psrlw $2, %%mm0 \n\t"
  537. "psrlw $2, %%mm1 \n\t"
  538. "movq (%2, %%"REG_a"), %%mm3 \n\t"
  539. "packuswb %%mm1, %%mm0 \n\t"
  540. "pcmpeqd %%mm2, %%mm2 \n\t"
  541. "paddb %%mm2, %%mm2 \n\t"
  542. PAVGB(%%mm3, %%mm0, %%mm1, %%mm2)
  543. "movq %%mm1, (%2, %%"REG_a") \n\t"
  544. "add %3, %%"REG_a" \n\t"
  545. "subl $2, %0 \n\t"
  546. "jnz 1b \n\t"
  547. :"+g"(h), "+S"(pixels)
  548. :"D"(block), "r"((long)line_size)
  549. :REG_a, "memory");
  550. }
  551. //FIXME optimize
  552. static void DEF(put, pixels16_y2)(uint8_t *block, const uint8_t *pixels, int line_size, int h){
  553. DEF(put, pixels8_y2)(block , pixels , line_size, h);
  554. DEF(put, pixels8_y2)(block+8, pixels+8, line_size, h);
  555. }
  556. static void DEF(put, pixels16_xy2)(uint8_t *block, const uint8_t *pixels, int line_size, int h){
  557. DEF(put, pixels8_xy2)(block , pixels , line_size, h);
  558. DEF(put, pixels8_xy2)(block+8, pixels+8, line_size, h);
  559. }
  560. static void DEF(avg, pixels16_y2)(uint8_t *block, const uint8_t *pixels, int line_size, int h){
  561. DEF(avg, pixels8_y2)(block , pixels , line_size, h);
  562. DEF(avg, pixels8_y2)(block+8, pixels+8, line_size, h);
  563. }
  564. static void DEF(avg, pixels16_xy2)(uint8_t *block, const uint8_t *pixels, int line_size, int h){
  565. DEF(avg, pixels8_xy2)(block , pixels , line_size, h);
  566. DEF(avg, pixels8_xy2)(block+8, pixels+8, line_size, h);
  567. }
  568. #endif /* FFMPEG_DSPUTIL_MMX_RND_H */