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.

306 lines
8.4KB

  1. /*
  2. * DSP utils mmx functions are compiled twice for rnd/no_rnd
  3. * Copyright (c) 2000, 2001 Fabrice Bellard.
  4. *
  5. * This library is free software; you can redistribute it and/or
  6. * modify it under the terms of the GNU Lesser General Public
  7. * License as published by the Free Software Foundation; either
  8. * version 2 of the License, or (at your option) any later version.
  9. *
  10. * This library is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13. * Lesser General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU Lesser General Public
  16. * License along with this library; if not, write to the Free Software
  17. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  18. *
  19. * MMX optimization by Nick Kurshev <nickols_k@mail.ru>
  20. * mostly rewritten by Michael Niedermayer <michaelni@gmx.at>
  21. * and improved by Zdenek Kabelac <kabi@users.sf.net>
  22. */
  23. // put_pixels
  24. static void DEF(put, pixels_x2)(UINT8 *block, const UINT8 *pixels, int line_size, int h)
  25. {
  26. MOVQ_BFE(mm6);
  27. __asm __volatile(
  28. "lea (%3, %3), %%eax \n\t"
  29. ".balign 8 \n\t"
  30. "1: \n\t"
  31. "movq (%1), %%mm0 \n\t"
  32. "movq 1(%1), %%mm1 \n\t"
  33. "movq (%1, %3), %%mm2 \n\t"
  34. "movq 1(%1, %3), %%mm3 \n\t"
  35. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  36. "movq %%mm4, (%2) \n\t"
  37. "movq %%mm5, (%2, %3) \n\t"
  38. "addl %%eax, %1 \n\t"
  39. "addl %%eax, %2 \n\t"
  40. "movq (%1), %%mm0 \n\t"
  41. "movq 1(%1), %%mm1 \n\t"
  42. "movq (%1, %3), %%mm2 \n\t"
  43. "movq 1(%1, %3), %%mm3 \n\t"
  44. PAVGBP(%%mm0, %%mm1, %%mm4, %%mm2, %%mm3, %%mm5)
  45. "movq %%mm4, (%2) \n\t"
  46. "movq %%mm5, (%2, %3) \n\t"
  47. "addl %%eax, %1 \n\t"
  48. "addl %%eax, %2 \n\t"
  49. "subl $4, %0 \n\t"
  50. "jnz 1b \n\t"
  51. :"+g"(h), "+S"(pixels), "+D"(block)
  52. :"r"(line_size)
  53. :"eax", "memory");
  54. }
  55. static void DEF(put, pixels_y2)(UINT8 *block, const UINT8 *pixels, int line_size, int h)
  56. {
  57. MOVQ_BFE(mm6);
  58. __asm __volatile(
  59. "lea (%3, %3), %%eax \n\t"
  60. "movq (%1), %%mm0 \n\t"
  61. ".balign 8 \n\t"
  62. "1: \n\t"
  63. "movq (%1, %3), %%mm1 \n\t"
  64. "movq (%1, %%eax),%%mm2 \n\t"
  65. PAVGBP(%%mm1, %%mm0, %%mm4, %%mm2, %%mm1, %%mm5)
  66. "movq %%mm4, (%2) \n\t"
  67. "movq %%mm5, (%2, %3) \n\t"
  68. "addl %%eax, %1 \n\t"
  69. "addl %%eax, %2 \n\t"
  70. "movq (%1, %3), %%mm1 \n\t"
  71. "movq (%1, %%eax),%%mm0 \n\t"
  72. PAVGBP(%%mm1, %%mm2, %%mm4, %%mm0, %%mm1, %%mm5)
  73. "movq %%mm4, (%2) \n\t"
  74. "movq %%mm5, (%2, %3) \n\t"
  75. "addl %%eax, %1 \n\t"
  76. "addl %%eax, %2 \n\t"
  77. "subl $4, %0 \n\t"
  78. "jnz 1b \n\t"
  79. :"+g"(h), "+S"(pixels), "+D"(block)
  80. :"r"(line_size)
  81. :"eax", "memory");
  82. }
  83. static void DEF(put, pixels_xy2)(UINT8 *block, const UINT8 *pixels, int line_size, int h)
  84. {
  85. MOVQ_ZERO(mm7);
  86. SET_RND(mm6); // =2 for rnd and =1 for no_rnd version
  87. __asm __volatile(
  88. "movq (%1), %%mm0 \n\t"
  89. "movq 1(%1), %%mm4 \n\t"
  90. "movq %%mm0, %%mm1 \n\t"
  91. "movq %%mm4, %%mm5 \n\t"
  92. "punpcklbw %%mm7, %%mm0 \n\t"
  93. "punpcklbw %%mm7, %%mm4 \n\t"
  94. "punpckhbw %%mm7, %%mm1 \n\t"
  95. "punpckhbw %%mm7, %%mm5 \n\t"
  96. "paddusw %%mm0, %%mm4 \n\t"
  97. "paddusw %%mm1, %%mm5 \n\t"
  98. "xorl %%eax, %%eax \n\t"
  99. "addl %3, %1 \n\t"
  100. ".balign 8 \n\t"
  101. "1: \n\t"
  102. "movq (%1, %%eax), %%mm0 \n\t"
  103. "movq 1(%1, %%eax), %%mm2 \n\t"
  104. "movq %%mm0, %%mm1 \n\t"
  105. "movq %%mm2, %%mm3 \n\t"
  106. "punpcklbw %%mm7, %%mm0 \n\t"
  107. "punpcklbw %%mm7, %%mm2 \n\t"
  108. "punpckhbw %%mm7, %%mm1 \n\t"
  109. "punpckhbw %%mm7, %%mm3 \n\t"
  110. "paddusw %%mm2, %%mm0 \n\t"
  111. "paddusw %%mm3, %%mm1 \n\t"
  112. "paddusw %%mm6, %%mm4 \n\t"
  113. "paddusw %%mm6, %%mm5 \n\t"
  114. "paddusw %%mm0, %%mm4 \n\t"
  115. "paddusw %%mm1, %%mm5 \n\t"
  116. "psrlw $2, %%mm4 \n\t"
  117. "psrlw $2, %%mm5 \n\t"
  118. "packuswb %%mm5, %%mm4 \n\t"
  119. "movq %%mm4, (%2, %%eax) \n\t"
  120. "addl %3, %%eax \n\t"
  121. "movq (%1, %%eax), %%mm2 \n\t" // 0 <-> 2 1 <-> 3
  122. "movq 1(%1, %%eax), %%mm4 \n\t"
  123. "movq %%mm2, %%mm3 \n\t"
  124. "movq %%mm4, %%mm5 \n\t"
  125. "punpcklbw %%mm7, %%mm2 \n\t"
  126. "punpcklbw %%mm7, %%mm4 \n\t"
  127. "punpckhbw %%mm7, %%mm3 \n\t"
  128. "punpckhbw %%mm7, %%mm5 \n\t"
  129. "paddusw %%mm2, %%mm4 \n\t"
  130. "paddusw %%mm3, %%mm5 \n\t"
  131. "paddusw %%mm6, %%mm0 \n\t"
  132. "paddusw %%mm6, %%mm1 \n\t"
  133. "paddusw %%mm4, %%mm0 \n\t"
  134. "paddusw %%mm5, %%mm1 \n\t"
  135. "psrlw $2, %%mm0 \n\t"
  136. "psrlw $2, %%mm1 \n\t"
  137. "packuswb %%mm1, %%mm0 \n\t"
  138. "movq %%mm0, (%2, %%eax) \n\t"
  139. "addl %3, %%eax \n\t"
  140. "subl $2, %0 \n\t"
  141. "jnz 1b \n\t"
  142. :"+g"(h), "+S"(pixels)
  143. :"D"(block), "r"(line_size)
  144. :"eax", "memory");
  145. }
  146. // avg_pixels
  147. // in case more speed is needed - unroling would certainly help
  148. static void DEF(avg, pixels)(UINT8 *block, const UINT8 *pixels, int line_size, int h)
  149. {
  150. MOVQ_BFE(mm6);
  151. JUMPALIGN();
  152. do {
  153. __asm __volatile(
  154. "movq %0, %%mm0 \n\t"
  155. "movq %1, %%mm1 \n\t"
  156. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  157. "movq %%mm2, %0 \n\t"
  158. :"+m"(*block)
  159. :"m"(*pixels)
  160. :"memory");
  161. pixels += line_size;
  162. block += line_size;
  163. }
  164. while (--h);
  165. }
  166. static void DEF(avg, pixels_x2)(UINT8 *block, const UINT8 *pixels, int line_size, int h)
  167. {
  168. MOVQ_BFE(mm6);
  169. JUMPALIGN();
  170. do {
  171. __asm __volatile(
  172. "movq %1, %%mm0 \n\t"
  173. "movq 1%1, %%mm1 \n\t"
  174. "movq %0, %%mm3 \n\t"
  175. PAVGB(%%mm0, %%mm1, %%mm2, %%mm6)
  176. PAVGB(%%mm3, %%mm2, %%mm0, %%mm6)
  177. "movq %%mm0, %0 \n\t"
  178. :"+m"(*block)
  179. :"m"(*pixels)
  180. :"memory");
  181. pixels += line_size;
  182. block += line_size;
  183. } while (--h);
  184. }
  185. static void DEF(avg, pixels_y2)(UINT8 *block, const UINT8 *pixels, int line_size, int h)
  186. {
  187. MOVQ_BFE(mm6);
  188. __asm __volatile(
  189. "lea (%3, %3), %%eax \n\t"
  190. "movq (%1), %%mm0 \n\t"
  191. ".balign 8 \n\t"
  192. "1: \n\t"
  193. "movq (%1, %3), %%mm1 \n\t"
  194. "movq (%1, %%eax), %%mm2 \n\t"
  195. PAVGBP(%%mm1, %%mm0, %%mm4, %%mm2, %%mm1, %%mm5)
  196. "movq (%2), %%mm3 \n\t"
  197. PAVGB(%%mm3, %%mm4, %%mm0, %%mm6)
  198. "movq (%2, %3), %%mm3 \n\t"
  199. PAVGB(%%mm3, %%mm5, %%mm1, %%mm6)
  200. "movq %%mm0, (%2) \n\t"
  201. "movq %%mm1, (%2, %3) \n\t"
  202. "addl %%eax, %1 \n\t"
  203. "addl %%eax, %2 \n\t"
  204. "movq (%1, %3), %%mm1 \n\t"
  205. "movq (%1, %%eax), %%mm0 \n\t"
  206. PAVGBP(%%mm1, %%mm2, %%mm4, %%mm0, %%mm1, %%mm5)
  207. "movq (%2), %%mm3 \n\t"
  208. PAVGB(%%mm3, %%mm4, %%mm0, %%mm6)
  209. "movq (%2, %3), %%mm3 \n\t"
  210. PAVGB(%%mm3, %%mm5, %%mm1, %%mm6)
  211. "movq %%mm0, (%2) \n\t"
  212. "movq %%mm1, (%2, %3) \n\t"
  213. "addl %%eax, %1 \n\t"
  214. "addl %%eax, %2 \n\t"
  215. "subl $4, %0 \n\t"
  216. "jnz 1b \n\t"
  217. :"+g"(h), "+S"(pixels), "+D"(block)
  218. :"r"(line_size)
  219. :"eax", "memory");
  220. }
  221. // this routine is 'slightly' suboptimal but mostly unused
  222. static void DEF(avg, pixels_xy2)(UINT8 *block, const UINT8 *pixels, int line_size, int h)
  223. {
  224. MOVQ_ZERO(mm7);
  225. SET_RND(mm6); // =2 for rnd and =1 for no_rnd version
  226. __asm __volatile(
  227. "movq (%1), %%mm0 \n\t"
  228. "movq 1(%1), %%mm4 \n\t"
  229. "movq %%mm0, %%mm1 \n\t"
  230. "movq %%mm4, %%mm5 \n\t"
  231. "punpcklbw %%mm7, %%mm0 \n\t"
  232. "punpcklbw %%mm7, %%mm4 \n\t"
  233. "punpckhbw %%mm7, %%mm1 \n\t"
  234. "punpckhbw %%mm7, %%mm5 \n\t"
  235. "paddusw %%mm0, %%mm4 \n\t"
  236. "paddusw %%mm1, %%mm5 \n\t"
  237. "xorl %%eax, %%eax \n\t"
  238. "addl %3, %1 \n\t"
  239. ".balign 8 \n\t"
  240. "1: \n\t"
  241. "movq (%1, %%eax), %%mm0 \n\t"
  242. "movq 1(%1, %%eax), %%mm2 \n\t"
  243. "movq %%mm0, %%mm1 \n\t"
  244. "movq %%mm2, %%mm3 \n\t"
  245. "punpcklbw %%mm7, %%mm0 \n\t"
  246. "punpcklbw %%mm7, %%mm2 \n\t"
  247. "punpckhbw %%mm7, %%mm1 \n\t"
  248. "punpckhbw %%mm7, %%mm3 \n\t"
  249. "paddusw %%mm2, %%mm0 \n\t"
  250. "paddusw %%mm3, %%mm1 \n\t"
  251. "paddusw %%mm6, %%mm4 \n\t"
  252. "paddusw %%mm6, %%mm5 \n\t"
  253. "paddusw %%mm0, %%mm4 \n\t"
  254. "paddusw %%mm1, %%mm5 \n\t"
  255. "psrlw $2, %%mm4 \n\t"
  256. "psrlw $2, %%mm5 \n\t"
  257. "movq (%2, %%eax), %%mm3 \n\t"
  258. "packuswb %%mm5, %%mm4 \n\t"
  259. "pcmpeqd %%mm2, %%mm2 \n\t"
  260. "paddb %%mm2, %%mm2 \n\t"
  261. PAVGB(%%mm3, %%mm4, %%mm5, %%mm2)
  262. "movq %%mm5, (%2, %%eax) \n\t"
  263. "addl %3, %%eax \n\t"
  264. "movq (%1, %%eax), %%mm2 \n\t" // 0 <-> 2 1 <-> 3
  265. "movq 1(%1, %%eax), %%mm4 \n\t"
  266. "movq %%mm2, %%mm3 \n\t"
  267. "movq %%mm4, %%mm5 \n\t"
  268. "punpcklbw %%mm7, %%mm2 \n\t"
  269. "punpcklbw %%mm7, %%mm4 \n\t"
  270. "punpckhbw %%mm7, %%mm3 \n\t"
  271. "punpckhbw %%mm7, %%mm5 \n\t"
  272. "paddusw %%mm2, %%mm4 \n\t"
  273. "paddusw %%mm3, %%mm5 \n\t"
  274. "paddusw %%mm6, %%mm0 \n\t"
  275. "paddusw %%mm6, %%mm1 \n\t"
  276. "paddusw %%mm4, %%mm0 \n\t"
  277. "paddusw %%mm5, %%mm1 \n\t"
  278. "psrlw $2, %%mm0 \n\t"
  279. "psrlw $2, %%mm1 \n\t"
  280. "movq (%2, %%eax), %%mm3 \n\t"
  281. "packuswb %%mm1, %%mm0 \n\t"
  282. "pcmpeqd %%mm2, %%mm2 \n\t"
  283. "paddb %%mm2, %%mm2 \n\t"
  284. PAVGB(%%mm3, %%mm0, %%mm1, %%mm2)
  285. "movq %%mm1, (%2, %%eax) \n\t"
  286. "addl %3, %%eax \n\t"
  287. "subl $2, %0 \n\t"
  288. "jnz 1b \n\t"
  289. :"+g"(h), "+S"(pixels)
  290. :"D"(block), "r"(line_size)
  291. :"eax", "memory");
  292. }