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.

343 lines
18KB

  1. /*
  2. * Format Conversion Utils for MIPS
  3. *
  4. * Copyright (c) 2012
  5. * MIPS Technologies, Inc., California.
  6. *
  7. * Redistribution and use in source and binary forms, with or without
  8. * modification, are permitted provided that the following conditions
  9. * are met:
  10. * 1. Redistributions of source code must retain the above copyright
  11. * notice, this list of conditions and the following disclaimer.
  12. * 2. Redistributions in binary form must reproduce the above copyright
  13. * notice, this list of conditions and the following disclaimer in the
  14. * documentation and/or other materials provided with the distribution.
  15. * 3. Neither the name of the MIPS Technologies, Inc., nor the names of is
  16. * contributors may be used to endorse or promote products derived from
  17. * this software without specific prior written permission.
  18. *
  19. * THIS SOFTWARE IS PROVIDED BY THE MIPS TECHNOLOGIES, INC. ``AS IS'' AND
  20. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  21. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  22. * ARE DISCLAIMED. IN NO EVENT SHALL THE MIPS TECHNOLOGIES, INC. BE LIABLE
  23. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  24. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  25. * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  26. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  27. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  28. * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  29. * SUCH DAMAGE.
  30. *
  31. * Author: Zoran Lukic (zoranl@mips.com)
  32. * Author: Nedeljko Babic (nbabic@mips.com)
  33. *
  34. * This file is part of FFmpeg.
  35. *
  36. * FFmpeg is free software; you can redistribute it and/or
  37. * modify it under the terms of the GNU Lesser General Public
  38. * License as published by the Free Software Foundation; either
  39. * version 2.1 of the License, or (at your option) any later version.
  40. *
  41. * FFmpeg is distributed in the hope that it will be useful,
  42. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  43. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  44. * Lesser General Public License for more details.
  45. *
  46. * You should have received a copy of the GNU Lesser General Public
  47. * License along with FFmpeg; if not, write to the Free Software
  48. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  49. */
  50. #include "config.h"
  51. #include "libavcodec/avcodec.h"
  52. #include "libavcodec/fmtconvert.h"
  53. #if HAVE_INLINE_ASM
  54. #if HAVE_MIPSDSPR1
  55. static void float_to_int16_mips(int16_t *dst, const float *src, long len)
  56. {
  57. const float *src_end = src + len;
  58. int ret0, ret1, ret2, ret3, ret4, ret5, ret6, ret7;
  59. float src0, src1, src2, src3, src4, src5, src6, src7;
  60. /*
  61. * loop is 8 times unrolled in assembler in order to achieve better performance
  62. */
  63. __asm__ volatile(
  64. "beq %[len], $zero, fti16_end%= \n\t"
  65. "fti16_lp%=: \n\t"
  66. "lwc1 %[src0], 0(%[src]) \n\t"
  67. "lwc1 %[src1], 4(%[src]) \n\t"
  68. "lwc1 %[src2], 8(%[src]) \n\t"
  69. "lwc1 %[src3], 12(%[src]) \n\t"
  70. "cvt.w.s %[src0], %[src0] \n\t"
  71. "cvt.w.s %[src1], %[src1] \n\t"
  72. "cvt.w.s %[src2], %[src2] \n\t"
  73. "cvt.w.s %[src3], %[src3] \n\t"
  74. "mfc1 %[ret0], %[src0] \n\t"
  75. "mfc1 %[ret1], %[src1] \n\t"
  76. "mfc1 %[ret2], %[src2] \n\t"
  77. "mfc1 %[ret3], %[src3] \n\t"
  78. "lwc1 %[src4], 16(%[src]) \n\t"
  79. "lwc1 %[src5], 20(%[src]) \n\t"
  80. "lwc1 %[src6], 24(%[src]) \n\t"
  81. "lwc1 %[src7], 28(%[src]) \n\t"
  82. "cvt.w.s %[src4], %[src4] \n\t"
  83. "cvt.w.s %[src5], %[src5] \n\t"
  84. "cvt.w.s %[src6], %[src6] \n\t"
  85. "cvt.w.s %[src7], %[src7] \n\t"
  86. "addiu %[src], 32 \n\t"
  87. "shll_s.w %[ret0], %[ret0], 16 \n\t"
  88. "shll_s.w %[ret1], %[ret1], 16 \n\t"
  89. "shll_s.w %[ret2], %[ret2], 16 \n\t"
  90. "shll_s.w %[ret3], %[ret3], 16 \n\t"
  91. "srl %[ret0], %[ret0], 16 \n\t"
  92. "srl %[ret1], %[ret1], 16 \n\t"
  93. "srl %[ret2], %[ret2], 16 \n\t"
  94. "srl %[ret3], %[ret3], 16 \n\t"
  95. "sh %[ret0], 0(%[dst]) \n\t"
  96. "sh %[ret1], 2(%[dst]) \n\t"
  97. "sh %[ret2], 4(%[dst]) \n\t"
  98. "sh %[ret3], 6(%[dst]) \n\t"
  99. "mfc1 %[ret4], %[src4] \n\t"
  100. "mfc1 %[ret5], %[src5] \n\t"
  101. "mfc1 %[ret6], %[src6] \n\t"
  102. "mfc1 %[ret7], %[src7] \n\t"
  103. "shll_s.w %[ret4], %[ret4], 16 \n\t"
  104. "shll_s.w %[ret5], %[ret5], 16 \n\t"
  105. "shll_s.w %[ret6], %[ret6], 16 \n\t"
  106. "shll_s.w %[ret7], %[ret7], 16 \n\t"
  107. "srl %[ret4], %[ret4], 16 \n\t"
  108. "srl %[ret5], %[ret5], 16 \n\t"
  109. "srl %[ret6], %[ret6], 16 \n\t"
  110. "srl %[ret7], %[ret7], 16 \n\t"
  111. "sh %[ret4], 8(%[dst]) \n\t"
  112. "sh %[ret5], 10(%[dst]) \n\t"
  113. "sh %[ret6], 12(%[dst]) \n\t"
  114. "sh %[ret7], 14(%[dst]) \n\t"
  115. "addiu %[dst], 16 \n\t"
  116. "bne %[src], %[src_end], fti16_lp%= \n\t"
  117. "fti16_end%=: \n\t"
  118. : [ret0]"=&r"(ret0), [ret1]"=&r"(ret1), [ret2]"=&r"(ret2), [ret3]"=&r"(ret3),
  119. [ret4]"=&r"(ret4), [ret5]"=&r"(ret5), [ret6]"=&r"(ret6), [ret7]"=&r"(ret7),
  120. [src0]"=&f"(src0), [src1]"=&f"(src1), [src2]"=&f"(src2), [src3]"=&f"(src3),
  121. [src4]"=&f"(src4), [src5]"=&f"(src5), [src6]"=&f"(src6), [src7]"=&f"(src7),
  122. [src]"+r"(src), [dst]"+r"(dst)
  123. : [src_end]"r"(src_end), [len]"r"(len)
  124. : "memory"
  125. );
  126. }
  127. static void float_to_int16_interleave_mips(int16_t *dst, const float **src, long len,
  128. int channels)
  129. {
  130. int c, ch2 = channels <<1;
  131. int ret0, ret1, ret2, ret3, ret4, ret5, ret6, ret7;
  132. float src0, src1, src2, src3, src4, src5, src6, src7;
  133. int16_t *dst_ptr0, *dst_ptr1, *dst_ptr2, *dst_ptr3;
  134. int16_t *dst_ptr4, *dst_ptr5, *dst_ptr6, *dst_ptr7;
  135. const float *src_ptr, *src_ptr2, *src_end;
  136. if (channels == 2) {
  137. src_ptr = &src[0][0];
  138. src_ptr2 = &src[1][0];
  139. src_end = src_ptr + len;
  140. __asm__ volatile (
  141. "fti16i2_lp%=: \n\t"
  142. "lwc1 %[src0], 0(%[src_ptr]) \n\t"
  143. "lwc1 %[src1], 0(%[src_ptr2]) \n\t"
  144. "addiu %[src_ptr], 4 \n\t"
  145. "cvt.w.s $f9, %[src0] \n\t"
  146. "cvt.w.s $f10, %[src1] \n\t"
  147. "mfc1 %[ret0], $f9 \n\t"
  148. "mfc1 %[ret1], $f10 \n\t"
  149. "shll_s.w %[ret0], %[ret0], 16 \n\t"
  150. "shll_s.w %[ret1], %[ret1], 16 \n\t"
  151. "addiu %[src_ptr2], 4 \n\t"
  152. "srl %[ret0], %[ret0], 16 \n\t"
  153. "srl %[ret1], %[ret1], 16 \n\t"
  154. "sh %[ret0], 0(%[dst]) \n\t"
  155. "sh %[ret1], 2(%[dst]) \n\t"
  156. "addiu %[dst], 4 \n\t"
  157. "bne %[src_ptr], %[src_end], fti16i2_lp%= \n\t"
  158. : [ret0]"=&r"(ret0), [ret1]"=&r"(ret1),
  159. [src0]"=&f"(src0), [src1]"=&f"(src1),
  160. [src_ptr]"+r"(src_ptr), [src_ptr2]"+r"(src_ptr2),
  161. [dst]"+r"(dst)
  162. : [src_end]"r"(src_end)
  163. : "memory"
  164. );
  165. } else {
  166. for (c = 0; c < channels; c++) {
  167. src_ptr = &src[c][0];
  168. dst_ptr0 = &dst[c];
  169. src_end = src_ptr + len;
  170. /*
  171. * loop is 8 times unrolled in assembler in order to achieve better performance
  172. */
  173. __asm__ volatile(
  174. "fti16i_lp%=: \n\t"
  175. "lwc1 %[src0], 0(%[src_ptr]) \n\t"
  176. "lwc1 %[src1], 4(%[src_ptr]) \n\t"
  177. "lwc1 %[src2], 8(%[src_ptr]) \n\t"
  178. "lwc1 %[src3], 12(%[src_ptr]) \n\t"
  179. "cvt.w.s %[src0], %[src0] \n\t"
  180. "cvt.w.s %[src1], %[src1] \n\t"
  181. "cvt.w.s %[src2], %[src2] \n\t"
  182. "cvt.w.s %[src3], %[src3] \n\t"
  183. "mfc1 %[ret0], %[src0] \n\t"
  184. "mfc1 %[ret1], %[src1] \n\t"
  185. "mfc1 %[ret2], %[src2] \n\t"
  186. "mfc1 %[ret3], %[src3] \n\t"
  187. "lwc1 %[src4], 16(%[src_ptr]) \n\t"
  188. "lwc1 %[src5], 20(%[src_ptr]) \n\t"
  189. "lwc1 %[src6], 24(%[src_ptr]) \n\t"
  190. "lwc1 %[src7], 28(%[src_ptr]) \n\t"
  191. "addu %[dst_ptr1], %[dst_ptr0], %[ch2] \n\t"
  192. "addu %[dst_ptr2], %[dst_ptr1], %[ch2] \n\t"
  193. "addu %[dst_ptr3], %[dst_ptr2], %[ch2] \n\t"
  194. "addu %[dst_ptr4], %[dst_ptr3], %[ch2] \n\t"
  195. "addu %[dst_ptr5], %[dst_ptr4], %[ch2] \n\t"
  196. "addu %[dst_ptr6], %[dst_ptr5], %[ch2] \n\t"
  197. "addu %[dst_ptr7], %[dst_ptr6], %[ch2] \n\t"
  198. "addiu %[src_ptr], 32 \n\t"
  199. "cvt.w.s %[src4], %[src4] \n\t"
  200. "cvt.w.s %[src5], %[src5] \n\t"
  201. "cvt.w.s %[src6], %[src6] \n\t"
  202. "cvt.w.s %[src7], %[src7] \n\t"
  203. "shll_s.w %[ret0], %[ret0], 16 \n\t"
  204. "shll_s.w %[ret1], %[ret1], 16 \n\t"
  205. "shll_s.w %[ret2], %[ret2], 16 \n\t"
  206. "shll_s.w %[ret3], %[ret3], 16 \n\t"
  207. "srl %[ret0], %[ret0], 16 \n\t"
  208. "srl %[ret1], %[ret1], 16 \n\t"
  209. "srl %[ret2], %[ret2], 16 \n\t"
  210. "srl %[ret3], %[ret3], 16 \n\t"
  211. "sh %[ret0], 0(%[dst_ptr0]) \n\t"
  212. "sh %[ret1], 0(%[dst_ptr1]) \n\t"
  213. "sh %[ret2], 0(%[dst_ptr2]) \n\t"
  214. "sh %[ret3], 0(%[dst_ptr3]) \n\t"
  215. "mfc1 %[ret4], %[src4] \n\t"
  216. "mfc1 %[ret5], %[src5] \n\t"
  217. "mfc1 %[ret6], %[src6] \n\t"
  218. "mfc1 %[ret7], %[src7] \n\t"
  219. "shll_s.w %[ret4], %[ret4], 16 \n\t"
  220. "shll_s.w %[ret5], %[ret5], 16 \n\t"
  221. "shll_s.w %[ret6], %[ret6], 16 \n\t"
  222. "shll_s.w %[ret7], %[ret7], 16 \n\t"
  223. "srl %[ret4], %[ret4], 16 \n\t"
  224. "srl %[ret5], %[ret5], 16 \n\t"
  225. "srl %[ret6], %[ret6], 16 \n\t"
  226. "srl %[ret7], %[ret7], 16 \n\t"
  227. "sh %[ret4], 0(%[dst_ptr4]) \n\t"
  228. "sh %[ret5], 0(%[dst_ptr5]) \n\t"
  229. "sh %[ret6], 0(%[dst_ptr6]) \n\t"
  230. "sh %[ret7], 0(%[dst_ptr7]) \n\t"
  231. "addu %[dst_ptr0], %[dst_ptr7], %[ch2] \n\t"
  232. "bne %[src_ptr], %[src_end], fti16i_lp%= \n\t"
  233. : [ret0]"=&r"(ret0), [ret1]"=&r"(ret1), [ret2]"=&r"(ret2), [ret3]"=&r"(ret3),
  234. [ret4]"=&r"(ret4), [ret5]"=&r"(ret5), [ret6]"=&r"(ret6), [ret7]"=&r"(ret7),
  235. [src0]"=&f"(src0), [src1]"=&f"(src1), [src2]"=&f"(src2), [src3]"=&f"(src3),
  236. [src4]"=&f"(src4), [src5]"=&f"(src5), [src6]"=&f"(src6), [src7]"=&f"(src7),
  237. [dst_ptr1]"=&r"(dst_ptr1), [dst_ptr2]"=&r"(dst_ptr2), [dst_ptr3]"=&r"(dst_ptr3),
  238. [dst_ptr4]"=&r"(dst_ptr4), [dst_ptr5]"=&r"(dst_ptr5), [dst_ptr6]"=&r"(dst_ptr6),
  239. [dst_ptr7]"=&r"(dst_ptr7), [dst_ptr0]"+r"(dst_ptr0), [src_ptr]"+r"(src_ptr)
  240. : [ch2]"r"(ch2), [src_end]"r"(src_end)
  241. : "memory"
  242. );
  243. }
  244. }
  245. }
  246. #endif /* HAVE_MIPSDSPR1 */
  247. static void int32_to_float_fmul_scalar_mips(float *dst, const int *src,
  248. float mul, int len)
  249. {
  250. /*
  251. * variables used in inline assembler
  252. */
  253. float temp1, temp3, temp5, temp7, temp9, temp11, temp13, temp15;
  254. int rpom1, rpom2, rpom11, rpom21, rpom12, rpom22, rpom13, rpom23;
  255. const int *src_end = src + len;
  256. /*
  257. * loop is 8 times unrolled in assembler in order to achieve better performance
  258. */
  259. __asm__ volatile (
  260. "i32tf_lp%=: \n\t"
  261. "lw %[rpom11], 0(%[src]) \n\t"
  262. "lw %[rpom21], 4(%[src]) \n\t"
  263. "lw %[rpom1], 8(%[src]) \n\t"
  264. "lw %[rpom2], 12(%[src]) \n\t"
  265. "mtc1 %[rpom11], %[temp1] \n\t"
  266. "mtc1 %[rpom21], %[temp3] \n\t"
  267. "mtc1 %[rpom1], %[temp5] \n\t"
  268. "mtc1 %[rpom2], %[temp7] \n\t"
  269. "lw %[rpom13], 16(%[src]) \n\t"
  270. "lw %[rpom23], 20(%[src]) \n\t"
  271. "lw %[rpom12], 24(%[src]) \n\t"
  272. "lw %[rpom22], 28(%[src]) \n\t"
  273. "mtc1 %[rpom13], %[temp9] \n\t"
  274. "mtc1 %[rpom23], %[temp11] \n\t"
  275. "mtc1 %[rpom12], %[temp13] \n\t"
  276. "mtc1 %[rpom22], %[temp15] \n\t"
  277. "addiu %[src], 32 \n\t"
  278. "cvt.s.w %[temp1], %[temp1] \n\t"
  279. "cvt.s.w %[temp3], %[temp3] \n\t"
  280. "cvt.s.w %[temp5], %[temp5] \n\t"
  281. "cvt.s.w %[temp7], %[temp7] \n\t"
  282. "cvt.s.w %[temp9], %[temp9] \n\t"
  283. "cvt.s.w %[temp11], %[temp11] \n\t"
  284. "cvt.s.w %[temp13], %[temp13] \n\t"
  285. "cvt.s.w %[temp15], %[temp15] \n\t"
  286. "mul.s %[temp1], %[temp1], %[mul] \n\t"
  287. "mul.s %[temp3], %[temp3], %[mul] \n\t"
  288. "mul.s %[temp5], %[temp5], %[mul] \n\t"
  289. "mul.s %[temp7], %[temp7], %[mul] \n\t"
  290. "mul.s %[temp9], %[temp9], %[mul] \n\t"
  291. "mul.s %[temp11], %[temp11], %[mul] \n\t"
  292. "mul.s %[temp13], %[temp13], %[mul] \n\t"
  293. "mul.s %[temp15], %[temp15], %[mul] \n\t"
  294. "swc1 %[temp1], 0(%[dst]) \n\t" /*dst[i] = src[i] * mul; */
  295. "swc1 %[temp3], 4(%[dst]) \n\t" /*dst[i+1] = src[i+1] * mul;*/
  296. "swc1 %[temp5], 8(%[dst]) \n\t" /*dst[i+2] = src[i+2] * mul;*/
  297. "swc1 %[temp7], 12(%[dst]) \n\t" /*dst[i+3] = src[i+3] * mul;*/
  298. "swc1 %[temp9], 16(%[dst]) \n\t" /*dst[i+4] = src[i+4] * mul;*/
  299. "swc1 %[temp11], 20(%[dst]) \n\t" /*dst[i+5] = src[i+5] * mul;*/
  300. "swc1 %[temp13], 24(%[dst]) \n\t" /*dst[i+6] = src[i+6] * mul;*/
  301. "swc1 %[temp15], 28(%[dst]) \n\t" /*dst[i+7] = src[i+7] * mul;*/
  302. "addiu %[dst], 32 \n\t"
  303. "bne %[src], %[src_end], i32tf_lp%= \n\t"
  304. : [temp1]"=&f"(temp1), [temp11]"=&f"(temp11),
  305. [temp13]"=&f"(temp13), [temp15]"=&f"(temp15),
  306. [temp3]"=&f"(temp3), [temp5]"=&f"(temp5),
  307. [temp7]"=&f"(temp7), [temp9]"=&f"(temp9),
  308. [rpom1]"=&r"(rpom1), [rpom2]"=&r"(rpom2),
  309. [rpom11]"=&r"(rpom11), [rpom21]"=&r"(rpom21),
  310. [rpom12]"=&r"(rpom12), [rpom22]"=&r"(rpom22),
  311. [rpom13]"=&r"(rpom13), [rpom23]"=&r"(rpom23),
  312. [dst]"+r"(dst), [src]"+r"(src)
  313. : [mul]"f"(mul), [src_end]"r"(src_end)
  314. : "memory"
  315. );
  316. }
  317. #endif /* HAVE_INLINE_ASM */
  318. av_cold void ff_fmt_convert_init_mips(FmtConvertContext *c)
  319. {
  320. #if HAVE_INLINE_ASM
  321. #if HAVE_MIPSDSPR1
  322. c->float_to_int16_interleave = float_to_int16_interleave_mips;
  323. c->float_to_int16 = float_to_int16_mips;
  324. #endif
  325. c->int32_to_float_fmul_scalar = int32_to_float_fmul_scalar_mips;
  326. #endif
  327. }