3 * MIPS Technologies, Inc., California.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 * 3. Neither the name of the MIPS Technologies, Inc., nor the names of its
14 * contributors may be used to endorse or promote products derived from
15 * this software without specific prior written permission.
17 * THIS SOFTWARE IS PROVIDED BY THE MIPS TECHNOLOGIES, INC. ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE MIPS TECHNOLOGIES, INC. BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * Authors: Branimir Vasic (bvasic@mips.com)
30 * Nedeljko Babic (nbabic@mips.com)
32 * Various AC-3 DSP Utils optimized for MIPS
34 * This file is part of FFmpeg.
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.
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.
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
53 * Reference: libavcodec/ac3dsp.c
57 #include "libavcodec/ac3dsp.h"
58 #include "libavcodec/ac3.h"
63 static void ac3_bit_alloc_calc_bap_mips(int16_t *mask
, int16_t *psd
,
65 int snr_offset
, int floor
,
66 const uint8_t *bap_tab
, uint8_t *bap
)
68 int band
, band_end
, cond
;
69 int m
, address1
, address2
;
70 int16_t *psd1
, *psd_end
;
73 if (snr_offset
== -960) {
74 memset(bap
, 0, AC3_MAX_COEFS
);
80 band
= ff_ac3_bin_to_band_tab
[start
];
83 m
= (FFMAX(mask
[band
] - snr_offset
- floor
, 0) & 0x1FE0) + floor
;
84 band_end
= ff_ac3_band_start_tab
[++band
];
85 band_end
= FFMIN(band_end
, end
);
86 psd_end
= psd
+ band_end
- 1;
89 "slt %[cond], %[psd1], %[psd_end] \n\t"
90 "beqz %[cond], 1f \n\t"
92 "lh %[address1], 0(%[psd1]) \n\t"
93 "lh %[address2], 2(%[psd1]) \n\t"
94 "addiu %[psd1], %[psd1], 4 \n\t"
95 "subu %[address1], %[address1], %[m] \n\t"
96 "sra %[address1], %[address1], 5 \n\t"
97 "addiu %[address1], %[address1], -32 \n\t"
98 "shll_s.w %[address1], %[address1], 26 \n\t"
99 "subu %[address2], %[address2], %[m] \n\t"
100 "sra %[address2], %[address2], 5 \n\t"
101 "sra %[address1], %[address1], 26 \n\t"
102 "addiu %[address1], %[address1], 32 \n\t"
103 "lbux %[address1], %[address1](%[bap_tab]) \n\t"
104 "addiu %[address2], %[address2], -32 \n\t"
105 "shll_s.w %[address2], %[address2], 26 \n\t"
106 "sb %[address1], 0(%[bap1]) \n\t"
107 "slt %[cond], %[psd1], %[psd_end] \n\t"
108 "sra %[address2], %[address2], 26 \n\t"
109 "addiu %[address2], %[address2], 32 \n\t"
110 "lbux %[address2], %[address2](%[bap_tab]) \n\t"
111 "sb %[address2], 1(%[bap1]) \n\t"
112 "addiu %[bap1], %[bap1], 2 \n\t"
113 "bnez %[cond], 2b \n\t"
114 "addiu %[psd_end], %[psd_end], 2 \n\t"
115 "slt %[cond], %[psd1], %[psd_end] \n\t"
116 "beqz %[cond], 3f \n\t"
118 "lh %[address1], 0(%[psd1]) \n\t"
119 "addiu %[psd1], %[psd1], 2 \n\t"
120 "subu %[address1], %[address1], %[m] \n\t"
121 "sra %[address1], %[address1], 5 \n\t"
122 "addiu %[address1], %[address1], -32 \n\t"
123 "shll_s.w %[address1], %[address1], 26 \n\t"
124 "sra %[address1], %[address1], 26 \n\t"
125 "addiu %[address1], %[address1], 32 \n\t"
126 "lbux %[address1], %[address1](%[bap_tab]) \n\t"
127 "sb %[address1], 0(%[bap1]) \n\t"
128 "addiu %[bap1], %[bap1], 1 \n\t"
131 : [address1
]"=&r"(address1
), [address2
]"=&r"(address2
),
132 [cond
]"=&r"(cond
), [bap1
]"+r"(bap1
),
133 [psd1
]"+r"(psd1
), [psd_end
]"+r"(psd_end
)
134 : [m
]"r"(m
), [bap_tab
]"r"(bap_tab
)
137 } while (end
> band_end
);
140 static void ac3_update_bap_counts_mips(uint16_t mant_cnt
[16], uint8_t *bap
,
143 int temp0
, temp1
, temp2
, temp3
, temp4
, temp5
, temp6
, temp7
;
146 "andi %[temp3], %[len], 3 \n\t"
147 "addu %[temp2], %[bap], %[len] \n\t"
148 "addu %[temp4], %[bap], %[temp3] \n\t"
149 "beq %[temp2], %[temp4], 4f \n\t"
151 "lbu %[temp0], -1(%[temp2]) \n\t"
152 "lbu %[temp5], -2(%[temp2]) \n\t"
153 "lbu %[temp6], -3(%[temp2]) \n\t"
154 "sll %[temp0], %[temp0], 1 \n\t"
155 "addu %[temp0], %[mant_cnt], %[temp0] \n\t"
156 "sll %[temp5], %[temp5], 1 \n\t"
157 "addu %[temp5], %[mant_cnt], %[temp5] \n\t"
158 "lhu %[temp1], 0(%[temp0]) \n\t"
159 "sll %[temp6], %[temp6], 1 \n\t"
160 "addu %[temp6], %[mant_cnt], %[temp6] \n\t"
161 "addiu %[temp1], %[temp1], 1 \n\t"
162 "sh %[temp1], 0(%[temp0]) \n\t"
163 "lhu %[temp1], 0(%[temp5]) \n\t"
164 "lbu %[temp7], -4(%[temp2]) \n\t"
165 "addiu %[temp2], %[temp2], -4 \n\t"
166 "addiu %[temp1], %[temp1], 1 \n\t"
167 "sh %[temp1], 0(%[temp5]) \n\t"
168 "lhu %[temp1], 0(%[temp6]) \n\t"
169 "sll %[temp7], %[temp7], 1 \n\t"
170 "addu %[temp7], %[mant_cnt], %[temp7] \n\t"
171 "addiu %[temp1], %[temp1],1 \n\t"
172 "sh %[temp1], 0(%[temp6]) \n\t"
173 "lhu %[temp1], 0(%[temp7]) \n\t"
174 "addiu %[temp1], %[temp1], 1 \n\t"
175 "sh %[temp1], 0(%[temp7]) \n\t"
176 "bne %[temp2], %[temp4], 1b \n\t"
178 "beqz %[temp3], 2f \n\t"
180 "addiu %[temp3], %[temp3], -1 \n\t"
181 "lbu %[temp0], -1(%[temp2]) \n\t"
182 "addiu %[temp2], %[temp2], -1 \n\t"
183 "sll %[temp0], %[temp0], 1 \n\t"
184 "addu %[temp0], %[mant_cnt], %[temp0] \n\t"
185 "lhu %[temp1], 0(%[temp0]) \n\t"
186 "addiu %[temp1], %[temp1], 1 \n\t"
187 "sh %[temp1], 0(%[temp0]) \n\t"
188 "bgtz %[temp3], 3b \n\t"
191 : [temp0
] "=&r" (temp0
), [temp1
] "=&r" (temp1
),
192 [temp2
] "=&r" (temp2
), [temp3
] "=&r" (temp3
),
193 [temp4
] "=&r" (temp4
), [temp5
] "=&r" (temp5
),
194 [temp6
] "=&r" (temp6
), [temp7
] "=&r" (temp7
)
195 : [len
] "r" (len
), [bap
] "r" (bap
),
196 [mant_cnt
] "r" (mant_cnt
)
202 #if HAVE_MIPSFPU && HAVE_MIPS32R2
203 static void float_to_fixed24_mips(int32_t *dst
, const float *src
, unsigned int len
)
205 const float scale
= 1 << 24;
206 float src0
, src1
, src2
, src3
, src4
, src5
, src6
, src7
;
207 int temp0
, temp1
, temp2
, temp3
, temp4
, temp5
, temp6
, temp7
;
211 "lwc1 %[src0], 0(%[src]) \n\t"
212 "lwc1 %[src1], 4(%[src]) \n\t"
213 "lwc1 %[src2], 8(%[src]) \n\t"
214 "lwc1 %[src3], 12(%[src]) \n\t"
215 "lwc1 %[src4], 16(%[src]) \n\t"
216 "lwc1 %[src5], 20(%[src]) \n\t"
217 "lwc1 %[src6], 24(%[src]) \n\t"
218 "lwc1 %[src7], 28(%[src]) \n\t"
219 "mul.s %[src0], %[src0], %[scale] \n\t"
220 "mul.s %[src1], %[src1], %[scale] \n\t"
221 "mul.s %[src2], %[src2], %[scale] \n\t"
222 "mul.s %[src3], %[src3], %[scale] \n\t"
223 "mul.s %[src4], %[src4], %[scale] \n\t"
224 "mul.s %[src5], %[src5], %[scale] \n\t"
225 "mul.s %[src6], %[src6], %[scale] \n\t"
226 "mul.s %[src7], %[src7], %[scale] \n\t"
227 "cvt.w.s %[src0], %[src0] \n\t"
228 "cvt.w.s %[src1], %[src1] \n\t"
229 "cvt.w.s %[src2], %[src2] \n\t"
230 "cvt.w.s %[src3], %[src3] \n\t"
231 "cvt.w.s %[src4], %[src4] \n\t"
232 "cvt.w.s %[src5], %[src5] \n\t"
233 "cvt.w.s %[src6], %[src6] \n\t"
234 "cvt.w.s %[src7], %[src7] \n\t"
235 "mfc1 %[temp0], %[src0] \n\t"
236 "mfc1 %[temp1], %[src1] \n\t"
237 "mfc1 %[temp2], %[src2] \n\t"
238 "mfc1 %[temp3], %[src3] \n\t"
239 "mfc1 %[temp4], %[src4] \n\t"
240 "mfc1 %[temp5], %[src5] \n\t"
241 "mfc1 %[temp6], %[src6] \n\t"
242 "mfc1 %[temp7], %[src7] \n\t"
243 "sw %[temp0], 0(%[dst]) \n\t"
244 "sw %[temp1], 4(%[dst]) \n\t"
245 "sw %[temp2], 8(%[dst]) \n\t"
246 "sw %[temp3], 12(%[dst]) \n\t"
247 "sw %[temp4], 16(%[dst]) \n\t"
248 "sw %[temp5], 20(%[dst]) \n\t"
249 "sw %[temp6], 24(%[dst]) \n\t"
250 "sw %[temp7], 28(%[dst]) \n\t"
252 : [dst
] "+r" (dst
), [src
] "+r" (src
),
253 [src0
] "=&f" (src0
), [src1
] "=&f" (src1
),
254 [src2
] "=&f" (src2
), [src3
] "=&f" (src3
),
255 [src4
] "=&f" (src4
), [src5
] "=&f" (src5
),
256 [src6
] "=&f" (src6
), [src7
] "=&f" (src7
),
257 [temp0
] "=r" (temp0
), [temp1
] "=r" (temp1
),
258 [temp2
] "=r" (temp2
), [temp3
] "=r" (temp3
),
259 [temp4
] "=r" (temp4
), [temp5
] "=r" (temp5
),
260 [temp6
] "=r" (temp6
), [temp7
] "=r" (temp7
)
261 : [scale
] "f" (scale
)
270 static void ac3_downmix_mips(float **samples
, float (*matrix
)[2],
271 int out_ch
, int in_ch
, int len
)
273 int i
, j
, i1
, i2
, i3
;
274 float v0
, v1
, v2
, v3
;
275 float v4
, v5
, v6
, v7
;
276 float samples0
, samples1
, samples2
, samples3
, matrix_j
, matrix_j2
;
277 float *samples_p
,*matrix_p
, **samples_x
, **samples_end
, **samples_sw
;
281 ".set noreorder \n\t"
285 "move %[i], $zero \n\t"
286 "sll %[j], %[in_ch], 2 \n\t"
288 "bne %[out_ch], %[i1], 3f \n\t" // if (out_ch == 2)
291 "2: \n\t" // start of the for loop (for (i = 0; i < len; i+=4))
292 "move %[matrix_p], %[matrix] \n\t"
293 "move %[samples_x], %[samples] \n\t"
294 "mtc1 $zero, %[v0] \n\t"
295 "mtc1 $zero, %[v1] \n\t"
296 "mtc1 $zero, %[v2] \n\t"
297 "mtc1 $zero, %[v3] \n\t"
298 "mtc1 $zero, %[v4] \n\t"
299 "mtc1 $zero, %[v5] \n\t"
300 "mtc1 $zero, %[v6] \n\t"
301 "mtc1 $zero, %[v7] \n\t"
302 "addiu %[i1], %[i], 4 \n\t"
303 "addiu %[i2], %[i], 8 \n\t"
304 "lw %[samples_p], 0(%[samples_x]) \n\t"
305 "addiu %[i3], %[i], 12 \n\t"
306 "addu %[samples_end], %[samples_x], %[j] \n\t"
307 "move %[samples_sw], %[samples_p] \n\t"
309 "1: \n\t" // start of the inner for loop (for (j = 0; j < in_ch; j++))
310 "lwc1 %[matrix_j], 0(%[matrix_p]) \n\t"
311 "lwc1 %[matrix_j2], 4(%[matrix_p]) \n\t"
312 "lwxc1 %[samples0], %[i](%[samples_p]) \n\t"
313 "lwxc1 %[samples1], %[i1](%[samples_p]) \n\t"
314 "lwxc1 %[samples2], %[i2](%[samples_p]) \n\t"
315 "lwxc1 %[samples3], %[i3](%[samples_p]) \n\t"
316 "addiu %[matrix_p], 8 \n\t"
317 "addiu %[samples_x], 4 \n\t"
318 "madd.s %[v0], %[v0], %[samples0], %[matrix_j] \n\t"
319 "madd.s %[v1], %[v1], %[samples1], %[matrix_j] \n\t"
320 "madd.s %[v2], %[v2], %[samples2], %[matrix_j] \n\t"
321 "madd.s %[v3], %[v3], %[samples3], %[matrix_j] \n\t"
322 "madd.s %[v4], %[v4], %[samples0], %[matrix_j2]\n\t"
323 "madd.s %[v5], %[v5], %[samples1], %[matrix_j2]\n\t"
324 "madd.s %[v6], %[v6], %[samples2], %[matrix_j2]\n\t"
325 "madd.s %[v7], %[v7], %[samples3], %[matrix_j2]\n\t"
326 "bne %[samples_x], %[samples_end], 1b \n\t"
327 " lw %[samples_p], 0(%[samples_x]) \n\t"
329 "lw %[samples_p], 4(%[samples]) \n\t"
330 "swxc1 %[v0], %[i](%[samples_sw]) \n\t"
331 "swxc1 %[v1], %[i1](%[samples_sw]) \n\t"
332 "swxc1 %[v2], %[i2](%[samples_sw]) \n\t"
333 "swxc1 %[v3], %[i3](%[samples_sw]) \n\t"
334 "swxc1 %[v4], %[i](%[samples_p]) \n\t"
335 "addiu %[i], 16 \n\t"
336 "swxc1 %[v5], %[i1](%[samples_p]) \n\t"
337 "swxc1 %[v6], %[i2](%[samples_p]) \n\t"
338 "bne %[i], %[len], 2b \n\t"
339 " swxc1 %[v7], %[i3](%[samples_p]) \n\t"
342 "bne %[out_ch], %[i2], 6f \n\t" // if (out_ch == 1)
345 "5: \n\t" // start of the outer for loop (for (i = 0; i < len; i+=4))
346 "move %[matrix_p], %[matrix] \n\t"
347 "move %[samples_x], %[samples] \n\t"
348 "mtc1 $zero, %[v0] \n\t"
349 "mtc1 $zero, %[v1] \n\t"
350 "mtc1 $zero, %[v2] \n\t"
351 "mtc1 $zero, %[v3] \n\t"
352 "addiu %[i1], %[i], 4 \n\t"
353 "addiu %[i2], %[i], 8 \n\t"
354 "lw %[samples_p], 0(%[samples_x]) \n\t"
355 "addiu %[i3], %[i], 12 \n\t"
356 "addu %[samples_end], %[samples_x], %[j] \n\t"
357 "move %[samples_sw], %[samples_p] \n\t"
359 "4: \n\t" // start of the inner for loop (for (j = 0; j < in_ch; j++))
360 "lwc1 %[matrix_j], 0(%[matrix_p]) \n\t"
361 "lwxc1 %[samples0], %[i](%[samples_p]) \n\t"
362 "lwxc1 %[samples1], %[i1](%[samples_p]) \n\t"
363 "lwxc1 %[samples2], %[i2](%[samples_p]) \n\t"
364 "lwxc1 %[samples3], %[i3](%[samples_p]) \n\t"
365 "addiu %[matrix_p], 8 \n\t"
366 "addiu %[samples_x], 4 \n\t"
367 "madd.s %[v0], %[v0], %[samples0], %[matrix_j] \n\t"
368 "madd.s %[v1], %[v1], %[samples1], %[matrix_j] \n\t"
369 "madd.s %[v2], %[v2], %[samples2], %[matrix_j] \n\t"
370 "madd.s %[v3], %[v3], %[samples3], %[matrix_j] \n\t"
371 "bne %[samples_x], %[samples_end], 4b \n\t"
372 " lw %[samples_p], 0(%[samples_x]) \n\t"
374 "swxc1 %[v0], %[i](%[samples_sw]) \n\t"
375 "addiu %[i], 16 \n\t"
376 "swxc1 %[v1], %[i1](%[samples_sw]) \n\t"
377 "swxc1 %[v2], %[i2](%[samples_sw]) \n\t"
378 "bne %[i], %[len], 5b \n\t"
379 " swxc1 %[v3], %[i3](%[samples_sw]) \n\t"
383 :[samples_p
]"=&r"(samples_p
), [matrix_j
]"=&f"(matrix_j
), [matrix_j2
]"=&f"(matrix_j2
),
384 [samples0
]"=&f"(samples0
), [samples1
]"=&f"(samples1
),
385 [samples2
]"=&f"(samples2
), [samples3
]"=&f"(samples3
),
386 [v0
]"=&f"(v0
), [v1
]"=&f"(v1
), [v2
]"=&f"(v2
), [v3
]"=&f"(v3
),
387 [v4
]"=&f"(v4
), [v5
]"=&f"(v5
), [v6
]"=&f"(v6
), [v7
]"=&f"(v7
),
388 [samples_x
]"=&r"(samples_x
), [matrix_p
]"=&r"(matrix_p
),
389 [samples_end
]"=&r"(samples_end
), [samples_sw
]"=&r"(samples_sw
),
390 [i1
]"=&r"(i1
), [i2
]"=&r"(i2
), [i3
]"=&r"(i3
), [i
]"=&r"(i
),
391 [j
]"=&r"(j
), [len
]"+r"(len
)
392 :[samples
]"r"(samples
), [matrix
]"r"(matrix
),
393 [in_ch
]"r"(in_ch
), [out_ch
]"r"(out_ch
)
398 #endif /* HAVE_INLINE_ASM */
400 void ff_ac3dsp_init_mips(AC3DSPContext
*c
, int bit_exact
) {
403 c
->bit_alloc_calc_bap
= ac3_bit_alloc_calc_bap_mips
;
404 c
->update_bap_counts
= ac3_update_bap_counts_mips
;
406 #if HAVE_MIPSFPU && HAVE_MIPS32R2
407 c
->float_to_fixed24
= float_to_fixed24_mips
;
408 c
->downmix
= ac3_downmix_mips
;