FFmpeg
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
lpc.c
Go to the documentation of this file.
1 /*
2  * MMX optimized LPC DSP utils
3  * Copyright (c) 2007 Loren Merritt
4  *
5  * This file is part of FFmpeg.
6  *
7  * FFmpeg is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * FFmpeg is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with FFmpeg; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21 
22 #include "libavutil/attributes.h"
23 #include "libavutil/cpu.h"
24 #include "libavutil/mem.h"
25 #include "libavutil/x86/asm.h"
26 #include "libavutil/x86/cpu.h"
27 #include "libavcodec/lpc.h"
28 
29 DECLARE_ASM_CONST(16, double, pd_1)[2] = { 1.0, 1.0 };
30 DECLARE_ASM_CONST(16, double, pd_2)[2] = { 2.0, 2.0 };
31 
32 #if HAVE_SSE2_INLINE
33 
34 static void lpc_apply_welch_window_sse2(const int32_t *data, int len,
35  double *w_data)
36 {
37  double c = 2.0 / (len-1.0);
38  int n2 = len>>1;
39  x86_reg i = -n2*sizeof(int32_t);
40  x86_reg j = n2*sizeof(int32_t);
41  __asm__ volatile(
42  "movsd %4, %%xmm7 \n\t"
43  "movapd "MANGLE(pd_1)", %%xmm6 \n\t"
44  "movapd "MANGLE(pd_2)", %%xmm5 \n\t"
45  "movlhps %%xmm7, %%xmm7 \n\t"
46  "subpd %%xmm5, %%xmm7 \n\t"
47  "addsd %%xmm6, %%xmm7 \n\t"
48  "test $1, %5 \n\t"
49  "jz 2f \n\t"
50 #define WELCH(MOVPD, offset)\
51  "1: \n\t"\
52  "movapd %%xmm7, %%xmm1 \n\t"\
53  "mulpd %%xmm1, %%xmm1 \n\t"\
54  "movapd %%xmm6, %%xmm0 \n\t"\
55  "subpd %%xmm1, %%xmm0 \n\t"\
56  "pshufd $0x4e, %%xmm0, %%xmm1 \n\t"\
57  "cvtpi2pd (%3,%0), %%xmm2 \n\t"\
58  "cvtpi2pd "#offset"*4(%3,%1), %%xmm3 \n\t"\
59  "mulpd %%xmm0, %%xmm2 \n\t"\
60  "mulpd %%xmm1, %%xmm3 \n\t"\
61  "movapd %%xmm2, (%2,%0,2) \n\t"\
62  MOVPD" %%xmm3, "#offset"*8(%2,%1,2) \n\t"\
63  "subpd %%xmm5, %%xmm7 \n\t"\
64  "sub $8, %1 \n\t"\
65  "add $8, %0 \n\t"\
66  "jl 1b \n\t"\
67 
68  WELCH("movupd", -1)
69  "jmp 3f \n\t"
70  "2: \n\t"
71  WELCH("movapd", -2)
72  "3: \n\t"
73  :"+&r"(i), "+&r"(j)
74  :"r"(w_data+n2), "r"(data+n2), "m"(c), "r"(len)
75  XMM_CLOBBERS_ONLY("%xmm0", "%xmm1", "%xmm2", "%xmm3",
76  "%xmm5", "%xmm6", "%xmm7")
77  );
78 #undef WELCH
79 }
80 
81 static void lpc_compute_autocorr_sse2(const double *data, int len, int lag,
82  double *autoc)
83 {
84  int j;
85 
86  if((x86_reg)data & 15)
87  data++;
88 
89  for(j=0; j<lag; j+=2){
90  x86_reg i = -len*sizeof(double);
91  if(j == lag-2) {
92  __asm__ volatile(
93  "movsd "MANGLE(pd_1)", %%xmm0 \n\t"
94  "movsd "MANGLE(pd_1)", %%xmm1 \n\t"
95  "movsd "MANGLE(pd_1)", %%xmm2 \n\t"
96  "1: \n\t"
97  "movapd (%2,%0), %%xmm3 \n\t"
98  "movupd -8(%3,%0), %%xmm4 \n\t"
99  "movapd (%3,%0), %%xmm5 \n\t"
100  "mulpd %%xmm3, %%xmm4 \n\t"
101  "mulpd %%xmm3, %%xmm5 \n\t"
102  "mulpd -16(%3,%0), %%xmm3 \n\t"
103  "addpd %%xmm4, %%xmm1 \n\t"
104  "addpd %%xmm5, %%xmm0 \n\t"
105  "addpd %%xmm3, %%xmm2 \n\t"
106  "add $16, %0 \n\t"
107  "jl 1b \n\t"
108  "movhlps %%xmm0, %%xmm3 \n\t"
109  "movhlps %%xmm1, %%xmm4 \n\t"
110  "movhlps %%xmm2, %%xmm5 \n\t"
111  "addsd %%xmm3, %%xmm0 \n\t"
112  "addsd %%xmm4, %%xmm1 \n\t"
113  "addsd %%xmm5, %%xmm2 \n\t"
114  "movsd %%xmm0, (%1) \n\t"
115  "movsd %%xmm1, 8(%1) \n\t"
116  "movsd %%xmm2, 16(%1) \n\t"
117  :"+&r"(i)
118  :"r"(autoc+j), "r"(data+len), "r"(data+len-j)
119  :"memory"
120  );
121  } else {
122  __asm__ volatile(
123  "movsd "MANGLE(pd_1)", %%xmm0 \n\t"
124  "movsd "MANGLE(pd_1)", %%xmm1 \n\t"
125  "1: \n\t"
126  "movapd (%3,%0), %%xmm3 \n\t"
127  "movupd -8(%4,%0), %%xmm4 \n\t"
128  "mulpd %%xmm3, %%xmm4 \n\t"
129  "mulpd (%4,%0), %%xmm3 \n\t"
130  "addpd %%xmm4, %%xmm1 \n\t"
131  "addpd %%xmm3, %%xmm0 \n\t"
132  "add $16, %0 \n\t"
133  "jl 1b \n\t"
134  "movhlps %%xmm0, %%xmm3 \n\t"
135  "movhlps %%xmm1, %%xmm4 \n\t"
136  "addsd %%xmm3, %%xmm0 \n\t"
137  "addsd %%xmm4, %%xmm1 \n\t"
138  "movsd %%xmm0, %1 \n\t"
139  "movsd %%xmm1, %2 \n\t"
140  :"+&r"(i), "=m"(autoc[j]), "=m"(autoc[j+1])
141  :"r"(data+len), "r"(data+len-j)
142  );
143  }
144  }
145 }
146 
147 #endif /* HAVE_SSE2_INLINE */
148 
150 {
151 #if HAVE_SSE2_INLINE
152  int cpu_flags = av_get_cpu_flags();
153 
154  if (HAVE_SSE2_INLINE && cpu_flags & (AV_CPU_FLAG_SSE2 | AV_CPU_FLAG_SSE2SLOW)) {
155  c->lpc_apply_welch_window = lpc_apply_welch_window_sse2;
156  c->lpc_compute_autocorr = lpc_compute_autocorr_sse2;
157  }
158 #endif /* HAVE_SSE2_INLINE */
159 }