Subversion Repositories Kolibri OS

Rev

Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
4349 Serge 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
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
 
149
av_cold void ff_lpc_init_x86(LPCContext *c)
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
}