8430
|
1 /*
|
|
2 * MMX optimized FLAC 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/x86_cpu.h"
|
|
23 #include "dsputil_mmx.h"
|
|
24
|
|
25 static void apply_welch_window_sse2(const int32_t *data, int len, double *w_data)
|
|
26 {
|
|
27 double c = 2.0 / (len-1.0);
|
|
28 int n2 = len>>1;
|
|
29 x86_reg i = -n2*sizeof(int32_t);
|
|
30 x86_reg j = n2*sizeof(int32_t);
|
|
31 __asm__ volatile(
|
|
32 "movsd %0, %%xmm7 \n\t"
|
|
33 "movapd "MANGLE(ff_pd_1)", %%xmm6 \n\t"
|
|
34 "movapd "MANGLE(ff_pd_2)", %%xmm5 \n\t"
|
|
35 "movlhps %%xmm7, %%xmm7 \n\t"
|
|
36 "subpd %%xmm5, %%xmm7 \n\t"
|
|
37 "addsd %%xmm6, %%xmm7 \n\t"
|
|
38 ::"m"(c)
|
|
39 );
|
|
40 #define WELCH(MOVPD, offset)\
|
|
41 __asm__ volatile(\
|
|
42 "1: \n\t"\
|
|
43 "movapd %%xmm7, %%xmm1 \n\t"\
|
|
44 "mulpd %%xmm1, %%xmm1 \n\t"\
|
|
45 "movapd %%xmm6, %%xmm0 \n\t"\
|
|
46 "subpd %%xmm1, %%xmm0 \n\t"\
|
|
47 "pshufd $0x4e, %%xmm0, %%xmm1 \n\t"\
|
|
48 "cvtpi2pd (%3,%0), %%xmm2 \n\t"\
|
|
49 "cvtpi2pd "#offset"*4(%3,%1), %%xmm3 \n\t"\
|
|
50 "mulpd %%xmm0, %%xmm2 \n\t"\
|
|
51 "mulpd %%xmm1, %%xmm3 \n\t"\
|
|
52 "movapd %%xmm2, (%2,%0,2) \n\t"\
|
|
53 MOVPD" %%xmm3, "#offset"*8(%2,%1,2) \n\t"\
|
|
54 "subpd %%xmm5, %%xmm7 \n\t"\
|
|
55 "sub $8, %1 \n\t"\
|
|
56 "add $8, %0 \n\t"\
|
|
57 "jl 1b \n\t"\
|
|
58 :"+&r"(i), "+&r"(j)\
|
|
59 :"r"(w_data+n2), "r"(data+n2)\
|
|
60 );
|
|
61 if(len&1)
|
|
62 WELCH("movupd", -1)
|
|
63 else
|
|
64 WELCH("movapd", -2)
|
|
65 #undef WELCH
|
|
66 }
|
|
67
|
|
68 void ff_flac_compute_autocorr_sse2(const int32_t *data, int len, int lag,
|
|
69 double *autoc)
|
|
70 {
|
|
71 double tmp[len + lag + 2];
|
|
72 double *data1 = tmp + lag;
|
|
73 int j;
|
|
74
|
|
75 if((x86_reg)data1 & 15)
|
|
76 data1++;
|
|
77
|
|
78 apply_welch_window_sse2(data, len, data1);
|
|
79
|
|
80 for(j=0; j<lag; j++)
|
|
81 data1[j-lag]= 0.0;
|
|
82 data1[len] = 0.0;
|
|
83
|
|
84 for(j=0; j<lag; j+=2){
|
|
85 x86_reg i = -len*sizeof(double);
|
|
86 if(j == lag-2) {
|
|
87 __asm__ volatile(
|
|
88 "movsd "MANGLE(ff_pd_1)", %%xmm0 \n\t"
|
|
89 "movsd "MANGLE(ff_pd_1)", %%xmm1 \n\t"
|
|
90 "movsd "MANGLE(ff_pd_1)", %%xmm2 \n\t"
|
|
91 "1: \n\t"
|
|
92 "movapd (%4,%0), %%xmm3 \n\t"
|
|
93 "movupd -8(%5,%0), %%xmm4 \n\t"
|
|
94 "movapd (%5,%0), %%xmm5 \n\t"
|
|
95 "mulpd %%xmm3, %%xmm4 \n\t"
|
|
96 "mulpd %%xmm3, %%xmm5 \n\t"
|
|
97 "mulpd -16(%5,%0), %%xmm3 \n\t"
|
|
98 "addpd %%xmm4, %%xmm1 \n\t"
|
|
99 "addpd %%xmm5, %%xmm0 \n\t"
|
|
100 "addpd %%xmm3, %%xmm2 \n\t"
|
|
101 "add $16, %0 \n\t"
|
|
102 "jl 1b \n\t"
|
|
103 "movhlps %%xmm0, %%xmm3 \n\t"
|
|
104 "movhlps %%xmm1, %%xmm4 \n\t"
|
|
105 "movhlps %%xmm2, %%xmm5 \n\t"
|
|
106 "addsd %%xmm3, %%xmm0 \n\t"
|
|
107 "addsd %%xmm4, %%xmm1 \n\t"
|
|
108 "addsd %%xmm5, %%xmm2 \n\t"
|
|
109 "movsd %%xmm0, %1 \n\t"
|
|
110 "movsd %%xmm1, %2 \n\t"
|
|
111 "movsd %%xmm2, %3 \n\t"
|
|
112 :"+&r"(i), "=m"(autoc[j]), "=m"(autoc[j+1]), "=m"(autoc[j+2])
|
|
113 :"r"(data1+len), "r"(data1+len-j)
|
|
114 );
|
|
115 } else {
|
|
116 __asm__ volatile(
|
|
117 "movsd "MANGLE(ff_pd_1)", %%xmm0 \n\t"
|
|
118 "movsd "MANGLE(ff_pd_1)", %%xmm1 \n\t"
|
|
119 "1: \n\t"
|
|
120 "movapd (%3,%0), %%xmm3 \n\t"
|
|
121 "movupd -8(%4,%0), %%xmm4 \n\t"
|
|
122 "mulpd %%xmm3, %%xmm4 \n\t"
|
|
123 "mulpd (%4,%0), %%xmm3 \n\t"
|
|
124 "addpd %%xmm4, %%xmm1 \n\t"
|
|
125 "addpd %%xmm3, %%xmm0 \n\t"
|
|
126 "add $16, %0 \n\t"
|
|
127 "jl 1b \n\t"
|
|
128 "movhlps %%xmm0, %%xmm3 \n\t"
|
|
129 "movhlps %%xmm1, %%xmm4 \n\t"
|
|
130 "addsd %%xmm3, %%xmm0 \n\t"
|
|
131 "addsd %%xmm4, %%xmm1 \n\t"
|
|
132 "movsd %%xmm0, %1 \n\t"
|
|
133 "movsd %%xmm1, %2 \n\t"
|
|
134 :"+&r"(i), "=m"(autoc[j]), "=m"(autoc[j+1])
|
|
135 :"r"(data1+len), "r"(data1+len-j)
|
|
136 );
|
|
137 }
|
|
138 }
|
|
139 }
|