1 /*
2  * Copyright (c) 2012
3  *      MIPS Technologies, Inc., California.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
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.
16  *
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
27  * SUCH DAMAGE.
28  *
29  * Author:  Nedeljko Babic (nbabic@mips.com)
30  *
31  * This file is part of FFmpeg.
32  *
33  * FFmpeg is free software; you can redistribute it and/or
34  * modify it under the terms of the GNU Lesser General Public
35  * License as published by the Free Software Foundation; either
36  * version 2.1 of the License, or (at your option) any later version.
37  *
38  * FFmpeg is distributed in the hope that it will be useful,
39  * but WITHOUT ANY WARRANTY; without even the implied warranty of
40  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
41  * Lesser General Public License for more details.
42  *
43  * You should have received a copy of the GNU Lesser General Public
44  * License along with FFmpeg; if not, write to the Free Software
45  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
46  */
47 
48 /**
49  * @file
50  * Reference: libavcodec/amrwbdec.c
51  */
52 #include "libavutil/avutil.h"
53 #include "libavcodec/amrwbdata.h"
54 #include "amrwbdec_mips.h"
55 
56 #if HAVE_INLINE_ASM
57 #if !HAVE_MIPS32R6 && !HAVE_MIPS64R6
ff_hb_fir_filter_mips(float * out,const float fir_coef[HB_FIR_SIZE+1],float mem[HB_FIR_SIZE],const float * in)58 void ff_hb_fir_filter_mips(float *out, const float fir_coef[HB_FIR_SIZE + 1],
59                           float mem[HB_FIR_SIZE], const float *in)
60 {
61     int i;
62     float data[AMRWB_SFR_SIZE_16k + HB_FIR_SIZE]; // past and current samples
63 
64     memcpy(data, mem, HB_FIR_SIZE * sizeof(float));
65     memcpy(data + HB_FIR_SIZE, in, AMRWB_SFR_SIZE_16k * sizeof(float));
66 
67     for (i = 0; i < AMRWB_SFR_SIZE_16k; i++) {
68         float output;
69         float * p_data = (data+i);
70 
71         /**
72         * inner loop is entirely unrolled and instructions are scheduled
73         * to minimize pipeline stall
74         */
75         __asm__ volatile(
76             "mtc1       $zero,     %[output]                      \n\t"
77             "lwc1       $f0,       0(%[p_data])                   \n\t"
78             "lwc1       $f1,       0(%[fir_coef])                 \n\t"
79             "lwc1       $f2,       4(%[p_data])                   \n\t"
80             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
81             "lwc1       $f3,       4(%[fir_coef])                 \n\t"
82             "lwc1       $f4,       8(%[p_data])                   \n\t"
83             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
84             "lwc1       $f5,       8(%[fir_coef])                 \n\t"
85 
86             "lwc1       $f0,       12(%[p_data])                  \n\t"
87             "lwc1       $f1,       12(%[fir_coef])                \n\t"
88             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
89             "lwc1       $f2,       16(%[p_data])                  \n\t"
90             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
91             "lwc1       $f3,       16(%[fir_coef])                \n\t"
92             "lwc1       $f4,       20(%[p_data])                  \n\t"
93             "lwc1       $f5,       20(%[fir_coef])                \n\t"
94             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
95 
96             "lwc1       $f0,       24(%[p_data])                  \n\t"
97             "lwc1       $f1,       24(%[fir_coef])                \n\t"
98             "lwc1       $f2,       28(%[p_data])                  \n\t"
99             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
100             "lwc1       $f3,       28(%[fir_coef])                \n\t"
101             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
102             "lwc1       $f4,       32(%[p_data])                  \n\t"
103             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
104             "lwc1       $f5,       32(%[fir_coef])                \n\t"
105             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
106 
107             "lwc1       $f0,       36(%[p_data])                  \n\t"
108             "lwc1       $f1,       36(%[fir_coef])                \n\t"
109             "lwc1       $f2,       40(%[p_data])                  \n\t"
110             "lwc1       $f3,       40(%[fir_coef])                \n\t"
111             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
112             "lwc1       $f4,       44(%[p_data])                  \n\t"
113             "lwc1       $f5,       44(%[fir_coef])                \n\t"
114             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
115 
116             "lwc1       $f0,       48(%[p_data])                  \n\t"
117             "lwc1       $f1,       48(%[fir_coef])                \n\t"
118             "lwc1       $f2,       52(%[p_data])                  \n\t"
119             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
120             "lwc1       $f3,       52(%[fir_coef])                \n\t"
121             "lwc1       $f4,       56(%[p_data])                  \n\t"
122             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
123             "lwc1       $f5,       56(%[fir_coef])                \n\t"
124             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
125 
126             "lwc1       $f0,       60(%[p_data])                  \n\t"
127             "lwc1       $f1,       60(%[fir_coef])                \n\t"
128             "lwc1       $f2,       64(%[p_data])                  \n\t"
129             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
130             "lwc1       $f3,       64(%[fir_coef])                \n\t"
131             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
132             "lwc1       $f4,       68(%[p_data])                  \n\t"
133             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
134             "lwc1       $f5,       68(%[fir_coef])                \n\t"
135             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
136 
137             "lwc1       $f0,       72(%[p_data])                  \n\t"
138             "lwc1       $f1,       72(%[fir_coef])                \n\t"
139             "lwc1       $f2,       76(%[p_data])                  \n\t"
140             "lwc1       $f3,       76(%[fir_coef])                \n\t"
141             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
142             "lwc1       $f4,       80(%[p_data])                  \n\t"
143             "lwc1       $f5,       80(%[fir_coef])                \n\t"
144             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
145 
146             "lwc1       $f0,       84(%[p_data])                  \n\t"
147             "lwc1       $f1,       84(%[fir_coef])                \n\t"
148             "lwc1       $f2,       88(%[p_data])                  \n\t"
149             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
150             "lwc1       $f3,       88(%[fir_coef])                \n\t"
151             "lwc1       $f4,       92(%[p_data])                  \n\t"
152             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
153             "lwc1       $f5,       92(%[fir_coef])                \n\t"
154             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
155 
156             "lwc1       $f0,       96(%[p_data])                  \n\t"
157             "lwc1       $f1,       96(%[fir_coef])                \n\t"
158             "lwc1       $f2,       100(%[p_data])                 \n\t"
159             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
160             "lwc1       $f3,       100(%[fir_coef])               \n\t"
161             "lwc1       $f4,       104(%[p_data])                 \n\t"
162             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
163             "lwc1       $f5,       104(%[fir_coef])               \n\t"
164             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
165 
166             "lwc1       $f0,       108(%[p_data])                 \n\t"
167             "lwc1       $f1,       108(%[fir_coef])               \n\t"
168             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
169             "lwc1       $f2,       112(%[p_data])                 \n\t"
170             "lwc1       $f3,       112(%[fir_coef])               \n\t"
171             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
172             "lwc1       $f4,       116(%[p_data])                 \n\t"
173             "lwc1       $f5,       116(%[fir_coef])               \n\t"
174             "lwc1       $f0,       120(%[p_data])                 \n\t"
175             "madd.s     %[output], %[output],       $f2, $f3      \n\t"
176             "lwc1       $f1,       120(%[fir_coef])               \n\t"
177             "madd.s     %[output], %[output],       $f4, $f5      \n\t"
178             "madd.s     %[output], %[output],       $f0, $f1      \n\t"
179 
180             : [output]"=&f"(output)
181             : [fir_coef]"r"(fir_coef), [p_data]"r"(p_data)
182             : "$f0", "$f1", "$f2", "$f3", "$f4", "$f5", "memory"
183         );
184         out[i] = output;
185     }
186     memcpy(mem, data + AMRWB_SFR_SIZE_16k, HB_FIR_SIZE * sizeof(float));
187 }
188 #endif /* !HAVE_MIPS32R6 && !HAVE_MIPS64R6 */
189 #endif /* HAVE_INLINE_ASM */
190