~ubuntu-branches/ubuntu/jaunty/xvidcap/jaunty-proposed
» Revision
8
: ffmpeg/libpostproc/postprocess_template.c
« back to all changes in this revision
Viewing changes to ffmpeg/libpostproc/postprocess_template.c
- browse files at revision 8
- compare with another revision
- download diff
- download tarball
- view history from revision 8
- Committer: Bazaar Package Importer
- Author(s): Lionel Le Folgoc, Andrew Starr-Bochicchio, Lionel Le Folgoc
- Date: 2008-12-26 00:10:06 UTC
- mfrom: (1.1.2 upstream)
- Revision ID: james.westby@ubuntu.com-20081226001006-2040ls9680bd1blt
Tags: 1.1.7-0.2ubuntu1
[ Andrew Starr-Bochicchio ]
* Merge from debian-multimedia (LP: #298547), Ubuntu Changes:
- For ffmpeg-related build-deps, fix versionized dependencies
as the ubuntu versioning is different than debian-multimedia's.
[ Lionel Le Folgoc ]
* LP: #311412 is fixed since the 1.1.7~rc1-0.1 revision.
* debian/patches/03_ffmpeg.diff: updated to fix FTBFS due to libswscale API
change (cherry-pick from Gentoo #234383).
* Merge from debian-multimedia (LP: #298547), Ubuntu Changes:
- For ffmpeg-related build-deps, fix versionized dependencies
as the ubuntu versioning is different than debian-multimedia's.
[ Lionel Le Folgoc ]
* LP: #311412 is fixed since the 1.1.7~rc1-0.1 revision.
* debian/patches/03_ffmpeg.diff: updated to fix FTBFS due to libswscale API
change (cherry-pick from Gentoo #234383).
- files added:
- acinclude.m4
- ffmpeg/libavdevice
- ffmpeg/libavfilter
- ffmpeg/tools
- files removed:
- debian/patches/00list
- files modified:
- COPYING
added
removed
ffmpeg/libpostproc/postprocess_template.c
16
16
* You should have received a copy of the GNU General Public License
17
17
* along with FFmpeg; if not, write to the Free Software
18
18
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
19
*/
19
*/
20
20
21
21
/**
22
22
* @file postprocess_template.c
23
23
* mmx/mmx2/3dnow postprocess code.
24
24
*/
25
25
26
27
#ifdef ARCH_X86_64
28
# define REGa rax
29
# define REGc rcx
30
# define REGd rdx
31
# define REG_a "rax"
32
# define REG_c "rcx"
33
# define REG_d "rdx"
34
# define REG_SP "rsp"
35
# define ALIGN_MASK "$0xFFFFFFFFFFFFFFF8"
36
#else
37
# define REGa eax
38
# define REGc ecx
39
# define REGd edx
40
# define REG_a "eax"
41
# define REG_c "ecx"
42
# define REG_d "edx"
43
# define REG_SP "esp"
44
# define ALIGN_MASK "$0xFFFFFFF8"
45
#endif
46
26
#include "x86_cpu.h"
27
28
#define ALIGN_MASK "$-8"
47
29
48
30
#undef PAVGB
49
31
#undef PMINUB
60
42
#define PMINUB(a,b,t) "pminub " #a ", " #b " \n\t"
61
43
#elif defined (HAVE_MMX)
62
44
#define PMINUB(b,a,t) \
63
"movq " #a ", " #t " \n\t"\
64
"psubusb " #b ", " #t " \n\t"\
65
"psubb " #t ", " #a " \n\t"
45
"movq " #a ", " #t " \n\t"\
46
"psubusb " #b ", " #t " \n\t"\
47
"psubb " #t ", " #a " \n\t"
66
48
#endif
67
49
68
50
#ifdef HAVE_MMX2
69
51
#define PMAXUB(a,b) "pmaxub " #a ", " #b " \n\t"
70
52
#elif defined (HAVE_MMX)
71
53
#define PMAXUB(a,b) \
72
"psubusb " #a ", " #b " \n\t"\
73
"paddb " #a ", " #b " \n\t"
54
"psubusb " #a ", " #b " \n\t"\
55
"paddb " #a ", " #b " \n\t"
74
56
#endif
75
57
76
//FIXME? |255-0| = 1 (shouldnt be a problem ...)
58
//FIXME? |255-0| = 1 (should not be a problem ...)
77
59
#ifdef HAVE_MMX
78
60
/**
79
61
* Check if the middle 8x8 Block in the given 8x16 block is flat
80
62
*/
81
63
static inline int RENAME(vertClassify)(uint8_t src[], int stride, PPContext *c){
82
int numEq= 0, dcOk;
83
src+= stride*4; // src points to begin of the 8x8 Block
84
asm volatile(
85
"movq %0, %%mm7 \n\t"
86
"movq %1, %%mm6 \n\t"
87
: : "m" (c->mmxDcOffset[c->nonBQP]), "m" (c->mmxDcThreshold[c->nonBQP])
88
);
64
int numEq= 0, dcOk;
65
src+= stride*4; // src points to begin of the 8x8 Block
66
asm volatile(
67
"movq %0, %%mm7 \n\t"
68
"movq %1, %%mm6 \n\t"
69
: : "m" (c->mmxDcOffset[c->nonBQP]), "m" (c->mmxDcThreshold[c->nonBQP])
70
);
89
71
90
asm volatile(
91
"lea (%2, %3), %%"REG_a" \n\t"
72
asm volatile(
73
"lea (%2, %3), %%"REG_a" \n\t"
92
74
// 0 1 2 3 4 5 6 7 8 9
93
75
// %1 eax eax+%2 eax+2%2 %1+4%2 ecx ecx+%2 ecx+2%2 %1+8%2 ecx+4%2
94
76
95
"movq (%2), %%mm0 \n\t"
96
"movq (%%"REG_a"), %%mm1 \n\t"
97
"movq %%mm0, %%mm3 \n\t"
98
"movq %%mm0, %%mm4 \n\t"
99
PMAXUB(%%mm1, %%mm4)
100
PMINUB(%%mm1, %%mm3, %%mm5)
101
"psubb %%mm1, %%mm0 \n\t" // mm0 = differnece
102
"paddb %%mm7, %%mm0 \n\t"
103
"pcmpgtb %%mm6, %%mm0 \n\t"
104
105
"movq (%%"REG_a",%3), %%mm2 \n\t"
106
PMAXUB(%%mm2, %%mm4)
107
PMINUB(%%mm2, %%mm3, %%mm5)
108
"psubb %%mm2, %%mm1 \n\t"
109
"paddb %%mm7, %%mm1 \n\t"
110
"pcmpgtb %%mm6, %%mm1 \n\t"
111
"paddb %%mm1, %%mm0 \n\t"
112
113
"movq (%%"REG_a", %3, 2), %%mm1 \n\t"
114
PMAXUB(%%mm1, %%mm4)
115
PMINUB(%%mm1, %%mm3, %%mm5)
116
"psubb %%mm1, %%mm2 \n\t"
117
"paddb %%mm7, %%mm2 \n\t"
118
"pcmpgtb %%mm6, %%mm2 \n\t"
119
"paddb %%mm2, %%mm0 \n\t"
120
121
"lea (%%"REG_a", %3, 4), %%"REG_a" \n\t"
122
123
"movq (%2, %3, 4), %%mm2 \n\t"
124
PMAXUB(%%mm2, %%mm4)
125
PMINUB(%%mm2, %%mm3, %%mm5)
126
"psubb %%mm2, %%mm1 \n\t"
127
"paddb %%mm7, %%mm1 \n\t"
128
"pcmpgtb %%mm6, %%mm1 \n\t"
129
"paddb %%mm1, %%mm0 \n\t"
130
131
"movq (%%"REG_a"), %%mm1 \n\t"
132
PMAXUB(%%mm1, %%mm4)
133
PMINUB(%%mm1, %%mm3, %%mm5)
134
"psubb %%mm1, %%mm2 \n\t"
135
"paddb %%mm7, %%mm2 \n\t"
136
"pcmpgtb %%mm6, %%mm2 \n\t"
137
"paddb %%mm2, %%mm0 \n\t"
138
139
"movq (%%"REG_a", %3), %%mm2 \n\t"
140
PMAXUB(%%mm2, %%mm4)
141
PMINUB(%%mm2, %%mm3, %%mm5)
142
"psubb %%mm2, %%mm1 \n\t"
143
"paddb %%mm7, %%mm1 \n\t"
144
"pcmpgtb %%mm6, %%mm1 \n\t"
145
"paddb %%mm1, %%mm0 \n\t"
146
147
"movq (%%"REG_a", %3, 2), %%mm1 \n\t"
148
PMAXUB(%%mm1, %%mm4)
149
PMINUB(%%mm1, %%mm3, %%mm5)
150
"psubb %%mm1, %%mm2 \n\t"
151
"paddb %%mm7, %%mm2 \n\t"
152
"pcmpgtb %%mm6, %%mm2 \n\t"
153
"paddb %%mm2, %%mm0 \n\t"
154
"psubusb %%mm3, %%mm4 \n\t"
155
156
" \n\t"
77
"movq (%2), %%mm0 \n\t"
78
"movq (%%"REG_a"), %%mm1 \n\t"
79
"movq %%mm0, %%mm3 \n\t"
80
"movq %%mm0, %%mm4 \n\t"
81
PMAXUB(%%mm1, %%mm4)
82
PMINUB(%%mm1, %%mm3, %%mm5)
83
"psubb %%mm1, %%mm0 \n\t" // mm0 = differnece
84
"paddb %%mm7, %%mm0 \n\t"
85
"pcmpgtb %%mm6, %%mm0 \n\t"
86
87
"movq (%%"REG_a",%3), %%mm2 \n\t"
88
PMAXUB(%%mm2, %%mm4)
89
PMINUB(%%mm2, %%mm3, %%mm5)
90
"psubb %%mm2, %%mm1 \n\t"
91
"paddb %%mm7, %%mm1 \n\t"
92
"pcmpgtb %%mm6, %%mm1 \n\t"
93
"paddb %%mm1, %%mm0 \n\t"
94
95
"movq (%%"REG_a", %3, 2), %%mm1 \n\t"
96
PMAXUB(%%mm1, %%mm4)
97
PMINUB(%%mm1, %%mm3, %%mm5)
98
"psubb %%mm1, %%mm2 \n\t"
99
"paddb %%mm7, %%mm2 \n\t"
100
"pcmpgtb %%mm6, %%mm2 \n\t"
101
"paddb %%mm2, %%mm0 \n\t"
102
103
"lea (%%"REG_a", %3, 4), %%"REG_a" \n\t"
104
105
"movq (%2, %3, 4), %%mm2 \n\t"
106
PMAXUB(%%mm2, %%mm4)
107
PMINUB(%%mm2, %%mm3, %%mm5)
108
"psubb %%mm2, %%mm1 \n\t"
109
"paddb %%mm7, %%mm1 \n\t"
110
"pcmpgtb %%mm6, %%mm1 \n\t"
111
"paddb %%mm1, %%mm0 \n\t"
112
113
"movq (%%"REG_a"), %%mm1 \n\t"
114
PMAXUB(%%mm1, %%mm4)
115
PMINUB(%%mm1, %%mm3, %%mm5)
116
"psubb %%mm1, %%mm2 \n\t"
117
"paddb %%mm7, %%mm2 \n\t"
118
"pcmpgtb %%mm6, %%mm2 \n\t"
119
"paddb %%mm2, %%mm0 \n\t"
120
121
"movq (%%"REG_a", %3), %%mm2 \n\t"
122
PMAXUB(%%mm2, %%mm4)
123
PMINUB(%%mm2, %%mm3, %%mm5)
124
"psubb %%mm2, %%mm1 \n\t"
125
"paddb %%mm7, %%mm1 \n\t"
126
"pcmpgtb %%mm6, %%mm1 \n\t"
127
"paddb %%mm1, %%mm0 \n\t"
128
129
"movq (%%"REG_a", %3, 2), %%mm1 \n\t"
130
PMAXUB(%%mm1, %%mm4)
131
PMINUB(%%mm1, %%mm3, %%mm5)
132
"psubb %%mm1, %%mm2 \n\t"
133
"paddb %%mm7, %%mm2 \n\t"
134
"pcmpgtb %%mm6, %%mm2 \n\t"
135
"paddb %%mm2, %%mm0 \n\t"
136
"psubusb %%mm3, %%mm4 \n\t"
137
138
" \n\t"
157
139
#ifdef HAVE_MMX2
158
"pxor %%mm7, %%mm7 \n\t"
159
"psadbw %%mm7, %%mm0 \n\t"
140
"pxor %%mm7, %%mm7 \n\t"
141
"psadbw %%mm7, %%mm0 \n\t"
160
142
#else
161
"movq %%mm0, %%mm1 \n\t"
162
"psrlw $8, %%mm0 \n\t"
163
"paddb %%mm1, %%mm0 \n\t"
164
"movq %%mm0, %%mm1 \n\t"
165
"psrlq $16, %%mm0 \n\t"
166
"paddb %%mm1, %%mm0 \n\t"
167
"movq %%mm0, %%mm1 \n\t"
168
"psrlq $32, %%mm0 \n\t"
169
"paddb %%mm1, %%mm0 \n\t"
143
"movq %%mm0, %%mm1 \n\t"
144
"psrlw $8, %%mm0 \n\t"
145
"paddb %%mm1, %%mm0 \n\t"
146
"movq %%mm0, %%mm1 \n\t"
147
"psrlq $16, %%mm0 \n\t"
148
"paddb %%mm1, %%mm0 \n\t"
149
"movq %%mm0, %%mm1 \n\t"
150
"psrlq $32, %%mm0 \n\t"
151
"paddb %%mm1, %%mm0 \n\t"
170
152
#endif
171
"movq %4, %%mm7 \n\t" // QP,..., QP
172
"paddusb %%mm7, %%mm7 \n\t" // 2QP ... 2QP
173
"psubusb %%mm7, %%mm4 \n\t" // Diff <= 2QP -> 0
174
"packssdw %%mm4, %%mm4 \n\t"
175
"movd %%mm0, %0 \n\t"
176
"movd %%mm4, %1 \n\t"
177
178
: "=r" (numEq), "=r" (dcOk)
179
: "r" (src), "r" ((long)stride), "m" (c->pQPb)
180
: "%"REG_a
181
);
182
183
numEq= (-numEq) &0xFF;
184
if(numEq > c->ppMode.flatnessThreshold){
185
if(dcOk) return 0;
186
else return 1;
187
}else{
188
return 2;
189
}
153
"movq %4, %%mm7 \n\t" // QP,..., QP
154
"paddusb %%mm7, %%mm7 \n\t" // 2QP ... 2QP
155
"psubusb %%mm7, %%mm4 \n\t" // Diff <= 2QP -> 0
156
"packssdw %%mm4, %%mm4 \n\t"
157
"movd %%mm0, %0 \n\t"
158
"movd %%mm4, %1 \n\t"
159
160
: "=r" (numEq), "=r" (dcOk)
161
: "r" (src), "r" ((long)stride), "m" (c->pQPb)
162
: "%"REG_a
163
);
164
165
numEq= (-numEq) &0xFF;
166
if(numEq > c->ppMode.flatnessThreshold){
167
if(dcOk) return 0;
168
else return 1;
169
}else{
170
return 2;
171
}
190
172
}
191
173
#endif //HAVE_MMX
192
174
198
180
static inline void RENAME(doVertLowPass)(uint8_t *src, int stride, PPContext *c)
199
181
{
200
182
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
201
src+= stride*3;
202
asm volatile( //"movv %0 %1 %2\n\t"
203
"movq %2, %%mm0 \n\t" // QP,..., QP
204
"pxor %%mm4, %%mm4 \n\t"
205
206
"movq (%0), %%mm6 \n\t"
207
"movq (%0, %1), %%mm5 \n\t"
208
"movq %%mm5, %%mm1 \n\t"
209
"movq %%mm6, %%mm2 \n\t"
210
"psubusb %%mm6, %%mm5 \n\t"
211
"psubusb %%mm1, %%mm2 \n\t"
212
"por %%mm5, %%mm2 \n\t" // ABS Diff of lines
213
"psubusb %%mm0, %%mm2 \n\t" // diff <= QP -> 0
214
"pcmpeqb %%mm4, %%mm2 \n\t" // diff <= QP -> FF
215
216
"pand %%mm2, %%mm6 \n\t"
217
"pandn %%mm1, %%mm2 \n\t"
218
"por %%mm2, %%mm6 \n\t"// First Line to Filter
219
220
"movq (%0, %1, 8), %%mm5 \n\t"
221
"lea (%0, %1, 4), %%"REG_a" \n\t"
222
"lea (%0, %1, 8), %%"REG_c" \n\t"
223
"sub %1, %%"REG_c" \n\t"
224
"add %1, %0 \n\t" // %0 points to line 1 not 0
225
"movq (%0, %1, 8), %%mm7 \n\t"
226
"movq %%mm5, %%mm1 \n\t"
227
"movq %%mm7, %%mm2 \n\t"
228
"psubusb %%mm7, %%mm5 \n\t"
229
"psubusb %%mm1, %%mm2 \n\t"
230
"por %%mm5, %%mm2 \n\t" // ABS Diff of lines
231
"psubusb %%mm0, %%mm2 \n\t" // diff <= QP -> 0
232
"pcmpeqb %%mm4, %%mm2 \n\t" // diff <= QP -> FF
233
234
"pand %%mm2, %%mm7 \n\t"
235
"pandn %%mm1, %%mm2 \n\t"
236
"por %%mm2, %%mm7 \n\t" // First Line to Filter
237
238
239
// 1 2 3 4 5 6 7 8
240
// %0 %0+%1 %0+2%1 eax %0+4%1 eax+2%1 ecx eax+4%1
241
// 6 4 2 2 1 1
242
// 6 4 4 2
243
// 6 8 2
244
245
"movq (%0, %1), %%mm0 \n\t" // 1
246
"movq %%mm0, %%mm1 \n\t" // 1
247
PAVGB(%%mm6, %%mm0) //1 1 /2
248
PAVGB(%%mm6, %%mm0) //3 1 /4
249
250
"movq (%0, %1, 4), %%mm2 \n\t" // 1
251
"movq %%mm2, %%mm5 \n\t" // 1
252
PAVGB((%%REGa), %%mm2) // 11 /2
253
PAVGB((%0, %1, 2), %%mm2) // 211 /4
254
"movq %%mm2, %%mm3 \n\t" // 211 /4
255
"movq (%0), %%mm4 \n\t" // 1
256
PAVGB(%%mm4, %%mm3) // 4 211 /8
257
PAVGB(%%mm0, %%mm3) //642211 /16
258
"movq %%mm3, (%0) \n\t" // X
259
// mm1=2 mm2=3(211) mm4=1 mm5=5 mm6=0 mm7=9
260
"movq %%mm1, %%mm0 \n\t" // 1
261
PAVGB(%%mm6, %%mm0) //1 1 /2
262
"movq %%mm4, %%mm3 \n\t" // 1
263
PAVGB((%0,%1,2), %%mm3) // 1 1 /2
264
PAVGB((%%REGa,%1,2), %%mm5) // 11 /2
265
PAVGB((%%REGa), %%mm5) // 211 /4
266
PAVGB(%%mm5, %%mm3) // 2 2211 /8
267
PAVGB(%%mm0, %%mm3) //4242211 /16
268
"movq %%mm3, (%0,%1) \n\t" // X
269
// mm1=2 mm2=3(211) mm4=1 mm5=4(211) mm6=0 mm7=9
270
PAVGB(%%mm4, %%mm6) //11 /2
271
"movq (%%"REG_c"), %%mm0 \n\t" // 1
272
PAVGB((%%REGa, %1, 2), %%mm0) // 11/2
273
"movq %%mm0, %%mm3 \n\t" // 11/2
274
PAVGB(%%mm1, %%mm0) // 2 11/4
275
PAVGB(%%mm6, %%mm0) //222 11/8
276
PAVGB(%%mm2, %%mm0) //22242211/16
277
"movq (%0, %1, 2), %%mm2 \n\t" // 1
278
"movq %%mm0, (%0, %1, 2) \n\t" // X
279
// mm1=2 mm2=3 mm3=6(11) mm4=1 mm5=4(211) mm6=0(11) mm7=9
280
"movq (%%"REG_a", %1, 4), %%mm0 \n\t" // 1
281
PAVGB((%%REGc), %%mm0) // 11 /2
282
PAVGB(%%mm0, %%mm6) //11 11 /4
283
PAVGB(%%mm1, %%mm4) // 11 /2
284
PAVGB(%%mm2, %%mm1) // 11 /2
285
PAVGB(%%mm1, %%mm6) //1122 11 /8
286
PAVGB(%%mm5, %%mm6) //112242211 /16
287
"movq (%%"REG_a"), %%mm5 \n\t" // 1
288
"movq %%mm6, (%%"REG_a") \n\t" // X
289
// mm0=7(11) mm1=2(11) mm2=3 mm3=6(11) mm4=1(11) mm5=4 mm7=9
290
"movq (%%"REG_a", %1, 4), %%mm6 \n\t" // 1
291
PAVGB(%%mm7, %%mm6) // 11 /2
292
PAVGB(%%mm4, %%mm6) // 11 11 /4
293
PAVGB(%%mm3, %%mm6) // 11 2211 /8
294
PAVGB(%%mm5, %%mm2) // 11 /2
295
"movq (%0, %1, 4), %%mm4 \n\t" // 1
296
PAVGB(%%mm4, %%mm2) // 112 /4
297
PAVGB(%%mm2, %%mm6) // 112242211 /16
298
"movq %%mm6, (%0, %1, 4) \n\t" // X
299
// mm0=7(11) mm1=2(11) mm2=3(112) mm3=6(11) mm4=5 mm5=4 mm7=9
300
PAVGB(%%mm7, %%mm1) // 11 2 /4
301
PAVGB(%%mm4, %%mm5) // 11 /2
302
PAVGB(%%mm5, %%mm0) // 11 11 /4
303
"movq (%%"REG_a", %1, 2), %%mm6 \n\t" // 1
304
PAVGB(%%mm6, %%mm1) // 11 4 2 /8
305
PAVGB(%%mm0, %%mm1) // 11224222 /16
306
"movq %%mm1, (%%"REG_a", %1, 2) \n\t" // X
307
// mm2=3(112) mm3=6(11) mm4=5 mm5=4(11) mm6=6 mm7=9
308
PAVGB((%%REGc), %%mm2) // 112 4 /8
309
"movq (%%"REG_a", %1, 4), %%mm0 \n\t" // 1
310
PAVGB(%%mm0, %%mm6) // 1 1 /2
311
PAVGB(%%mm7, %%mm6) // 1 12 /4
312
PAVGB(%%mm2, %%mm6) // 1122424 /4
313
"movq %%mm6, (%%"REG_c") \n\t" // X
314
// mm0=8 mm3=6(11) mm4=5 mm5=4(11) mm7=9
315
PAVGB(%%mm7, %%mm5) // 11 2 /4
316
PAVGB(%%mm7, %%mm5) // 11 6 /8
317
318
PAVGB(%%mm3, %%mm0) // 112 /4
319
PAVGB(%%mm0, %%mm5) // 112246 /16
320
"movq %%mm5, (%%"REG_a", %1, 4) \n\t" // X
321
"sub %1, %0 \n\t"
322
323
:
324
: "r" (src), "r" ((long)stride), "m" (c->pQPb)
325
: "%"REG_a, "%"REG_c
326
);
183
src+= stride*3;
184
asm volatile( //"movv %0 %1 %2\n\t"
185
"movq %2, %%mm0 \n\t" // QP,..., QP
186
"pxor %%mm4, %%mm4 \n\t"
187
188
"movq (%0), %%mm6 \n\t"
189
"movq (%0, %1), %%mm5 \n\t"
190
"movq %%mm5, %%mm1 \n\t"
191
"movq %%mm6, %%mm2 \n\t"
192
"psubusb %%mm6, %%mm5 \n\t"
193
"psubusb %%mm1, %%mm2 \n\t"
194
"por %%mm5, %%mm2 \n\t" // ABS Diff of lines
195
"psubusb %%mm0, %%mm2 \n\t" // diff <= QP -> 0
196
"pcmpeqb %%mm4, %%mm2 \n\t" // diff <= QP -> FF
197
198
"pand %%mm2, %%mm6 \n\t"
199
"pandn %%mm1, %%mm2 \n\t"
200
"por %%mm2, %%mm6 \n\t"// First Line to Filter
201
202
"movq (%0, %1, 8), %%mm5 \n\t"
203
"lea (%0, %1, 4), %%"REG_a" \n\t"
204
"lea (%0, %1, 8), %%"REG_c" \n\t"
205
"sub %1, %%"REG_c" \n\t"
206
"add %1, %0 \n\t" // %0 points to line 1 not 0
207
"movq (%0, %1, 8), %%mm7 \n\t"
208
"movq %%mm5, %%mm1 \n\t"
209
"movq %%mm7, %%mm2 \n\t"
210
"psubusb %%mm7, %%mm5 \n\t"
211
"psubusb %%mm1, %%mm2 \n\t"
212
"por %%mm5, %%mm2 \n\t" // ABS Diff of lines
213
"psubusb %%mm0, %%mm2 \n\t" // diff <= QP -> 0
214
"pcmpeqb %%mm4, %%mm2 \n\t" // diff <= QP -> FF
215
216
"pand %%mm2, %%mm7 \n\t"
217
"pandn %%mm1, %%mm2 \n\t"
218
"por %%mm2, %%mm7 \n\t" // First Line to Filter
219
220
221
// 1 2 3 4 5 6 7 8
222
// %0 %0+%1 %0+2%1 eax %0+4%1 eax+2%1 ecx eax+4%1
223
// 6 4 2 2 1 1
224
// 6 4 4 2
225
// 6 8 2
226
227
"movq (%0, %1), %%mm0 \n\t" // 1
228
"movq %%mm0, %%mm1 \n\t" // 1
229
PAVGB(%%mm6, %%mm0) //1 1 /2
230
PAVGB(%%mm6, %%mm0) //3 1 /4
231
232
"movq (%0, %1, 4), %%mm2 \n\t" // 1
233
"movq %%mm2, %%mm5 \n\t" // 1
234
PAVGB((%%REGa), %%mm2) // 11 /2
235
PAVGB((%0, %1, 2), %%mm2) // 211 /4
236
"movq %%mm2, %%mm3 \n\t" // 211 /4
237
"movq (%0), %%mm4 \n\t" // 1
238
PAVGB(%%mm4, %%mm3) // 4 211 /8
239
PAVGB(%%mm0, %%mm3) //642211 /16
240
"movq %%mm3, (%0) \n\t" // X
241
// mm1=2 mm2=3(211) mm4=1 mm5=5 mm6=0 mm7=9
242
"movq %%mm1, %%mm0 \n\t" // 1
243
PAVGB(%%mm6, %%mm0) //1 1 /2
244
"movq %%mm4, %%mm3 \n\t" // 1
245
PAVGB((%0,%1,2), %%mm3) // 1 1 /2
246
PAVGB((%%REGa,%1,2), %%mm5) // 11 /2
247
PAVGB((%%REGa), %%mm5) // 211 /4
248
PAVGB(%%mm5, %%mm3) // 2 2211 /8
249
PAVGB(%%mm0, %%mm3) //4242211 /16
250
"movq %%mm3, (%0,%1) \n\t" // X
251
// mm1=2 mm2=3(211) mm4=1 mm5=4(211) mm6=0 mm7=9
252
PAVGB(%%mm4, %%mm6) //11 /2
253
"movq (%%"REG_c"), %%mm0 \n\t" // 1
254
PAVGB((%%REGa, %1, 2), %%mm0) // 11/2
255
"movq %%mm0, %%mm3 \n\t" // 11/2
256
PAVGB(%%mm1, %%mm0) // 2 11/4
257
PAVGB(%%mm6, %%mm0) //222 11/8
258
PAVGB(%%mm2, %%mm0) //22242211/16
259
"movq (%0, %1, 2), %%mm2 \n\t" // 1
260
"movq %%mm0, (%0, %1, 2) \n\t" // X
261
// mm1=2 mm2=3 mm3=6(11) mm4=1 mm5=4(211) mm6=0(11) mm7=9
262
"movq (%%"REG_a", %1, 4), %%mm0 \n\t" // 1
263
PAVGB((%%REGc), %%mm0) // 11 /2
264
PAVGB(%%mm0, %%mm6) //11 11 /4
265
PAVGB(%%mm1, %%mm4) // 11 /2
266
PAVGB(%%mm2, %%mm1) // 11 /2
267
PAVGB(%%mm1, %%mm6) //1122 11 /8
268
PAVGB(%%mm5, %%mm6) //112242211 /16
269
"movq (%%"REG_a"), %%mm5 \n\t" // 1
270
"movq %%mm6, (%%"REG_a") \n\t" // X
271
// mm0=7(11) mm1=2(11) mm2=3 mm3=6(11) mm4=1(11) mm5=4 mm7=9
272
"movq (%%"REG_a", %1, 4), %%mm6 \n\t" // 1
273
PAVGB(%%mm7, %%mm6) // 11 /2
274
PAVGB(%%mm4, %%mm6) // 11 11 /4
275
PAVGB(%%mm3, %%mm6) // 11 2211 /8
276
PAVGB(%%mm5, %%mm2) // 11 /2
277
"movq (%0, %1, 4), %%mm4 \n\t" // 1
278
PAVGB(%%mm4, %%mm2) // 112 /4
279
PAVGB(%%mm2, %%mm6) // 112242211 /16
280
"movq %%mm6, (%0, %1, 4) \n\t" // X
281
// mm0=7(11) mm1=2(11) mm2=3(112) mm3=6(11) mm4=5 mm5=4 mm7=9
282
PAVGB(%%mm7, %%mm1) // 11 2 /4
283
PAVGB(%%mm4, %%mm5) // 11 /2
284
PAVGB(%%mm5, %%mm0) // 11 11 /4
285
"movq (%%"REG_a", %1, 2), %%mm6 \n\t" // 1
286
PAVGB(%%mm6, %%mm1) // 11 4 2 /8
287
PAVGB(%%mm0, %%mm1) // 11224222 /16
288
"movq %%mm1, (%%"REG_a", %1, 2) \n\t" // X
289
// mm2=3(112) mm3=6(11) mm4=5 mm5=4(11) mm6=6 mm7=9
290
PAVGB((%%REGc), %%mm2) // 112 4 /8
291
"movq (%%"REG_a", %1, 4), %%mm0 \n\t" // 1
292
PAVGB(%%mm0, %%mm6) // 1 1 /2
293
PAVGB(%%mm7, %%mm6) // 1 12 /4
294
PAVGB(%%mm2, %%mm6) // 1122424 /4
295
"movq %%mm6, (%%"REG_c") \n\t" // X
296
// mm0=8 mm3=6(11) mm4=5 mm5=4(11) mm7=9
297
PAVGB(%%mm7, %%mm5) // 11 2 /4
298
PAVGB(%%mm7, %%mm5) // 11 6 /8
299
300
PAVGB(%%mm3, %%mm0) // 112 /4
301
PAVGB(%%mm0, %%mm5) // 112246 /16
302
"movq %%mm5, (%%"REG_a", %1, 4) \n\t" // X
303
"sub %1, %0 \n\t"
304
305
:
306
: "r" (src), "r" ((long)stride), "m" (c->pQPb)
307
: "%"REG_a, "%"REG_c
308
);
327
309
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
328
const int l1= stride;
329
const int l2= stride + l1;
330
const int l3= stride + l2;
331
const int l4= stride + l3;
332
const int l5= stride + l4;
333
const int l6= stride + l5;
334
const int l7= stride + l6;
335
const int l8= stride + l7;
336
const int l9= stride + l8;
337
int x;
338
src+= stride*3;
339
for(x=0; x<BLOCK_SIZE; x++)
340
{
341
const int first= FFABS(src[0] - src[l1]) < c->QP ? src[0] : src[l1];
342
const int last= FFABS(src[l8] - src[l9]) < c->QP ? src[l9] : src[l8];
343
344
int sums[10];
345
sums[0] = 4*first + src[l1] + src[l2] + src[l3] + 4;
346
sums[1] = sums[0] - first + src[l4];
347
sums[2] = sums[1] - first + src[l5];
348
sums[3] = sums[2] - first + src[l6];
349
sums[4] = sums[3] - first + src[l7];
350
sums[5] = sums[4] - src[l1] + src[l8];
351
sums[6] = sums[5] - src[l2] + last;
352
sums[7] = sums[6] - src[l3] + last;
353
sums[8] = sums[7] - src[l4] + last;
354
sums[9] = sums[8] - src[l5] + last;
355
356
src[l1]= (sums[0] + sums[2] + 2*src[l1])>>4;
357
src[l2]= (sums[1] + sums[3] + 2*src[l2])>>4;
358
src[l3]= (sums[2] + sums[4] + 2*src[l3])>>4;
359
src[l4]= (sums[3] + sums[5] + 2*src[l4])>>4;
360
src[l5]= (sums[4] + sums[6] + 2*src[l5])>>4;
361
src[l6]= (sums[5] + sums[7] + 2*src[l6])>>4;
362
src[l7]= (sums[6] + sums[8] + 2*src[l7])>>4;
363
src[l8]= (sums[7] + sums[9] + 2*src[l8])>>4;
364
365
src++;
366
}
310
const int l1= stride;
311
const int l2= stride + l1;
312
const int l3= stride + l2;
313
const int l4= stride + l3;
314
const int l5= stride + l4;
315
const int l6= stride + l5;
316
const int l7= stride + l6;
317
const int l8= stride + l7;
318
const int l9= stride + l8;
319
int x;
320
src+= stride*3;
321
for(x=0; x<BLOCK_SIZE; x++){
322
const int first= FFABS(src[0] - src[l1]) < c->QP ? src[0] : src[l1];
323
const int last= FFABS(src[l8] - src[l9]) < c->QP ? src[l9] : src[l8];
324
325
int sums[10];
326
sums[0] = 4*first + src[l1] + src[l2] + src[l3] + 4;
327
sums[1] = sums[0] - first + src[l4];
328
sums[2] = sums[1] - first + src[l5];
329
sums[3] = sums[2] - first + src[l6];
330
sums[4] = sums[3] - first + src[l7];
331
sums[5] = sums[4] - src[l1] + src[l8];
332
sums[6] = sums[5] - src[l2] + last;
333
sums[7] = sums[6] - src[l3] + last;
334
sums[8] = sums[7] - src[l4] + last;
335
sums[9] = sums[8] - src[l5] + last;
336
337
src[l1]= (sums[0] + sums[2] + 2*src[l1])>>4;
338
src[l2]= (sums[1] + sums[3] + 2*src[l2])>>4;
339
src[l3]= (sums[2] + sums[4] + 2*src[l3])>>4;
340
src[l4]= (sums[3] + sums[5] + 2*src[l4])>>4;
341
src[l5]= (sums[4] + sums[6] + 2*src[l5])>>4;
342
src[l6]= (sums[5] + sums[7] + 2*src[l6])>>4;
343
src[l7]= (sums[6] + sums[8] + 2*src[l7])>>4;
344
src[l8]= (sums[7] + sums[9] + 2*src[l8])>>4;
345
346
src++;
347
}
367
348
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
368
349
}
369
350
#endif //HAVE_ALTIVEC
373
354
* Experimental implementation of the filter (Algorithm 1) described in a paper from Ramkishor & Karandikar
374
355
* values are correctly clipped (MMX2)
375
356
* values are wraparound (C)
376
* conclusion: its fast, but introduces ugly horizontal patterns if there is a continious gradient
357
* Conclusion: It is fast, but introduces ugly horizontal patterns
358
* if there is a continuous gradient.
377
359
0 8 16 24
378
360
x = 8
379
361
x/2 = 4
383
365
static inline void RENAME(vertRK1Filter)(uint8_t *src, int stride, int QP)
384
366
{
385
367
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
386
src+= stride*3;
368
src+= stride*3;
387
369
// FIXME rounding
388
asm volatile(
389
"pxor %%mm7, %%mm7 \n\t" // 0
390
"movq "MANGLE(b80)", %%mm6 \n\t" // MIN_SIGNED_BYTE
391
"leal (%0, %1), %%"REG_a" \n\t"
392
"leal (%%"REG_a", %1, 4), %%"REG_c" \n\t"
370
asm volatile(
371
"pxor %%mm7, %%mm7 \n\t" // 0
372
"movq "MANGLE(b80)", %%mm6 \n\t" // MIN_SIGNED_BYTE
373
"leal (%0, %1), %%"REG_a" \n\t"
374
"leal (%%"REG_a", %1, 4), %%"REG_c" \n\t"
393
375
// 0 1 2 3 4 5 6 7 8 9
394
376
// %0 eax eax+%1 eax+2%1 %0+4%1 ecx ecx+%1 ecx+2%1 %0+8%1 ecx+4%1
395
"movq "MANGLE(pQPb)", %%mm0 \n\t" // QP,..., QP
396
"movq %%mm0, %%mm1 \n\t" // QP,..., QP
397
"paddusb "MANGLE(b02)", %%mm0 \n\t"
398
"psrlw $2, %%mm0 \n\t"
399
"pand "MANGLE(b3F)", %%mm0 \n\t" // QP/4,..., QP/4
400
"paddusb %%mm1, %%mm0 \n\t" // QP*1.25 ...
401
"movq (%0, %1, 4), %%mm2 \n\t" // line 4
402
"movq (%%"REG_c"), %%mm3 \n\t" // line 5
403
"movq %%mm2, %%mm4 \n\t" // line 4
404
"pcmpeqb %%mm5, %%mm5 \n\t" // -1
405
"pxor %%mm2, %%mm5 \n\t" // -line 4 - 1
406
PAVGB(%%mm3, %%mm5)
407
"paddb %%mm6, %%mm5 \n\t" // (l5-l4)/2
408
"psubusb %%mm3, %%mm4 \n\t"
409
"psubusb %%mm2, %%mm3 \n\t"
410
"por %%mm3, %%mm4 \n\t" // |l4 - l5|
411
"psubusb %%mm0, %%mm4 \n\t"
412
"pcmpeqb %%mm7, %%mm4 \n\t"
413
"pand %%mm4, %%mm5 \n\t" // d/2
414
415
// "paddb %%mm6, %%mm2 \n\t" // line 4 + 0x80
416
"paddb %%mm5, %%mm2 \n\t"
417
// "psubb %%mm6, %%mm2 \n\t"
418
"movq %%mm2, (%0,%1, 4) \n\t"
419
420
"movq (%%"REG_c"), %%mm2 \n\t"
421
// "paddb %%mm6, %%mm2 \n\t" // line 5 + 0x80
422
"psubb %%mm5, %%mm2 \n\t"
423
// "psubb %%mm6, %%mm2 \n\t"
424
"movq %%mm2, (%%"REG_c") \n\t"
425
426
"paddb %%mm6, %%mm5 \n\t"
427
"psrlw $2, %%mm5 \n\t"
428
"pand "MANGLE(b3F)", %%mm5 \n\t"
429
"psubb "MANGLE(b20)", %%mm5 \n\t" // (l5-l4)/8
430
431
"movq (%%"REG_a", %1, 2), %%mm2 \n\t"
432
"paddb %%mm6, %%mm2 \n\t" // line 3 + 0x80
433
"paddsb %%mm5, %%mm2 \n\t"
434
"psubb %%mm6, %%mm2 \n\t"
435
"movq %%mm2, (%%"REG_a", %1, 2) \n\t"
436
437
"movq (%%"REG_c", %1), %%mm2 \n\t"
438
"paddb %%mm6, %%mm2 \n\t" // line 6 + 0x80
439
"psubsb %%mm5, %%mm2 \n\t"
440
"psubb %%mm6, %%mm2 \n\t"
441
"movq %%mm2, (%%"REG_c", %1) \n\t"
442
443
:
444
: "r" (src), "r" ((long)stride)
445
: "%"REG_a, "%"REG_c
446
);
377
"movq "MANGLE(pQPb)", %%mm0 \n\t" // QP,..., QP
378
"movq %%mm0, %%mm1 \n\t" // QP,..., QP
379
"paddusb "MANGLE(b02)", %%mm0 \n\t"
380
"psrlw $2, %%mm0 \n\t"
381
"pand "MANGLE(b3F)", %%mm0 \n\t" // QP/4,..., QP/4
382
"paddusb %%mm1, %%mm0 \n\t" // QP*1.25 ...
383
"movq (%0, %1, 4), %%mm2 \n\t" // line 4
384
"movq (%%"REG_c"), %%mm3 \n\t" // line 5
385
"movq %%mm2, %%mm4 \n\t" // line 4
386
"pcmpeqb %%mm5, %%mm5 \n\t" // -1
387
"pxor %%mm2, %%mm5 \n\t" // -line 4 - 1
388
PAVGB(%%mm3, %%mm5)
389
"paddb %%mm6, %%mm5 \n\t" // (l5-l4)/2
390
"psubusb %%mm3, %%mm4 \n\t"
391
"psubusb %%mm2, %%mm3 \n\t"
392
"por %%mm3, %%mm4 \n\t" // |l4 - l5|
393
"psubusb %%mm0, %%mm4 \n\t"
394
"pcmpeqb %%mm7, %%mm4 \n\t"
395
"pand %%mm4, %%mm5 \n\t" // d/2
396
397
// "paddb %%mm6, %%mm2 \n\t" // line 4 + 0x80
398
"paddb %%mm5, %%mm2 \n\t"
399
// "psubb %%mm6, %%mm2 \n\t"
400
"movq %%mm2, (%0,%1, 4) \n\t"
401
402
"movq (%%"REG_c"), %%mm2 \n\t"
403
// "paddb %%mm6, %%mm2 \n\t" // line 5 + 0x80
404
"psubb %%mm5, %%mm2 \n\t"
405
// "psubb %%mm6, %%mm2 \n\t"
406
"movq %%mm2, (%%"REG_c") \n\t"
407
408
"paddb %%mm6, %%mm5 \n\t"
409
"psrlw $2, %%mm5 \n\t"
410
"pand "MANGLE(b3F)", %%mm5 \n\t"
411
"psubb "MANGLE(b20)", %%mm5 \n\t" // (l5-l4)/8
412
413
"movq (%%"REG_a", %1, 2), %%mm2 \n\t"
414
"paddb %%mm6, %%mm2 \n\t" // line 3 + 0x80
415
"paddsb %%mm5, %%mm2 \n\t"
416
"psubb %%mm6, %%mm2 \n\t"
417
"movq %%mm2, (%%"REG_a", %1, 2) \n\t"
418
419
"movq (%%"REG_c", %1), %%mm2 \n\t"
420
"paddb %%mm6, %%mm2 \n\t" // line 6 + 0x80
421
"psubsb %%mm5, %%mm2 \n\t"
422
"psubb %%mm6, %%mm2 \n\t"
423
"movq %%mm2, (%%"REG_c", %1) \n\t"
424
425
:
426
: "r" (src), "r" ((long)stride)
427
: "%"REG_a, "%"REG_c
428
);
447
429
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
448
const int l1= stride;
449
const int l2= stride + l1;
450
const int l3= stride + l2;
451
const int l4= stride + l3;
452
const int l5= stride + l4;
453
const int l6= stride + l5;
454
// const int l7= stride + l6;
455
// const int l8= stride + l7;
456
// const int l9= stride + l8;
457
int x;
458
const int QP15= QP + (QP>>2);
459
src+= stride*3;
460
for(x=0; x<BLOCK_SIZE; x++)
461
{
462
const int v = (src[x+l5] - src[x+l4]);
463
if(FFABS(v) < QP15)
464
{
465
src[x+l3] +=v>>3;
466
src[x+l4] +=v>>1;
467
src[x+l5] -=v>>1;
468
src[x+l6] -=v>>3;
469
470
}
430
const int l1= stride;
431
const int l2= stride + l1;
432
const int l3= stride + l2;
433
const int l4= stride + l3;
434
const int l5= stride + l4;
435
const int l6= stride + l5;
436
// const int l7= stride + l6;
437
// const int l8= stride + l7;
438
// const int l9= stride + l8;
439
int x;
440
const int QP15= QP + (QP>>2);
441
src+= stride*3;
442
for(x=0; x<BLOCK_SIZE; x++){
443
const int v = (src[x+l5] - src[x+l4]);
444
if(FFABS(v) < QP15){
445
src[x+l3] +=v>>3;
446
src[x+l4] +=v>>1;
447
src[x+l5] -=v>>1;
448
src[x+l6] -=v>>3;
471
449
}
450
}
472
451
473
452
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
474
453
}
477
456
/**
478
457
* Experimental Filter 1
479
458
* will not damage linear gradients
480
* Flat blocks should look like they where passed through the (1,1,2,2,4,2,2,1,1) 9-Tap filter
481
* can only smooth blocks at the expected locations (it cant smooth them if they did move)
482
* MMX2 version does correct clipping C version doesnt
459
* Flat blocks should look like they were passed through the (1,1,2,2,4,2,2,1,1) 9-Tap filter
460
* can only smooth blocks at the expected locations (it cannot smooth them if they did move)
461
* MMX2 version does correct clipping C version does not
483
462
*/
484
463
static inline void RENAME(vertX1Filter)(uint8_t *src, int stride, PPContext *co)
485
464
{
486
465
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
487
src+= stride*3;
466
src+= stride*3;
488
467
489
asm volatile(
490
"pxor %%mm7, %%mm7 \n\t" // 0
491
"lea (%0, %1), %%"REG_a" \n\t"
492
"lea (%%"REG_a", %1, 4), %%"REG_c" \n\t"
468
asm volatile(
469
"pxor %%mm7, %%mm7 \n\t" // 0
470
"lea (%0, %1), %%"REG_a" \n\t"
471
"lea (%%"REG_a", %1, 4), %%"REG_c" \n\t"
493
472
// 0 1 2 3 4 5 6 7 8 9
494
473
// %0 eax eax+%1 eax+2%1 %0+4%1 ecx ecx+%1 ecx+2%1 %0+8%1 ecx+4%1
495
"movq (%%"REG_a", %1, 2), %%mm0 \n\t" // line 3
496
"movq (%0, %1, 4), %%mm1 \n\t" // line 4
497
"movq %%mm1, %%mm2 \n\t" // line 4
498
"psubusb %%mm0, %%mm1 \n\t"
499
"psubusb %%mm2, %%mm0 \n\t"
500
"por %%mm1, %%mm0 \n\t" // |l2 - l3|
501
"movq (%%"REG_c"), %%mm3 \n\t" // line 5
502
"movq (%%"REG_c", %1), %%mm4 \n\t" // line 6
503
"movq %%mm3, %%mm5 \n\t" // line 5
504
"psubusb %%mm4, %%mm3 \n\t"
505
"psubusb %%mm5, %%mm4 \n\t"
506
"por %%mm4, %%mm3 \n\t" // |l5 - l6|
507
PAVGB(%%mm3, %%mm0) // (|l2 - l3| + |l5 - l6|)/2
508
"movq %%mm2, %%mm1 \n\t" // line 4
509
"psubusb %%mm5, %%mm2 \n\t"
510
"movq %%mm2, %%mm4 \n\t"
511
"pcmpeqb %%mm7, %%mm2 \n\t" // (l4 - l5) <= 0 ? -1 : 0
512
"psubusb %%mm1, %%mm5 \n\t"
513
"por %%mm5, %%mm4 \n\t" // |l4 - l5|
514
"psubusb %%mm0, %%mm4 \n\t" //d = MAX(0, |l4-l5| - (|l2-l3| + |l5-l6|)/2)
515
"movq %%mm4, %%mm3 \n\t" // d
516
"movq %2, %%mm0 \n\t"
517
"paddusb %%mm0, %%mm0 \n\t"
518
"psubusb %%mm0, %%mm4 \n\t"
519
"pcmpeqb %%mm7, %%mm4 \n\t" // d <= QP ? -1 : 0
520
"psubusb "MANGLE(b01)", %%mm3 \n\t"
521
"pand %%mm4, %%mm3 \n\t" // d <= QP ? d : 0
522
523
PAVGB(%%mm7, %%mm3) // d/2
524
"movq %%mm3, %%mm1 \n\t" // d/2
525
PAVGB(%%mm7, %%mm3) // d/4
526
PAVGB(%%mm1, %%mm3) // 3*d/8
527
528
"movq (%0, %1, 4), %%mm0 \n\t" // line 4
529
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l4-1 : l4
530
"psubusb %%mm3, %%mm0 \n\t"
531
"pxor %%mm2, %%mm0 \n\t"
532
"movq %%mm0, (%0, %1, 4) \n\t" // line 4
533
534
"movq (%%"REG_c"), %%mm0 \n\t" // line 5
535
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l5-1 : l5
536
"paddusb %%mm3, %%mm0 \n\t"
537
"pxor %%mm2, %%mm0 \n\t"
538
"movq %%mm0, (%%"REG_c") \n\t" // line 5
539
540
PAVGB(%%mm7, %%mm1) // d/4
541
542
"movq (%%"REG_a", %1, 2), %%mm0 \n\t" // line 3
543
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l4-1 : l4
544
"psubusb %%mm1, %%mm0 \n\t"
545
"pxor %%mm2, %%mm0 \n\t"
546
"movq %%mm0, (%%"REG_a", %1, 2) \n\t" // line 3
547
548
"movq (%%"REG_c", %1), %%mm0 \n\t" // line 6
549
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l5-1 : l5
550
"paddusb %%mm1, %%mm0 \n\t"
551
"pxor %%mm2, %%mm0 \n\t"
552
"movq %%mm0, (%%"REG_c", %1) \n\t" // line 6
553
554
PAVGB(%%mm7, %%mm1) // d/8
555
556
"movq (%%"REG_a", %1), %%mm0 \n\t" // line 2
557
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l2-1 : l2
558
"psubusb %%mm1, %%mm0 \n\t"
559
"pxor %%mm2, %%mm0 \n\t"
560
"movq %%mm0, (%%"REG_a", %1) \n\t" // line 2
561
562
"movq (%%"REG_c", %1, 2), %%mm0 \n\t" // line 7
563
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l7-1 : l7
564
"paddusb %%mm1, %%mm0 \n\t"
565
"pxor %%mm2, %%mm0 \n\t"
566
"movq %%mm0, (%%"REG_c", %1, 2) \n\t" // line 7
567
568
:
569
: "r" (src), "r" ((long)stride), "m" (co->pQPb)
570
: "%"REG_a, "%"REG_c
571
);
474
"movq (%%"REG_a", %1, 2), %%mm0 \n\t" // line 3
475
"movq (%0, %1, 4), %%mm1 \n\t" // line 4
476
"movq %%mm1, %%mm2 \n\t" // line 4
477
"psubusb %%mm0, %%mm1 \n\t"
478
"psubusb %%mm2, %%mm0 \n\t"
479
"por %%mm1, %%mm0 \n\t" // |l2 - l3|
480
"movq (%%"REG_c"), %%mm3 \n\t" // line 5
481
"movq (%%"REG_c", %1), %%mm4 \n\t" // line 6
482
"movq %%mm3, %%mm5 \n\t" // line 5
483
"psubusb %%mm4, %%mm3 \n\t"
484
"psubusb %%mm5, %%mm4 \n\t"
485
"por %%mm4, %%mm3 \n\t" // |l5 - l6|
486
PAVGB(%%mm3, %%mm0) // (|l2 - l3| + |l5 - l6|)/2
487
"movq %%mm2, %%mm1 \n\t" // line 4
488
"psubusb %%mm5, %%mm2 \n\t"
489
"movq %%mm2, %%mm4 \n\t"
490
"pcmpeqb %%mm7, %%mm2 \n\t" // (l4 - l5) <= 0 ? -1 : 0
491
"psubusb %%mm1, %%mm5 \n\t"
492
"por %%mm5, %%mm4 \n\t" // |l4 - l5|
493
"psubusb %%mm0, %%mm4 \n\t" //d = MAX(0, |l4-l5| - (|l2-l3| + |l5-l6|)/2)
494
"movq %%mm4, %%mm3 \n\t" // d
495
"movq %2, %%mm0 \n\t"
496
"paddusb %%mm0, %%mm0 \n\t"
497
"psubusb %%mm0, %%mm4 \n\t"
498
"pcmpeqb %%mm7, %%mm4 \n\t" // d <= QP ? -1 : 0
499
"psubusb "MANGLE(b01)", %%mm3 \n\t"
500
"pand %%mm4, %%mm3 \n\t" // d <= QP ? d : 0
501
502
PAVGB(%%mm7, %%mm3) // d/2
503
"movq %%mm3, %%mm1 \n\t" // d/2
504
PAVGB(%%mm7, %%mm3) // d/4
505
PAVGB(%%mm1, %%mm3) // 3*d/8
506
507
"movq (%0, %1, 4), %%mm0 \n\t" // line 4
508
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l4-1 : l4
509
"psubusb %%mm3, %%mm0 \n\t"
510
"pxor %%mm2, %%mm0 \n\t"
511
"movq %%mm0, (%0, %1, 4) \n\t" // line 4
512
513
"movq (%%"REG_c"), %%mm0 \n\t" // line 5
514
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l5-1 : l5
515
"paddusb %%mm3, %%mm0 \n\t"
516
"pxor %%mm2, %%mm0 \n\t"
517
"movq %%mm0, (%%"REG_c") \n\t" // line 5
518
519
PAVGB(%%mm7, %%mm1) // d/4
520
521
"movq (%%"REG_a", %1, 2), %%mm0 \n\t" // line 3
522
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l4-1 : l4
523
"psubusb %%mm1, %%mm0 \n\t"
524
"pxor %%mm2, %%mm0 \n\t"
525
"movq %%mm0, (%%"REG_a", %1, 2) \n\t" // line 3
526
527
"movq (%%"REG_c", %1), %%mm0 \n\t" // line 6
528
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l5-1 : l5
529
"paddusb %%mm1, %%mm0 \n\t"
530
"pxor %%mm2, %%mm0 \n\t"
531
"movq %%mm0, (%%"REG_c", %1) \n\t" // line 6
532
533
PAVGB(%%mm7, %%mm1) // d/8
534
535
"movq (%%"REG_a", %1), %%mm0 \n\t" // line 2
536
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l2-1 : l2
537
"psubusb %%mm1, %%mm0 \n\t"
538
"pxor %%mm2, %%mm0 \n\t"
539
"movq %%mm0, (%%"REG_a", %1) \n\t" // line 2
540
541
"movq (%%"REG_c", %1, 2), %%mm0 \n\t" // line 7
542
"pxor %%mm2, %%mm0 \n\t" //(l4 - l5) <= 0 ? -l7-1 : l7
543
"paddusb %%mm1, %%mm0 \n\t"
544
"pxor %%mm2, %%mm0 \n\t"
545
"movq %%mm0, (%%"REG_c", %1, 2) \n\t" // line 7
546
547
:
548
: "r" (src), "r" ((long)stride), "m" (co->pQPb)
549
: "%"REG_a, "%"REG_c
550
);
572
551
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
573
552
574
const int l1= stride;
575
const int l2= stride + l1;
576
const int l3= stride + l2;
577
const int l4= stride + l3;
578
const int l5= stride + l4;
579
const int l6= stride + l5;
580
const int l7= stride + l6;
581
// const int l8= stride + l7;
582
// const int l9= stride + l8;
583
int x;
584
585
src+= stride*3;
586
for(x=0; x<BLOCK_SIZE; x++)
587
{
588
int a= src[l3] - src[l4];
589
int b= src[l4] - src[l5];
590
int c= src[l5] - src[l6];
591
592
int d= FFABS(b) - ((FFABS(a) + FFABS(c))>>1);
593
d= FFMAX(d, 0);
594
595
if(d < co->QP*2)
596
{
597
int v = d * FFSIGN(-b);
598
599
src[l2] +=v>>3;
600
src[l3] +=v>>2;
601
src[l4] +=(3*v)>>3;
602
src[l5] -=(3*v)>>3;
603
src[l6] -=v>>2;
604
src[l7] -=v>>3;
605
606
}
607
src++;
553
const int l1= stride;
554
const int l2= stride + l1;
555
const int l3= stride + l2;
556
const int l4= stride + l3;
557
const int l5= stride + l4;
558
const int l6= stride + l5;
559
const int l7= stride + l6;
560
// const int l8= stride + l7;
561
// const int l9= stride + l8;
562
int x;
563
564
src+= stride*3;
565
for(x=0; x<BLOCK_SIZE; x++){
566
int a= src[l3] - src[l4];
567
int b= src[l4] - src[l5];
568
int c= src[l5] - src[l6];
569
570
int d= FFABS(b) - ((FFABS(a) + FFABS(c))>>1);
571
d= FFMAX(d, 0);
572
573
if(d < co->QP*2){
574
int v = d * FFSIGN(-b);
575
576
src[l2] +=v>>3;
577
src[l3] +=v>>2;
578
src[l4] +=(3*v)>>3;
579
src[l5] -=(3*v)>>3;
580
src[l6] -=v>>2;
581
src[l7] -=v>>3;
608
582
}
583
src++;
584
}
609
585
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
610
586
}
611
587
614
590
{
615
591
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
616
592
/*
617
uint8_t tmp[16];
618
const int l1= stride;
619
const int l2= stride + l1;
620
const int l3= stride + l2;
621
const int l4= (int)tmp - (int)src - stride*3;
622
const int l5= (int)tmp - (int)src - stride*3 + 8;
623
const int l6= stride*3 + l3;
624
const int l7= stride + l6;
625
const int l8= stride + l7;
593
uint8_t tmp[16];
594
const int l1= stride;
595
const int l2= stride + l1;
596
const int l3= stride + l2;
597
const int l4= (int)tmp - (int)src - stride*3;
598
const int l5= (int)tmp - (int)src - stride*3 + 8;
599
const int l6= stride*3 + l3;
600
const int l7= stride + l6;
601
const int l8= stride + l7;
626
602
627
memcpy(tmp, src+stride*7, 8);
628
memcpy(tmp+8, src+stride*8, 8);
603
memcpy(tmp, src+stride*7, 8);
604
memcpy(tmp+8, src+stride*8, 8);
629
605
*/
630
src+= stride*4;
631
asm volatile(
606
src+= stride*4;
607
asm volatile(
632
608
633
#if 0 //sligtly more accurate and slightly slower
634
"pxor %%mm7, %%mm7 \n\t" // 0
635
"lea (%0, %1), %%"REG_a" \n\t"
636
"lea (%%"REG_a", %1, 4), %%"REG_c" \n\t"
609
#if 0 //slightly more accurate and slightly slower
610
"pxor %%mm7, %%mm7 \n\t" // 0
611
"lea (%0, %1), %%"REG_a" \n\t"
612
"lea (%%"REG_a", %1, 4), %%"REG_c" \n\t"
637
613
// 0 1 2 3 4 5 6 7
638
614
// %0 %0+%1 %0+2%1 eax+2%1 %0+4%1 eax+4%1 ecx+%1 ecx+2%1
639
615
// %0 eax eax+%1 eax+2%1 %0+4%1 ecx ecx+%1 ecx+2%1
640
616
641
617
642
"movq (%0, %1, 2), %%mm0 \n\t" // l2
643
"movq (%0), %%mm1 \n\t" // l0
644
"movq %%mm0, %%mm2 \n\t" // l2
645
PAVGB(%%mm7, %%mm0) // ~l2/2
646
PAVGB(%%mm1, %%mm0) // ~(l2 + 2l0)/4
647
PAVGB(%%mm2, %%mm0) // ~(5l2 + 2l0)/8
648
649
"movq (%%"REG_a"), %%mm1 \n\t" // l1
650
"movq (%%"REG_a", %1, 2), %%mm3 \n\t" // l3
651
"movq %%mm1, %%mm4 \n\t" // l1
652
PAVGB(%%mm7, %%mm1) // ~l1/2
653
PAVGB(%%mm3, %%mm1) // ~(l1 + 2l3)/4
654
PAVGB(%%mm4, %%mm1) // ~(5l1 + 2l3)/8
655
656
"movq %%mm0, %%mm4 \n\t" // ~(5l2 + 2l0)/8
657
"psubusb %%mm1, %%mm0 \n\t"
658
"psubusb %%mm4, %%mm1 \n\t"
659
"por %%mm0, %%mm1 \n\t" // ~|2l0 - 5l1 + 5l2 - 2l3|/8
618
"movq (%0, %1, 2), %%mm0 \n\t" // l2
619
"movq (%0), %%mm1 \n\t" // l0
620
"movq %%mm0, %%mm2 \n\t" // l2
621
PAVGB(%%mm7, %%mm0) // ~l2/2
622
PAVGB(%%mm1, %%mm0) // ~(l2 + 2l0)/4
623
PAVGB(%%mm2, %%mm0) // ~(5l2 + 2l0)/8
624
625
"movq (%%"REG_a"), %%mm1 \n\t" // l1
626
"movq (%%"REG_a", %1, 2), %%mm3 \n\t" // l3
627
"movq %%mm1, %%mm4 \n\t" // l1
628
PAVGB(%%mm7, %%mm1) // ~l1/2
629
PAVGB(%%mm3, %%mm1) // ~(l1 + 2l3)/4
630
PAVGB(%%mm4, %%mm1) // ~(5l1 + 2l3)/8
631
632
"movq %%mm0, %%mm4 \n\t" // ~(5l2 + 2l0)/8
633
"psubusb %%mm1, %%mm0 \n\t"
634
"psubusb %%mm4, %%mm1 \n\t"
635
"por %%mm0, %%mm1 \n\t" // ~|2l0 - 5l1 + 5l2 - 2l3|/8
660
636
// mm1= |lenergy|, mm2= l2, mm3= l3, mm7=0
661
637
662
"movq (%0, %1, 4), %%mm0 \n\t" // l4
663
"movq %%mm0, %%mm4 \n\t" // l4
664
PAVGB(%%mm7, %%mm0) // ~l4/2
665
PAVGB(%%mm2, %%mm0) // ~(l4 + 2l2)/4
666
PAVGB(%%mm4, %%mm0) // ~(5l4 + 2l2)/8
667
668
"movq (%%"REG_c"), %%mm2 \n\t" // l5
669
"movq %%mm3, %%mm5 \n\t" // l3
670
PAVGB(%%mm7, %%mm3) // ~l3/2
671
PAVGB(%%mm2, %%mm3) // ~(l3 + 2l5)/4
672
PAVGB(%%mm5, %%mm3) // ~(5l3 + 2l5)/8
673
674
"movq %%mm0, %%mm6 \n\t" // ~(5l4 + 2l2)/8
675
"psubusb %%mm3, %%mm0 \n\t"
676
"psubusb %%mm6, %%mm3 \n\t"
677
"por %%mm0, %%mm3 \n\t" // ~|2l2 - 5l3 + 5l4 - 2l5|/8
678
"pcmpeqb %%mm7, %%mm0 \n\t" // SIGN(2l2 - 5l3 + 5l4 - 2l5)
638
"movq (%0, %1, 4), %%mm0 \n\t" // l4
639
"movq %%mm0, %%mm4 \n\t" // l4
640
PAVGB(%%mm7, %%mm0) // ~l4/2
641
PAVGB(%%mm2, %%mm0) // ~(l4 + 2l2)/4
642
PAVGB(%%mm4, %%mm0) // ~(5l4 + 2l2)/8
643
644
"movq (%%"REG_c"), %%mm2 \n\t" // l5
645
"movq %%mm3, %%mm5 \n\t" // l3
646
PAVGB(%%mm7, %%mm3) // ~l3/2
647
PAVGB(%%mm2, %%mm3) // ~(l3 + 2l5)/4
648
PAVGB(%%mm5, %%mm3) // ~(5l3 + 2l5)/8
649
650
"movq %%mm0, %%mm6 \n\t" // ~(5l4 + 2l2)/8
651
"psubusb %%mm3, %%mm0 \n\t"
652
"psubusb %%mm6, %%mm3 \n\t"
653
"por %%mm0, %%mm3 \n\t" // ~|2l2 - 5l3 + 5l4 - 2l5|/8
654
"pcmpeqb %%mm7, %%mm0 \n\t" // SIGN(2l2 - 5l3 + 5l4 - 2l5)
679
655
// mm0= SIGN(menergy), mm1= |lenergy|, mm2= l5, mm3= |menergy|, mm4=l4, mm5= l3, mm7=0
680
656
681
"movq (%%"REG_c", %1), %%mm6 \n\t" // l6
682
"movq %%mm6, %%mm5 \n\t" // l6
683
PAVGB(%%mm7, %%mm6) // ~l6/2
684
PAVGB(%%mm4, %%mm6) // ~(l6 + 2l4)/4
685
PAVGB(%%mm5, %%mm6) // ~(5l6 + 2l4)/8
686
687
"movq (%%"REG_c", %1, 2), %%mm5 \n\t" // l7
688
"movq %%mm2, %%mm4 \n\t" // l5
689
PAVGB(%%mm7, %%mm2) // ~l5/2
690
PAVGB(%%mm5, %%mm2) // ~(l5 + 2l7)/4
691
PAVGB(%%mm4, %%mm2) // ~(5l5 + 2l7)/8
692
693
"movq %%mm6, %%mm4 \n\t" // ~(5l6 + 2l4)/8
694
"psubusb %%mm2, %%mm6 \n\t"
695
"psubusb %%mm4, %%mm2 \n\t"
696
"por %%mm6, %%mm2 \n\t" // ~|2l4 - 5l5 + 5l6 - 2l7|/8
657
"movq (%%"REG_c", %1), %%mm6 \n\t" // l6
658
"movq %%mm6, %%mm5 \n\t" // l6
659
PAVGB(%%mm7, %%mm6) // ~l6/2
660
PAVGB(%%mm4, %%mm6) // ~(l6 + 2l4)/4
661
PAVGB(%%mm5, %%mm6) // ~(5l6 + 2l4)/8
662
663
"movq (%%"REG_c", %1, 2), %%mm5 \n\t" // l7
664
"movq %%mm2, %%mm4 \n\t" // l5
665
PAVGB(%%mm7, %%mm2) // ~l5/2
666
PAVGB(%%mm5, %%mm2) // ~(l5 + 2l7)/4
667
PAVGB(%%mm4, %%mm2) // ~(5l5 + 2l7)/8
668
669
"movq %%mm6, %%mm4 \n\t" // ~(5l6 + 2l4)/8
670
"psubusb %%mm2, %%mm6 \n\t"
671
"psubusb %%mm4, %%mm2 \n\t"
672
"por %%mm6, %%mm2 \n\t" // ~|2l4 - 5l5 + 5l6 - 2l7|/8
697
673
// mm0= SIGN(menergy), mm1= |lenergy|/8, mm2= |renergy|/8, mm3= |menergy|/8, mm7=0
698
674
699
675
700
PMINUB(%%mm2, %%mm1, %%mm4) // MIN(|lenergy|,|renergy|)/8
701
"movq %2, %%mm4 \n\t" // QP //FIXME QP+1 ?
702
"paddusb "MANGLE(b01)", %%mm4 \n\t"
703
"pcmpgtb %%mm3, %%mm4 \n\t" // |menergy|/8 < QP
704
"psubusb %%mm1, %%mm3 \n\t" // d=|menergy|/8-MIN(|lenergy|,|renergy|)/8
705
"pand %%mm4, %%mm3 \n\t"
706
707
"movq %%mm3, %%mm1 \n\t"
708
// "psubusb "MANGLE(b01)", %%mm3 \n\t"
709
PAVGB(%%mm7, %%mm3)
710
PAVGB(%%mm7, %%mm3)
711
"paddusb %%mm1, %%mm3 \n\t"
712
// "paddusb "MANGLE(b01)", %%mm3 \n\t"
713
714
"movq (%%"REG_a", %1, 2), %%mm6 \n\t" //l3
715
"movq (%0, %1, 4), %%mm5 \n\t" //l4
716
"movq (%0, %1, 4), %%mm4 \n\t" //l4
717
"psubusb %%mm6, %%mm5 \n\t"
718
"psubusb %%mm4, %%mm6 \n\t"
719
"por %%mm6, %%mm5 \n\t" // |l3-l4|
720
"pcmpeqb %%mm7, %%mm6 \n\t" // SIGN(l3-l4)
721
"pxor %%mm6, %%mm0 \n\t"
722
"pand %%mm0, %%mm3 \n\t"
723
PMINUB(%%mm5, %%mm3, %%mm0)
724
725
"psubusb "MANGLE(b01)", %%mm3 \n\t"
726
PAVGB(%%mm7, %%mm3)
727
728
"movq (%%"REG_a", %1, 2), %%mm0 \n\t"
729
"movq (%0, %1, 4), %%mm2 \n\t"
730
"pxor %%mm6, %%mm0 \n\t"
731
"pxor %%mm6, %%mm2 \n\t"
732
"psubb %%mm3, %%mm0 \n\t"
733
"paddb %%mm3, %%mm2 \n\t"
734
"pxor %%mm6, %%mm0 \n\t"
735
"pxor %%mm6, %%mm2 \n\t"
736
"movq %%mm0, (%%"REG_a", %1, 2) \n\t"
737
"movq %%mm2, (%0, %1, 4) \n\t"
676
PMINUB(%%mm2, %%mm1, %%mm4) // MIN(|lenergy|,|renergy|)/8
677
"movq %2, %%mm4 \n\t" // QP //FIXME QP+1 ?
678
"paddusb "MANGLE(b01)", %%mm4 \n\t"
679
"pcmpgtb %%mm3, %%mm4 \n\t" // |menergy|/8 < QP
680
"psubusb %%mm1, %%mm3 \n\t" // d=|menergy|/8-MIN(|lenergy|,|renergy|)/8
681
"pand %%mm4, %%mm3 \n\t"
682
683
"movq %%mm3, %%mm1 \n\t"
684
// "psubusb "MANGLE(b01)", %%mm3 \n\t"
685
PAVGB(%%mm7, %%mm3)
686
PAVGB(%%mm7, %%mm3)
687
"paddusb %%mm1, %%mm3 \n\t"
688
// "paddusb "MANGLE(b01)", %%mm3 \n\t"
689
690
"movq (%%"REG_a", %1, 2), %%mm6 \n\t" //l3
691
"movq (%0, %1, 4), %%mm5 \n\t" //l4
692
"movq (%0, %1, 4), %%mm4 \n\t" //l4
693
"psubusb %%mm6, %%mm5 \n\t"
694
"psubusb %%mm4, %%mm6 \n\t"
695
"por %%mm6, %%mm5 \n\t" // |l3-l4|
696
"pcmpeqb %%mm7, %%mm6 \n\t" // SIGN(l3-l4)
697
"pxor %%mm6, %%mm0 \n\t"
698
"pand %%mm0, %%mm3 \n\t"
699
PMINUB(%%mm5, %%mm3, %%mm0)
700
701
"psubusb "MANGLE(b01)", %%mm3 \n\t"
702
PAVGB(%%mm7, %%mm3)
703
704
"movq (%%"REG_a", %1, 2), %%mm0 \n\t"
705
"movq (%0, %1, 4), %%mm2 \n\t"
706
"pxor %%mm6, %%mm0 \n\t"
707
"pxor %%mm6, %%mm2 \n\t"
708
"psubb %%mm3, %%mm0 \n\t"
709
"paddb %%mm3, %%mm2 \n\t"
710
"pxor %%mm6, %%mm0 \n\t"
711
"pxor %%mm6, %%mm2 \n\t"
712
"movq %%mm0, (%%"REG_a", %1, 2) \n\t"
713
"movq %%mm2, (%0, %1, 4) \n\t"
738
714
#endif //0
739
715
740
"lea (%0, %1), %%"REG_a" \n\t"
741
"pcmpeqb %%mm6, %%mm6 \n\t" // -1
716
"lea (%0, %1), %%"REG_a" \n\t"
717
"pcmpeqb %%mm6, %%mm6 \n\t" // -1
742
718
// 0 1 2 3 4 5 6 7
743
719
// %0 %0+%1 %0+2%1 eax+2%1 %0+4%1 eax+4%1 ecx+%1 ecx+2%1
744
720
// %0 eax eax+%1 eax+2%1 %0+4%1 ecx ecx+%1 ecx+2%1
745
721
746
722
747
"movq (%%"REG_a", %1, 2), %%mm1 \n\t" // l3
748
"movq (%0, %1, 4), %%mm0 \n\t" // l4
749
"pxor %%mm6, %%mm1 \n\t" // -l3-1
750
PAVGB(%%mm1, %%mm0) // -q+128 = (l4-l3+256)/2
723
"movq (%%"REG_a", %1, 2), %%mm1 \n\t" // l3
724
"movq (%0, %1, 4), %%mm0 \n\t" // l4
725
"pxor %%mm6, %%mm1 \n\t" // -l3-1
726
PAVGB(%%mm1, %%mm0) // -q+128 = (l4-l3+256)/2
751
727
// mm1=-l3-1, mm0=128-q
752
728
753
"movq (%%"REG_a", %1, 4), %%mm2 \n\t" // l5
754
"movq (%%"REG_a", %1), %%mm3 \n\t" // l2
755
"pxor %%mm6, %%mm2 \n\t" // -l5-1
756
"movq %%mm2, %%mm5 \n\t" // -l5-1
757
"movq "MANGLE(b80)", %%mm4 \n\t" // 128
758
"lea (%%"REG_a", %1, 4), %%"REG_c" \n\t"
759
PAVGB(%%mm3, %%mm2) // (l2-l5+256)/2
760
PAVGB(%%mm0, %%mm4) // ~(l4-l3)/4 + 128
761
PAVGB(%%mm2, %%mm4) // ~(l2-l5)/4 +(l4-l3)/8 + 128
762
PAVGB(%%mm0, %%mm4) // ~(l2-l5)/8 +5(l4-l3)/16 + 128
729
"movq (%%"REG_a", %1, 4), %%mm2 \n\t" // l5
730
"movq (%%"REG_a", %1), %%mm3 \n\t" // l2
731
"pxor %%mm6, %%mm2 \n\t" // -l5-1
732
"movq %%mm2, %%mm5 \n\t" // -l5-1
733
"movq "MANGLE(b80)", %%mm4 \n\t" // 128
734
"lea (%%"REG_a", %1, 4), %%"REG_c" \n\t"
735
PAVGB(%%mm3, %%mm2) // (l2-l5+256)/2
736
PAVGB(%%mm0, %%mm4) // ~(l4-l3)/4 + 128
737
PAVGB(%%mm2, %%mm4) // ~(l2-l5)/4 +(l4-l3)/8 + 128
738
PAVGB(%%mm0, %%mm4) // ~(l2-l5)/8 +5(l4-l3)/16 + 128
763
739
// mm1=-l3-1, mm0=128-q, mm3=l2, mm4=menergy/16 + 128, mm5= -l5-1
764
740
765
"movq (%%"REG_a"), %%mm2 \n\t" // l1
766
"pxor %%mm6, %%mm2 \n\t" // -l1-1
767
PAVGB(%%mm3, %%mm2) // (l2-l1+256)/2
768
PAVGB((%0), %%mm1) // (l0-l3+256)/2
769
"movq "MANGLE(b80)", %%mm3 \n\t" // 128
770
PAVGB(%%mm2, %%mm3) // ~(l2-l1)/4 + 128
771
PAVGB(%%mm1, %%mm3) // ~(l0-l3)/4 +(l2-l1)/8 + 128
772
PAVGB(%%mm2, %%mm3) // ~(l0-l3)/8 +5(l2-l1)/16 + 128
741
"movq (%%"REG_a"), %%mm2 \n\t" // l1
742
"pxor %%mm6, %%mm2 \n\t" // -l1-1
743
PAVGB(%%mm3, %%mm2) // (l2-l1+256)/2
744
PAVGB((%0), %%mm1) // (l0-l3+256)/2
745
"movq "MANGLE(b80)", %%mm3 \n\t" // 128
746
PAVGB(%%mm2, %%mm3) // ~(l2-l1)/4 + 128
747
PAVGB(%%mm1, %%mm3) // ~(l0-l3)/4 +(l2-l1)/8 + 128
748
PAVGB(%%mm2, %%mm3) // ~(l0-l3)/8 +5(l2-l1)/16 + 128
773
749
// mm0=128-q, mm3=lenergy/16 + 128, mm4= menergy/16 + 128, mm5= -l5-1
774
750
775
PAVGB((%%REGc, %1), %%mm5) // (l6-l5+256)/2
776
"movq (%%"REG_c", %1, 2), %%mm1 \n\t" // l7
777
"pxor %%mm6, %%mm1 \n\t" // -l7-1
778
PAVGB((%0, %1, 4), %%mm1) // (l4-l7+256)/2
779
"movq "MANGLE(b80)", %%mm2 \n\t" // 128
780
PAVGB(%%mm5, %%mm2) // ~(l6-l5)/4 + 128
781
PAVGB(%%mm1, %%mm2) // ~(l4-l7)/4 +(l6-l5)/8 + 128
782
PAVGB(%%mm5, %%mm2) // ~(l4-l7)/8 +5(l6-l5)/16 + 128
751
PAVGB((%%REGc, %1), %%mm5) // (l6-l5+256)/2
752
"movq (%%"REG_c", %1, 2), %%mm1 \n\t" // l7
753
"pxor %%mm6, %%mm1 \n\t" // -l7-1
754
PAVGB((%0, %1, 4), %%mm1) // (l4-l7+256)/2
755
"movq "MANGLE(b80)", %%mm2 \n\t" // 128
756
PAVGB(%%mm5, %%mm2) // ~(l6-l5)/4 + 128
757
PAVGB(%%mm1, %%mm2) // ~(l4-l7)/4 +(l6-l5)/8 + 128
758
PAVGB(%%mm5, %%mm2) // ~(l4-l7)/8 +5(l6-l5)/16 + 128
783
759
// mm0=128-q, mm2=renergy/16 + 128, mm3=lenergy/16 + 128, mm4= menergy/16 + 128
784
760
785
"movq "MANGLE(b00)", %%mm1 \n\t" // 0
786
"movq "MANGLE(b00)", %%mm5 \n\t" // 0
787
"psubb %%mm2, %%mm1 \n\t" // 128 - renergy/16
788
"psubb %%mm3, %%mm5 \n\t" // 128 - lenergy/16
789
PMAXUB(%%mm1, %%mm2) // 128 + |renergy/16|
790
PMAXUB(%%mm5, %%mm3) // 128 + |lenergy/16|
791
PMINUB(%%mm2, %%mm3, %%mm1) // 128 + MIN(|lenergy|,|renergy|)/16
761
"movq "MANGLE(b00)", %%mm1 \n\t" // 0
762
"movq "MANGLE(b00)", %%mm5 \n\t" // 0
763
"psubb %%mm2, %%mm1 \n\t" // 128 - renergy/16
764
"psubb %%mm3, %%mm5 \n\t" // 128 - lenergy/16
765
PMAXUB(%%mm1, %%mm2) // 128 + |renergy/16|
766
PMAXUB(%%mm5, %%mm3) // 128 + |lenergy/16|
767
PMINUB(%%mm2, %%mm3, %%mm1) // 128 + MIN(|lenergy|,|renergy|)/16
792
768
793
769
// mm0=128-q, mm3=128 + MIN(|lenergy|,|renergy|)/16, mm4= menergy/16 + 128
794
770
795
"movq "MANGLE(b00)", %%mm7 \n\t" // 0
796
"movq %2, %%mm2 \n\t" // QP
797
PAVGB(%%mm6, %%mm2) // 128 + QP/2
798
"psubb %%mm6, %%mm2 \n\t"
771
"movq "MANGLE(b00)", %%mm7 \n\t" // 0
772
"movq %2, %%mm2 \n\t" // QP
773
PAVGB(%%mm6, %%mm2) // 128 + QP/2
774
"psubb %%mm6, %%mm2 \n\t"
799
775
800
"movq %%mm4, %%mm1 \n\t"
801
"pcmpgtb %%mm7, %%mm1 \n\t" // SIGN(menergy)
802
"pxor %%mm1, %%mm4 \n\t"
803
"psubb %%mm1, %%mm4 \n\t" // 128 + |menergy|/16
804
"pcmpgtb %%mm4, %%mm2 \n\t" // |menergy|/16 < QP/2
805
"psubusb %%mm3, %%mm4 \n\t" //d=|menergy|/16 - MIN(|lenergy|,|renergy|)/16
776
"movq %%mm4, %%mm1 \n\t"
777
"pcmpgtb %%mm7, %%mm1 \n\t" // SIGN(menergy)
778
"pxor %%mm1, %%mm4 \n\t"
779
"psubb %%mm1, %%mm4 \n\t" // 128 + |menergy|/16
780
"pcmpgtb %%mm4, %%mm2 \n\t" // |menergy|/16 < QP/2
781
"psubusb %%mm3, %%mm4 \n\t" //d=|menergy|/16 - MIN(|lenergy|,|renergy|)/16
806
782
// mm0=128-q, mm1= SIGN(menergy), mm2= |menergy|/16 < QP/2, mm4= d/16
807
783
808
"movq %%mm4, %%mm3 \n\t" // d
809
"psubusb "MANGLE(b01)", %%mm4 \n\t"
810
PAVGB(%%mm7, %%mm4) // d/32
811
PAVGB(%%mm7, %%mm4) // (d + 32)/64
812
"paddb %%mm3, %%mm4 \n\t" // 5d/64
813
"pand %%mm2, %%mm4 \n\t"
814
815
"movq "MANGLE(b80)", %%mm5 \n\t" // 128
816
"psubb %%mm0, %%mm5 \n\t" // q
817
"paddsb %%mm6, %%mm5 \n\t" // fix bad rounding
818
"pcmpgtb %%mm5, %%mm7 \n\t" // SIGN(q)
819
"pxor %%mm7, %%mm5 \n\t"
820
821
PMINUB(%%mm5, %%mm4, %%mm3) // MIN(|q|, 5d/64)
822
"pxor %%mm1, %%mm7 \n\t" // SIGN(d*q)
823
824
"pand %%mm7, %%mm4 \n\t"
825
"movq (%%"REG_a", %1, 2), %%mm0 \n\t"
826
"movq (%0, %1, 4), %%mm2 \n\t"
827
"pxor %%mm1, %%mm0 \n\t"
828
"pxor %%mm1, %%mm2 \n\t"
829
"paddb %%mm4, %%mm0 \n\t"
830
"psubb %%mm4, %%mm2 \n\t"
831
"pxor %%mm1, %%mm0 \n\t"
832
"pxor %%mm1, %%mm2 \n\t"
833
"movq %%mm0, (%%"REG_a", %1, 2) \n\t"
834
"movq %%mm2, (%0, %1, 4) \n\t"
835
836
:
837
: "r" (src), "r" ((long)stride), "m" (c->pQPb)
838
: "%"REG_a, "%"REG_c
839
);
784
"movq %%mm4, %%mm3 \n\t" // d
785
"psubusb "MANGLE(b01)", %%mm4 \n\t"
786
PAVGB(%%mm7, %%mm4) // d/32
787
PAVGB(%%mm7, %%mm4) // (d + 32)/64
788
"paddb %%mm3, %%mm4 \n\t" // 5d/64
789
"pand %%mm2, %%mm4 \n\t"
790
791
"movq "MANGLE(b80)", %%mm5 \n\t" // 128
792
"psubb %%mm0, %%mm5 \n\t" // q
793
"paddsb %%mm6, %%mm5 \n\t" // fix bad rounding
794
"pcmpgtb %%mm5, %%mm7 \n\t" // SIGN(q)
795
"pxor %%mm7, %%mm5 \n\t"
796
797
PMINUB(%%mm5, %%mm4, %%mm3) // MIN(|q|, 5d/64)
798
"pxor %%mm1, %%mm7 \n\t" // SIGN(d*q)
799
800
"pand %%mm7, %%mm4 \n\t"
801
"movq (%%"REG_a", %1, 2), %%mm0 \n\t"
802
"movq (%0, %1, 4), %%mm2 \n\t"
803
"pxor %%mm1, %%mm0 \n\t"
804
"pxor %%mm1, %%mm2 \n\t"
805
"paddb %%mm4, %%mm0 \n\t"
806
"psubb %%mm4, %%mm2 \n\t"
807
"pxor %%mm1, %%mm0 \n\t"
808
"pxor %%mm1, %%mm2 \n\t"
809
"movq %%mm0, (%%"REG_a", %1, 2) \n\t"
810
"movq %%mm2, (%0, %1, 4) \n\t"
811
812
:
813
: "r" (src), "r" ((long)stride), "m" (c->pQPb)
814
: "%"REG_a, "%"REG_c
815
);
840
816
841
817
/*
842
{
843
int x;
844
src-= stride;
845
for(x=0; x<BLOCK_SIZE; x++)
846
{
847
const int middleEnergy= 5*(src[l5] - src[l4]) + 2*(src[l3] - src[l6]);
848
if(FFABS(middleEnergy)< 8*QP)
849
{
850
const int q=(src[l4] - src[l5])/2;
851
const int leftEnergy= 5*(src[l3] - src[l2]) + 2*(src[l1] - src[l4]);
852
const int rightEnergy= 5*(src[l7] - src[l6]) + 2*(src[l5] - src[l8]);
853
854
int d= FFABS(middleEnergy) - FFMIN( FFABS(leftEnergy), FFABS(rightEnergy) );
855
d= FFMAX(d, 0);
856
857
d= (5*d + 32) >> 6;
858
d*= FFSIGN(-middleEnergy);
859
860
if(q>0)
861
{
862
d= d<0 ? 0 : d;
863
d= d>q ? q : d;
864
}
865
else
866
{
867
d= d>0 ? 0 : d;
868
d= d<q ? q : d;
869
}
870
871
src[l4]-= d;
872
src[l5]+= d;
873
}
874
src++;
875
}
876
src-=8;
877
for(x=0; x<8; x++)
878
{
879
int y;
880
for(y=4; y<6; y++)
881
{
882
int d= src[x+y*stride] - tmp[x+(y-4)*8];
883
int ad= FFABS(d);
884
static int max=0;
885
static int sum=0;
886
static int num=0;
887
static int bias=0;
888
889
if(max<ad) max=ad;
890
sum+= ad>3 ? 1 : 0;
891
if(ad>3)
892
{
893
src[0] = src[7] = src[stride*7] = src[(stride+1)*7]=255;
894
}
895
if(y==4) bias+=d;
896
num++;
897
if(num%1000000 == 0)
898
{
899
av_log(c, AV_LOG_INFO, " %d %d %d %d\n", num, sum, max, bias);
900
}
901
}
902
}
818
{
819
int x;
820
src-= stride;
821
for(x=0; x<BLOCK_SIZE; x++){
822
const int middleEnergy= 5*(src[l5] - src[l4]) + 2*(src[l3] - src[l6]);
823
if(FFABS(middleEnergy)< 8*QP){
824
const int q=(src[l4] - src[l5])/2;
825
const int leftEnergy= 5*(src[l3] - src[l2]) + 2*(src[l1] - src[l4]);
826
const int rightEnergy= 5*(src[l7] - src[l6]) + 2*(src[l5] - src[l8]);
827
828
int d= FFABS(middleEnergy) - FFMIN( FFABS(leftEnergy), FFABS(rightEnergy) );
829
d= FFMAX(d, 0);
830
831
d= (5*d + 32) >> 6;
832
d*= FFSIGN(-middleEnergy);
833
834
if(q>0){
835
d= d<0 ? 0 : d;
836
d= d>q ? q : d;
837
}else{
838
d= d>0 ? 0 : d;
839
d= d<q ? q : d;
840
}
841
842
src[l4]-= d;
843
src[l5]+= d;
844
}
845
src++;
846
}
847
src-=8;
848
for(x=0; x<8; x++){
849
int y;
850
for(y=4; y<6; y++){
851
int d= src[x+y*stride] - tmp[x+(y-4)*8];
852
int ad= FFABS(d);
853
static int max=0;
854
static int sum=0;
855
static int num=0;
856
static int bias=0;
857
858
if(max<ad) max=ad;
859
sum+= ad>3 ? 1 : 0;
860
if(ad>3){
861
src[0] = src[7] = src[stride*7] = src[(stride+1)*7]=255;
862
}
863
if(y==4) bias+=d;
864
num++;
865
if(num%1000000 == 0){
866
av_log(c, AV_LOG_INFO, " %d %d %d %d\n", num, sum, max, bias);
867
}
868
}
869
}
903
870
}
904
871
*/
905
872
#elif defined (HAVE_MMX)
906
src+= stride*4;
907
asm volatile(
908
"pxor %%mm7, %%mm7 \n\t"
909
"lea -40(%%"REG_SP"), %%"REG_c" \n\t" // make space for 4 8-byte vars
910
"and "ALIGN_MASK", %%"REG_c" \n\t" // align
873
src+= stride*4;
874
asm volatile(
875
"pxor %%mm7, %%mm7 \n\t"
876
"lea -40(%%"REG_SP"), %%"REG_c" \n\t" // make space for 4 8-byte vars
877
"and "ALIGN_MASK", %%"REG_c" \n\t" // align
911
878
// 0 1 2 3 4 5 6 7
912
879
// %0 %0+%1 %0+2%1 eax+2%1 %0+4%1 eax+4%1 edx+%1 edx+2%1
913
880
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1
914
881
915
"movq (%0), %%mm0 \n\t"
916
"movq %%mm0, %%mm1 \n\t"
917
"punpcklbw %%mm7, %%mm0 \n\t" // low part of line 0
918
"punpckhbw %%mm7, %%mm1 \n\t" // high part of line 0
919
920
"movq (%0, %1), %%mm2 \n\t"
921
"lea (%0, %1, 2), %%"REG_a" \n\t"
922
"movq %%mm2, %%mm3 \n\t"
923
"punpcklbw %%mm7, %%mm2 \n\t" // low part of line 1
924
"punpckhbw %%mm7, %%mm3 \n\t" // high part of line 1
925
926
"movq (%%"REG_a"), %%mm4 \n\t"
927
"movq %%mm4, %%mm5 \n\t"
928
"punpcklbw %%mm7, %%mm4 \n\t" // low part of line 2
929
"punpckhbw %%mm7, %%mm5 \n\t" // high part of line 2
930
931
"paddw %%mm0, %%mm0 \n\t" // 2L0
932
"paddw %%mm1, %%mm1 \n\t" // 2H0
933
"psubw %%mm4, %%mm2 \n\t" // L1 - L2
934
"psubw %%mm5, %%mm3 \n\t" // H1 - H2
935
"psubw %%mm2, %%mm0 \n\t" // 2L0 - L1 + L2
936
"psubw %%mm3, %%mm1 \n\t" // 2H0 - H1 + H2
937
938
"psllw $2, %%mm2 \n\t" // 4L1 - 4L2
939
"psllw $2, %%mm3 \n\t" // 4H1 - 4H2
940
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2
941
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2
942
943
"movq (%%"REG_a", %1), %%mm2 \n\t"
944
"movq %%mm2, %%mm3 \n\t"
945
"punpcklbw %%mm7, %%mm2 \n\t" // L3
946
"punpckhbw %%mm7, %%mm3 \n\t" // H3
947
948
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2 - L3
949
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2 - H3
950
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2 - 2L3
951
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2 - 2H3
952
"movq %%mm0, (%%"REG_c") \n\t" // 2L0 - 5L1 + 5L2 - 2L3
953
"movq %%mm1, 8(%%"REG_c") \n\t" // 2H0 - 5H1 + 5H2 - 2H3
954
955
"movq (%%"REG_a", %1, 2), %%mm0 \n\t"
956
"movq %%mm0, %%mm1 \n\t"
957
"punpcklbw %%mm7, %%mm0 \n\t" // L4
958
"punpckhbw %%mm7, %%mm1 \n\t" // H4
959
960
"psubw %%mm0, %%mm2 \n\t" // L3 - L4
961
"psubw %%mm1, %%mm3 \n\t" // H3 - H4
962
"movq %%mm2, 16(%%"REG_c") \n\t" // L3 - L4
963
"movq %%mm3, 24(%%"REG_c") \n\t" // H3 - H4
964
"paddw %%mm4, %%mm4 \n\t" // 2L2
965
"paddw %%mm5, %%mm5 \n\t" // 2H2
966
"psubw %%mm2, %%mm4 \n\t" // 2L2 - L3 + L4
967
"psubw %%mm3, %%mm5 \n\t" // 2H2 - H3 + H4
968
969
"lea (%%"REG_a", %1), %0 \n\t"
970
"psllw $2, %%mm2 \n\t" // 4L3 - 4L4
971
"psllw $2, %%mm3 \n\t" // 4H3 - 4H4
972
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4
973
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4
882
"movq (%0), %%mm0 \n\t"
883
"movq %%mm0, %%mm1 \n\t"
884
"punpcklbw %%mm7, %%mm0 \n\t" // low part of line 0
885
"punpckhbw %%mm7, %%mm1 \n\t" // high part of line 0
886
887
"movq (%0, %1), %%mm2 \n\t"
888
"lea (%0, %1, 2), %%"REG_a" \n\t"
889
"movq %%mm2, %%mm3 \n\t"
890
"punpcklbw %%mm7, %%mm2 \n\t" // low part of line 1
891
"punpckhbw %%mm7, %%mm3 \n\t" // high part of line 1
892
893
"movq (%%"REG_a"), %%mm4 \n\t"
894
"movq %%mm4, %%mm5 \n\t"
895
"punpcklbw %%mm7, %%mm4 \n\t" // low part of line 2
896
"punpckhbw %%mm7, %%mm5 \n\t" // high part of line 2
897
898
"paddw %%mm0, %%mm0 \n\t" // 2L0
899
"paddw %%mm1, %%mm1 \n\t" // 2H0
900
"psubw %%mm4, %%mm2 \n\t" // L1 - L2
901
"psubw %%mm5, %%mm3 \n\t" // H1 - H2
902
"psubw %%mm2, %%mm0 \n\t" // 2L0 - L1 + L2
903
"psubw %%mm3, %%mm1 \n\t" // 2H0 - H1 + H2
904
905
"psllw $2, %%mm2 \n\t" // 4L1 - 4L2
906
"psllw $2, %%mm3 \n\t" // 4H1 - 4H2
907
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2
908
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2
909
910
"movq (%%"REG_a", %1), %%mm2 \n\t"
911
"movq %%mm2, %%mm3 \n\t"
912
"punpcklbw %%mm7, %%mm2 \n\t" // L3
913
"punpckhbw %%mm7, %%mm3 \n\t" // H3
914
915
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2 - L3
916
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2 - H3
917
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2 - 2L3
918
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2 - 2H3
919
"movq %%mm0, (%%"REG_c") \n\t" // 2L0 - 5L1 + 5L2 - 2L3
920
"movq %%mm1, 8(%%"REG_c") \n\t" // 2H0 - 5H1 + 5H2 - 2H3
921
922
"movq (%%"REG_a", %1, 2), %%mm0 \n\t"
923
"movq %%mm0, %%mm1 \n\t"
924
"punpcklbw %%mm7, %%mm0 \n\t" // L4
925
"punpckhbw %%mm7, %%mm1 \n\t" // H4
926
927
"psubw %%mm0, %%mm2 \n\t" // L3 - L4
928
"psubw %%mm1, %%mm3 \n\t" // H3 - H4
929
"movq %%mm2, 16(%%"REG_c") \n\t" // L3 - L4
930
"movq %%mm3, 24(%%"REG_c") \n\t" // H3 - H4
931
"paddw %%mm4, %%mm4 \n\t" // 2L2
932
"paddw %%mm5, %%mm5 \n\t" // 2H2
933
"psubw %%mm2, %%mm4 \n\t" // 2L2 - L3 + L4
934
"psubw %%mm3, %%mm5 \n\t" // 2H2 - H3 + H4
935
936
"lea (%%"REG_a", %1), %0 \n\t"
937
"psllw $2, %%mm2 \n\t" // 4L3 - 4L4
938
"psllw $2, %%mm3 \n\t" // 4H3 - 4H4
939
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4
940
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4
974
941
//50 opcodes so far
975
"movq (%0, %1, 2), %%mm2 \n\t"
976
"movq %%mm2, %%mm3 \n\t"
977
"punpcklbw %%mm7, %%mm2 \n\t" // L5
978
"punpckhbw %%mm7, %%mm3 \n\t" // H5
979
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4 - L5
980
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4 - H5
981
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4 - 2L5
982
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4 - 2H5
983
984
"movq (%%"REG_a", %1, 4), %%mm6 \n\t"
985
"punpcklbw %%mm7, %%mm6 \n\t" // L6
986
"psubw %%mm6, %%mm2 \n\t" // L5 - L6
987
"movq (%%"REG_a", %1, 4), %%mm6 \n\t"
988
"punpckhbw %%mm7, %%mm6 \n\t" // H6
989
"psubw %%mm6, %%mm3 \n\t" // H5 - H6
990
991
"paddw %%mm0, %%mm0 \n\t" // 2L4
992
"paddw %%mm1, %%mm1 \n\t" // 2H4
993
"psubw %%mm2, %%mm0 \n\t" // 2L4 - L5 + L6
994
"psubw %%mm3, %%mm1 \n\t" // 2H4 - H5 + H6
995
996
"psllw $2, %%mm2 \n\t" // 4L5 - 4L6
997
"psllw $2, %%mm3 \n\t" // 4H5 - 4H6
998
"psubw %%mm2, %%mm0 \n\t" // 2L4 - 5L5 + 5L6
999
"psubw %%mm3, %%mm1 \n\t" // 2H4 - 5H5 + 5H6
1000
1001
"movq (%0, %1, 4), %%mm2 \n\t"
1002
"movq %%mm2, %%mm3 \n\t"
1003
"punpcklbw %%mm7, %%mm2 \n\t" // L7
1004
"punpckhbw %%mm7, %%mm3 \n\t" // H7
1005
1006
"paddw %%mm2, %%mm2 \n\t" // 2L7
1007
"paddw %%mm3, %%mm3 \n\t" // 2H7
1008
"psubw %%mm2, %%mm0 \n\t" // 2L4 - 5L5 + 5L6 - 2L7
1009
"psubw %%mm3, %%mm1 \n\t" // 2H4 - 5H5 + 5H6 - 2H7
1010
1011
"movq (%%"REG_c"), %%mm2 \n\t" // 2L0 - 5L1 + 5L2 - 2L3
1012
"movq 8(%%"REG_c"), %%mm3 \n\t" // 2H0 - 5H1 + 5H2 - 2H3
1013
1014
#ifdef HAVE_MMX2
1015
"movq %%mm7, %%mm6 \n\t" // 0
1016
"psubw %%mm0, %%mm6 \n\t"
1017
"pmaxsw %%mm6, %%mm0 \n\t" // |2L4 - 5L5 + 5L6 - 2L7|
1018
"movq %%mm7, %%mm6 \n\t" // 0
1019
"psubw %%mm1, %%mm6 \n\t"
1020
"pmaxsw %%mm6, %%mm1 \n\t" // |2H4 - 5H5 + 5H6 - 2H7|
1021
"movq %%mm7, %%mm6 \n\t" // 0
1022
"psubw %%mm2, %%mm6 \n\t"
1023
"pmaxsw %%mm6, %%mm2 \n\t" // |2L0 - 5L1 + 5L2 - 2L3|
1024
"movq %%mm7, %%mm6 \n\t" // 0
1025
"psubw %%mm3, %%mm6 \n\t"
1026
"pmaxsw %%mm6, %%mm3 \n\t" // |2H0 - 5H1 + 5H2 - 2H3|
1027
#else
1028
"movq %%mm7, %%mm6 \n\t" // 0
1029
"pcmpgtw %%mm0, %%mm6 \n\t"
1030
"pxor %%mm6, %%mm0 \n\t"
1031
"psubw %%mm6, %%mm0 \n\t" // |2L4 - 5L5 + 5L6 - 2L7|
1032
"movq %%mm7, %%mm6 \n\t" // 0
1033
"pcmpgtw %%mm1, %%mm6 \n\t"
1034
"pxor %%mm6, %%mm1 \n\t"
1035
"psubw %%mm6, %%mm1 \n\t" // |2H4 - 5H5 + 5H6 - 2H7|
1036
"movq %%mm7, %%mm6 \n\t" // 0
1037
"pcmpgtw %%mm2, %%mm6 \n\t"
1038
"pxor %%mm6, %%mm2 \n\t"
1039
"psubw %%mm6, %%mm2 \n\t" // |2L0 - 5L1 + 5L2 - 2L3|
1040
"movq %%mm7, %%mm6 \n\t" // 0
1041
"pcmpgtw %%mm3, %%mm6 \n\t"
1042
"pxor %%mm6, %%mm3 \n\t"
1043
"psubw %%mm6, %%mm3 \n\t" // |2H0 - 5H1 + 5H2 - 2H3|
1044
#endif
1045
1046
#ifdef HAVE_MMX2
1047
"pminsw %%mm2, %%mm0 \n\t"
1048
"pminsw %%mm3, %%mm1 \n\t"
1049
#else
1050
"movq %%mm0, %%mm6 \n\t"
1051
"psubusw %%mm2, %%mm6 \n\t"
1052
"psubw %%mm6, %%mm0 \n\t"
1053
"movq %%mm1, %%mm6 \n\t"
1054
"psubusw %%mm3, %%mm6 \n\t"
1055
"psubw %%mm6, %%mm1 \n\t"
1056
#endif
1057
1058
"movd %2, %%mm2 \n\t" // QP
1059
"punpcklbw %%mm7, %%mm2 \n\t"
1060
1061
"movq %%mm7, %%mm6 \n\t" // 0
1062
"pcmpgtw %%mm4, %%mm6 \n\t" // sign(2L2 - 5L3 + 5L4 - 2L5)
1063
"pxor %%mm6, %%mm4 \n\t"
1064
"psubw %%mm6, %%mm4 \n\t" // |2L2 - 5L3 + 5L4 - 2L5|
1065
"pcmpgtw %%mm5, %%mm7 \n\t" // sign(2H2 - 5H3 + 5H4 - 2H5)
1066
"pxor %%mm7, %%mm5 \n\t"
1067
"psubw %%mm7, %%mm5 \n\t" // |2H2 - 5H3 + 5H4 - 2H5|
942
"movq (%0, %1, 2), %%mm2 \n\t"
943
"movq %%mm2, %%mm3 \n\t"
944
"punpcklbw %%mm7, %%mm2 \n\t" // L5
945
"punpckhbw %%mm7, %%mm3 \n\t" // H5
946
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4 - L5
947
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4 - H5
948
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4 - 2L5
949
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4 - 2H5
950
951
"movq (%%"REG_a", %1, 4), %%mm6 \n\t"
952
"punpcklbw %%mm7, %%mm6 \n\t" // L6
953
"psubw %%mm6, %%mm2 \n\t" // L5 - L6
954
"movq (%%"REG_a", %1, 4), %%mm6 \n\t"
955
"punpckhbw %%mm7, %%mm6 \n\t" // H6
956
"psubw %%mm6, %%mm3 \n\t" // H5 - H6
957
958
"paddw %%mm0, %%mm0 \n\t" // 2L4
959
"paddw %%mm1, %%mm1 \n\t" // 2H4
960
"psubw %%mm2, %%mm0 \n\t" // 2L4 - L5 + L6
961
"psubw %%mm3, %%mm1 \n\t" // 2H4 - H5 + H6
962
963
"psllw $2, %%mm2 \n\t" // 4L5 - 4L6
964
"psllw $2, %%mm3 \n\t" // 4H5 - 4H6
965
"psubw %%mm2, %%mm0 \n\t" // 2L4 - 5L5 + 5L6
966
"psubw %%mm3, %%mm1 \n\t" // 2H4 - 5H5 + 5H6
967
968
"movq (%0, %1, 4), %%mm2 \n\t"
969
"movq %%mm2, %%mm3 \n\t"
970
"punpcklbw %%mm7, %%mm2 \n\t" // L7
971
"punpckhbw %%mm7, %%mm3 \n\t" // H7
972
973
"paddw %%mm2, %%mm2 \n\t" // 2L7
974
"paddw %%mm3, %%mm3 \n\t" // 2H7
975
"psubw %%mm2, %%mm0 \n\t" // 2L4 - 5L5 + 5L6 - 2L7
976
"psubw %%mm3, %%mm1 \n\t" // 2H4 - 5H5 + 5H6 - 2H7
977
978
"movq (%%"REG_c"), %%mm2 \n\t" // 2L0 - 5L1 + 5L2 - 2L3
979
"movq 8(%%"REG_c"), %%mm3 \n\t" // 2H0 - 5H1 + 5H2 - 2H3
980
981
#ifdef HAVE_MMX2
982
"movq %%mm7, %%mm6 \n\t" // 0
983
"psubw %%mm0, %%mm6 \n\t"
984
"pmaxsw %%mm6, %%mm0 \n\t" // |2L4 - 5L5 + 5L6 - 2L7|
985
"movq %%mm7, %%mm6 \n\t" // 0
986
"psubw %%mm1, %%mm6 \n\t"
987
"pmaxsw %%mm6, %%mm1 \n\t" // |2H4 - 5H5 + 5H6 - 2H7|
988
"movq %%mm7, %%mm6 \n\t" // 0
989
"psubw %%mm2, %%mm6 \n\t"
990
"pmaxsw %%mm6, %%mm2 \n\t" // |2L0 - 5L1 + 5L2 - 2L3|
991
"movq %%mm7, %%mm6 \n\t" // 0
992
"psubw %%mm3, %%mm6 \n\t"
993
"pmaxsw %%mm6, %%mm3 \n\t" // |2H0 - 5H1 + 5H2 - 2H3|
994
#else
995
"movq %%mm7, %%mm6 \n\t" // 0
996
"pcmpgtw %%mm0, %%mm6 \n\t"
997
"pxor %%mm6, %%mm0 \n\t"
998
"psubw %%mm6, %%mm0 \n\t" // |2L4 - 5L5 + 5L6 - 2L7|
999
"movq %%mm7, %%mm6 \n\t" // 0
1000
"pcmpgtw %%mm1, %%mm6 \n\t"
1001
"pxor %%mm6, %%mm1 \n\t"
1002
"psubw %%mm6, %%mm1 \n\t" // |2H4 - 5H5 + 5H6 - 2H7|
1003
"movq %%mm7, %%mm6 \n\t" // 0
1004
"pcmpgtw %%mm2, %%mm6 \n\t"
1005
"pxor %%mm6, %%mm2 \n\t"
1006
"psubw %%mm6, %%mm2 \n\t" // |2L0 - 5L1 + 5L2 - 2L3|
1007
"movq %%mm7, %%mm6 \n\t" // 0
1008
"pcmpgtw %%mm3, %%mm6 \n\t"
1009
"pxor %%mm6, %%mm3 \n\t"
1010
"psubw %%mm6, %%mm3 \n\t" // |2H0 - 5H1 + 5H2 - 2H3|
1011
#endif
1012
1013
#ifdef HAVE_MMX2
1014
"pminsw %%mm2, %%mm0 \n\t"
1015
"pminsw %%mm3, %%mm1 \n\t"
1016
#else
1017
"movq %%mm0, %%mm6 \n\t"
1018
"psubusw %%mm2, %%mm6 \n\t"
1019
"psubw %%mm6, %%mm0 \n\t"
1020
"movq %%mm1, %%mm6 \n\t"
1021
"psubusw %%mm3, %%mm6 \n\t"
1022
"psubw %%mm6, %%mm1 \n\t"
1023
#endif
1024
1025
"movd %2, %%mm2 \n\t" // QP
1026
"punpcklbw %%mm7, %%mm2 \n\t"
1027
1028
"movq %%mm7, %%mm6 \n\t" // 0
1029
"pcmpgtw %%mm4, %%mm6 \n\t" // sign(2L2 - 5L3 + 5L4 - 2L5)
1030
"pxor %%mm6, %%mm4 \n\t"
1031
"psubw %%mm6, %%mm4 \n\t" // |2L2 - 5L3 + 5L4 - 2L5|
1032
"pcmpgtw %%mm5, %%mm7 \n\t" // sign(2H2 - 5H3 + 5H4 - 2H5)
1033
"pxor %%mm7, %%mm5 \n\t"
1034
"psubw %%mm7, %%mm5 \n\t" // |2H2 - 5H3 + 5H4 - 2H5|
1068
1035
// 100 opcodes
1069
"psllw $3, %%mm2 \n\t" // 8QP
1070
"movq %%mm2, %%mm3 \n\t" // 8QP
1071
"pcmpgtw %%mm4, %%mm2 \n\t"
1072
"pcmpgtw %%mm5, %%mm3 \n\t"
1073
"pand %%mm2, %%mm4 \n\t"
1074
"pand %%mm3, %%mm5 \n\t"
1075
1076
1077
"psubusw %%mm0, %%mm4 \n\t" // hd
1078
"psubusw %%mm1, %%mm5 \n\t" // ld
1079
1080
1081
"movq "MANGLE(w05)", %%mm2 \n\t" // 5
1082
"pmullw %%mm2, %%mm4 \n\t"
1083
"pmullw %%mm2, %%mm5 \n\t"
1084
"movq "MANGLE(w20)", %%mm2 \n\t" // 32
1085
"paddw %%mm2, %%mm4 \n\t"
1086
"paddw %%mm2, %%mm5 \n\t"
1087
"psrlw $6, %%mm4 \n\t"
1088
"psrlw $6, %%mm5 \n\t"
1089
1090
"movq 16(%%"REG_c"), %%mm0 \n\t" // L3 - L4
1091
"movq 24(%%"REG_c"), %%mm1 \n\t" // H3 - H4
1092
1093
"pxor %%mm2, %%mm2 \n\t"
1094
"pxor %%mm3, %%mm3 \n\t"
1095
1096
"pcmpgtw %%mm0, %%mm2 \n\t" // sign (L3-L4)
1097
"pcmpgtw %%mm1, %%mm3 \n\t" // sign (H3-H4)
1098
"pxor %%mm2, %%mm0 \n\t"
1099
"pxor %%mm3, %%mm1 \n\t"
1100
"psubw %%mm2, %%mm0 \n\t" // |L3-L4|
1101
"psubw %%mm3, %%mm1 \n\t" // |H3-H4|
1102
"psrlw $1, %%mm0 \n\t" // |L3 - L4|/2
1103
"psrlw $1, %%mm1 \n\t" // |H3 - H4|/2
1104
1105
"pxor %%mm6, %%mm2 \n\t"
1106
"pxor %%mm7, %%mm3 \n\t"
1107
"pand %%mm2, %%mm4 \n\t"
1108
"pand %%mm3, %%mm5 \n\t"
1036
"psllw $3, %%mm2 \n\t" // 8QP
1037
"movq %%mm2, %%mm3 \n\t" // 8QP
1038
"pcmpgtw %%mm4, %%mm2 \n\t"
1039
"pcmpgtw %%mm5, %%mm3 \n\t"
1040
"pand %%mm2, %%mm4 \n\t"
1041
"pand %%mm3, %%mm5 \n\t"
1042
1043
1044
"psubusw %%mm0, %%mm4 \n\t" // hd
1045
"psubusw %%mm1, %%mm5 \n\t" // ld
1046
1047
1048
"movq "MANGLE(w05)", %%mm2 \n\t" // 5
1049
"pmullw %%mm2, %%mm4 \n\t"
1050
"pmullw %%mm2, %%mm5 \n\t"
1051
"movq "MANGLE(w20)", %%mm2 \n\t" // 32
1052
"paddw %%mm2, %%mm4 \n\t"
1053
"paddw %%mm2, %%mm5 \n\t"
1054
"psrlw $6, %%mm4 \n\t"
1055
"psrlw $6, %%mm5 \n\t"
1056
1057
"movq 16(%%"REG_c"), %%mm0 \n\t" // L3 - L4
1058
"movq 24(%%"REG_c"), %%mm1 \n\t" // H3 - H4
1059
1060
"pxor %%mm2, %%mm2 \n\t"
1061
"pxor %%mm3, %%mm3 \n\t"
1062
1063
"pcmpgtw %%mm0, %%mm2 \n\t" // sign (L3-L4)
1064
"pcmpgtw %%mm1, %%mm3 \n\t" // sign (H3-H4)
1065
"pxor %%mm2, %%mm0 \n\t"
1066
"pxor %%mm3, %%mm1 \n\t"
1067
"psubw %%mm2, %%mm0 \n\t" // |L3-L4|
1068
"psubw %%mm3, %%mm1 \n\t" // |H3-H4|
1069
"psrlw $1, %%mm0 \n\t" // |L3 - L4|/2
1070
"psrlw $1, %%mm1 \n\t" // |H3 - H4|/2
1071
1072
"pxor %%mm6, %%mm2 \n\t"
1073
"pxor %%mm7, %%mm3 \n\t"
1074
"pand %%mm2, %%mm4 \n\t"
1075
"pand %%mm3, %%mm5 \n\t"
1109
1076
1110
1077
#ifdef HAVE_MMX2
1111
"pminsw %%mm0, %%mm4 \n\t"
1112
"pminsw %%mm1, %%mm5 \n\t"
1078
"pminsw %%mm0, %%mm4 \n\t"
1079
"pminsw %%mm1, %%mm5 \n\t"
1113
1080
#else
1114
"movq %%mm4, %%mm2 \n\t"
1115
"psubusw %%mm0, %%mm2 \n\t"
1116
"psubw %%mm2, %%mm4 \n\t"
1117
"movq %%mm5, %%mm2 \n\t"
1118
"psubusw %%mm1, %%mm2 \n\t"
1119
"psubw %%mm2, %%mm5 \n\t"
1081
"movq %%mm4, %%mm2 \n\t"
1082
"psubusw %%mm0, %%mm2 \n\t"
1083
"psubw %%mm2, %%mm4 \n\t"
1084
"movq %%mm5, %%mm2 \n\t"
1085
"psubusw %%mm1, %%mm2 \n\t"
1086
"psubw %%mm2, %%mm5 \n\t"
1120
1087
#endif
1121
"pxor %%mm6, %%mm4 \n\t"
1122
"pxor %%mm7, %%mm5 \n\t"
1123
"psubw %%mm6, %%mm4 \n\t"
1124
"psubw %%mm7, %%mm5 \n\t"
1125
"packsswb %%mm5, %%mm4 \n\t"
1126
"movq (%0), %%mm0 \n\t"
1127
"paddb %%mm4, %%mm0 \n\t"
1128
"movq %%mm0, (%0) \n\t"
1129
"movq (%0, %1), %%mm0 \n\t"
1130
"psubb %%mm4, %%mm0 \n\t"
1131
"movq %%mm0, (%0, %1) \n\t"
1088
"pxor %%mm6, %%mm4 \n\t"
1089
"pxor %%mm7, %%mm5 \n\t"
1090
"psubw %%mm6, %%mm4 \n\t"
1091
"psubw %%mm7, %%mm5 \n\t"
1092
"packsswb %%mm5, %%mm4 \n\t"
1093
"movq (%0), %%mm0 \n\t"
1094
"paddb %%mm4, %%mm0 \n\t"
1095
"movq %%mm0, (%0) \n\t"
1096
"movq (%0, %1), %%mm0 \n\t"
1097
"psubb %%mm4, %%mm0 \n\t"
1098
"movq %%mm0, (%0, %1) \n\t"
1132
1099
1133
: "+r" (src)
1134
: "r" ((long)stride), "m" (c->pQPb)
1135
: "%"REG_a, "%"REG_c
1136
);
1100
: "+r" (src)
1101
: "r" ((long)stride), "m" (c->pQPb)
1102
: "%"REG_a, "%"REG_c
1103
);
1137
1104
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1138
const int l1= stride;
1139
const int l2= stride + l1;
1140
const int l3= stride + l2;
1141
const int l4= stride + l3;
1142
const int l5= stride + l4;
1143
const int l6= stride + l5;
1144
const int l7= stride + l6;
1145
const int l8= stride + l7;
1146
// const int l9= stride + l8;
1147
int x;
1148
src+= stride*3;
1149
for(x=0; x<BLOCK_SIZE; x++)
1150
{
1151
const int middleEnergy= 5*(src[l5] - src[l4]) + 2*(src[l3] - src[l6]);
1152
if(FFABS(middleEnergy) < 8*c->QP)
1153
{
1154
const int q=(src[l4] - src[l5])/2;
1155
const int leftEnergy= 5*(src[l3] - src[l2]) + 2*(src[l1] - src[l4]);
1156
const int rightEnergy= 5*(src[l7] - src[l6]) + 2*(src[l5] - src[l8]);
1157
1158
int d= FFABS(middleEnergy) - FFMIN( FFABS(leftEnergy), FFABS(rightEnergy) );
1159
d= FFMAX(d, 0);
1160
1161
d= (5*d + 32) >> 6;
1162
d*= FFSIGN(-middleEnergy);
1163
1164
if(q>0)
1165
{
1166
d= d<0 ? 0 : d;
1167
d= d>q ? q : d;
1168
}
1169
else
1170
{
1171
d= d>0 ? 0 : d;
1172
d= d<q ? q : d;
1173
}
1174
1175
src[l4]-= d;
1176
src[l5]+= d;
1177
}
1178
src++;
1105
const int l1= stride;
1106
const int l2= stride + l1;
1107
const int l3= stride + l2;
1108
const int l4= stride + l3;
1109
const int l5= stride + l4;
1110
const int l6= stride + l5;
1111
const int l7= stride + l6;
1112
const int l8= stride + l7;
1113
// const int l9= stride + l8;
1114
int x;
1115
src+= stride*3;
1116
for(x=0; x<BLOCK_SIZE; x++){
1117
const int middleEnergy= 5*(src[l5] - src[l4]) + 2*(src[l3] - src[l6]);
1118
if(FFABS(middleEnergy) < 8*c->QP){
1119
const int q=(src[l4] - src[l5])/2;
1120
const int leftEnergy= 5*(src[l3] - src[l2]) + 2*(src[l1] - src[l4]);
1121
const int rightEnergy= 5*(src[l7] - src[l6]) + 2*(src[l5] - src[l8]);
1122
1123
int d= FFABS(middleEnergy) - FFMIN( FFABS(leftEnergy), FFABS(rightEnergy) );
1124
d= FFMAX(d, 0);
1125
1126
d= (5*d + 32) >> 6;
1127
d*= FFSIGN(-middleEnergy);
1128
1129
if(q>0){
1130
d= d<0 ? 0 : d;
1131
d= d>q ? q : d;
1132
}else{
1133
d= d>0 ? 0 : d;
1134
d= d<q ? q : d;
1135
}
1136
1137
src[l4]-= d;
1138
src[l5]+= d;
1179
1139
}
1140
src++;
1141
}
1180
1142
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1181
1143
}
1182
1144
#endif //HAVE_ALTIVEC
1185
1147
static inline void RENAME(dering)(uint8_t src[], int stride, PPContext *c)
1186
1148
{
1187
1149
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1188
asm volatile(
1189
"pxor %%mm6, %%mm6 \n\t"
1190
"pcmpeqb %%mm7, %%mm7 \n\t"
1191
"movq %2, %%mm0 \n\t"
1192
"punpcklbw %%mm6, %%mm0 \n\t"
1193
"psrlw $1, %%mm0 \n\t"
1194
"psubw %%mm7, %%mm0 \n\t"
1195
"packuswb %%mm0, %%mm0 \n\t"
1196
"movq %%mm0, %3 \n\t"
1150
asm volatile(
1151
"pxor %%mm6, %%mm6 \n\t"
1152
"pcmpeqb %%mm7, %%mm7 \n\t"
1153
"movq %2, %%mm0 \n\t"
1154
"punpcklbw %%mm6, %%mm0 \n\t"
1155
"psrlw $1, %%mm0 \n\t"
1156
"psubw %%mm7, %%mm0 \n\t"
1157
"packuswb %%mm0, %%mm0 \n\t"
1158
"movq %%mm0, %3 \n\t"
1197
1159
1198
"lea (%0, %1), %%"REG_a" \n\t"
1199
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1160
"lea (%0, %1), %%"REG_a" \n\t"
1161
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1200
1162
1201
1163
// 0 1 2 3 4 5 6 7 8 9
1202
1164
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1
1204
1166
#undef FIND_MIN_MAX
1205
1167
#ifdef HAVE_MMX2
1206
1168
#define REAL_FIND_MIN_MAX(addr)\
1207
"movq " #addr ", %%mm0 \n\t"\
1208
"pminub %%mm0, %%mm7 \n\t"\
1209
"pmaxub %%mm0, %%mm6 \n\t"
1169
"movq " #addr ", %%mm0 \n\t"\
1170
"pminub %%mm0, %%mm7 \n\t"\
1171
"pmaxub %%mm0, %%mm6 \n\t"
1210
1172
#else
1211
1173
#define REAL_FIND_MIN_MAX(addr)\
1212
"movq " #addr ", %%mm0 \n\t"\
1213
"movq %%mm7, %%mm1 \n\t"\
1214
"psubusb %%mm0, %%mm6 \n\t"\
1215
"paddb %%mm0, %%mm6 \n\t"\
1216
"psubusb %%mm0, %%mm1 \n\t"\
1217
"psubb %%mm1, %%mm7 \n\t"
1174
"movq " #addr ", %%mm0 \n\t"\
1175
"movq %%mm7, %%mm1 \n\t"\
1176
"psubusb %%mm0, %%mm6 \n\t"\
1177
"paddb %%mm0, %%mm6 \n\t"\
1178
"psubusb %%mm0, %%mm1 \n\t"\
1179
"psubb %%mm1, %%mm7 \n\t"
1218
1180
#endif
1219
1181
#define FIND_MIN_MAX(addr) REAL_FIND_MIN_MAX(addr)
1220
1182
1227
1189
FIND_MIN_MAX((%%REGd, %1, 2))
1228
1190
FIND_MIN_MAX((%0, %1, 8))
1229
1191
1230
"movq %%mm7, %%mm4 \n\t"
1231
"psrlq $8, %%mm7 \n\t"
1232
#ifdef HAVE_MMX2
1233
"pminub %%mm4, %%mm7 \n\t" // min of pixels
1234
"pshufw $0xF9, %%mm7, %%mm4 \n\t"
1235
"pminub %%mm4, %%mm7 \n\t" // min of pixels
1236
"pshufw $0xFE, %%mm7, %%mm4 \n\t"
1237
"pminub %%mm4, %%mm7 \n\t"
1238
#else
1239
"movq %%mm7, %%mm1 \n\t"
1240
"psubusb %%mm4, %%mm1 \n\t"
1241
"psubb %%mm1, %%mm7 \n\t"
1242
"movq %%mm7, %%mm4 \n\t"
1243
"psrlq $16, %%mm7 \n\t"
1244
"movq %%mm7, %%mm1 \n\t"
1245
"psubusb %%mm4, %%mm1 \n\t"
1246
"psubb %%mm1, %%mm7 \n\t"
1247
"movq %%mm7, %%mm4 \n\t"
1248
"psrlq $32, %%mm7 \n\t"
1249
"movq %%mm7, %%mm1 \n\t"
1250
"psubusb %%mm4, %%mm1 \n\t"
1251
"psubb %%mm1, %%mm7 \n\t"
1252
#endif
1253
1254
1255
"movq %%mm6, %%mm4 \n\t"
1256
"psrlq $8, %%mm6 \n\t"
1257
#ifdef HAVE_MMX2
1258
"pmaxub %%mm4, %%mm6 \n\t" // max of pixels
1259
"pshufw $0xF9, %%mm6, %%mm4 \n\t"
1260
"pmaxub %%mm4, %%mm6 \n\t"
1261
"pshufw $0xFE, %%mm6, %%mm4 \n\t"
1262
"pmaxub %%mm4, %%mm6 \n\t"
1263
#else
1264
"psubusb %%mm4, %%mm6 \n\t"
1265
"paddb %%mm4, %%mm6 \n\t"
1266
"movq %%mm6, %%mm4 \n\t"
1267
"psrlq $16, %%mm6 \n\t"
1268
"psubusb %%mm4, %%mm6 \n\t"
1269
"paddb %%mm4, %%mm6 \n\t"
1270
"movq %%mm6, %%mm4 \n\t"
1271
"psrlq $32, %%mm6 \n\t"
1272
"psubusb %%mm4, %%mm6 \n\t"
1273
"paddb %%mm4, %%mm6 \n\t"
1274
#endif
1275
"movq %%mm6, %%mm0 \n\t" // max
1276
"psubb %%mm7, %%mm6 \n\t" // max - min
1277
"movd %%mm6, %%ecx \n\t"
1278
"cmpb "MANGLE(deringThreshold)", %%cl \n\t"
1279
" jb 1f \n\t"
1280
"lea -24(%%"REG_SP"), %%"REG_c" \n\t"
1281
"and "ALIGN_MASK", %%"REG_c" \n\t"
1282
PAVGB(%%mm0, %%mm7) // a=(max + min)/2
1283
"punpcklbw %%mm7, %%mm7 \n\t"
1284
"punpcklbw %%mm7, %%mm7 \n\t"
1285
"punpcklbw %%mm7, %%mm7 \n\t"
1286
"movq %%mm7, (%%"REG_c") \n\t"
1287
1288
"movq (%0), %%mm0 \n\t" // L10
1289
"movq %%mm0, %%mm1 \n\t" // L10
1290
"movq %%mm0, %%mm2 \n\t" // L10
1291
"psllq $8, %%mm1 \n\t"
1292
"psrlq $8, %%mm2 \n\t"
1293
"movd -4(%0), %%mm3 \n\t"
1294
"movd 8(%0), %%mm4 \n\t"
1295
"psrlq $24, %%mm3 \n\t"
1296
"psllq $56, %%mm4 \n\t"
1297
"por %%mm3, %%mm1 \n\t" // L00
1298
"por %%mm4, %%mm2 \n\t" // L20
1299
"movq %%mm1, %%mm3 \n\t" // L00
1300
PAVGB(%%mm2, %%mm1) // (L20 + L00)/2
1301
PAVGB(%%mm0, %%mm1) // (L20 + L00 + 2L10)/4
1302
"psubusb %%mm7, %%mm0 \n\t"
1303
"psubusb %%mm7, %%mm2 \n\t"
1304
"psubusb %%mm7, %%mm3 \n\t"
1305
"pcmpeqb "MANGLE(b00)", %%mm0 \n\t" // L10 > a ? 0 : -1
1306
"pcmpeqb "MANGLE(b00)", %%mm2 \n\t" // L20 > a ? 0 : -1
1307
"pcmpeqb "MANGLE(b00)", %%mm3 \n\t" // L00 > a ? 0 : -1
1308
"paddb %%mm2, %%mm0 \n\t"
1309
"paddb %%mm3, %%mm0 \n\t"
1310
1311
"movq (%%"REG_a"), %%mm2 \n\t" // L11
1312
"movq %%mm2, %%mm3 \n\t" // L11
1313
"movq %%mm2, %%mm4 \n\t" // L11
1314
"psllq $8, %%mm3 \n\t"
1315
"psrlq $8, %%mm4 \n\t"
1316
"movd -4(%%"REG_a"), %%mm5 \n\t"
1317
"movd 8(%%"REG_a"), %%mm6 \n\t"
1318
"psrlq $24, %%mm5 \n\t"
1319
"psllq $56, %%mm6 \n\t"
1320
"por %%mm5, %%mm3 \n\t" // L01
1321
"por %%mm6, %%mm4 \n\t" // L21
1322
"movq %%mm3, %%mm5 \n\t" // L01
1323
PAVGB(%%mm4, %%mm3) // (L21 + L01)/2
1324
PAVGB(%%mm2, %%mm3) // (L21 + L01 + 2L11)/4
1325
"psubusb %%mm7, %%mm2 \n\t"
1326
"psubusb %%mm7, %%mm4 \n\t"
1327
"psubusb %%mm7, %%mm5 \n\t"
1328
"pcmpeqb "MANGLE(b00)", %%mm2 \n\t" // L11 > a ? 0 : -1
1329
"pcmpeqb "MANGLE(b00)", %%mm4 \n\t" // L21 > a ? 0 : -1
1330
"pcmpeqb "MANGLE(b00)", %%mm5 \n\t" // L01 > a ? 0 : -1
1331
"paddb %%mm4, %%mm2 \n\t"
1332
"paddb %%mm5, %%mm2 \n\t"
1192
"movq %%mm7, %%mm4 \n\t"
1193
"psrlq $8, %%mm7 \n\t"
1194
#ifdef HAVE_MMX2
1195
"pminub %%mm4, %%mm7 \n\t" // min of pixels
1196
"pshufw $0xF9, %%mm7, %%mm4 \n\t"
1197
"pminub %%mm4, %%mm7 \n\t" // min of pixels
1198
"pshufw $0xFE, %%mm7, %%mm4 \n\t"
1199
"pminub %%mm4, %%mm7 \n\t"
1200
#else
1201
"movq %%mm7, %%mm1 \n\t"
1202
"psubusb %%mm4, %%mm1 \n\t"
1203
"psubb %%mm1, %%mm7 \n\t"
1204
"movq %%mm7, %%mm4 \n\t"
1205
"psrlq $16, %%mm7 \n\t"
1206
"movq %%mm7, %%mm1 \n\t"
1207
"psubusb %%mm4, %%mm1 \n\t"
1208
"psubb %%mm1, %%mm7 \n\t"
1209
"movq %%mm7, %%mm4 \n\t"
1210
"psrlq $32, %%mm7 \n\t"
1211
"movq %%mm7, %%mm1 \n\t"
1212
"psubusb %%mm4, %%mm1 \n\t"
1213
"psubb %%mm1, %%mm7 \n\t"
1214
#endif
1215
1216
1217
"movq %%mm6, %%mm4 \n\t"
1218
"psrlq $8, %%mm6 \n\t"
1219
#ifdef HAVE_MMX2
1220
"pmaxub %%mm4, %%mm6 \n\t" // max of pixels
1221
"pshufw $0xF9, %%mm6, %%mm4 \n\t"
1222
"pmaxub %%mm4, %%mm6 \n\t"
1223
"pshufw $0xFE, %%mm6, %%mm4 \n\t"
1224
"pmaxub %%mm4, %%mm6 \n\t"
1225
#else
1226
"psubusb %%mm4, %%mm6 \n\t"
1227
"paddb %%mm4, %%mm6 \n\t"
1228
"movq %%mm6, %%mm4 \n\t"
1229
"psrlq $16, %%mm6 \n\t"
1230
"psubusb %%mm4, %%mm6 \n\t"
1231
"paddb %%mm4, %%mm6 \n\t"
1232
"movq %%mm6, %%mm4 \n\t"
1233
"psrlq $32, %%mm6 \n\t"
1234
"psubusb %%mm4, %%mm6 \n\t"
1235
"paddb %%mm4, %%mm6 \n\t"
1236
#endif
1237
"movq %%mm6, %%mm0 \n\t" // max
1238
"psubb %%mm7, %%mm6 \n\t" // max - min
1239
"movd %%mm6, %%ecx \n\t"
1240
"cmpb "MANGLE(deringThreshold)", %%cl \n\t"
1241
" jb 1f \n\t"
1242
"lea -24(%%"REG_SP"), %%"REG_c" \n\t"
1243
"and "ALIGN_MASK", %%"REG_c" \n\t"
1244
PAVGB(%%mm0, %%mm7) // a=(max + min)/2
1245
"punpcklbw %%mm7, %%mm7 \n\t"
1246
"punpcklbw %%mm7, %%mm7 \n\t"
1247
"punpcklbw %%mm7, %%mm7 \n\t"
1248
"movq %%mm7, (%%"REG_c") \n\t"
1249
1250
"movq (%0), %%mm0 \n\t" // L10
1251
"movq %%mm0, %%mm1 \n\t" // L10
1252
"movq %%mm0, %%mm2 \n\t" // L10
1253
"psllq $8, %%mm1 \n\t"
1254
"psrlq $8, %%mm2 \n\t"
1255
"movd -4(%0), %%mm3 \n\t"
1256
"movd 8(%0), %%mm4 \n\t"
1257
"psrlq $24, %%mm3 \n\t"
1258
"psllq $56, %%mm4 \n\t"
1259
"por %%mm3, %%mm1 \n\t" // L00
1260
"por %%mm4, %%mm2 \n\t" // L20
1261
"movq %%mm1, %%mm3 \n\t" // L00
1262
PAVGB(%%mm2, %%mm1) // (L20 + L00)/2
1263
PAVGB(%%mm0, %%mm1) // (L20 + L00 + 2L10)/4
1264
"psubusb %%mm7, %%mm0 \n\t"
1265
"psubusb %%mm7, %%mm2 \n\t"
1266
"psubusb %%mm7, %%mm3 \n\t"
1267
"pcmpeqb "MANGLE(b00)", %%mm0 \n\t" // L10 > a ? 0 : -1
1268
"pcmpeqb "MANGLE(b00)", %%mm2 \n\t" // L20 > a ? 0 : -1
1269
"pcmpeqb "MANGLE(b00)", %%mm3 \n\t" // L00 > a ? 0 : -1
1270
"paddb %%mm2, %%mm0 \n\t"
1271
"paddb %%mm3, %%mm0 \n\t"
1272
1273
"movq (%%"REG_a"), %%mm2 \n\t" // L11
1274
"movq %%mm2, %%mm3 \n\t" // L11
1275
"movq %%mm2, %%mm4 \n\t" // L11
1276
"psllq $8, %%mm3 \n\t"
1277
"psrlq $8, %%mm4 \n\t"
1278
"movd -4(%%"REG_a"), %%mm5 \n\t"
1279
"movd 8(%%"REG_a"), %%mm6 \n\t"
1280
"psrlq $24, %%mm5 \n\t"
1281
"psllq $56, %%mm6 \n\t"
1282
"por %%mm5, %%mm3 \n\t" // L01
1283
"por %%mm6, %%mm4 \n\t" // L21
1284
"movq %%mm3, %%mm5 \n\t" // L01
1285
PAVGB(%%mm4, %%mm3) // (L21 + L01)/2
1286
PAVGB(%%mm2, %%mm3) // (L21 + L01 + 2L11)/4
1287
"psubusb %%mm7, %%mm2 \n\t"
1288
"psubusb %%mm7, %%mm4 \n\t"
1289
"psubusb %%mm7, %%mm5 \n\t"
1290
"pcmpeqb "MANGLE(b00)", %%mm2 \n\t" // L11 > a ? 0 : -1
1291
"pcmpeqb "MANGLE(b00)", %%mm4 \n\t" // L21 > a ? 0 : -1
1292
"pcmpeqb "MANGLE(b00)", %%mm5 \n\t" // L01 > a ? 0 : -1
1293
"paddb %%mm4, %%mm2 \n\t"
1294
"paddb %%mm5, %%mm2 \n\t"
1333
1295
// 0, 2, 3, 1
1334
1296
#define REAL_DERING_CORE(dst,src,ppsx,psx,sx,pplx,plx,lx,t0,t1) \
1335
"movq " #src ", " #sx " \n\t" /* src[0] */\
1336
"movq " #sx ", " #lx " \n\t" /* src[0] */\
1337
"movq " #sx ", " #t0 " \n\t" /* src[0] */\
1338
"psllq $8, " #lx " \n\t"\
1339
"psrlq $8, " #t0 " \n\t"\
1340
"movd -4" #src ", " #t1 " \n\t"\
1341
"psrlq $24, " #t1 " \n\t"\
1342
"por " #t1 ", " #lx " \n\t" /* src[-1] */\
1343
"movd 8" #src ", " #t1 " \n\t"\
1344
"psllq $56, " #t1 " \n\t"\
1345
"por " #t1 ", " #t0 " \n\t" /* src[+1] */\
1346
"movq " #lx ", " #t1 " \n\t" /* src[-1] */\
1347
PAVGB(t0, lx) /* (src[-1] + src[+1])/2 */\
1348
PAVGB(sx, lx) /* (src[-1] + 2src[0] + src[+1])/4 */\
1349
PAVGB(lx, pplx) \
1350
"movq " #lx ", 8(%%"REG_c") \n\t"\
1351
"movq (%%"REG_c"), " #lx " \n\t"\
1352
"psubusb " #lx ", " #t1 " \n\t"\
1353
"psubusb " #lx ", " #t0 " \n\t"\
1354
"psubusb " #lx ", " #sx " \n\t"\
1355
"movq "MANGLE(b00)", " #lx " \n\t"\
1356
"pcmpeqb " #lx ", " #t1 " \n\t" /* src[-1] > a ? 0 : -1*/\
1357
"pcmpeqb " #lx ", " #t0 " \n\t" /* src[+1] > a ? 0 : -1*/\
1358
"pcmpeqb " #lx ", " #sx " \n\t" /* src[0] > a ? 0 : -1*/\
1359
"paddb " #t1 ", " #t0 " \n\t"\
1360
"paddb " #t0 ", " #sx " \n\t"\
1297
"movq " #src ", " #sx " \n\t" /* src[0] */\
1298
"movq " #sx ", " #lx " \n\t" /* src[0] */\
1299
"movq " #sx ", " #t0 " \n\t" /* src[0] */\
1300
"psllq $8, " #lx " \n\t"\
1301
"psrlq $8, " #t0 " \n\t"\
1302
"movd -4" #src ", " #t1 " \n\t"\
1303
"psrlq $24, " #t1 " \n\t"\
1304
"por " #t1 ", " #lx " \n\t" /* src[-1] */\
1305
"movd 8" #src ", " #t1 " \n\t"\
1306
"psllq $56, " #t1 " \n\t"\
1307
"por " #t1 ", " #t0 " \n\t" /* src[+1] */\
1308
"movq " #lx ", " #t1 " \n\t" /* src[-1] */\
1309
PAVGB(t0, lx) /* (src[-1] + src[+1])/2 */\
1310
PAVGB(sx, lx) /* (src[-1] + 2src[0] + src[+1])/4 */\
1311
PAVGB(lx, pplx) \
1312
"movq " #lx ", 8(%%"REG_c") \n\t"\
1313
"movq (%%"REG_c"), " #lx " \n\t"\
1314
"psubusb " #lx ", " #t1 " \n\t"\
1315
"psubusb " #lx ", " #t0 " \n\t"\
1316
"psubusb " #lx ", " #sx " \n\t"\
1317
"movq "MANGLE(b00)", " #lx " \n\t"\
1318
"pcmpeqb " #lx ", " #t1 " \n\t" /* src[-1] > a ? 0 : -1*/\
1319
"pcmpeqb " #lx ", " #t0 " \n\t" /* src[+1] > a ? 0 : -1*/\
1320
"pcmpeqb " #lx ", " #sx " \n\t" /* src[0] > a ? 0 : -1*/\
1321
"paddb " #t1 ", " #t0 " \n\t"\
1322
"paddb " #t0 ", " #sx " \n\t"\
1361
1323
\
1362
PAVGB(plx, pplx) /* filtered */\
1363
"movq " #dst ", " #t0 " \n\t" /* dst */\
1364
"movq " #t0 ", " #t1 " \n\t" /* dst */\
1365
"psubusb %3, " #t0 " \n\t"\
1366
"paddusb %3, " #t1 " \n\t"\
1367
PMAXUB(t0, pplx)\
1368
PMINUB(t1, pplx, t0)\
1369
"paddb " #sx ", " #ppsx " \n\t"\
1370
"paddb " #psx ", " #ppsx " \n\t"\
1371
"#paddb "MANGLE(b02)", " #ppsx " \n\t"\
1372
"pand "MANGLE(b08)", " #ppsx " \n\t"\
1373
"pcmpeqb " #lx ", " #ppsx " \n\t"\
1374
"pand " #ppsx ", " #pplx " \n\t"\
1375
"pandn " #dst ", " #ppsx " \n\t"\
1376
"por " #pplx ", " #ppsx " \n\t"\
1377
"movq " #ppsx ", " #dst " \n\t"\
1378
"movq 8(%%"REG_c"), " #lx " \n\t"
1324
PAVGB(plx, pplx) /* filtered */\
1325
"movq " #dst ", " #t0 " \n\t" /* dst */\
1326
"movq " #t0 ", " #t1 " \n\t" /* dst */\
1327
"psubusb %3, " #t0 " \n\t"\
1328
"paddusb %3, " #t1 " \n\t"\
1329
PMAXUB(t0, pplx)\
1330
PMINUB(t1, pplx, t0)\
1331
"paddb " #sx ", " #ppsx " \n\t"\
1332
"paddb " #psx ", " #ppsx " \n\t"\
1333
"#paddb "MANGLE(b02)", " #ppsx " \n\t"\
1334
"pand "MANGLE(b08)", " #ppsx " \n\t"\
1335
"pcmpeqb " #lx ", " #ppsx " \n\t"\
1336
"pand " #ppsx ", " #pplx " \n\t"\
1337
"pandn " #dst ", " #ppsx " \n\t"\
1338
"por " #pplx ", " #ppsx " \n\t"\
1339
"movq " #ppsx ", " #dst " \n\t"\
1340
"movq 8(%%"REG_c"), " #lx " \n\t"
1379
1341
1380
1342
#define DERING_CORE(dst,src,ppsx,psx,sx,pplx,plx,lx,t0,t1) \
1381
1343
REAL_DERING_CORE(dst,src,ppsx,psx,sx,pplx,plx,lx,t0,t1)
1404
1366
DERING_CORE((%%REGd, %1, 2),(%0, %1, 8) ,%%mm0,%%mm2,%%mm4,%%mm1,%%mm3,%%mm5,%%mm6,%%mm7)
1405
1367
DERING_CORE((%0, %1, 8) ,(%%REGd, %1, 4),%%mm2,%%mm4,%%mm0,%%mm3,%%mm5,%%mm1,%%mm6,%%mm7)
1406
1368
1407
"1: \n\t"
1408
: : "r" (src), "r" ((long)stride), "m" (c->pQPb), "m"(c->pQPb2)
1409
: "%"REG_a, "%"REG_d, "%"REG_c
1410
);
1369
"1: \n\t"
1370
: : "r" (src), "r" ((long)stride), "m" (c->pQPb), "m"(c->pQPb2)
1371
: "%"REG_a, "%"REG_d, "%"REG_c
1372
);
1411
1373
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1412
int y;
1413
int min=255;
1414
int max=0;
1415
int avg;
1416
uint8_t *p;
1417
int s[10];
1418
const int QP2= c->QP/2 + 1;
1419
1420
for(y=1; y<9; y++)
1421
{
1422
int x;
1423
p= src + stride*y;
1424
for(x=1; x<9; x++)
1425
{
1426
p++;
1427
if(*p > max) max= *p;
1428
if(*p < min) min= *p;
1429
}
1430
}
1431
avg= (min + max + 1)>>1;
1432
1433
if(max - min <deringThreshold) return;
1434
1435
for(y=0; y<10; y++)
1436
{
1437
int t = 0;
1438
1439
if(src[stride*y + 0] > avg) t+= 1;
1440
if(src[stride*y + 1] > avg) t+= 2;
1441
if(src[stride*y + 2] > avg) t+= 4;
1442
if(src[stride*y + 3] > avg) t+= 8;
1443
if(src[stride*y + 4] > avg) t+= 16;
1444
if(src[stride*y + 5] > avg) t+= 32;
1445
if(src[stride*y + 6] > avg) t+= 64;
1446
if(src[stride*y + 7] > avg) t+= 128;
1447
if(src[stride*y + 8] > avg) t+= 256;
1448
if(src[stride*y + 9] > avg) t+= 512;
1449
1450
t |= (~t)<<16;
1451
t &= (t<<1) & (t>>1);
1452
s[y] = t;
1453
}
1454
1455
for(y=1; y<9; y++)
1456
{
1457
int t = s[y-1] & s[y] & s[y+1];
1458
t|= t>>16;
1459
s[y-1]= t;
1460
}
1461
1462
for(y=1; y<9; y++)
1463
{
1464
int x;
1465
int t = s[y-1];
1466
1467
p= src + stride*y;
1468
for(x=1; x<9; x++)
1469
{
1470
p++;
1471
if(t & (1<<x))
1472
{
1473
int f= (*(p-stride-1)) + 2*(*(p-stride)) + (*(p-stride+1))
1474
+2*(*(p -1)) + 4*(*p ) + 2*(*(p +1))
1475
+(*(p+stride-1)) + 2*(*(p+stride)) + (*(p+stride+1));
1476
f= (f + 8)>>4;
1374
int y;
1375
int min=255;
1376
int max=0;
1377
int avg;
1378
uint8_t *p;
1379
int s[10];
1380
const int QP2= c->QP/2 + 1;
1381
1382
for(y=1; y<9; y++){
1383
int x;
1384
p= src + stride*y;
1385
for(x=1; x<9; x++){
1386
p++;
1387
if(*p > max) max= *p;
1388
if(*p < min) min= *p;
1389
}
1390
}
1391
avg= (min + max + 1)>>1;
1392
1393
if(max - min <deringThreshold) return;
1394
1395
for(y=0; y<10; y++){
1396
int t = 0;
1397
1398
if(src[stride*y + 0] > avg) t+= 1;
1399
if(src[stride*y + 1] > avg) t+= 2;
1400
if(src[stride*y + 2] > avg) t+= 4;
1401
if(src[stride*y + 3] > avg) t+= 8;
1402
if(src[stride*y + 4] > avg) t+= 16;
1403
if(src[stride*y + 5] > avg) t+= 32;
1404
if(src[stride*y + 6] > avg) t+= 64;
1405
if(src[stride*y + 7] > avg) t+= 128;
1406
if(src[stride*y + 8] > avg) t+= 256;
1407
if(src[stride*y + 9] > avg) t+= 512;
1408
1409
t |= (~t)<<16;
1410
t &= (t<<1) & (t>>1);
1411
s[y] = t;
1412
}
1413
1414
for(y=1; y<9; y++){
1415
int t = s[y-1] & s[y] & s[y+1];
1416
t|= t>>16;
1417
s[y-1]= t;
1418
}
1419
1420
for(y=1; y<9; y++){
1421
int x;
1422
int t = s[y-1];
1423
1424
p= src + stride*y;
1425
for(x=1; x<9; x++){
1426
p++;
1427
if(t & (1<<x)){
1428
int f= (*(p-stride-1)) + 2*(*(p-stride)) + (*(p-stride+1))
1429
+2*(*(p -1)) + 4*(*p ) + 2*(*(p +1))
1430
+(*(p+stride-1)) + 2*(*(p+stride)) + (*(p+stride+1));
1431
f= (f + 8)>>4;
1477
1432
1478
1433
#ifdef DEBUG_DERING_THRESHOLD
1479
asm volatile("emms\n\t":);
1480
{
1481
static long long numPixels=0;
1482
if(x!=1 && x!=8 && y!=1 && y!=8) numPixels++;
1483
// if((max-min)<20 || (max-min)*QP<200)
1484
// if((max-min)*QP < 500)
1485
// if(max-min<QP/2)
1486
if(max-min < 20)
1487
{
1488
static int numSkiped=0;
1489
static int errorSum=0;
1490
static int worstQP=0;
1491
static int worstRange=0;
1492
static int worstDiff=0;
1493
int diff= (f - *p);
1494
int absDiff= FFABS(diff);
1495
int error= diff*diff;
1496
1497
if(x==1 || x==8 || y==1 || y==8) continue;
1498
1499
numSkiped++;
1500
if(absDiff > worstDiff)
1501
{
1502
worstDiff= absDiff;
1503
worstQP= QP;
1504
worstRange= max-min;
1505
}
1506
errorSum+= error;
1507
1508
if(1024LL*1024LL*1024LL % numSkiped == 0)
1509
{
1510
av_log(c, AV_LOG_INFO, "sum:%1.3f, skip:%d, wQP:%d, "
1511
"wRange:%d, wDiff:%d, relSkip:%1.3f\n",
1512
(float)errorSum/numSkiped, numSkiped, worstQP, worstRange,
1513
worstDiff, (float)numSkiped/numPixels);
1514
}
1515
}
1516
}
1434
asm volatile("emms\n\t":);
1435
{
1436
static long long numPixels=0;
1437
if(x!=1 && x!=8 && y!=1 && y!=8) numPixels++;
1438
// if((max-min)<20 || (max-min)*QP<200)
1439
// if((max-min)*QP < 500)
1440
// if(max-min<QP/2)
1441
if(max-min < 20){
1442
static int numSkipped=0;
1443
static int errorSum=0;
1444
static int worstQP=0;
1445
static int worstRange=0;
1446
static int worstDiff=0;
1447
int diff= (f - *p);
1448
int absDiff= FFABS(diff);
1449
int error= diff*diff;
1450
1451
if(x==1 || x==8 || y==1 || y==8) continue;
1452
1453
numSkipped++;
1454
if(absDiff > worstDiff){
1455
worstDiff= absDiff;
1456
worstQP= QP;
1457
worstRange= max-min;
1458
}
1459
errorSum+= error;
1460
1461
if(1024LL*1024LL*1024LL % numSkipped == 0){
1462
av_log(c, AV_LOG_INFO, "sum:%1.3f, skip:%d, wQP:%d, "
1463
"wRange:%d, wDiff:%d, relSkip:%1.3f\n",
1464
(float)errorSum/numSkipped, numSkipped, worstQP, worstRange,
1465
worstDiff, (float)numSkipped/numPixels);
1466
}
1467
}
1468
}
1517
1469
#endif
1518
if (*p + QP2 < f) *p= *p + QP2;
1519
else if(*p - QP2 > f) *p= *p - QP2;
1520
else *p=f;
1521
}
1522
}
1470
if (*p + QP2 < f) *p= *p + QP2;
1471
else if(*p - QP2 > f) *p= *p - QP2;
1472
else *p=f;
1473
}
1523
1474
}
1475
}
1524
1476
#ifdef DEBUG_DERING_THRESHOLD
1525
if(max-min < 20)
1526
{
1527
for(y=1; y<9; y++)
1528
{
1529
int x;
1530
int t = 0;
1531
p= src + stride*y;
1532
for(x=1; x<9; x++)
1533
{
1534
p++;
1535
*p = FFMIN(*p + 20, 255);
1536
}
1537
}
1538
// src[0] = src[7]=src[stride*7]=src[stride*7 + 7]=255;
1477
if(max-min < 20){
1478
for(y=1; y<9; y++){
1479
int x;
1480
int t = 0;
1481
p= src + stride*y;
1482
for(x=1; x<9; x++){
1483
p++;
1484
*p = FFMIN(*p + 20, 255);
1485
}
1539
1486
}
1487
// src[0] = src[7]=src[stride*7]=src[stride*7 + 7]=255;
1488
}
1540
1489
#endif
1541
1490
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1542
1491
}
1545
1494
/**
1546
1495
* Deinterlaces the given block by linearly interpolating every second line.
1547
1496
* will be called for every 8x8 block and can read & write from line 4-15
1548
* lines 0-3 have been passed through the deblock / dering filters allready, but can be read too
1497
* lines 0-3 have been passed through the deblock / dering filters already, but can be read, too.
1549
1498
* lines 4-12 will be read into the deblocking filter and should be deinterlaced
1550
1499
*/
1551
1500
static inline void RENAME(deInterlaceInterpolateLinear)(uint8_t src[], int stride)
1552
1501
{
1553
1502
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1554
src+= 4*stride;
1555
asm volatile(
1556
"lea (%0, %1), %%"REG_a" \n\t"
1557
"lea (%%"REG_a", %1, 4), %%"REG_c" \n\t"
1503
src+= 4*stride;
1504
asm volatile(
1505
"lea (%0, %1), %%"REG_a" \n\t"
1506
"lea (%%"REG_a", %1, 4), %%"REG_c" \n\t"
1558
1507
// 0 1 2 3 4 5 6 7 8 9
1559
1508
// %0 eax eax+%1 eax+2%1 %0+4%1 ecx ecx+%1 ecx+2%1 %0+8%1 ecx+4%1
1560
1509
1561
"movq (%0), %%mm0 \n\t"
1562
"movq (%%"REG_a", %1), %%mm1 \n\t"
1563
PAVGB(%%mm1, %%mm0)
1564
"movq %%mm0, (%%"REG_a") \n\t"
1565
"movq (%0, %1, 4), %%mm0 \n\t"
1566
PAVGB(%%mm0, %%mm1)
1567
"movq %%mm1, (%%"REG_a", %1, 2) \n\t"
1568
"movq (%%"REG_c", %1), %%mm1 \n\t"
1569
PAVGB(%%mm1, %%mm0)
1570
"movq %%mm0, (%%"REG_c") \n\t"
1571
"movq (%0, %1, 8), %%mm0 \n\t"
1572
PAVGB(%%mm0, %%mm1)
1573
"movq %%mm1, (%%"REG_c", %1, 2) \n\t"
1510
"movq (%0), %%mm0 \n\t"
1511
"movq (%%"REG_a", %1), %%mm1 \n\t"
1512
PAVGB(%%mm1, %%mm0)
1513
"movq %%mm0, (%%"REG_a") \n\t"
1514
"movq (%0, %1, 4), %%mm0 \n\t"
1515
PAVGB(%%mm0, %%mm1)
1516
"movq %%mm1, (%%"REG_a", %1, 2) \n\t"
1517
"movq (%%"REG_c", %1), %%mm1 \n\t"
1518
PAVGB(%%mm1, %%mm0)
1519
"movq %%mm0, (%%"REG_c") \n\t"
1520
"movq (%0, %1, 8), %%mm0 \n\t"
1521
PAVGB(%%mm0, %%mm1)
1522
"movq %%mm1, (%%"REG_c", %1, 2) \n\t"
1574
1523
1575
: : "r" (src), "r" ((long)stride)
1576
: "%"REG_a, "%"REG_c
1577
);
1524
: : "r" (src), "r" ((long)stride)
1525
: "%"REG_a, "%"REG_c
1526
);
1578
1527
#else
1579
int a, b, x;
1580
src+= 4*stride;
1528
int a, b, x;
1529
src+= 4*stride;
1581
1530
1582
for(x=0; x<2; x++){
1583
a= *(uint32_t*)&src[stride*0];
1584
b= *(uint32_t*)&src[stride*2];
1585
*(uint32_t*)&src[stride*1]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1586
a= *(uint32_t*)&src[stride*4];
1587
*(uint32_t*)&src[stride*3]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1588
b= *(uint32_t*)&src[stride*6];
1589
*(uint32_t*)&src[stride*5]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1590
a= *(uint32_t*)&src[stride*8];
1591
*(uint32_t*)&src[stride*7]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1592
src += 4;
1593
}
1531
for(x=0; x<2; x++){
1532
a= *(uint32_t*)&src[stride*0];
1533
b= *(uint32_t*)&src[stride*2];
1534
*(uint32_t*)&src[stride*1]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1535
a= *(uint32_t*)&src[stride*4];
1536
*(uint32_t*)&src[stride*3]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1537
b= *(uint32_t*)&src[stride*6];
1538
*(uint32_t*)&src[stride*5]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1539
a= *(uint32_t*)&src[stride*8];
1540
*(uint32_t*)&src[stride*7]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1541
src += 4;
1542
}
1594
1543
#endif
1595
1544
}
1596
1545
1597
1546
/**
1598
1547
* Deinterlaces the given block by cubic interpolating every second line.
1599
1548
* will be called for every 8x8 block and can read & write from line 4-15
1600
* lines 0-3 have been passed through the deblock / dering filters allready, but can be read too
1549
* lines 0-3 have been passed through the deblock / dering filters already, but can be read, too.
1601
1550
* lines 4-12 will be read into the deblocking filter and should be deinterlaced
1602
1551
* this filter will read lines 3-15 and write 7-13
1603
1552
*/
1604
1553
static inline void RENAME(deInterlaceInterpolateCubic)(uint8_t src[], int stride)
1605
1554
{
1606
1555
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1607
src+= stride*3;
1608
asm volatile(
1609
"lea (%0, %1), %%"REG_a" \n\t"
1610
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1611
"lea (%%"REG_d", %1, 4), %%"REG_c" \n\t"
1612
"add %1, %%"REG_c" \n\t"
1613
"pxor %%mm7, %%mm7 \n\t"
1556
src+= stride*3;
1557
asm volatile(
1558
"lea (%0, %1), %%"REG_a" \n\t"
1559
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1560
"lea (%%"REG_d", %1, 4), %%"REG_c" \n\t"
1561
"add %1, %%"REG_c" \n\t"
1562
"pxor %%mm7, %%mm7 \n\t"
1614
1563
// 0 1 2 3 4 5 6 7 8 9 10
1615
1564
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1 ecx
1616
1565
1617
1566
#define REAL_DEINT_CUBIC(a,b,c,d,e)\
1618
"movq " #a ", %%mm0 \n\t"\
1619
"movq " #b ", %%mm1 \n\t"\
1620
"movq " #d ", %%mm2 \n\t"\
1621
"movq " #e ", %%mm3 \n\t"\
1622
PAVGB(%%mm2, %%mm1) /* (b+d) /2 */\
1623
PAVGB(%%mm3, %%mm0) /* a(a+e) /2 */\
1624
"movq %%mm0, %%mm2 \n\t"\
1625
"punpcklbw %%mm7, %%mm0 \n\t"\
1626
"punpckhbw %%mm7, %%mm2 \n\t"\
1627
"movq %%mm1, %%mm3 \n\t"\
1628
"punpcklbw %%mm7, %%mm1 \n\t"\
1629
"punpckhbw %%mm7, %%mm3 \n\t"\
1630
"psubw %%mm1, %%mm0 \n\t" /* L(a+e - (b+d))/2 */\
1631
"psubw %%mm3, %%mm2 \n\t" /* H(a+e - (b+d))/2 */\
1632
"psraw $3, %%mm0 \n\t" /* L(a+e - (b+d))/16 */\
1633
"psraw $3, %%mm2 \n\t" /* H(a+e - (b+d))/16 */\
1634
"psubw %%mm0, %%mm1 \n\t" /* L(9b + 9d - a - e)/16 */\
1635
"psubw %%mm2, %%mm3 \n\t" /* H(9b + 9d - a - e)/16 */\
1636
"packuswb %%mm3, %%mm1 \n\t"\
1637
"movq %%mm1, " #c " \n\t"
1567
"movq " #a ", %%mm0 \n\t"\
1568
"movq " #b ", %%mm1 \n\t"\
1569
"movq " #d ", %%mm2 \n\t"\
1570
"movq " #e ", %%mm3 \n\t"\
1571
PAVGB(%%mm2, %%mm1) /* (b+d) /2 */\
1572
PAVGB(%%mm3, %%mm0) /* a(a+e) /2 */\
1573
"movq %%mm0, %%mm2 \n\t"\
1574
"punpcklbw %%mm7, %%mm0 \n\t"\
1575
"punpckhbw %%mm7, %%mm2 \n\t"\
1576
"movq %%mm1, %%mm3 \n\t"\
1577
"punpcklbw %%mm7, %%mm1 \n\t"\
1578
"punpckhbw %%mm7, %%mm3 \n\t"\
1579
"psubw %%mm1, %%mm0 \n\t" /* L(a+e - (b+d))/2 */\
1580
"psubw %%mm3, %%mm2 \n\t" /* H(a+e - (b+d))/2 */\
1581
"psraw $3, %%mm0 \n\t" /* L(a+e - (b+d))/16 */\
1582
"psraw $3, %%mm2 \n\t" /* H(a+e - (b+d))/16 */\
1583
"psubw %%mm0, %%mm1 \n\t" /* L(9b + 9d - a - e)/16 */\
1584
"psubw %%mm2, %%mm3 \n\t" /* H(9b + 9d - a - e)/16 */\
1585
"packuswb %%mm3, %%mm1 \n\t"\
1586
"movq %%mm1, " #c " \n\t"
1638
1587
#define DEINT_CUBIC(a,b,c,d,e) REAL_DEINT_CUBIC(a,b,c,d,e)
1639
1588
1640
1589
DEINT_CUBIC((%0) , (%%REGa, %1), (%%REGa, %1, 2), (%0, %1, 4) , (%%REGd, %1))
1642
1591
DEINT_CUBIC((%0, %1, 4) , (%%REGd, %1), (%%REGd, %1, 2), (%0, %1, 8) , (%%REGc))
1643
1592
DEINT_CUBIC((%%REGd, %1), (%0, %1, 8) , (%%REGd, %1, 4), (%%REGc) , (%%REGc, %1, 2))
1644
1593
1645
: : "r" (src), "r" ((long)stride)
1646
: "%"REG_a, "%"REG_d, "%"REG_c
1647
);
1594
: : "r" (src), "r" ((long)stride)
1595
: "%"REG_a, "%"REG_d, "%"REG_c
1596
);
1648
1597
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1649
int x;
1650
src+= stride*3;
1651
for(x=0; x<8; x++)
1652
{
1653
src[stride*3] = CLIP((-src[0] + 9*src[stride*2] + 9*src[stride*4] - src[stride*6])>>4);
1654
src[stride*5] = CLIP((-src[stride*2] + 9*src[stride*4] + 9*src[stride*6] - src[stride*8])>>4);
1655
src[stride*7] = CLIP((-src[stride*4] + 9*src[stride*6] + 9*src[stride*8] - src[stride*10])>>4);
1656
src[stride*9] = CLIP((-src[stride*6] + 9*src[stride*8] + 9*src[stride*10] - src[stride*12])>>4);
1657
src++;
1658
}
1598
int x;
1599
src+= stride*3;
1600
for(x=0; x<8; x++){
1601
src[stride*3] = CLIP((-src[0] + 9*src[stride*2] + 9*src[stride*4] - src[stride*6])>>4);
1602
src[stride*5] = CLIP((-src[stride*2] + 9*src[stride*4] + 9*src[stride*6] - src[stride*8])>>4);
1603
src[stride*7] = CLIP((-src[stride*4] + 9*src[stride*6] + 9*src[stride*8] - src[stride*10])>>4);
1604
src[stride*9] = CLIP((-src[stride*6] + 9*src[stride*8] + 9*src[stride*10] - src[stride*12])>>4);
1605
src++;
1606
}
1659
1607
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1660
1608
}
1661
1609
1662
1610
/**
1663
1611
* Deinterlaces the given block by filtering every second line with a (-1 4 2 4 -1) filter.
1664
1612
* will be called for every 8x8 block and can read & write from line 4-15
1665
* lines 0-3 have been passed through the deblock / dering filters allready, but can be read too
1613
* lines 0-3 have been passed through the deblock / dering filters already, but can be read, too.
1666
1614
* lines 4-12 will be read into the deblocking filter and should be deinterlaced
1667
1615
* this filter will read lines 4-13 and write 5-11
1668
1616
*/
1669
1617
static inline void RENAME(deInterlaceFF)(uint8_t src[], int stride, uint8_t *tmp)
1670
1618
{
1671
1619
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1672
src+= stride*4;
1673
asm volatile(
1674
"lea (%0, %1), %%"REG_a" \n\t"
1675
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1676
"pxor %%mm7, %%mm7 \n\t"
1677
"movq (%2), %%mm0 \n\t"
1620
src+= stride*4;
1621
asm volatile(
1622
"lea (%0, %1), %%"REG_a" \n\t"
1623
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1624
"pxor %%mm7, %%mm7 \n\t"
1625
"movq (%2), %%mm0 \n\t"
1678
1626
// 0 1 2 3 4 5 6 7 8 9 10
1679
1627
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1 ecx
1680
1628
1681
1629
#define REAL_DEINT_FF(a,b,c,d)\
1682
"movq " #a ", %%mm1 \n\t"\
1683
"movq " #b ", %%mm2 \n\t"\
1684
"movq " #c ", %%mm3 \n\t"\
1685
"movq " #d ", %%mm4 \n\t"\
1686
PAVGB(%%mm3, %%mm1) \
1687
PAVGB(%%mm4, %%mm0) \
1688
"movq %%mm0, %%mm3 \n\t"\
1689
"punpcklbw %%mm7, %%mm0 \n\t"\
1690
"punpckhbw %%mm7, %%mm3 \n\t"\
1691
"movq %%mm1, %%mm4 \n\t"\
1692
"punpcklbw %%mm7, %%mm1 \n\t"\
1693
"punpckhbw %%mm7, %%mm4 \n\t"\
1694
"psllw $2, %%mm1 \n\t"\
1695
"psllw $2, %%mm4 \n\t"\
1696
"psubw %%mm0, %%mm1 \n\t"\
1697
"psubw %%mm3, %%mm4 \n\t"\
1698
"movq %%mm2, %%mm5 \n\t"\
1699
"movq %%mm2, %%mm0 \n\t"\
1700
"punpcklbw %%mm7, %%mm2 \n\t"\
1701
"punpckhbw %%mm7, %%mm5 \n\t"\
1702
"paddw %%mm2, %%mm1 \n\t"\
1703
"paddw %%mm5, %%mm4 \n\t"\
1704
"psraw $2, %%mm1 \n\t"\
1705
"psraw $2, %%mm4 \n\t"\
1706
"packuswb %%mm4, %%mm1 \n\t"\
1707
"movq %%mm1, " #b " \n\t"\
1630
"movq " #a ", %%mm1 \n\t"\
1631
"movq " #b ", %%mm2 \n\t"\
1632
"movq " #c ", %%mm3 \n\t"\
1633
"movq " #d ", %%mm4 \n\t"\
1634
PAVGB(%%mm3, %%mm1) \
1635
PAVGB(%%mm4, %%mm0) \
1636
"movq %%mm0, %%mm3 \n\t"\
1637
"punpcklbw %%mm7, %%mm0 \n\t"\
1638
"punpckhbw %%mm7, %%mm3 \n\t"\
1639
"movq %%mm1, %%mm4 \n\t"\
1640
"punpcklbw %%mm7, %%mm1 \n\t"\
1641
"punpckhbw %%mm7, %%mm4 \n\t"\
1642
"psllw $2, %%mm1 \n\t"\
1643
"psllw $2, %%mm4 \n\t"\
1644
"psubw %%mm0, %%mm1 \n\t"\
1645
"psubw %%mm3, %%mm4 \n\t"\
1646
"movq %%mm2, %%mm5 \n\t"\
1647
"movq %%mm2, %%mm0 \n\t"\
1648
"punpcklbw %%mm7, %%mm2 \n\t"\
1649
"punpckhbw %%mm7, %%mm5 \n\t"\
1650
"paddw %%mm2, %%mm1 \n\t"\
1651
"paddw %%mm5, %%mm4 \n\t"\
1652
"psraw $2, %%mm1 \n\t"\
1653
"psraw $2, %%mm4 \n\t"\
1654
"packuswb %%mm4, %%mm1 \n\t"\
1655
"movq %%mm1, " #b " \n\t"\
1708
1656
1709
1657
#define DEINT_FF(a,b,c,d) REAL_DEINT_FF(a,b,c,d)
1710
1658
1713
1661
DEINT_FF((%0, %1, 4) , (%%REGd) , (%%REGd, %1), (%%REGd, %1, 2))
1714
1662
DEINT_FF((%%REGd, %1), (%%REGd, %1, 2), (%0, %1, 8) , (%%REGd, %1, 4))
1715
1663
1716
"movq %%mm0, (%2) \n\t"
1717
: : "r" (src), "r" ((long)stride), "r"(tmp)
1718
: "%"REG_a, "%"REG_d
1719
);
1664
"movq %%mm0, (%2) \n\t"
1665
: : "r" (src), "r" ((long)stride), "r"(tmp)
1666
: "%"REG_a, "%"REG_d
1667
);
1720
1668
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1721
int x;
1722
src+= stride*4;
1723
for(x=0; x<8; x++)
1724
{
1725
int t1= tmp[x];
1726
int t2= src[stride*1];
1727
1728
src[stride*1]= CLIP((-t1 + 4*src[stride*0] + 2*t2 + 4*src[stride*2] - src[stride*3] + 4)>>3);
1729
t1= src[stride*4];
1730
src[stride*3]= CLIP((-t2 + 4*src[stride*2] + 2*t1 + 4*src[stride*4] - src[stride*5] + 4)>>3);
1731
t2= src[stride*6];
1732
src[stride*5]= CLIP((-t1 + 4*src[stride*4] + 2*t2 + 4*src[stride*6] - src[stride*7] + 4)>>3);
1733
t1= src[stride*8];
1734
src[stride*7]= CLIP((-t2 + 4*src[stride*6] + 2*t1 + 4*src[stride*8] - src[stride*9] + 4)>>3);
1735
tmp[x]= t1;
1736
1737
src++;
1738
}
1669
int x;
1670
src+= stride*4;
1671
for(x=0; x<8; x++){
1672
int t1= tmp[x];
1673
int t2= src[stride*1];
1674
1675
src[stride*1]= CLIP((-t1 + 4*src[stride*0] + 2*t2 + 4*src[stride*2] - src[stride*3] + 4)>>3);
1676
t1= src[stride*4];
1677
src[stride*3]= CLIP((-t2 + 4*src[stride*2] + 2*t1 + 4*src[stride*4] - src[stride*5] + 4)>>3);
1678
t2= src[stride*6];
1679
src[stride*5]= CLIP((-t1 + 4*src[stride*4] + 2*t2 + 4*src[stride*6] - src[stride*7] + 4)>>3);
1680
t1= src[stride*8];
1681
src[stride*7]= CLIP((-t2 + 4*src[stride*6] + 2*t1 + 4*src[stride*8] - src[stride*9] + 4)>>3);
1682
tmp[x]= t1;
1683
1684
src++;
1685
}
1739
1686
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1740
1687
}
1741
1688
1742
1689
/**
1743
1690
* Deinterlaces the given block by filtering every line with a (-1 2 6 2 -1) filter.
1744
1691
* will be called for every 8x8 block and can read & write from line 4-15
1745
* lines 0-3 have been passed through the deblock / dering filters allready, but can be read too
1692
* lines 0-3 have been passed through the deblock / dering filters already, but can be read, too.
1746
1693
* lines 4-12 will be read into the deblocking filter and should be deinterlaced
1747
1694
* this filter will read lines 4-13 and write 4-11
1748
1695
*/
1749
1696
static inline void RENAME(deInterlaceL5)(uint8_t src[], int stride, uint8_t *tmp, uint8_t *tmp2)
1750
1697
{
1751
1698
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1752
src+= stride*4;
1753
asm volatile(
1754
"lea (%0, %1), %%"REG_a" \n\t"
1755
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1756
"pxor %%mm7, %%mm7 \n\t"
1757
"movq (%2), %%mm0 \n\t"
1758
"movq (%3), %%mm1 \n\t"
1699
src+= stride*4;
1700
asm volatile(
1701
"lea (%0, %1), %%"REG_a" \n\t"
1702
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1703
"pxor %%mm7, %%mm7 \n\t"
1704
"movq (%2), %%mm0 \n\t"
1705
"movq (%3), %%mm1 \n\t"
1759
1706
// 0 1 2 3 4 5 6 7 8 9 10
1760
1707
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1 ecx
1761
1708
1762
1709
#define REAL_DEINT_L5(t1,t2,a,b,c)\
1763
"movq " #a ", %%mm2 \n\t"\
1764
"movq " #b ", %%mm3 \n\t"\
1765
"movq " #c ", %%mm4 \n\t"\
1766
PAVGB(t2, %%mm3) \
1767
PAVGB(t1, %%mm4) \
1768
"movq %%mm2, %%mm5 \n\t"\
1769
"movq %%mm2, " #t1 " \n\t"\
1770
"punpcklbw %%mm7, %%mm2 \n\t"\
1771
"punpckhbw %%mm7, %%mm5 \n\t"\
1772
"movq %%mm2, %%mm6 \n\t"\
1773
"paddw %%mm2, %%mm2 \n\t"\
1774
"paddw %%mm6, %%mm2 \n\t"\
1775
"movq %%mm5, %%mm6 \n\t"\
1776
"paddw %%mm5, %%mm5 \n\t"\
1777
"paddw %%mm6, %%mm5 \n\t"\
1778
"movq %%mm3, %%mm6 \n\t"\
1779
"punpcklbw %%mm7, %%mm3 \n\t"\
1780
"punpckhbw %%mm7, %%mm6 \n\t"\
1781
"paddw %%mm3, %%mm3 \n\t"\
1782
"paddw %%mm6, %%mm6 \n\t"\
1783
"paddw %%mm3, %%mm2 \n\t"\
1784
"paddw %%mm6, %%mm5 \n\t"\
1785
"movq %%mm4, %%mm6 \n\t"\
1786
"punpcklbw %%mm7, %%mm4 \n\t"\
1787
"punpckhbw %%mm7, %%mm6 \n\t"\
1788
"psubw %%mm4, %%mm2 \n\t"\
1789
"psubw %%mm6, %%mm5 \n\t"\
1790
"psraw $2, %%mm2 \n\t"\
1791
"psraw $2, %%mm5 \n\t"\
1792
"packuswb %%mm5, %%mm2 \n\t"\
1793
"movq %%mm2, " #a " \n\t"\
1710
"movq " #a ", %%mm2 \n\t"\
1711
"movq " #b ", %%mm3 \n\t"\
1712
"movq " #c ", %%mm4 \n\t"\
1713
PAVGB(t2, %%mm3) \
1714
PAVGB(t1, %%mm4) \
1715
"movq %%mm2, %%mm5 \n\t"\
1716
"movq %%mm2, " #t1 " \n\t"\
1717
"punpcklbw %%mm7, %%mm2 \n\t"\
1718
"punpckhbw %%mm7, %%mm5 \n\t"\
1719
"movq %%mm2, %%mm6 \n\t"\
1720
"paddw %%mm2, %%mm2 \n\t"\
1721
"paddw %%mm6, %%mm2 \n\t"\
1722
"movq %%mm5, %%mm6 \n\t"\
1723
"paddw %%mm5, %%mm5 \n\t"\
1724
"paddw %%mm6, %%mm5 \n\t"\
1725
"movq %%mm3, %%mm6 \n\t"\
1726
"punpcklbw %%mm7, %%mm3 \n\t"\
1727
"punpckhbw %%mm7, %%mm6 \n\t"\
1728
"paddw %%mm3, %%mm3 \n\t"\
1729
"paddw %%mm6, %%mm6 \n\t"\
1730
"paddw %%mm3, %%mm2 \n\t"\
1731
"paddw %%mm6, %%mm5 \n\t"\
1732
"movq %%mm4, %%mm6 \n\t"\
1733
"punpcklbw %%mm7, %%mm4 \n\t"\
1734
"punpckhbw %%mm7, %%mm6 \n\t"\
1735
"psubw %%mm4, %%mm2 \n\t"\
1736
"psubw %%mm6, %%mm5 \n\t"\
1737
"psraw $2, %%mm2 \n\t"\
1738
"psraw $2, %%mm5 \n\t"\
1739
"packuswb %%mm5, %%mm2 \n\t"\
1740
"movq %%mm2, " #a " \n\t"\
1794
1741
1795
1742
#define DEINT_L5(t1,t2,a,b,c) REAL_DEINT_L5(t1,t2,a,b,c)
1796
1743
1803
1750
DEINT_L5(%%mm0, %%mm1, (%%REGd, %1) , (%%REGd, %1, 2), (%0, %1, 8) )
1804
1751
DEINT_L5(%%mm1, %%mm0, (%%REGd, %1, 2), (%0, %1, 8) , (%%REGd, %1, 4))
1805
1752
1806
"movq %%mm0, (%2) \n\t"
1807
"movq %%mm1, (%3) \n\t"
1808
: : "r" (src), "r" ((long)stride), "r"(tmp), "r"(tmp2)
1809
: "%"REG_a, "%"REG_d
1810
);
1753
"movq %%mm0, (%2) \n\t"
1754
"movq %%mm1, (%3) \n\t"
1755
: : "r" (src), "r" ((long)stride), "r"(tmp), "r"(tmp2)
1756
: "%"REG_a, "%"REG_d
1757
);
1811
1758
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1812
int x;
1813
src+= stride*4;
1814
for(x=0; x<8; x++)
1815
{
1816
int t1= tmp[x];
1817
int t2= tmp2[x];
1818
int t3= src[0];
1819
1820
src[stride*0]= CLIP((-(t1 + src[stride*2]) + 2*(t2 + src[stride*1]) + 6*t3 + 4)>>3);
1821
t1= src[stride*1];
1822
src[stride*1]= CLIP((-(t2 + src[stride*3]) + 2*(t3 + src[stride*2]) + 6*t1 + 4)>>3);
1823
t2= src[stride*2];
1824
src[stride*2]= CLIP((-(t3 + src[stride*4]) + 2*(t1 + src[stride*3]) + 6*t2 + 4)>>3);
1825
t3= src[stride*3];
1826
src[stride*3]= CLIP((-(t1 + src[stride*5]) + 2*(t2 + src[stride*4]) + 6*t3 + 4)>>3);
1827
t1= src[stride*4];
1828
src[stride*4]= CLIP((-(t2 + src[stride*6]) + 2*(t3 + src[stride*5]) + 6*t1 + 4)>>3);
1829
t2= src[stride*5];
1830
src[stride*5]= CLIP((-(t3 + src[stride*7]) + 2*(t1 + src[stride*6]) + 6*t2 + 4)>>3);
1831
t3= src[stride*6];
1832
src[stride*6]= CLIP((-(t1 + src[stride*8]) + 2*(t2 + src[stride*7]) + 6*t3 + 4)>>3);
1833
t1= src[stride*7];
1834
src[stride*7]= CLIP((-(t2 + src[stride*9]) + 2*(t3 + src[stride*8]) + 6*t1 + 4)>>3);
1835
1836
tmp[x]= t3;
1837
tmp2[x]= t1;
1838
1839
src++;
1840
}
1759
int x;
1760
src+= stride*4;
1761
for(x=0; x<8; x++){
1762
int t1= tmp[x];
1763
int t2= tmp2[x];
1764
int t3= src[0];
1765
1766
src[stride*0]= CLIP((-(t1 + src[stride*2]) + 2*(t2 + src[stride*1]) + 6*t3 + 4)>>3);
1767
t1= src[stride*1];
1768
src[stride*1]= CLIP((-(t2 + src[stride*3]) + 2*(t3 + src[stride*2]) + 6*t1 + 4)>>3);
1769
t2= src[stride*2];
1770
src[stride*2]= CLIP((-(t3 + src[stride*4]) + 2*(t1 + src[stride*3]) + 6*t2 + 4)>>3);
1771
t3= src[stride*3];
1772
src[stride*3]= CLIP((-(t1 + src[stride*5]) + 2*(t2 + src[stride*4]) + 6*t3 + 4)>>3);
1773
t1= src[stride*4];
1774
src[stride*4]= CLIP((-(t2 + src[stride*6]) + 2*(t3 + src[stride*5]) + 6*t1 + 4)>>3);
1775
t2= src[stride*5];
1776
src[stride*5]= CLIP((-(t3 + src[stride*7]) + 2*(t1 + src[stride*6]) + 6*t2 + 4)>>3);
1777
t3= src[stride*6];
1778
src[stride*6]= CLIP((-(t1 + src[stride*8]) + 2*(t2 + src[stride*7]) + 6*t3 + 4)>>3);
1779
t1= src[stride*7];
1780
src[stride*7]= CLIP((-(t2 + src[stride*9]) + 2*(t3 + src[stride*8]) + 6*t1 + 4)>>3);
1781
1782
tmp[x]= t3;
1783
tmp2[x]= t1;
1784
1785
src++;
1786
}
1841
1787
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1842
1788
}
1843
1789
1844
1790
/**
1845
1791
* Deinterlaces the given block by filtering all lines with a (1 2 1) filter.
1846
1792
* will be called for every 8x8 block and can read & write from line 4-15
1847
* lines 0-3 have been passed through the deblock / dering filters allready, but can be read too
1793
* lines 0-3 have been passed through the deblock / dering filters already, but can be read, too.
1848
1794
* lines 4-12 will be read into the deblocking filter and should be deinterlaced
1849
1795
* this filter will read lines 4-13 and write 4-11
1850
1796
*/
1851
1797
static inline void RENAME(deInterlaceBlendLinear)(uint8_t src[], int stride, uint8_t *tmp)
1852
1798
{
1853
1799
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1854
src+= 4*stride;
1855
asm volatile(
1856
"lea (%0, %1), %%"REG_a" \n\t"
1857
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1800
src+= 4*stride;
1801
asm volatile(
1802
"lea (%0, %1), %%"REG_a" \n\t"
1803
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1858
1804
// 0 1 2 3 4 5 6 7 8 9
1859
1805
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1
1860
1806
1861
"movq (%2), %%mm0 \n\t" // L0
1862
"movq (%%"REG_a"), %%mm1 \n\t" // L2
1863
PAVGB(%%mm1, %%mm0) // L0+L2
1864
"movq (%0), %%mm2 \n\t" // L1
1865
PAVGB(%%mm2, %%mm0)
1866
"movq %%mm0, (%0) \n\t"
1867
"movq (%%"REG_a", %1), %%mm0 \n\t" // L3
1868
PAVGB(%%mm0, %%mm2) // L1+L3
1869
PAVGB(%%mm1, %%mm2) // 2L2 + L1 + L3
1870
"movq %%mm2, (%%"REG_a") \n\t"
1871
"movq (%%"REG_a", %1, 2), %%mm2 \n\t" // L4
1872
PAVGB(%%mm2, %%mm1) // L2+L4
1873
PAVGB(%%mm0, %%mm1) // 2L3 + L2 + L4
1874
"movq %%mm1, (%%"REG_a", %1) \n\t"
1875
"movq (%0, %1, 4), %%mm1 \n\t" // L5
1876
PAVGB(%%mm1, %%mm0) // L3+L5
1877
PAVGB(%%mm2, %%mm0) // 2L4 + L3 + L5
1878
"movq %%mm0, (%%"REG_a", %1, 2) \n\t"
1879
"movq (%%"REG_d"), %%mm0 \n\t" // L6
1880
PAVGB(%%mm0, %%mm2) // L4+L6
1881
PAVGB(%%mm1, %%mm2) // 2L5 + L4 + L6
1882
"movq %%mm2, (%0, %1, 4) \n\t"
1883
"movq (%%"REG_d", %1), %%mm2 \n\t" // L7
1884
PAVGB(%%mm2, %%mm1) // L5+L7
1885
PAVGB(%%mm0, %%mm1) // 2L6 + L5 + L7
1886
"movq %%mm1, (%%"REG_d") \n\t"
1887
"movq (%%"REG_d", %1, 2), %%mm1 \n\t" // L8
1888
PAVGB(%%mm1, %%mm0) // L6+L8
1889
PAVGB(%%mm2, %%mm0) // 2L7 + L6 + L8
1890
"movq %%mm0, (%%"REG_d", %1) \n\t"
1891
"movq (%0, %1, 8), %%mm0 \n\t" // L9
1892
PAVGB(%%mm0, %%mm2) // L7+L9
1893
PAVGB(%%mm1, %%mm2) // 2L8 + L7 + L9
1894
"movq %%mm2, (%%"REG_d", %1, 2) \n\t"
1895
"movq %%mm1, (%2) \n\t"
1807
"movq (%2), %%mm0 \n\t" // L0
1808
"movq (%%"REG_a"), %%mm1 \n\t" // L2
1809
PAVGB(%%mm1, %%mm0) // L0+L2
1810
"movq (%0), %%mm2 \n\t" // L1
1811
PAVGB(%%mm2, %%mm0)
1812
"movq %%mm0, (%0) \n\t"
1813
"movq (%%"REG_a", %1), %%mm0 \n\t" // L3
1814
PAVGB(%%mm0, %%mm2) // L1+L3
1815
PAVGB(%%mm1, %%mm2) // 2L2 + L1 + L3
1816
"movq %%mm2, (%%"REG_a") \n\t"
1817
"movq (%%"REG_a", %1, 2), %%mm2 \n\t" // L4
1818
PAVGB(%%mm2, %%mm1) // L2+L4
1819
PAVGB(%%mm0, %%mm1) // 2L3 + L2 + L4
1820
"movq %%mm1, (%%"REG_a", %1) \n\t"
1821
"movq (%0, %1, 4), %%mm1 \n\t" // L5
1822
PAVGB(%%mm1, %%mm0) // L3+L5
1823
PAVGB(%%mm2, %%mm0) // 2L4 + L3 + L5
1824
"movq %%mm0, (%%"REG_a", %1, 2) \n\t"
1825
"movq (%%"REG_d"), %%mm0 \n\t" // L6
1826
PAVGB(%%mm0, %%mm2) // L4+L6
1827
PAVGB(%%mm1, %%mm2) // 2L5 + L4 + L6
1828
"movq %%mm2, (%0, %1, 4) \n\t"
1829
"movq (%%"REG_d", %1), %%mm2 \n\t" // L7
1830
PAVGB(%%mm2, %%mm1) // L5+L7
1831
PAVGB(%%mm0, %%mm1) // 2L6 + L5 + L7
1832
"movq %%mm1, (%%"REG_d") \n\t"
1833
"movq (%%"REG_d", %1, 2), %%mm1 \n\t" // L8
1834
PAVGB(%%mm1, %%mm0) // L6+L8
1835
PAVGB(%%mm2, %%mm0) // 2L7 + L6 + L8
1836
"movq %%mm0, (%%"REG_d", %1) \n\t"
1837
"movq (%0, %1, 8), %%mm0 \n\t" // L9
1838
PAVGB(%%mm0, %%mm2) // L7+L9
1839
PAVGB(%%mm1, %%mm2) // 2L8 + L7 + L9
1840
"movq %%mm2, (%%"REG_d", %1, 2) \n\t"
1841
"movq %%mm1, (%2) \n\t"
1896
1842
1897
: : "r" (src), "r" ((long)stride), "r" (tmp)
1898
: "%"REG_a, "%"REG_d
1899
);
1843
: : "r" (src), "r" ((long)stride), "r" (tmp)
1844
: "%"REG_a, "%"REG_d
1845
);
1900
1846
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1901
int a, b, c, x;
1902
src+= 4*stride;
1903
1904
for(x=0; x<2; x++){
1905
a= *(uint32_t*)&tmp[stride*0];
1906
b= *(uint32_t*)&src[stride*0];
1907
c= *(uint32_t*)&src[stride*1];
1908
a= (a&c) + (((a^c)&0xFEFEFEFEUL)>>1);
1909
*(uint32_t*)&src[stride*0]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1910
1911
a= *(uint32_t*)&src[stride*2];
1912
b= (a&b) + (((a^b)&0xFEFEFEFEUL)>>1);
1913
*(uint32_t*)&src[stride*1]= (c|b) - (((c^b)&0xFEFEFEFEUL)>>1);
1914
1915
b= *(uint32_t*)&src[stride*3];
1916
c= (b&c) + (((b^c)&0xFEFEFEFEUL)>>1);
1917
*(uint32_t*)&src[stride*2]= (c|a) - (((c^a)&0xFEFEFEFEUL)>>1);
1918
1919
c= *(uint32_t*)&src[stride*4];
1920
a= (a&c) + (((a^c)&0xFEFEFEFEUL)>>1);
1921
*(uint32_t*)&src[stride*3]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1922
1923
a= *(uint32_t*)&src[stride*5];
1924
b= (a&b) + (((a^b)&0xFEFEFEFEUL)>>1);
1925
*(uint32_t*)&src[stride*4]= (c|b) - (((c^b)&0xFEFEFEFEUL)>>1);
1926
1927
b= *(uint32_t*)&src[stride*6];
1928
c= (b&c) + (((b^c)&0xFEFEFEFEUL)>>1);
1929
*(uint32_t*)&src[stride*5]= (c|a) - (((c^a)&0xFEFEFEFEUL)>>1);
1930
1931
c= *(uint32_t*)&src[stride*7];
1932
a= (a&c) + (((a^c)&0xFEFEFEFEUL)>>1);
1933
*(uint32_t*)&src[stride*6]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1934
1935
a= *(uint32_t*)&src[stride*8];
1936
b= (a&b) + (((a^b)&0xFEFEFEFEUL)>>1);
1937
*(uint32_t*)&src[stride*7]= (c|b) - (((c^b)&0xFEFEFEFEUL)>>1);
1938
1939
*(uint32_t*)&tmp[stride*0]= c;
1940
src += 4;
1941
tmp += 4;
1942
}
1847
int a, b, c, x;
1848
src+= 4*stride;
1849
1850
for(x=0; x<2; x++){
1851
a= *(uint32_t*)&tmp[stride*0];
1852
b= *(uint32_t*)&src[stride*0];
1853
c= *(uint32_t*)&src[stride*1];
1854
a= (a&c) + (((a^c)&0xFEFEFEFEUL)>>1);
1855
*(uint32_t*)&src[stride*0]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1856
1857
a= *(uint32_t*)&src[stride*2];
1858
b= (a&b) + (((a^b)&0xFEFEFEFEUL)>>1);
1859
*(uint32_t*)&src[stride*1]= (c|b) - (((c^b)&0xFEFEFEFEUL)>>1);
1860
1861
b= *(uint32_t*)&src[stride*3];
1862
c= (b&c) + (((b^c)&0xFEFEFEFEUL)>>1);
1863
*(uint32_t*)&src[stride*2]= (c|a) - (((c^a)&0xFEFEFEFEUL)>>1);
1864
1865
c= *(uint32_t*)&src[stride*4];
1866
a= (a&c) + (((a^c)&0xFEFEFEFEUL)>>1);
1867
*(uint32_t*)&src[stride*3]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1868
1869
a= *(uint32_t*)&src[stride*5];
1870
b= (a&b) + (((a^b)&0xFEFEFEFEUL)>>1);
1871
*(uint32_t*)&src[stride*4]= (c|b) - (((c^b)&0xFEFEFEFEUL)>>1);
1872
1873
b= *(uint32_t*)&src[stride*6];
1874
c= (b&c) + (((b^c)&0xFEFEFEFEUL)>>1);
1875
*(uint32_t*)&src[stride*5]= (c|a) - (((c^a)&0xFEFEFEFEUL)>>1);
1876
1877
c= *(uint32_t*)&src[stride*7];
1878
a= (a&c) + (((a^c)&0xFEFEFEFEUL)>>1);
1879
*(uint32_t*)&src[stride*6]= (a|b) - (((a^b)&0xFEFEFEFEUL)>>1);
1880
1881
a= *(uint32_t*)&src[stride*8];
1882
b= (a&b) + (((a^b)&0xFEFEFEFEUL)>>1);
1883
*(uint32_t*)&src[stride*7]= (c|b) - (((c^b)&0xFEFEFEFEUL)>>1);
1884
1885
*(uint32_t*)&tmp[stride*0]= c;
1886
src += 4;
1887
tmp += 4;
1888
}
1943
1889
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
1944
1890
}
1945
1891
1946
1892
/**
1947
1893
* Deinterlaces the given block by applying a median filter to every second line.
1948
1894
* will be called for every 8x8 block and can read & write from line 4-15,
1949
* lines 0-3 have been passed through the deblock / dering filters allready, but can be read too
1895
* lines 0-3 have been passed through the deblock / dering filters already, but can be read, too.
1950
1896
* lines 4-12 will be read into the deblocking filter and should be deinterlaced
1951
1897
*/
1952
1898
static inline void RENAME(deInterlaceMedian)(uint8_t src[], int stride)
1953
1899
{
1954
1900
#ifdef HAVE_MMX
1955
src+= 4*stride;
1901
src+= 4*stride;
1956
1902
#ifdef HAVE_MMX2
1957
asm volatile(
1958
"lea (%0, %1), %%"REG_a" \n\t"
1959
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1903
asm volatile(
1904
"lea (%0, %1), %%"REG_a" \n\t"
1905
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1960
1906
// 0 1 2 3 4 5 6 7 8 9
1961
1907
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1
1962
1908
1963
"movq (%0), %%mm0 \n\t" //
1964
"movq (%%"REG_a", %1), %%mm2 \n\t" //
1965
"movq (%%"REG_a"), %%mm1 \n\t" //
1966
"movq %%mm0, %%mm3 \n\t"
1967
"pmaxub %%mm1, %%mm0 \n\t" //
1968
"pminub %%mm3, %%mm1 \n\t" //
1969
"pmaxub %%mm2, %%mm1 \n\t" //
1970
"pminub %%mm1, %%mm0 \n\t"
1971
"movq %%mm0, (%%"REG_a") \n\t"
1972
1973
"movq (%0, %1, 4), %%mm0 \n\t" //
1974
"movq (%%"REG_a", %1, 2), %%mm1 \n\t" //
1975
"movq %%mm2, %%mm3 \n\t"
1976
"pmaxub %%mm1, %%mm2 \n\t" //
1977
"pminub %%mm3, %%mm1 \n\t" //
1978
"pmaxub %%mm0, %%mm1 \n\t" //
1979
"pminub %%mm1, %%mm2 \n\t"
1980
"movq %%mm2, (%%"REG_a", %1, 2) \n\t"
1981
1982
"movq (%%"REG_d"), %%mm2 \n\t" //
1983
"movq (%%"REG_d", %1), %%mm1 \n\t" //
1984
"movq %%mm2, %%mm3 \n\t"
1985
"pmaxub %%mm0, %%mm2 \n\t" //
1986
"pminub %%mm3, %%mm0 \n\t" //
1987
"pmaxub %%mm1, %%mm0 \n\t" //
1988
"pminub %%mm0, %%mm2 \n\t"
1989
"movq %%mm2, (%%"REG_d") \n\t"
1990
1991
"movq (%%"REG_d", %1, 2), %%mm2 \n\t" //
1992
"movq (%0, %1, 8), %%mm0 \n\t" //
1993
"movq %%mm2, %%mm3 \n\t"
1994
"pmaxub %%mm0, %%mm2 \n\t" //
1995
"pminub %%mm3, %%mm0 \n\t" //
1996
"pmaxub %%mm1, %%mm0 \n\t" //
1997
"pminub %%mm0, %%mm2 \n\t"
1998
"movq %%mm2, (%%"REG_d", %1, 2) \n\t"
1999
2000
2001
: : "r" (src), "r" ((long)stride)
2002
: "%"REG_a, "%"REG_d
2003
);
1909
"movq (%0), %%mm0 \n\t" //
1910
"movq (%%"REG_a", %1), %%mm2 \n\t" //
1911
"movq (%%"REG_a"), %%mm1 \n\t" //
1912
"movq %%mm0, %%mm3 \n\t"
1913
"pmaxub %%mm1, %%mm0 \n\t" //
1914
"pminub %%mm3, %%mm1 \n\t" //
1915
"pmaxub %%mm2, %%mm1 \n\t" //
1916
"pminub %%mm1, %%mm0 \n\t"
1917
"movq %%mm0, (%%"REG_a") \n\t"
1918
1919
"movq (%0, %1, 4), %%mm0 \n\t" //
1920
"movq (%%"REG_a", %1, 2), %%mm1 \n\t" //
1921
"movq %%mm2, %%mm3 \n\t"
1922
"pmaxub %%mm1, %%mm2 \n\t" //
1923
"pminub %%mm3, %%mm1 \n\t" //
1924
"pmaxub %%mm0, %%mm1 \n\t" //
1925
"pminub %%mm1, %%mm2 \n\t"
1926
"movq %%mm2, (%%"REG_a", %1, 2) \n\t"
1927
1928
"movq (%%"REG_d"), %%mm2 \n\t" //
1929
"movq (%%"REG_d", %1), %%mm1 \n\t" //
1930
"movq %%mm2, %%mm3 \n\t"
1931
"pmaxub %%mm0, %%mm2 \n\t" //
1932
"pminub %%mm3, %%mm0 \n\t" //
1933
"pmaxub %%mm1, %%mm0 \n\t" //
1934
"pminub %%mm0, %%mm2 \n\t"
1935
"movq %%mm2, (%%"REG_d") \n\t"
1936
1937
"movq (%%"REG_d", %1, 2), %%mm2 \n\t" //
1938
"movq (%0, %1, 8), %%mm0 \n\t" //
1939
"movq %%mm2, %%mm3 \n\t"
1940
"pmaxub %%mm0, %%mm2 \n\t" //
1941
"pminub %%mm3, %%mm0 \n\t" //
1942
"pmaxub %%mm1, %%mm0 \n\t" //
1943
"pminub %%mm0, %%mm2 \n\t"
1944
"movq %%mm2, (%%"REG_d", %1, 2) \n\t"
1945
1946
1947
: : "r" (src), "r" ((long)stride)
1948
: "%"REG_a, "%"REG_d
1949
);
2004
1950
2005
1951
#else // MMX without MMX2
2006
asm volatile(
2007
"lea (%0, %1), %%"REG_a" \n\t"
2008
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
1952
asm volatile(
1953
"lea (%0, %1), %%"REG_a" \n\t"
1954
"lea (%%"REG_a", %1, 4), %%"REG_d" \n\t"
2009
1955
// 0 1 2 3 4 5 6 7 8 9
2010
1956
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1
2011
"pxor %%mm7, %%mm7 \n\t"
1957
"pxor %%mm7, %%mm7 \n\t"
2012
1958
2013
1959
#define REAL_MEDIAN(a,b,c)\
2014
"movq " #a ", %%mm0 \n\t"\
2015
"movq " #b ", %%mm2 \n\t"\
2016
"movq " #c ", %%mm1 \n\t"\
2017
"movq %%mm0, %%mm3 \n\t"\
2018
"movq %%mm1, %%mm4 \n\t"\
2019
"movq %%mm2, %%mm5 \n\t"\
2020
"psubusb %%mm1, %%mm3 \n\t"\
2021
"psubusb %%mm2, %%mm4 \n\t"\
2022
"psubusb %%mm0, %%mm5 \n\t"\
2023
"pcmpeqb %%mm7, %%mm3 \n\t"\
2024
"pcmpeqb %%mm7, %%mm4 \n\t"\
2025
"pcmpeqb %%mm7, %%mm5 \n\t"\
2026
"movq %%mm3, %%mm6 \n\t"\
2027
"pxor %%mm4, %%mm3 \n\t"\
2028
"pxor %%mm5, %%mm4 \n\t"\
2029
"pxor %%mm6, %%mm5 \n\t"\
2030
"por %%mm3, %%mm1 \n\t"\
2031
"por %%mm4, %%mm2 \n\t"\
2032
"por %%mm5, %%mm0 \n\t"\
2033
"pand %%mm2, %%mm0 \n\t"\
2034
"pand %%mm1, %%mm0 \n\t"\
2035
"movq %%mm0, " #b " \n\t"
1960
"movq " #a ", %%mm0 \n\t"\
1961
"movq " #b ", %%mm2 \n\t"\
1962
"movq " #c ", %%mm1 \n\t"\
1963
"movq %%mm0, %%mm3 \n\t"\
1964
"movq %%mm1, %%mm4 \n\t"\
1965
"movq %%mm2, %%mm5 \n\t"\
1966
"psubusb %%mm1, %%mm3 \n\t"\
1967
"psubusb %%mm2, %%mm4 \n\t"\
1968
"psubusb %%mm0, %%mm5 \n\t"\
1969
"pcmpeqb %%mm7, %%mm3 \n\t"\
1970
"pcmpeqb %%mm7, %%mm4 \n\t"\
1971
"pcmpeqb %%mm7, %%mm5 \n\t"\
1972
"movq %%mm3, %%mm6 \n\t"\
1973
"pxor %%mm4, %%mm3 \n\t"\
1974
"pxor %%mm5, %%mm4 \n\t"\
1975
"pxor %%mm6, %%mm5 \n\t"\
1976
"por %%mm3, %%mm1 \n\t"\
1977
"por %%mm4, %%mm2 \n\t"\
1978
"por %%mm5, %%mm0 \n\t"\
1979
"pand %%mm2, %%mm0 \n\t"\
1980
"pand %%mm1, %%mm0 \n\t"\
1981
"movq %%mm0, " #b " \n\t"
2036
1982
#define MEDIAN(a,b,c) REAL_MEDIAN(a,b,c)
2037
1983
2038
1984
MEDIAN((%0) , (%%REGa) , (%%REGa, %1))
2040
1986
MEDIAN((%0, %1, 4) , (%%REGd) , (%%REGd, %1))
2041
1987
MEDIAN((%%REGd, %1), (%%REGd, %1, 2), (%0, %1, 8))
2042
1988
2043
: : "r" (src), "r" ((long)stride)
2044
: "%"REG_a, "%"REG_d
2045
);
1989
: : "r" (src), "r" ((long)stride)
1990
: "%"REG_a, "%"REG_d
1991
);
2046
1992
#endif //HAVE_MMX2
2047
1993
#else //HAVE_MMX
2048
int x, y;
2049
src+= 4*stride;
2050
// FIXME - there should be a way to do a few columns in parallel like w/mmx
2051
for(x=0; x<8; x++)
2052
{
2053
uint8_t *colsrc = src;
2054
for (y=0; y<4; y++)
2055
{
2056
int a, b, c, d, e, f;
2057
a = colsrc[0 ];
2058
b = colsrc[stride ];
2059
c = colsrc[stride*2];
2060
d = (a-b)>>31;
2061
e = (b-c)>>31;
2062
f = (c-a)>>31;
2063
colsrc[stride ] = (a|(d^f)) & (b|(d^e)) & (c|(e^f));
2064
colsrc += stride*2;
2065
}
2066
src++;
1994
int x, y;
1995
src+= 4*stride;
1996
// FIXME - there should be a way to do a few columns in parallel like w/mmx
1997
for(x=0; x<8; x++){
1998
uint8_t *colsrc = src;
1999
for (y=0; y<4; y++){
2000
int a, b, c, d, e, f;
2001
a = colsrc[0 ];
2002
b = colsrc[stride ];
2003
c = colsrc[stride*2];
2004
d = (a-b)>>31;
2005
e = (b-c)>>31;
2006
f = (c-a)>>31;
2007
colsrc[stride ] = (a|(d^f)) & (b|(d^e)) & (c|(e^f));
2008
colsrc += stride*2;
2067
2009
}
2010
src++;
2011
}
2068
2012
#endif //HAVE_MMX
2069
2013
}
2070
2014
2074
2018
*/
2075
2019
static inline void RENAME(transpose1)(uint8_t *dst1, uint8_t *dst2, uint8_t *src, int srcStride)
2076
2020
{
2077
asm(
2078
"lea (%0, %1), %%"REG_a" \n\t"
2021
asm(
2022
"lea (%0, %1), %%"REG_a" \n\t"
2079
2023
// 0 1 2 3 4 5 6 7 8 9
2080
2024
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1
2081
"movq (%0), %%mm0 \n\t" // 12345678
2082
"movq (%%"REG_a"), %%mm1 \n\t" // abcdefgh
2083
"movq %%mm0, %%mm2 \n\t" // 12345678
2084
"punpcklbw %%mm1, %%mm0 \n\t" // 1a2b3c4d
2085
"punpckhbw %%mm1, %%mm2 \n\t" // 5e6f7g8h
2086
2087
"movq (%%"REG_a", %1), %%mm1 \n\t"
2088
"movq (%%"REG_a", %1, 2), %%mm3 \n\t"
2089
"movq %%mm1, %%mm4 \n\t"
2090
"punpcklbw %%mm3, %%mm1 \n\t"
2091
"punpckhbw %%mm3, %%mm4 \n\t"
2092
2093
"movq %%mm0, %%mm3 \n\t"
2094
"punpcklwd %%mm1, %%mm0 \n\t"
2095
"punpckhwd %%mm1, %%mm3 \n\t"
2096
"movq %%mm2, %%mm1 \n\t"
2097
"punpcklwd %%mm4, %%mm2 \n\t"
2098
"punpckhwd %%mm4, %%mm1 \n\t"
2099
2100
"movd %%mm0, 128(%2) \n\t"
2101
"psrlq $32, %%mm0 \n\t"
2102
"movd %%mm0, 144(%2) \n\t"
2103
"movd %%mm3, 160(%2) \n\t"
2104
"psrlq $32, %%mm3 \n\t"
2105
"movd %%mm3, 176(%2) \n\t"
2106
"movd %%mm3, 48(%3) \n\t"
2107
"movd %%mm2, 192(%2) \n\t"
2108
"movd %%mm2, 64(%3) \n\t"
2109
"psrlq $32, %%mm2 \n\t"
2110
"movd %%mm2, 80(%3) \n\t"
2111
"movd %%mm1, 96(%3) \n\t"
2112
"psrlq $32, %%mm1 \n\t"
2113
"movd %%mm1, 112(%3) \n\t"
2114
2115
"lea (%%"REG_a", %1, 4), %%"REG_a" \n\t"
2116
2117
"movq (%0, %1, 4), %%mm0 \n\t" // 12345678
2118
"movq (%%"REG_a"), %%mm1 \n\t" // abcdefgh
2119
"movq %%mm0, %%mm2 \n\t" // 12345678
2120
"punpcklbw %%mm1, %%mm0 \n\t" // 1a2b3c4d
2121
"punpckhbw %%mm1, %%mm2 \n\t" // 5e6f7g8h
2122
2123
"movq (%%"REG_a", %1), %%mm1 \n\t"
2124
"movq (%%"REG_a", %1, 2), %%mm3 \n\t"
2125
"movq %%mm1, %%mm4 \n\t"
2126
"punpcklbw %%mm3, %%mm1 \n\t"
2127
"punpckhbw %%mm3, %%mm4 \n\t"
2128
2129
"movq %%mm0, %%mm3 \n\t"
2130
"punpcklwd %%mm1, %%mm0 \n\t"
2131
"punpckhwd %%mm1, %%mm3 \n\t"
2132
"movq %%mm2, %%mm1 \n\t"
2133
"punpcklwd %%mm4, %%mm2 \n\t"
2134
"punpckhwd %%mm4, %%mm1 \n\t"
2135
2136
"movd %%mm0, 132(%2) \n\t"
2137
"psrlq $32, %%mm0 \n\t"
2138
"movd %%mm0, 148(%2) \n\t"
2139
"movd %%mm3, 164(%2) \n\t"
2140
"psrlq $32, %%mm3 \n\t"
2141
"movd %%mm3, 180(%2) \n\t"
2142
"movd %%mm3, 52(%3) \n\t"
2143
"movd %%mm2, 196(%2) \n\t"
2144
"movd %%mm2, 68(%3) \n\t"
2145
"psrlq $32, %%mm2 \n\t"
2146
"movd %%mm2, 84(%3) \n\t"
2147
"movd %%mm1, 100(%3) \n\t"
2148
"psrlq $32, %%mm1 \n\t"
2149
"movd %%mm1, 116(%3) \n\t"
2025
"movq (%0), %%mm0 \n\t" // 12345678
2026
"movq (%%"REG_a"), %%mm1 \n\t" // abcdefgh
2027
"movq %%mm0, %%mm2 \n\t" // 12345678
2028
"punpcklbw %%mm1, %%mm0 \n\t" // 1a2b3c4d
2029
"punpckhbw %%mm1, %%mm2 \n\t" // 5e6f7g8h
2030
2031
"movq (%%"REG_a", %1), %%mm1 \n\t"
2032
"movq (%%"REG_a", %1, 2), %%mm3 \n\t"
2033
"movq %%mm1, %%mm4 \n\t"
2034
"punpcklbw %%mm3, %%mm1 \n\t"
2035
"punpckhbw %%mm3, %%mm4 \n\t"
2036
2037
"movq %%mm0, %%mm3 \n\t"
2038
"punpcklwd %%mm1, %%mm0 \n\t"
2039
"punpckhwd %%mm1, %%mm3 \n\t"
2040
"movq %%mm2, %%mm1 \n\t"
2041
"punpcklwd %%mm4, %%mm2 \n\t"
2042
"punpckhwd %%mm4, %%mm1 \n\t"
2043
2044
"movd %%mm0, 128(%2) \n\t"
2045
"psrlq $32, %%mm0 \n\t"
2046
"movd %%mm0, 144(%2) \n\t"
2047
"movd %%mm3, 160(%2) \n\t"
2048
"psrlq $32, %%mm3 \n\t"
2049
"movd %%mm3, 176(%2) \n\t"
2050
"movd %%mm3, 48(%3) \n\t"
2051
"movd %%mm2, 192(%2) \n\t"
2052
"movd %%mm2, 64(%3) \n\t"
2053
"psrlq $32, %%mm2 \n\t"
2054
"movd %%mm2, 80(%3) \n\t"
2055
"movd %%mm1, 96(%3) \n\t"
2056
"psrlq $32, %%mm1 \n\t"
2057
"movd %%mm1, 112(%3) \n\t"
2058
2059
"lea (%%"REG_a", %1, 4), %%"REG_a" \n\t"
2060
2061
"movq (%0, %1, 4), %%mm0 \n\t" // 12345678
2062
"movq (%%"REG_a"), %%mm1 \n\t" // abcdefgh
2063
"movq %%mm0, %%mm2 \n\t" // 12345678
2064
"punpcklbw %%mm1, %%mm0 \n\t" // 1a2b3c4d
2065
"punpckhbw %%mm1, %%mm2 \n\t" // 5e6f7g8h
2066
2067
"movq (%%"REG_a", %1), %%mm1 \n\t"
2068
"movq (%%"REG_a", %1, 2), %%mm3 \n\t"
2069
"movq %%mm1, %%mm4 \n\t"
2070
"punpcklbw %%mm3, %%mm1 \n\t"
2071
"punpckhbw %%mm3, %%mm4 \n\t"
2072
2073
"movq %%mm0, %%mm3 \n\t"
2074
"punpcklwd %%mm1, %%mm0 \n\t"
2075
"punpckhwd %%mm1, %%mm3 \n\t"
2076
"movq %%mm2, %%mm1 \n\t"
2077
"punpcklwd %%mm4, %%mm2 \n\t"
2078
"punpckhwd %%mm4, %%mm1 \n\t"
2079
2080
"movd %%mm0, 132(%2) \n\t"
2081
"psrlq $32, %%mm0 \n\t"
2082
"movd %%mm0, 148(%2) \n\t"
2083
"movd %%mm3, 164(%2) \n\t"
2084
"psrlq $32, %%mm3 \n\t"
2085
"movd %%mm3, 180(%2) \n\t"
2086
"movd %%mm3, 52(%3) \n\t"
2087
"movd %%mm2, 196(%2) \n\t"
2088
"movd %%mm2, 68(%3) \n\t"
2089
"psrlq $32, %%mm2 \n\t"
2090
"movd %%mm2, 84(%3) \n\t"
2091
"movd %%mm1, 100(%3) \n\t"
2092
"psrlq $32, %%mm1 \n\t"
2093
"movd %%mm1, 116(%3) \n\t"
2150
2094
2151
2095
2152
2096
:: "r" (src), "r" ((long)srcStride), "r" (dst1), "r" (dst2)
2153
2097
: "%"REG_a
2154
);
2098
);
2155
2099
}
2156
2100
2157
2101
/**
2159
2103
*/
2160
2104
static inline void RENAME(transpose2)(uint8_t *dst, int dstStride, uint8_t *src)
2161
2105
{
2162
asm(
2163
"lea (%0, %1), %%"REG_a" \n\t"
2164
"lea (%%"REG_a",%1,4), %%"REG_d" \n\t"
2106
asm(
2107
"lea (%0, %1), %%"REG_a" \n\t"
2108
"lea (%%"REG_a",%1,4), %%"REG_d" \n\t"
2165
2109
// 0 1 2 3 4 5 6 7 8 9
2166
2110
// %0 eax eax+%1 eax+2%1 %0+4%1 edx edx+%1 edx+2%1 %0+8%1 edx+4%1
2167
"movq (%2), %%mm0 \n\t" // 12345678
2168
"movq 16(%2), %%mm1 \n\t" // abcdefgh
2169
"movq %%mm0, %%mm2 \n\t" // 12345678
2170
"punpcklbw %%mm1, %%mm0 \n\t" // 1a2b3c4d
2171
"punpckhbw %%mm1, %%mm2 \n\t" // 5e6f7g8h
2172
2173
"movq 32(%2), %%mm1 \n\t"
2174
"movq 48(%2), %%mm3 \n\t"
2175
"movq %%mm1, %%mm4 \n\t"
2176
"punpcklbw %%mm3, %%mm1 \n\t"
2177
"punpckhbw %%mm3, %%mm4 \n\t"
2178
2179
"movq %%mm0, %%mm3 \n\t"
2180
"punpcklwd %%mm1, %%mm0 \n\t"
2181
"punpckhwd %%mm1, %%mm3 \n\t"
2182
"movq %%mm2, %%mm1 \n\t"
2183
"punpcklwd %%mm4, %%mm2 \n\t"
2184
"punpckhwd %%mm4, %%mm1 \n\t"
2185
2186
"movd %%mm0, (%0) \n\t"
2187
"psrlq $32, %%mm0 \n\t"
2188
"movd %%mm0, (%%"REG_a") \n\t"
2189
"movd %%mm3, (%%"REG_a", %1) \n\t"
2190
"psrlq $32, %%mm3 \n\t"
2191
"movd %%mm3, (%%"REG_a", %1, 2) \n\t"
2192
"movd %%mm2, (%0, %1, 4) \n\t"
2193
"psrlq $32, %%mm2 \n\t"
2194
"movd %%mm2, (%%"REG_d") \n\t"
2195
"movd %%mm1, (%%"REG_d", %1) \n\t"
2196
"psrlq $32, %%mm1 \n\t"
2197
"movd %%mm1, (%%"REG_d", %1, 2) \n\t"
2198
2199
2200
"movq 64(%2), %%mm0 \n\t" // 12345678
2201
"movq 80(%2), %%mm1 \n\t" // abcdefgh
2202
"movq %%mm0, %%mm2 \n\t" // 12345678
2203
"punpcklbw %%mm1, %%mm0 \n\t" // 1a2b3c4d
2204
"punpckhbw %%mm1, %%mm2 \n\t" // 5e6f7g8h
2205
2206
"movq 96(%2), %%mm1 \n\t"
2207
"movq 112(%2), %%mm3 \n\t"
2208
"movq %%mm1, %%mm4 \n\t"
2209
"punpcklbw %%mm3, %%mm1 \n\t"
2210
"punpckhbw %%mm3, %%mm4 \n\t"
2211
2212
"movq %%mm0, %%mm3 \n\t"
2213
"punpcklwd %%mm1, %%mm0 \n\t"
2214
"punpckhwd %%mm1, %%mm3 \n\t"
2215
"movq %%mm2, %%mm1 \n\t"
2216
"punpcklwd %%mm4, %%mm2 \n\t"
2217
"punpckhwd %%mm4, %%mm1 \n\t"
2218
2219
"movd %%mm0, 4(%0) \n\t"
2220
"psrlq $32, %%mm0 \n\t"
2221
"movd %%mm0, 4(%%"REG_a") \n\t"
2222
"movd %%mm3, 4(%%"REG_a", %1) \n\t"
2223
"psrlq $32, %%mm3 \n\t"
2224
"movd %%mm3, 4(%%"REG_a", %1, 2) \n\t"
2225
"movd %%mm2, 4(%0, %1, 4) \n\t"
2226
"psrlq $32, %%mm2 \n\t"
2227
"movd %%mm2, 4(%%"REG_d") \n\t"
2228
"movd %%mm1, 4(%%"REG_d", %1) \n\t"
2229
"psrlq $32, %%mm1 \n\t"
2230
"movd %%mm1, 4(%%"REG_d", %1, 2) \n\t"
2111
"movq (%2), %%mm0 \n\t" // 12345678
2112
"movq 16(%2), %%mm1 \n\t" // abcdefgh
2113
"movq %%mm0, %%mm2 \n\t" // 12345678
2114
"punpcklbw %%mm1, %%mm0 \n\t" // 1a2b3c4d
2115
"punpckhbw %%mm1, %%mm2 \n\t" // 5e6f7g8h
2116
2117
"movq 32(%2), %%mm1 \n\t"
2118
"movq 48(%2), %%mm3 \n\t"
2119
"movq %%mm1, %%mm4 \n\t"
2120
"punpcklbw %%mm3, %%mm1 \n\t"
2121
"punpckhbw %%mm3, %%mm4 \n\t"
2122
2123
"movq %%mm0, %%mm3 \n\t"
2124
"punpcklwd %%mm1, %%mm0 \n\t"
2125
"punpckhwd %%mm1, %%mm3 \n\t"
2126
"movq %%mm2, %%mm1 \n\t"
2127
"punpcklwd %%mm4, %%mm2 \n\t"
2128
"punpckhwd %%mm4, %%mm1 \n\t"
2129
2130
"movd %%mm0, (%0) \n\t"
2131
"psrlq $32, %%mm0 \n\t"
2132
"movd %%mm0, (%%"REG_a") \n\t"
2133
"movd %%mm3, (%%"REG_a", %1) \n\t"
2134
"psrlq $32, %%mm3 \n\t"
2135
"movd %%mm3, (%%"REG_a", %1, 2) \n\t"
2136
"movd %%mm2, (%0, %1, 4) \n\t"
2137
"psrlq $32, %%mm2 \n\t"
2138
"movd %%mm2, (%%"REG_d") \n\t"
2139
"movd %%mm1, (%%"REG_d", %1) \n\t"
2140
"psrlq $32, %%mm1 \n\t"
2141
"movd %%mm1, (%%"REG_d", %1, 2) \n\t"
2142
2143
2144
"movq 64(%2), %%mm0 \n\t" // 12345678
2145
"movq 80(%2), %%mm1 \n\t" // abcdefgh
2146
"movq %%mm0, %%mm2 \n\t" // 12345678
2147
"punpcklbw %%mm1, %%mm0 \n\t" // 1a2b3c4d
2148
"punpckhbw %%mm1, %%mm2 \n\t" // 5e6f7g8h
2149
2150
"movq 96(%2), %%mm1 \n\t"
2151
"movq 112(%2), %%mm3 \n\t"
2152
"movq %%mm1, %%mm4 \n\t"
2153
"punpcklbw %%mm3, %%mm1 \n\t"
2154
"punpckhbw %%mm3, %%mm4 \n\t"
2155
2156
"movq %%mm0, %%mm3 \n\t"
2157
"punpcklwd %%mm1, %%mm0 \n\t"
2158
"punpckhwd %%mm1, %%mm3 \n\t"
2159
"movq %%mm2, %%mm1 \n\t"
2160
"punpcklwd %%mm4, %%mm2 \n\t"
2161
"punpckhwd %%mm4, %%mm1 \n\t"
2162
2163
"movd %%mm0, 4(%0) \n\t"
2164
"psrlq $32, %%mm0 \n\t"
2165
"movd %%mm0, 4(%%"REG_a") \n\t"
2166
"movd %%mm3, 4(%%"REG_a", %1) \n\t"
2167
"psrlq $32, %%mm3 \n\t"
2168
"movd %%mm3, 4(%%"REG_a", %1, 2) \n\t"
2169
"movd %%mm2, 4(%0, %1, 4) \n\t"
2170
"psrlq $32, %%mm2 \n\t"
2171
"movd %%mm2, 4(%%"REG_d") \n\t"
2172
"movd %%mm1, 4(%%"REG_d", %1) \n\t"
2173
"psrlq $32, %%mm1 \n\t"
2174
"movd %%mm1, 4(%%"REG_d", %1, 2) \n\t"
2231
2175
2232
2176
:: "r" (dst), "r" ((long)dstStride), "r" (src)
2233
2177
: "%"REG_a, "%"REG_d
2234
);
2178
);
2235
2179
}
2236
2180
#endif //HAVE_MMX
2237
2181
//static long test=0;
2238
2182
2239
2183
#ifndef HAVE_ALTIVEC
2240
2184
static inline void RENAME(tempNoiseReducer)(uint8_t *src, int stride,
2241
uint8_t *tempBlured, uint32_t *tempBluredPast, int *maxNoise)
2185
uint8_t *tempBlurred, uint32_t *tempBlurredPast, int *maxNoise)
2242
2186
{
2243
// to save a register (FIXME do this outside of the loops)
2244
tempBluredPast[127]= maxNoise[0];
2245
tempBluredPast[128]= maxNoise[1];
2246
tempBluredPast[129]= maxNoise[2];
2187
// to save a register (FIXME do this outside of the loops)
2188
tempBlurredPast[127]= maxNoise[0];
2189
tempBlurredPast[128]= maxNoise[1];
2190
tempBlurredPast[129]= maxNoise[2];
2247
2191
2248
2192
#define FAST_L2_DIFF
2249
2193
//#define L1_DIFF //u should change the thresholds too if u try that one
2250
2194
#if defined (HAVE_MMX2) || defined (HAVE_3DNOW)
2251
asm volatile(
2252
"lea (%2, %2, 2), %%"REG_a" \n\t" // 3*stride
2253
"lea (%2, %2, 4), %%"REG_d" \n\t" // 5*stride
2254
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2195
asm volatile(
2196
"lea (%2, %2, 2), %%"REG_a" \n\t" // 3*stride
2197
"lea (%2, %2, 4), %%"REG_d" \n\t" // 5*stride
2198
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2255
2199
// 0 1 2 3 4 5 6 7 8 9
2256
2200
// %x %x+%2 %x+2%2 %x+eax %x+4%2 %x+edx %x+2eax %x+ecx %x+8%2
2257
2201
//FIXME reorder?
2258
2202
#ifdef L1_DIFF //needs mmx2
2259
"movq (%0), %%mm0 \n\t" // L0
2260
"psadbw (%1), %%mm0 \n\t" // |L0-R0|
2261
"movq (%0, %2), %%mm1 \n\t" // L1
2262
"psadbw (%1, %2), %%mm1 \n\t" // |L1-R1|
2263
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2264
"psadbw (%1, %2, 2), %%mm2 \n\t" // |L2-R2|
2265
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2266
"psadbw (%1, %%"REG_a"), %%mm3 \n\t" // |L3-R3|
2203
"movq (%0), %%mm0 \n\t" // L0
2204
"psadbw (%1), %%mm0 \n\t" // |L0-R0|
2205
"movq (%0, %2), %%mm1 \n\t" // L1
2206
"psadbw (%1, %2), %%mm1 \n\t" // |L1-R1|
2207
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2208
"psadbw (%1, %2, 2), %%mm2 \n\t" // |L2-R2|
2209
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2210
"psadbw (%1, %%"REG_a"), %%mm3 \n\t" // |L3-R3|
2267
2211
2268
"movq (%0, %2, 4), %%mm4 \n\t" // L4
2269
"paddw %%mm1, %%mm0 \n\t"
2270
"psadbw (%1, %2, 4), %%mm4 \n\t" // |L4-R4|
2271
"movq (%0, %%"REG_d"), %%mm5 \n\t" // L5
2272
"paddw %%mm2, %%mm0 \n\t"
2273
"psadbw (%1, %%"REG_d"), %%mm5 \n\t" // |L5-R5|
2274
"movq (%0, %%"REG_a", 2), %%mm6 \n\t" // L6
2275
"paddw %%mm3, %%mm0 \n\t"
2276
"psadbw (%1, %%"REG_a", 2), %%mm6 \n\t" // |L6-R6|
2277
"movq (%0, %%"REG_c"), %%mm7 \n\t" // L7
2278
"paddw %%mm4, %%mm0 \n\t"
2279
"psadbw (%1, %%"REG_c"), %%mm7 \n\t" // |L7-R7|
2280
"paddw %%mm5, %%mm6 \n\t"
2281
"paddw %%mm7, %%mm6 \n\t"
2282
"paddw %%mm6, %%mm0 \n\t"
2212
"movq (%0, %2, 4), %%mm4 \n\t" // L4
2213
"paddw %%mm1, %%mm0 \n\t"
2214
"psadbw (%1, %2, 4), %%mm4 \n\t" // |L4-R4|
2215
"movq (%0, %%"REG_d"), %%mm5 \n\t" // L5
2216
"paddw %%mm2, %%mm0 \n\t"
2217
"psadbw (%1, %%"REG_d"), %%mm5 \n\t" // |L5-R5|
2218
"movq (%0, %%"REG_a", 2), %%mm6 \n\t" // L6
2219
"paddw %%mm3, %%mm0 \n\t"
2220
"psadbw (%1, %%"REG_a", 2), %%mm6 \n\t" // |L6-R6|
2221
"movq (%0, %%"REG_c"), %%mm7 \n\t" // L7
2222
"paddw %%mm4, %%mm0 \n\t"
2223
"psadbw (%1, %%"REG_c"), %%mm7 \n\t" // |L7-R7|
2224
"paddw %%mm5, %%mm6 \n\t"
2225
"paddw %%mm7, %%mm6 \n\t"
2226
"paddw %%mm6, %%mm0 \n\t"
2283
2227
#else //L1_DIFF
2284
2228
#if defined (FAST_L2_DIFF)
2285
"pcmpeqb %%mm7, %%mm7 \n\t"
2286
"movq "MANGLE(b80)", %%mm6 \n\t"
2287
"pxor %%mm0, %%mm0 \n\t"
2229
"pcmpeqb %%mm7, %%mm7 \n\t"
2230
"movq "MANGLE(b80)", %%mm6 \n\t"
2231
"pxor %%mm0, %%mm0 \n\t"
2288
2232
#define REAL_L2_DIFF_CORE(a, b)\
2289
"movq " #a ", %%mm5 \n\t"\
2290
"movq " #b ", %%mm2 \n\t"\
2291
"pxor %%mm7, %%mm2 \n\t"\
2292
PAVGB(%%mm2, %%mm5)\
2293
"paddb %%mm6, %%mm5 \n\t"\
2294
"movq %%mm5, %%mm2 \n\t"\
2295
"psllw $8, %%mm5 \n\t"\
2296
"pmaddwd %%mm5, %%mm5 \n\t"\
2297
"pmaddwd %%mm2, %%mm2 \n\t"\
2298
"paddd %%mm2, %%mm5 \n\t"\
2299
"psrld $14, %%mm5 \n\t"\
2300
"paddd %%mm5, %%mm0 \n\t"
2233
"movq " #a ", %%mm5 \n\t"\
2234
"movq " #b ", %%mm2 \n\t"\
2235
"pxor %%mm7, %%mm2 \n\t"\
2236
PAVGB(%%mm2, %%mm5)\
2237
"paddb %%mm6, %%mm5 \n\t"\
2238
"movq %%mm5, %%mm2 \n\t"\
2239
"psllw $8, %%mm5 \n\t"\
2240
"pmaddwd %%mm5, %%mm5 \n\t"\
2241
"pmaddwd %%mm2, %%mm2 \n\t"\
2242
"paddd %%mm2, %%mm5 \n\t"\
2243
"psrld $14, %%mm5 \n\t"\
2244
"paddd %%mm5, %%mm0 \n\t"
2301
2245
2302
2246
#else //defined (FAST_L2_DIFF)
2303
"pxor %%mm7, %%mm7 \n\t"
2304
"pxor %%mm0, %%mm0 \n\t"
2247
"pxor %%mm7, %%mm7 \n\t"
2248
"pxor %%mm0, %%mm0 \n\t"
2305
2249
#define REAL_L2_DIFF_CORE(a, b)\
2306
"movq " #a ", %%mm5 \n\t"\
2307
"movq " #b ", %%mm2 \n\t"\
2308
"movq %%mm5, %%mm1 \n\t"\
2309
"movq %%mm2, %%mm3 \n\t"\
2310
"punpcklbw %%mm7, %%mm5 \n\t"\
2311
"punpckhbw %%mm7, %%mm1 \n\t"\
2312
"punpcklbw %%mm7, %%mm2 \n\t"\
2313
"punpckhbw %%mm7, %%mm3 \n\t"\
2314
"psubw %%mm2, %%mm5 \n\t"\
2315
"psubw %%mm3, %%mm1 \n\t"\
2316
"pmaddwd %%mm5, %%mm5 \n\t"\
2317
"pmaddwd %%mm1, %%mm1 \n\t"\
2318
"paddd %%mm1, %%mm5 \n\t"\
2319
"paddd %%mm5, %%mm0 \n\t"
2250
"movq " #a ", %%mm5 \n\t"\
2251
"movq " #b ", %%mm2 \n\t"\
2252
"movq %%mm5, %%mm1 \n\t"\
2253
"movq %%mm2, %%mm3 \n\t"\
2254
"punpcklbw %%mm7, %%mm5 \n\t"\
2255
"punpckhbw %%mm7, %%mm1 \n\t"\
2256
"punpcklbw %%mm7, %%mm2 \n\t"\
2257
"punpckhbw %%mm7, %%mm3 \n\t"\
2258
"psubw %%mm2, %%mm5 \n\t"\
2259
"psubw %%mm3, %%mm1 \n\t"\
2260
"pmaddwd %%mm5, %%mm5 \n\t"\
2261
"pmaddwd %%mm1, %%mm1 \n\t"\
2262
"paddd %%mm1, %%mm5 \n\t"\
2263
"paddd %%mm5, %%mm0 \n\t"
2320
2264
2321
2265
#endif //defined (FAST_L2_DIFF)
2322
2266
2333
2277
2334
2278
#endif //L1_DIFF
2335
2279
2336
"movq %%mm0, %%mm4 \n\t"
2337
"psrlq $32, %%mm0 \n\t"
2338
"paddd %%mm0, %%mm4 \n\t"
2339
"movd %%mm4, %%ecx \n\t"
2340
"shll $2, %%ecx \n\t"
2341
"mov %3, %%"REG_d" \n\t"
2342
"addl -4(%%"REG_d"), %%ecx \n\t"
2343
"addl 4(%%"REG_d"), %%ecx \n\t"
2344
"addl -1024(%%"REG_d"), %%ecx \n\t"
2345
"addl $4, %%ecx \n\t"
2346
"addl 1024(%%"REG_d"), %%ecx \n\t"
2347
"shrl $3, %%ecx \n\t"
2348
"movl %%ecx, (%%"REG_d") \n\t"
2349
2350
// "mov %3, %%"REG_c" \n\t"
2351
// "mov %%"REG_c", test \n\t"
2352
// "jmp 4f \n\t"
2353
"cmpl 512(%%"REG_d"), %%ecx \n\t"
2354
" jb 2f \n\t"
2355
"cmpl 516(%%"REG_d"), %%ecx \n\t"
2356
" jb 1f \n\t"
2357
2358
"lea (%%"REG_a", %2, 2), %%"REG_d" \n\t" // 5*stride
2359
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2360
"movq (%0), %%mm0 \n\t" // L0
2361
"movq (%0, %2), %%mm1 \n\t" // L1
2362
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2363
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2364
"movq (%0, %2, 4), %%mm4 \n\t" // L4
2365
"movq (%0, %%"REG_d"), %%mm5 \n\t" // L5
2366
"movq (%0, %%"REG_a", 2), %%mm6 \n\t" // L6
2367
"movq (%0, %%"REG_c"), %%mm7 \n\t" // L7
2368
"movq %%mm0, (%1) \n\t" // L0
2369
"movq %%mm1, (%1, %2) \n\t" // L1
2370
"movq %%mm2, (%1, %2, 2) \n\t" // L2
2371
"movq %%mm3, (%1, %%"REG_a") \n\t" // L3
2372
"movq %%mm4, (%1, %2, 4) \n\t" // L4
2373
"movq %%mm5, (%1, %%"REG_d") \n\t" // L5
2374
"movq %%mm6, (%1, %%"REG_a", 2) \n\t" // L6
2375
"movq %%mm7, (%1, %%"REG_c") \n\t" // L7
2376
"jmp 4f \n\t"
2377
2378
"1: \n\t"
2379
"lea (%%"REG_a", %2, 2), %%"REG_d" \n\t" // 5*stride
2380
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2381
"movq (%0), %%mm0 \n\t" // L0
2382
PAVGB((%1), %%mm0) // L0
2383
"movq (%0, %2), %%mm1 \n\t" // L1
2384
PAVGB((%1, %2), %%mm1) // L1
2385
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2386
PAVGB((%1, %2, 2), %%mm2) // L2
2387
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2388
PAVGB((%1, %%REGa), %%mm3) // L3
2389
"movq (%0, %2, 4), %%mm4 \n\t" // L4
2390
PAVGB((%1, %2, 4), %%mm4) // L4
2391
"movq (%0, %%"REG_d"), %%mm5 \n\t" // L5
2392
PAVGB((%1, %%REGd), %%mm5) // L5
2393
"movq (%0, %%"REG_a", 2), %%mm6 \n\t" // L6
2394
PAVGB((%1, %%REGa, 2), %%mm6) // L6
2395
"movq (%0, %%"REG_c"), %%mm7 \n\t" // L7
2396
PAVGB((%1, %%REGc), %%mm7) // L7
2397
"movq %%mm0, (%1) \n\t" // R0
2398
"movq %%mm1, (%1, %2) \n\t" // R1
2399
"movq %%mm2, (%1, %2, 2) \n\t" // R2
2400
"movq %%mm3, (%1, %%"REG_a") \n\t" // R3
2401
"movq %%mm4, (%1, %2, 4) \n\t" // R4
2402
"movq %%mm5, (%1, %%"REG_d") \n\t" // R5
2403
"movq %%mm6, (%1, %%"REG_a", 2) \n\t" // R6
2404
"movq %%mm7, (%1, %%"REG_c") \n\t" // R7
2405
"movq %%mm0, (%0) \n\t" // L0
2406
"movq %%mm1, (%0, %2) \n\t" // L1
2407
"movq %%mm2, (%0, %2, 2) \n\t" // L2
2408
"movq %%mm3, (%0, %%"REG_a") \n\t" // L3
2409
"movq %%mm4, (%0, %2, 4) \n\t" // L4
2410
"movq %%mm5, (%0, %%"REG_d") \n\t" // L5
2411
"movq %%mm6, (%0, %%"REG_a", 2) \n\t" // L6
2412
"movq %%mm7, (%0, %%"REG_c") \n\t" // L7
2413
"jmp 4f \n\t"
2414
2415
"2: \n\t"
2416
"cmpl 508(%%"REG_d"), %%ecx \n\t"
2417
" jb 3f \n\t"
2418
2419
"lea (%%"REG_a", %2, 2), %%"REG_d" \n\t" // 5*stride
2420
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2421
"movq (%0), %%mm0 \n\t" // L0
2422
"movq (%0, %2), %%mm1 \n\t" // L1
2423
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2424
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2425
"movq (%1), %%mm4 \n\t" // R0
2426
"movq (%1, %2), %%mm5 \n\t" // R1
2427
"movq (%1, %2, 2), %%mm6 \n\t" // R2
2428
"movq (%1, %%"REG_a"), %%mm7 \n\t" // R3
2429
PAVGB(%%mm4, %%mm0)
2430
PAVGB(%%mm5, %%mm1)
2431
PAVGB(%%mm6, %%mm2)
2432
PAVGB(%%mm7, %%mm3)
2433
PAVGB(%%mm4, %%mm0)
2434
PAVGB(%%mm5, %%mm1)
2435
PAVGB(%%mm6, %%mm2)
2436
PAVGB(%%mm7, %%mm3)
2437
"movq %%mm0, (%1) \n\t" // R0
2438
"movq %%mm1, (%1, %2) \n\t" // R1
2439
"movq %%mm2, (%1, %2, 2) \n\t" // R2
2440
"movq %%mm3, (%1, %%"REG_a") \n\t" // R3
2441
"movq %%mm0, (%0) \n\t" // L0
2442
"movq %%mm1, (%0, %2) \n\t" // L1
2443
"movq %%mm2, (%0, %2, 2) \n\t" // L2
2444
"movq %%mm3, (%0, %%"REG_a") \n\t" // L3
2445
2446
"movq (%0, %2, 4), %%mm0 \n\t" // L4
2447
"movq (%0, %%"REG_d"), %%mm1 \n\t" // L5
2448
"movq (%0, %%"REG_a", 2), %%mm2 \n\t" // L6
2449
"movq (%0, %%"REG_c"), %%mm3 \n\t" // L7
2450
"movq (%1, %2, 4), %%mm4 \n\t" // R4
2451
"movq (%1, %%"REG_d"), %%mm5 \n\t" // R5
2452
"movq (%1, %%"REG_a", 2), %%mm6 \n\t" // R6
2453
"movq (%1, %%"REG_c"), %%mm7 \n\t" // R7
2454
PAVGB(%%mm4, %%mm0)
2455
PAVGB(%%mm5, %%mm1)
2456
PAVGB(%%mm6, %%mm2)
2457
PAVGB(%%mm7, %%mm3)
2458
PAVGB(%%mm4, %%mm0)
2459
PAVGB(%%mm5, %%mm1)
2460
PAVGB(%%mm6, %%mm2)
2461
PAVGB(%%mm7, %%mm3)
2462
"movq %%mm0, (%1, %2, 4) \n\t" // R4
2463
"movq %%mm1, (%1, %%"REG_d") \n\t" // R5
2464
"movq %%mm2, (%1, %%"REG_a", 2) \n\t" // R6
2465
"movq %%mm3, (%1, %%"REG_c") \n\t" // R7
2466
"movq %%mm0, (%0, %2, 4) \n\t" // L4
2467
"movq %%mm1, (%0, %%"REG_d") \n\t" // L5
2468
"movq %%mm2, (%0, %%"REG_a", 2) \n\t" // L6
2469
"movq %%mm3, (%0, %%"REG_c") \n\t" // L7
2470
"jmp 4f \n\t"
2471
2472
"3: \n\t"
2473
"lea (%%"REG_a", %2, 2), %%"REG_d" \n\t" // 5*stride
2474
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2475
"movq (%0), %%mm0 \n\t" // L0
2476
"movq (%0, %2), %%mm1 \n\t" // L1
2477
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2478
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2479
"movq (%1), %%mm4 \n\t" // R0
2480
"movq (%1, %2), %%mm5 \n\t" // R1
2481
"movq (%1, %2, 2), %%mm6 \n\t" // R2
2482
"movq (%1, %%"REG_a"), %%mm7 \n\t" // R3
2483
PAVGB(%%mm4, %%mm0)
2484
PAVGB(%%mm5, %%mm1)
2485
PAVGB(%%mm6, %%mm2)
2486
PAVGB(%%mm7, %%mm3)
2487
PAVGB(%%mm4, %%mm0)
2488
PAVGB(%%mm5, %%mm1)
2489
PAVGB(%%mm6, %%mm2)
2490
PAVGB(%%mm7, %%mm3)
2491
PAVGB(%%mm4, %%mm0)
2492
PAVGB(%%mm5, %%mm1)
2493
PAVGB(%%mm6, %%mm2)
2494
PAVGB(%%mm7, %%mm3)
2495
"movq %%mm0, (%1) \n\t" // R0
2496
"movq %%mm1, (%1, %2) \n\t" // R1
2497
"movq %%mm2, (%1, %2, 2) \n\t" // R2
2498
"movq %%mm3, (%1, %%"REG_a") \n\t" // R3
2499
"movq %%mm0, (%0) \n\t" // L0
2500
"movq %%mm1, (%0, %2) \n\t" // L1
2501
"movq %%mm2, (%0, %2, 2) \n\t" // L2
2502
"movq %%mm3, (%0, %%"REG_a") \n\t" // L3
2503
2504
"movq (%0, %2, 4), %%mm0 \n\t" // L4
2505
"movq (%0, %%"REG_d"), %%mm1 \n\t" // L5
2506
"movq (%0, %%"REG_a", 2), %%mm2 \n\t" // L6
2507
"movq (%0, %%"REG_c"), %%mm3 \n\t" // L7
2508
"movq (%1, %2, 4), %%mm4 \n\t" // R4
2509
"movq (%1, %%"REG_d"), %%mm5 \n\t" // R5
2510
"movq (%1, %%"REG_a", 2), %%mm6 \n\t" // R6
2511
"movq (%1, %%"REG_c"), %%mm7 \n\t" // R7
2512
PAVGB(%%mm4, %%mm0)
2513
PAVGB(%%mm5, %%mm1)
2514
PAVGB(%%mm6, %%mm2)
2515
PAVGB(%%mm7, %%mm3)
2516
PAVGB(%%mm4, %%mm0)
2517
PAVGB(%%mm5, %%mm1)
2518
PAVGB(%%mm6, %%mm2)
2519
PAVGB(%%mm7, %%mm3)
2520
PAVGB(%%mm4, %%mm0)
2521
PAVGB(%%mm5, %%mm1)
2522
PAVGB(%%mm6, %%mm2)
2523
PAVGB(%%mm7, %%mm3)
2524
"movq %%mm0, (%1, %2, 4) \n\t" // R4
2525
"movq %%mm1, (%1, %%"REG_d") \n\t" // R5
2526
"movq %%mm2, (%1, %%"REG_a", 2) \n\t" // R6
2527
"movq %%mm3, (%1, %%"REG_c") \n\t" // R7
2528
"movq %%mm0, (%0, %2, 4) \n\t" // L4
2529
"movq %%mm1, (%0, %%"REG_d") \n\t" // L5
2530
"movq %%mm2, (%0, %%"REG_a", 2) \n\t" // L6
2531
"movq %%mm3, (%0, %%"REG_c") \n\t" // L7
2532
2533
"4: \n\t"
2534
2535
:: "r" (src), "r" (tempBlured), "r"((long)stride), "m" (tempBluredPast)
2536
: "%"REG_a, "%"REG_d, "%"REG_c, "memory"
2537
);
2280
"movq %%mm0, %%mm4 \n\t"
2281
"psrlq $32, %%mm0 \n\t"
2282
"paddd %%mm0, %%mm4 \n\t"
2283
"movd %%mm4, %%ecx \n\t"
2284
"shll $2, %%ecx \n\t"
2285
"mov %3, %%"REG_d" \n\t"
2286
"addl -4(%%"REG_d"), %%ecx \n\t"
2287
"addl 4(%%"REG_d"), %%ecx \n\t"
2288
"addl -1024(%%"REG_d"), %%ecx \n\t"
2289
"addl $4, %%ecx \n\t"
2290
"addl 1024(%%"REG_d"), %%ecx \n\t"
2291
"shrl $3, %%ecx \n\t"
2292
"movl %%ecx, (%%"REG_d") \n\t"
2293
2294
// "mov %3, %%"REG_c" \n\t"
2295
// "mov %%"REG_c", test \n\t"
2296
// "jmp 4f \n\t"
2297
"cmpl 512(%%"REG_d"), %%ecx \n\t"
2298
" jb 2f \n\t"
2299
"cmpl 516(%%"REG_d"), %%ecx \n\t"
2300
" jb 1f \n\t"
2301
2302
"lea (%%"REG_a", %2, 2), %%"REG_d" \n\t" // 5*stride
2303
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2304
"movq (%0), %%mm0 \n\t" // L0
2305
"movq (%0, %2), %%mm1 \n\t" // L1
2306
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2307
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2308
"movq (%0, %2, 4), %%mm4 \n\t" // L4
2309
"movq (%0, %%"REG_d"), %%mm5 \n\t" // L5
2310
"movq (%0, %%"REG_a", 2), %%mm6 \n\t" // L6
2311
"movq (%0, %%"REG_c"), %%mm7 \n\t" // L7
2312
"movq %%mm0, (%1) \n\t" // L0
2313
"movq %%mm1, (%1, %2) \n\t" // L1
2314
"movq %%mm2, (%1, %2, 2) \n\t" // L2
2315
"movq %%mm3, (%1, %%"REG_a") \n\t" // L3
2316
"movq %%mm4, (%1, %2, 4) \n\t" // L4
2317
"movq %%mm5, (%1, %%"REG_d") \n\t" // L5
2318
"movq %%mm6, (%1, %%"REG_a", 2) \n\t" // L6
2319
"movq %%mm7, (%1, %%"REG_c") \n\t" // L7
2320
"jmp 4f \n\t"
2321
2322
"1: \n\t"
2323
"lea (%%"REG_a", %2, 2), %%"REG_d" \n\t" // 5*stride
2324
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2325
"movq (%0), %%mm0 \n\t" // L0
2326
PAVGB((%1), %%mm0) // L0
2327
"movq (%0, %2), %%mm1 \n\t" // L1
2328
PAVGB((%1, %2), %%mm1) // L1
2329
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2330
PAVGB((%1, %2, 2), %%mm2) // L2
2331
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2332
PAVGB((%1, %%REGa), %%mm3) // L3
2333
"movq (%0, %2, 4), %%mm4 \n\t" // L4
2334
PAVGB((%1, %2, 4), %%mm4) // L4
2335
"movq (%0, %%"REG_d"), %%mm5 \n\t" // L5
2336
PAVGB((%1, %%REGd), %%mm5) // L5
2337
"movq (%0, %%"REG_a", 2), %%mm6 \n\t" // L6
2338
PAVGB((%1, %%REGa, 2), %%mm6) // L6
2339
"movq (%0, %%"REG_c"), %%mm7 \n\t" // L7
2340
PAVGB((%1, %%REGc), %%mm7) // L7
2341
"movq %%mm0, (%1) \n\t" // R0
2342
"movq %%mm1, (%1, %2) \n\t" // R1
2343
"movq %%mm2, (%1, %2, 2) \n\t" // R2
2344
"movq %%mm3, (%1, %%"REG_a") \n\t" // R3
2345
"movq %%mm4, (%1, %2, 4) \n\t" // R4
2346
"movq %%mm5, (%1, %%"REG_d") \n\t" // R5
2347
"movq %%mm6, (%1, %%"REG_a", 2) \n\t" // R6
2348
"movq %%mm7, (%1, %%"REG_c") \n\t" // R7
2349
"movq %%mm0, (%0) \n\t" // L0
2350
"movq %%mm1, (%0, %2) \n\t" // L1
2351
"movq %%mm2, (%0, %2, 2) \n\t" // L2
2352
"movq %%mm3, (%0, %%"REG_a") \n\t" // L3
2353
"movq %%mm4, (%0, %2, 4) \n\t" // L4
2354
"movq %%mm5, (%0, %%"REG_d") \n\t" // L5
2355
"movq %%mm6, (%0, %%"REG_a", 2) \n\t" // L6
2356
"movq %%mm7, (%0, %%"REG_c") \n\t" // L7
2357
"jmp 4f \n\t"
2358
2359
"2: \n\t"
2360
"cmpl 508(%%"REG_d"), %%ecx \n\t"
2361
" jb 3f \n\t"
2362
2363
"lea (%%"REG_a", %2, 2), %%"REG_d" \n\t" // 5*stride
2364
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2365
"movq (%0), %%mm0 \n\t" // L0
2366
"movq (%0, %2), %%mm1 \n\t" // L1
2367
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2368
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2369
"movq (%1), %%mm4 \n\t" // R0
2370
"movq (%1, %2), %%mm5 \n\t" // R1
2371
"movq (%1, %2, 2), %%mm6 \n\t" // R2
2372
"movq (%1, %%"REG_a"), %%mm7 \n\t" // R3
2373
PAVGB(%%mm4, %%mm0)
2374
PAVGB(%%mm5, %%mm1)
2375
PAVGB(%%mm6, %%mm2)
2376
PAVGB(%%mm7, %%mm3)
2377
PAVGB(%%mm4, %%mm0)
2378
PAVGB(%%mm5, %%mm1)
2379
PAVGB(%%mm6, %%mm2)
2380
PAVGB(%%mm7, %%mm3)
2381
"movq %%mm0, (%1) \n\t" // R0
2382
"movq %%mm1, (%1, %2) \n\t" // R1
2383
"movq %%mm2, (%1, %2, 2) \n\t" // R2
2384
"movq %%mm3, (%1, %%"REG_a") \n\t" // R3
2385
"movq %%mm0, (%0) \n\t" // L0
2386
"movq %%mm1, (%0, %2) \n\t" // L1
2387
"movq %%mm2, (%0, %2, 2) \n\t" // L2
2388
"movq %%mm3, (%0, %%"REG_a") \n\t" // L3
2389
2390
"movq (%0, %2, 4), %%mm0 \n\t" // L4
2391
"movq (%0, %%"REG_d"), %%mm1 \n\t" // L5
2392
"movq (%0, %%"REG_a", 2), %%mm2 \n\t" // L6
2393
"movq (%0, %%"REG_c"), %%mm3 \n\t" // L7
2394
"movq (%1, %2, 4), %%mm4 \n\t" // R4
2395
"movq (%1, %%"REG_d"), %%mm5 \n\t" // R5
2396
"movq (%1, %%"REG_a", 2), %%mm6 \n\t" // R6
2397
"movq (%1, %%"REG_c"), %%mm7 \n\t" // R7
2398
PAVGB(%%mm4, %%mm0)
2399
PAVGB(%%mm5, %%mm1)
2400
PAVGB(%%mm6, %%mm2)
2401
PAVGB(%%mm7, %%mm3)
2402
PAVGB(%%mm4, %%mm0)
2403
PAVGB(%%mm5, %%mm1)
2404
PAVGB(%%mm6, %%mm2)
2405
PAVGB(%%mm7, %%mm3)
2406
"movq %%mm0, (%1, %2, 4) \n\t" // R4
2407
"movq %%mm1, (%1, %%"REG_d") \n\t" // R5
2408
"movq %%mm2, (%1, %%"REG_a", 2) \n\t" // R6
2409
"movq %%mm3, (%1, %%"REG_c") \n\t" // R7
2410
"movq %%mm0, (%0, %2, 4) \n\t" // L4
2411
"movq %%mm1, (%0, %%"REG_d") \n\t" // L5
2412
"movq %%mm2, (%0, %%"REG_a", 2) \n\t" // L6
2413
"movq %%mm3, (%0, %%"REG_c") \n\t" // L7
2414
"jmp 4f \n\t"
2415
2416
"3: \n\t"
2417
"lea (%%"REG_a", %2, 2), %%"REG_d" \n\t" // 5*stride
2418
"lea (%%"REG_d", %2, 2), %%"REG_c" \n\t" // 7*stride
2419
"movq (%0), %%mm0 \n\t" // L0
2420
"movq (%0, %2), %%mm1 \n\t" // L1
2421
"movq (%0, %2, 2), %%mm2 \n\t" // L2
2422
"movq (%0, %%"REG_a"), %%mm3 \n\t" // L3
2423
"movq (%1), %%mm4 \n\t" // R0
2424
"movq (%1, %2), %%mm5 \n\t" // R1
2425
"movq (%1, %2, 2), %%mm6 \n\t" // R2
2426
"movq (%1, %%"REG_a"), %%mm7 \n\t" // R3
2427
PAVGB(%%mm4, %%mm0)
2428
PAVGB(%%mm5, %%mm1)
2429
PAVGB(%%mm6, %%mm2)
2430
PAVGB(%%mm7, %%mm3)
2431
PAVGB(%%mm4, %%mm0)
2432
PAVGB(%%mm5, %%mm1)
2433
PAVGB(%%mm6, %%mm2)
2434
PAVGB(%%mm7, %%mm3)
2435
PAVGB(%%mm4, %%mm0)
2436
PAVGB(%%mm5, %%mm1)
2437
PAVGB(%%mm6, %%mm2)
2438
PAVGB(%%mm7, %%mm3)
2439
"movq %%mm0, (%1) \n\t" // R0
2440
"movq %%mm1, (%1, %2) \n\t" // R1
2441
"movq %%mm2, (%1, %2, 2) \n\t" // R2
2442
"movq %%mm3, (%1, %%"REG_a") \n\t" // R3
2443
"movq %%mm0, (%0) \n\t" // L0
2444
"movq %%mm1, (%0, %2) \n\t" // L1
2445
"movq %%mm2, (%0, %2, 2) \n\t" // L2
2446
"movq %%mm3, (%0, %%"REG_a") \n\t" // L3
2447
2448
"movq (%0, %2, 4), %%mm0 \n\t" // L4
2449
"movq (%0, %%"REG_d"), %%mm1 \n\t" // L5
2450
"movq (%0, %%"REG_a", 2), %%mm2 \n\t" // L6
2451
"movq (%0, %%"REG_c"), %%mm3 \n\t" // L7
2452
"movq (%1, %2, 4), %%mm4 \n\t" // R4
2453
"movq (%1, %%"REG_d"), %%mm5 \n\t" // R5
2454
"movq (%1, %%"REG_a", 2), %%mm6 \n\t" // R6
2455
"movq (%1, %%"REG_c"), %%mm7 \n\t" // R7
2456
PAVGB(%%mm4, %%mm0)
2457
PAVGB(%%mm5, %%mm1)
2458
PAVGB(%%mm6, %%mm2)
2459
PAVGB(%%mm7, %%mm3)
2460
PAVGB(%%mm4, %%mm0)
2461
PAVGB(%%mm5, %%mm1)
2462
PAVGB(%%mm6, %%mm2)
2463
PAVGB(%%mm7, %%mm3)
2464
PAVGB(%%mm4, %%mm0)
2465
PAVGB(%%mm5, %%mm1)
2466
PAVGB(%%mm6, %%mm2)
2467
PAVGB(%%mm7, %%mm3)
2468
"movq %%mm0, (%1, %2, 4) \n\t" // R4
2469
"movq %%mm1, (%1, %%"REG_d") \n\t" // R5
2470
"movq %%mm2, (%1, %%"REG_a", 2) \n\t" // R6
2471
"movq %%mm3, (%1, %%"REG_c") \n\t" // R7
2472
"movq %%mm0, (%0, %2, 4) \n\t" // L4
2473
"movq %%mm1, (%0, %%"REG_d") \n\t" // L5
2474
"movq %%mm2, (%0, %%"REG_a", 2) \n\t" // L6
2475
"movq %%mm3, (%0, %%"REG_c") \n\t" // L7
2476
2477
"4: \n\t"
2478
2479
:: "r" (src), "r" (tempBlurred), "r"((long)stride), "m" (tempBlurredPast)
2480
: "%"REG_a, "%"REG_d, "%"REG_c, "memory"
2481
);
2538
2482
#else //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
2539
2483
{
2540
int y;
2541
int d=0;
2542
// int sysd=0;
2543
int i;
2484
int y;
2485
int d=0;
2486
// int sysd=0;
2487
int i;
2544
2488
2545
for(y=0; y<8; y++)
2546
{
2547
int x;
2548
for(x=0; x<8; x++)
2549
{
2550
int ref= tempBlured[ x + y*stride ];
2551
int cur= src[ x + y*stride ];
2552
int d1=ref - cur;
2553
// if(x==0 || x==7) d1+= d1>>1;
2554
// if(y==0 || y==7) d1+= d1>>1;
2555
// d+= FFABS(d1);
2556
d+= d1*d1;
2557
// sysd+= d1;
2558
}
2489
for(y=0; y<8; y++){
2490
int x;
2491
for(x=0; x<8; x++){
2492
int ref= tempBlurred[ x + y*stride ];
2493
int cur= src[ x + y*stride ];
2494
int d1=ref - cur;
2495
// if(x==0 || x==7) d1+= d1>>1;
2496
// if(y==0 || y==7) d1+= d1>>1;
2497
// d+= FFABS(d1);
2498
d+= d1*d1;
2499
// sysd+= d1;
2559
2500
}
2560
i=d;
2561
d= (
2562
4*d
2563
+(*(tempBluredPast-256))
2564
+(*(tempBluredPast-1))+ (*(tempBluredPast+1))
2565
+(*(tempBluredPast+256))
2566
+4)>>3;
2567
*tempBluredPast=i;
2568
// ((*tempBluredPast)*3 + d + 2)>>2;
2501
}
2502
i=d;
2503
d= (
2504
4*d
2505
+(*(tempBlurredPast-256))
2506
+(*(tempBlurredPast-1))+ (*(tempBlurredPast+1))
2507
+(*(tempBlurredPast+256))
2508
+4)>>3;
2509
*tempBlurredPast=i;
2510
// ((*tempBlurredPast)*3 + d + 2)>>2;
2569
2511
2570
2512
/*
2571
2513
Switch between
2574
2516
64 48 36 27 20 15 11 (33) (approx)
2575
2517
64 56 49 43 37 33 29 (200) (approx)
2576
2518
*/
2577
if(d > maxNoise[1])
2578
{
2579
if(d < maxNoise[2])
2580
{
2581
for(y=0; y<8; y++)
2582
{
2583
int x;
2584
for(x=0; x<8; x++)
2585
{
2586
int ref= tempBlured[ x + y*stride ];
2587
int cur= src[ x + y*stride ];
2588
tempBlured[ x + y*stride ]=
2589
src[ x + y*stride ]=
2590
(ref + cur + 1)>>1;
2591
}
2592
}
2593
}
2594
else
2595
{
2596
for(y=0; y<8; y++)
2597
{
2598
int x;
2599
for(x=0; x<8; x++)
2600
{
2601
tempBlured[ x + y*stride ]= src[ x + y*stride ];
2602
}
2603
}
2604
}
2605
}
2606
else
2607
{
2608
if(d < maxNoise[0])
2609
{
2610
for(y=0; y<8; y++)
2611
{
2612
int x;
2613
for(x=0; x<8; x++)
2614
{
2615
int ref= tempBlured[ x + y*stride ];
2616
int cur= src[ x + y*stride ];
2617
tempBlured[ x + y*stride ]=
2618
src[ x + y*stride ]=
2619
(ref*7 + cur + 4)>>3;
2620
}
2621
}
2622
}
2623
else
2624
{
2625
for(y=0; y<8; y++)
2626
{
2627
int x;
2628
for(x=0; x<8; x++)
2629
{
2630
int ref= tempBlured[ x + y*stride ];
2631
int cur= src[ x + y*stride ];
2632
tempBlured[ x + y*stride ]=
2633
src[ x + y*stride ]=
2634
(ref*3 + cur + 2)>>2;
2635
}
2636
}
2637
}
2638
}
2519
if(d > maxNoise[1]){
2520
if(d < maxNoise[2]){
2521
for(y=0; y<8; y++){
2522
int x;
2523
for(x=0; x<8; x++){
2524
int ref= tempBlurred[ x + y*stride ];
2525
int cur= src[ x + y*stride ];
2526
tempBlurred[ x + y*stride ]=
2527
src[ x + y*stride ]=
2528
(ref + cur + 1)>>1;
2529
}
2530
}
2531
}else{
2532
for(y=0; y<8; y++){
2533
int x;
2534
for(x=0; x<8; x++){
2535
tempBlurred[ x + y*stride ]= src[ x + y*stride ];
2536
}
2537
}
2538
}
2539
}else{
2540
if(d < maxNoise[0]){
2541
for(y=0; y<8; y++){
2542
int x;
2543
for(x=0; x<8; x++){
2544
int ref= tempBlurred[ x + y*stride ];
2545
int cur= src[ x + y*stride ];
2546
tempBlurred[ x + y*stride ]=
2547
src[ x + y*stride ]=
2548
(ref*7 + cur + 4)>>3;
2549
}
2550
}
2551
}else{
2552
for(y=0; y<8; y++){
2553
int x;
2554
for(x=0; x<8; x++){
2555
int ref= tempBlurred[ x + y*stride ];
2556
int cur= src[ x + y*stride ];
2557
tempBlurred[ x + y*stride ]=
2558
src[ x + y*stride ]=
2559
(ref*3 + cur + 2)>>2;
2560
}
2561
}
2562
}
2563
}
2639
2564
}
2640
2565
#endif //defined (HAVE_MMX2) || defined (HAVE_3DNOW)
2641
2566
}
2646
2571
* accurate deblock filter
2647
2572
*/
2648
2573
static av_always_inline void RENAME(do_a_deblock)(uint8_t *src, int step, int stride, PPContext *c){
2649
int64_t dc_mask, eq_mask, both_masks;
2650
int64_t sums[10*8*2];
2651
src+= step*3; // src points to begin of the 8x8 Block
2574
int64_t dc_mask, eq_mask, both_masks;
2575
int64_t sums[10*8*2];
2576
src+= step*3; // src points to begin of the 8x8 Block
2652
2577
//START_TIMER
2653
asm volatile(
2654
"movq %0, %%mm7 \n\t"
2655
"movq %1, %%mm6 \n\t"
2656
: : "m" (c->mmxDcOffset[c->nonBQP]), "m" (c->mmxDcThreshold[c->nonBQP])
2657
);
2578
asm volatile(
2579
"movq %0, %%mm7 \n\t"
2580
"movq %1, %%mm6 \n\t"
2581
: : "m" (c->mmxDcOffset[c->nonBQP]), "m" (c->mmxDcThreshold[c->nonBQP])
2582
);
2658
2583
2659
asm volatile(
2660
"lea (%2, %3), %%"REG_a" \n\t"
2584
asm volatile(
2585
"lea (%2, %3), %%"REG_a" \n\t"
2661
2586
// 0 1 2 3 4 5 6 7 8 9
2662
2587
// %1 eax eax+%2 eax+2%2 %1+4%2 ecx ecx+%2 ecx+2%2 %1+8%2 ecx+4%2
2663
2588
2664
"movq (%2), %%mm0 \n\t"
2665
"movq (%%"REG_a"), %%mm1 \n\t"
2666
"movq %%mm1, %%mm3 \n\t"
2667
"movq %%mm1, %%mm4 \n\t"
2668
"psubb %%mm1, %%mm0 \n\t" // mm0 = differnece
2669
"paddb %%mm7, %%mm0 \n\t"
2670
"pcmpgtb %%mm6, %%mm0 \n\t"
2671
2672
"movq (%%"REG_a",%3), %%mm2 \n\t"
2673
PMAXUB(%%mm2, %%mm4)
2674
PMINUB(%%mm2, %%mm3, %%mm5)
2675
"psubb %%mm2, %%mm1 \n\t"
2676
"paddb %%mm7, %%mm1 \n\t"
2677
"pcmpgtb %%mm6, %%mm1 \n\t"
2678
"paddb %%mm1, %%mm0 \n\t"
2679
2680
"movq (%%"REG_a", %3, 2), %%mm1 \n\t"
2681
PMAXUB(%%mm1, %%mm4)
2682
PMINUB(%%mm1, %%mm3, %%mm5)
2683
"psubb %%mm1, %%mm2 \n\t"
2684
"paddb %%mm7, %%mm2 \n\t"
2685
"pcmpgtb %%mm6, %%mm2 \n\t"
2686
"paddb %%mm2, %%mm0 \n\t"
2687
2688
"lea (%%"REG_a", %3, 4), %%"REG_a" \n\t"
2689
2690
"movq (%2, %3, 4), %%mm2 \n\t"
2691
PMAXUB(%%mm2, %%mm4)
2692
PMINUB(%%mm2, %%mm3, %%mm5)
2693
"psubb %%mm2, %%mm1 \n\t"
2694
"paddb %%mm7, %%mm1 \n\t"
2695
"pcmpgtb %%mm6, %%mm1 \n\t"
2696
"paddb %%mm1, %%mm0 \n\t"
2697
2698
"movq (%%"REG_a"), %%mm1 \n\t"
2699
PMAXUB(%%mm1, %%mm4)
2700
PMINUB(%%mm1, %%mm3, %%mm5)
2701
"psubb %%mm1, %%mm2 \n\t"
2702
"paddb %%mm7, %%mm2 \n\t"
2703
"pcmpgtb %%mm6, %%mm2 \n\t"
2704
"paddb %%mm2, %%mm0 \n\t"
2705
2706
"movq (%%"REG_a", %3), %%mm2 \n\t"
2707
PMAXUB(%%mm2, %%mm4)
2708
PMINUB(%%mm2, %%mm3, %%mm5)
2709
"psubb %%mm2, %%mm1 \n\t"
2710
"paddb %%mm7, %%mm1 \n\t"
2711
"pcmpgtb %%mm6, %%mm1 \n\t"
2712
"paddb %%mm1, %%mm0 \n\t"
2713
2714
"movq (%%"REG_a", %3, 2), %%mm1 \n\t"
2715
PMAXUB(%%mm1, %%mm4)
2716
PMINUB(%%mm1, %%mm3, %%mm5)
2717
"psubb %%mm1, %%mm2 \n\t"
2718
"paddb %%mm7, %%mm2 \n\t"
2719
"pcmpgtb %%mm6, %%mm2 \n\t"
2720
"paddb %%mm2, %%mm0 \n\t"
2721
2722
"movq (%2, %3, 8), %%mm2 \n\t"
2723
PMAXUB(%%mm2, %%mm4)
2724
PMINUB(%%mm2, %%mm3, %%mm5)
2725
"psubb %%mm2, %%mm1 \n\t"
2726
"paddb %%mm7, %%mm1 \n\t"
2727
"pcmpgtb %%mm6, %%mm1 \n\t"
2728
"paddb %%mm1, %%mm0 \n\t"
2729
2730
"movq (%%"REG_a", %3, 4), %%mm1 \n\t"
2731
"psubb %%mm1, %%mm2 \n\t"
2732
"paddb %%mm7, %%mm2 \n\t"
2733
"pcmpgtb %%mm6, %%mm2 \n\t"
2734
"paddb %%mm2, %%mm0 \n\t"
2735
"psubusb %%mm3, %%mm4 \n\t"
2736
2737
"pxor %%mm6, %%mm6 \n\t"
2738
"movq %4, %%mm7 \n\t" // QP,..., QP
2739
"paddusb %%mm7, %%mm7 \n\t" // 2QP ... 2QP
2740
"psubusb %%mm4, %%mm7 \n\t" // Diff >=2QP -> 0
2741
"pcmpeqb %%mm6, %%mm7 \n\t" // Diff < 2QP -> 0
2742
"pcmpeqb %%mm6, %%mm7 \n\t" // Diff < 2QP -> 0
2743
"movq %%mm7, %1 \n\t"
2744
2745
"movq %5, %%mm7 \n\t"
2746
"punpcklbw %%mm7, %%mm7 \n\t"
2747
"punpcklbw %%mm7, %%mm7 \n\t"
2748
"punpcklbw %%mm7, %%mm7 \n\t"
2749
"psubb %%mm0, %%mm6 \n\t"
2750
"pcmpgtb %%mm7, %%mm6 \n\t"
2751
"movq %%mm6, %0 \n\t"
2752
2753
: "=m" (eq_mask), "=m" (dc_mask)
2754
: "r" (src), "r" ((long)step), "m" (c->pQPb), "m"(c->ppMode.flatnessThreshold)
2755
: "%"REG_a
2756
);
2757
2758
both_masks = dc_mask & eq_mask;
2759
2760
if(both_masks){
2761
long offset= -8*step;
2762
int64_t *temp_sums= sums;
2763
2764
asm volatile(
2765
"movq %2, %%mm0 \n\t" // QP,..., QP
2766
"pxor %%mm4, %%mm4 \n\t"
2767
2768
"movq (%0), %%mm6 \n\t"
2769
"movq (%0, %1), %%mm5 \n\t"
2770
"movq %%mm5, %%mm1 \n\t"
2771
"movq %%mm6, %%mm2 \n\t"
2772
"psubusb %%mm6, %%mm5 \n\t"
2773
"psubusb %%mm1, %%mm2 \n\t"
2774
"por %%mm5, %%mm2 \n\t" // ABS Diff of lines
2775
"psubusb %%mm2, %%mm0 \n\t" // diff >= QP -> 0
2776
"pcmpeqb %%mm4, %%mm0 \n\t" // diff >= QP -> FF
2777
2778
"pxor %%mm6, %%mm1 \n\t"
2779
"pand %%mm0, %%mm1 \n\t"
2780
"pxor %%mm1, %%mm6 \n\t"
2781
// 0:QP 6:First
2782
2783
"movq (%0, %1, 8), %%mm5 \n\t"
2784
"add %1, %0 \n\t" // %0 points to line 1 not 0
2785
"movq (%0, %1, 8), %%mm7 \n\t"
2786
"movq %%mm5, %%mm1 \n\t"
2787
"movq %%mm7, %%mm2 \n\t"
2788
"psubusb %%mm7, %%mm5 \n\t"
2789
"psubusb %%mm1, %%mm2 \n\t"
2790
"por %%mm5, %%mm2 \n\t" // ABS Diff of lines
2791
"movq %2, %%mm0 \n\t" // QP,..., QP
2792
"psubusb %%mm2, %%mm0 \n\t" // diff >= QP -> 0
2793
"pcmpeqb %%mm4, %%mm0 \n\t" // diff >= QP -> FF
2794
2795
"pxor %%mm7, %%mm1 \n\t"
2796
"pand %%mm0, %%mm1 \n\t"
2797
"pxor %%mm1, %%mm7 \n\t"
2798
2799
"movq %%mm6, %%mm5 \n\t"
2800
"punpckhbw %%mm4, %%mm6 \n\t"
2801
"punpcklbw %%mm4, %%mm5 \n\t"
2802
// 4:0 5/6:First 7:Last
2803
2804
"movq %%mm5, %%mm0 \n\t"
2805
"movq %%mm6, %%mm1 \n\t"
2806
"psllw $2, %%mm0 \n\t"
2807
"psllw $2, %%mm1 \n\t"
2808
"paddw "MANGLE(w04)", %%mm0 \n\t"
2809
"paddw "MANGLE(w04)", %%mm1 \n\t"
2589
"movq (%2), %%mm0 \n\t"
2590
"movq (%%"REG_a"), %%mm1 \n\t"
2591
"movq %%mm1, %%mm3 \n\t"
2592
"movq %%mm1, %%mm4 \n\t"
2593
"psubb %%mm1, %%mm0 \n\t" // mm0 = differnece
2594
"paddb %%mm7, %%mm0 \n\t"
2595
"pcmpgtb %%mm6, %%mm0 \n\t"
2596
2597
"movq (%%"REG_a",%3), %%mm2 \n\t"
2598
PMAXUB(%%mm2, %%mm4)
2599
PMINUB(%%mm2, %%mm3, %%mm5)
2600
"psubb %%mm2, %%mm1 \n\t"
2601
"paddb %%mm7, %%mm1 \n\t"
2602
"pcmpgtb %%mm6, %%mm1 \n\t"
2603
"paddb %%mm1, %%mm0 \n\t"
2604
2605
"movq (%%"REG_a", %3, 2), %%mm1 \n\t"
2606
PMAXUB(%%mm1, %%mm4)
2607
PMINUB(%%mm1, %%mm3, %%mm5)
2608
"psubb %%mm1, %%mm2 \n\t"
2609
"paddb %%mm7, %%mm2 \n\t"
2610
"pcmpgtb %%mm6, %%mm2 \n\t"
2611
"paddb %%mm2, %%mm0 \n\t"
2612
2613
"lea (%%"REG_a", %3, 4), %%"REG_a" \n\t"
2614
2615
"movq (%2, %3, 4), %%mm2 \n\t"
2616
PMAXUB(%%mm2, %%mm4)
2617
PMINUB(%%mm2, %%mm3, %%mm5)
2618
"psubb %%mm2, %%mm1 \n\t"
2619
"paddb %%mm7, %%mm1 \n\t"
2620
"pcmpgtb %%mm6, %%mm1 \n\t"
2621
"paddb %%mm1, %%mm0 \n\t"
2622
2623
"movq (%%"REG_a"), %%mm1 \n\t"
2624
PMAXUB(%%mm1, %%mm4)
2625
PMINUB(%%mm1, %%mm3, %%mm5)
2626
"psubb %%mm1, %%mm2 \n\t"
2627
"paddb %%mm7, %%mm2 \n\t"
2628
"pcmpgtb %%mm6, %%mm2 \n\t"
2629
"paddb %%mm2, %%mm0 \n\t"
2630
2631
"movq (%%"REG_a", %3), %%mm2 \n\t"
2632
PMAXUB(%%mm2, %%mm4)
2633
PMINUB(%%mm2, %%mm3, %%mm5)
2634
"psubb %%mm2, %%mm1 \n\t"
2635
"paddb %%mm7, %%mm1 \n\t"
2636
"pcmpgtb %%mm6, %%mm1 \n\t"
2637
"paddb %%mm1, %%mm0 \n\t"
2638
2639
"movq (%%"REG_a", %3, 2), %%mm1 \n\t"
2640
PMAXUB(%%mm1, %%mm4)
2641
PMINUB(%%mm1, %%mm3, %%mm5)
2642
"psubb %%mm1, %%mm2 \n\t"
2643
"paddb %%mm7, %%mm2 \n\t"
2644
"pcmpgtb %%mm6, %%mm2 \n\t"
2645
"paddb %%mm2, %%mm0 \n\t"
2646
2647
"movq (%2, %3, 8), %%mm2 \n\t"
2648
PMAXUB(%%mm2, %%mm4)
2649
PMINUB(%%mm2, %%mm3, %%mm5)
2650
"psubb %%mm2, %%mm1 \n\t"
2651
"paddb %%mm7, %%mm1 \n\t"
2652
"pcmpgtb %%mm6, %%mm1 \n\t"
2653
"paddb %%mm1, %%mm0 \n\t"
2654
2655
"movq (%%"REG_a", %3, 4), %%mm1 \n\t"
2656
"psubb %%mm1, %%mm2 \n\t"
2657
"paddb %%mm7, %%mm2 \n\t"
2658
"pcmpgtb %%mm6, %%mm2 \n\t"
2659
"paddb %%mm2, %%mm0 \n\t"
2660
"psubusb %%mm3, %%mm4 \n\t"
2661
2662
"pxor %%mm6, %%mm6 \n\t"
2663
"movq %4, %%mm7 \n\t" // QP,..., QP
2664
"paddusb %%mm7, %%mm7 \n\t" // 2QP ... 2QP
2665
"psubusb %%mm4, %%mm7 \n\t" // Diff >=2QP -> 0
2666
"pcmpeqb %%mm6, %%mm7 \n\t" // Diff < 2QP -> 0
2667
"pcmpeqb %%mm6, %%mm7 \n\t" // Diff < 2QP -> 0
2668
"movq %%mm7, %1 \n\t"
2669
2670
"movq %5, %%mm7 \n\t"
2671
"punpcklbw %%mm7, %%mm7 \n\t"
2672
"punpcklbw %%mm7, %%mm7 \n\t"
2673
"punpcklbw %%mm7, %%mm7 \n\t"
2674
"psubb %%mm0, %%mm6 \n\t"
2675
"pcmpgtb %%mm7, %%mm6 \n\t"
2676
"movq %%mm6, %0 \n\t"
2677
2678
: "=m" (eq_mask), "=m" (dc_mask)
2679
: "r" (src), "r" ((long)step), "m" (c->pQPb), "m"(c->ppMode.flatnessThreshold)
2680
: "%"REG_a
2681
);
2682
2683
both_masks = dc_mask & eq_mask;
2684
2685
if(both_masks){
2686
long offset= -8*step;
2687
int64_t *temp_sums= sums;
2688
2689
asm volatile(
2690
"movq %2, %%mm0 \n\t" // QP,..., QP
2691
"pxor %%mm4, %%mm4 \n\t"
2692
2693
"movq (%0), %%mm6 \n\t"
2694
"movq (%0, %1), %%mm5 \n\t"
2695
"movq %%mm5, %%mm1 \n\t"
2696
"movq %%mm6, %%mm2 \n\t"
2697
"psubusb %%mm6, %%mm5 \n\t"
2698
"psubusb %%mm1, %%mm2 \n\t"
2699
"por %%mm5, %%mm2 \n\t" // ABS Diff of lines
2700
"psubusb %%mm2, %%mm0 \n\t" // diff >= QP -> 0
2701
"pcmpeqb %%mm4, %%mm0 \n\t" // diff >= QP -> FF
2702
2703
"pxor %%mm6, %%mm1 \n\t"
2704
"pand %%mm0, %%mm1 \n\t"
2705
"pxor %%mm1, %%mm6 \n\t"
2706
// 0:QP 6:First
2707
2708
"movq (%0, %1, 8), %%mm5 \n\t"
2709
"add %1, %0 \n\t" // %0 points to line 1 not 0
2710
"movq (%0, %1, 8), %%mm7 \n\t"
2711
"movq %%mm5, %%mm1 \n\t"
2712
"movq %%mm7, %%mm2 \n\t"
2713
"psubusb %%mm7, %%mm5 \n\t"
2714
"psubusb %%mm1, %%mm2 \n\t"
2715
"por %%mm5, %%mm2 \n\t" // ABS Diff of lines
2716
"movq %2, %%mm0 \n\t" // QP,..., QP
2717
"psubusb %%mm2, %%mm0 \n\t" // diff >= QP -> 0
2718
"pcmpeqb %%mm4, %%mm0 \n\t" // diff >= QP -> FF
2719
2720
"pxor %%mm7, %%mm1 \n\t"
2721
"pand %%mm0, %%mm1 \n\t"
2722
"pxor %%mm1, %%mm7 \n\t"
2723
2724
"movq %%mm6, %%mm5 \n\t"
2725
"punpckhbw %%mm4, %%mm6 \n\t"
2726
"punpcklbw %%mm4, %%mm5 \n\t"
2727
// 4:0 5/6:First 7:Last
2728
2729
"movq %%mm5, %%mm0 \n\t"
2730
"movq %%mm6, %%mm1 \n\t"
2731
"psllw $2, %%mm0 \n\t"
2732
"psllw $2, %%mm1 \n\t"
2733
"paddw "MANGLE(w04)", %%mm0 \n\t"
2734
"paddw "MANGLE(w04)", %%mm1 \n\t"
2810
2735
2811
2736
#define NEXT\
2812
"movq (%0), %%mm2 \n\t"\
2813
"movq (%0), %%mm3 \n\t"\
2814
"add %1, %0 \n\t"\
2815
"punpcklbw %%mm4, %%mm2 \n\t"\
2816
"punpckhbw %%mm4, %%mm3 \n\t"\
2817
"paddw %%mm2, %%mm0 \n\t"\
2818
"paddw %%mm3, %%mm1 \n\t"
2737
"movq (%0), %%mm2 \n\t"\
2738
"movq (%0), %%mm3 \n\t"\
2739
"add %1, %0 \n\t"\
2740
"punpcklbw %%mm4, %%mm2 \n\t"\
2741
"punpckhbw %%mm4, %%mm3 \n\t"\
2742
"paddw %%mm2, %%mm0 \n\t"\
2743
"paddw %%mm3, %%mm1 \n\t"
2819
2744
2820
2745
#define PREV\
2821
"movq (%0), %%mm2 \n\t"\
2822
"movq (%0), %%mm3 \n\t"\
2823
"add %1, %0 \n\t"\
2824
"punpcklbw %%mm4, %%mm2 \n\t"\
2825
"punpckhbw %%mm4, %%mm3 \n\t"\
2826
"psubw %%mm2, %%mm0 \n\t"\
2827
"psubw %%mm3, %%mm1 \n\t"
2828
2829
2830
NEXT //0
2831
NEXT //1
2832
NEXT //2
2833
"movq %%mm0, (%3) \n\t"
2834
"movq %%mm1, 8(%3) \n\t"
2835
2836
NEXT //3
2837
"psubw %%mm5, %%mm0 \n\t"
2838
"psubw %%mm6, %%mm1 \n\t"
2839
"movq %%mm0, 16(%3) \n\t"
2840
"movq %%mm1, 24(%3) \n\t"
2841
2842
NEXT //4
2843
"psubw %%mm5, %%mm0 \n\t"
2844
"psubw %%mm6, %%mm1 \n\t"
2845
"movq %%mm0, 32(%3) \n\t"
2846
"movq %%mm1, 40(%3) \n\t"
2847
2848
NEXT //5
2849
"psubw %%mm5, %%mm0 \n\t"
2850
"psubw %%mm6, %%mm1 \n\t"
2851
"movq %%mm0, 48(%3) \n\t"
2852
"movq %%mm1, 56(%3) \n\t"
2853
2854
NEXT //6
2855
"psubw %%mm5, %%mm0 \n\t"
2856
"psubw %%mm6, %%mm1 \n\t"
2857
"movq %%mm0, 64(%3) \n\t"
2858
"movq %%mm1, 72(%3) \n\t"
2859
2860
"movq %%mm7, %%mm6 \n\t"
2861
"punpckhbw %%mm4, %%mm7 \n\t"
2862
"punpcklbw %%mm4, %%mm6 \n\t"
2863
2864
NEXT //7
2865
"mov %4, %0 \n\t"
2866
"add %1, %0 \n\t"
2867
PREV //0
2868
"movq %%mm0, 80(%3) \n\t"
2869
"movq %%mm1, 88(%3) \n\t"
2870
2871
PREV //1
2872
"paddw %%mm6, %%mm0 \n\t"
2873
"paddw %%mm7, %%mm1 \n\t"
2874
"movq %%mm0, 96(%3) \n\t"
2875
"movq %%mm1, 104(%3) \n\t"
2876
2877
PREV //2
2878
"paddw %%mm6, %%mm0 \n\t"
2879
"paddw %%mm7, %%mm1 \n\t"
2880
"movq %%mm0, 112(%3) \n\t"
2881
"movq %%mm1, 120(%3) \n\t"
2882
2883
PREV //3
2884
"paddw %%mm6, %%mm0 \n\t"
2885
"paddw %%mm7, %%mm1 \n\t"
2886
"movq %%mm0, 128(%3) \n\t"
2887
"movq %%mm1, 136(%3) \n\t"
2888
2889
PREV //4
2890
"paddw %%mm6, %%mm0 \n\t"
2891
"paddw %%mm7, %%mm1 \n\t"
2892
"movq %%mm0, 144(%3) \n\t"
2893
"movq %%mm1, 152(%3) \n\t"
2894
2895
"mov %4, %0 \n\t" //FIXME
2896
2897
: "+&r"(src)
2898
: "r" ((long)step), "m" (c->pQPb), "r"(sums), "g"(src)
2899
);
2900
2901
src+= step; // src points to begin of the 8x8 Block
2902
2903
asm volatile(
2904
"movq %4, %%mm6 \n\t"
2905
"pcmpeqb %%mm5, %%mm5 \n\t"
2906
"pxor %%mm6, %%mm5 \n\t"
2907
"pxor %%mm7, %%mm7 \n\t"
2908
2909
"1: \n\t"
2910
"movq (%1), %%mm0 \n\t"
2911
"movq 8(%1), %%mm1 \n\t"
2912
"paddw 32(%1), %%mm0 \n\t"
2913
"paddw 40(%1), %%mm1 \n\t"
2914
"movq (%0, %3), %%mm2 \n\t"
2915
"movq %%mm2, %%mm3 \n\t"
2916
"movq %%mm2, %%mm4 \n\t"
2917
"punpcklbw %%mm7, %%mm2 \n\t"
2918
"punpckhbw %%mm7, %%mm3 \n\t"
2919
"paddw %%mm2, %%mm0 \n\t"
2920
"paddw %%mm3, %%mm1 \n\t"
2921
"paddw %%mm2, %%mm0 \n\t"
2922
"paddw %%mm3, %%mm1 \n\t"
2923
"psrlw $4, %%mm0 \n\t"
2924
"psrlw $4, %%mm1 \n\t"
2925
"packuswb %%mm1, %%mm0 \n\t"
2926
"pand %%mm6, %%mm0 \n\t"
2927
"pand %%mm5, %%mm4 \n\t"
2928
"por %%mm4, %%mm0 \n\t"
2929
"movq %%mm0, (%0, %3) \n\t"
2930
"add $16, %1 \n\t"
2931
"add %2, %0 \n\t"
2932
" js 1b \n\t"
2933
2934
: "+r"(offset), "+r"(temp_sums)
2935
: "r" ((long)step), "r"(src - offset), "m"(both_masks)
2936
);
2937
}else
2938
src+= step; // src points to begin of the 8x8 Block
2939
2940
if(eq_mask != -1LL){
2941
uint8_t *temp_src= src;
2942
asm volatile(
2943
"pxor %%mm7, %%mm7 \n\t"
2944
"lea -40(%%"REG_SP"), %%"REG_c" \n\t" // make space for 4 8-byte vars
2945
"and "ALIGN_MASK", %%"REG_c" \n\t" // align
2746
"movq (%0), %%mm2 \n\t"\
2747
"movq (%0), %%mm3 \n\t"\
2748
"add %1, %0 \n\t"\
2749
"punpcklbw %%mm4, %%mm2 \n\t"\
2750
"punpckhbw %%mm4, %%mm3 \n\t"\
2751
"psubw %%mm2, %%mm0 \n\t"\
2752
"psubw %%mm3, %%mm1 \n\t"
2753
2754
2755
NEXT //0
2756
NEXT //1
2757
NEXT //2
2758
"movq %%mm0, (%3) \n\t"
2759
"movq %%mm1, 8(%3) \n\t"
2760
2761
NEXT //3
2762
"psubw %%mm5, %%mm0 \n\t"
2763
"psubw %%mm6, %%mm1 \n\t"
2764
"movq %%mm0, 16(%3) \n\t"
2765
"movq %%mm1, 24(%3) \n\t"
2766
2767
NEXT //4
2768
"psubw %%mm5, %%mm0 \n\t"
2769
"psubw %%mm6, %%mm1 \n\t"
2770
"movq %%mm0, 32(%3) \n\t"
2771
"movq %%mm1, 40(%3) \n\t"
2772
2773
NEXT //5
2774
"psubw %%mm5, %%mm0 \n\t"
2775
"psubw %%mm6, %%mm1 \n\t"
2776
"movq %%mm0, 48(%3) \n\t"
2777
"movq %%mm1, 56(%3) \n\t"
2778
2779
NEXT //6
2780
"psubw %%mm5, %%mm0 \n\t"
2781
"psubw %%mm6, %%mm1 \n\t"
2782
"movq %%mm0, 64(%3) \n\t"
2783
"movq %%mm1, 72(%3) \n\t"
2784
2785
"movq %%mm7, %%mm6 \n\t"
2786
"punpckhbw %%mm4, %%mm7 \n\t"
2787
"punpcklbw %%mm4, %%mm6 \n\t"
2788
2789
NEXT //7
2790
"mov %4, %0 \n\t"
2791
"add %1, %0 \n\t"
2792
PREV //0
2793
"movq %%mm0, 80(%3) \n\t"
2794
"movq %%mm1, 88(%3) \n\t"
2795
2796
PREV //1
2797
"paddw %%mm6, %%mm0 \n\t"
2798
"paddw %%mm7, %%mm1 \n\t"
2799
"movq %%mm0, 96(%3) \n\t"
2800
"movq %%mm1, 104(%3) \n\t"
2801
2802
PREV //2
2803
"paddw %%mm6, %%mm0 \n\t"
2804
"paddw %%mm7, %%mm1 \n\t"
2805
"movq %%mm0, 112(%3) \n\t"
2806
"movq %%mm1, 120(%3) \n\t"
2807
2808
PREV //3
2809
"paddw %%mm6, %%mm0 \n\t"
2810
"paddw %%mm7, %%mm1 \n\t"
2811
"movq %%mm0, 128(%3) \n\t"
2812
"movq %%mm1, 136(%3) \n\t"
2813
2814
PREV //4
2815
"paddw %%mm6, %%mm0 \n\t"
2816
"paddw %%mm7, %%mm1 \n\t"
2817
"movq %%mm0, 144(%3) \n\t"
2818
"movq %%mm1, 152(%3) \n\t"
2819
2820
"mov %4, %0 \n\t" //FIXME
2821
2822
: "+&r"(src)
2823
: "r" ((long)step), "m" (c->pQPb), "r"(sums), "g"(src)
2824
);
2825
2826
src+= step; // src points to begin of the 8x8 Block
2827
2828
asm volatile(
2829
"movq %4, %%mm6 \n\t"
2830
"pcmpeqb %%mm5, %%mm5 \n\t"
2831
"pxor %%mm6, %%mm5 \n\t"
2832
"pxor %%mm7, %%mm7 \n\t"
2833
2834
"1: \n\t"
2835
"movq (%1), %%mm0 \n\t"
2836
"movq 8(%1), %%mm1 \n\t"
2837
"paddw 32(%1), %%mm0 \n\t"
2838
"paddw 40(%1), %%mm1 \n\t"
2839
"movq (%0, %3), %%mm2 \n\t"
2840
"movq %%mm2, %%mm3 \n\t"
2841
"movq %%mm2, %%mm4 \n\t"
2842
"punpcklbw %%mm7, %%mm2 \n\t"
2843
"punpckhbw %%mm7, %%mm3 \n\t"
2844
"paddw %%mm2, %%mm0 \n\t"
2845
"paddw %%mm3, %%mm1 \n\t"
2846
"paddw %%mm2, %%mm0 \n\t"
2847
"paddw %%mm3, %%mm1 \n\t"
2848
"psrlw $4, %%mm0 \n\t"
2849
"psrlw $4, %%mm1 \n\t"
2850
"packuswb %%mm1, %%mm0 \n\t"
2851
"pand %%mm6, %%mm0 \n\t"
2852
"pand %%mm5, %%mm4 \n\t"
2853
"por %%mm4, %%mm0 \n\t"
2854
"movq %%mm0, (%0, %3) \n\t"
2855
"add $16, %1 \n\t"
2856
"add %2, %0 \n\t"
2857
" js 1b \n\t"
2858
2859
: "+r"(offset), "+r"(temp_sums)
2860
: "r" ((long)step), "r"(src - offset), "m"(both_masks)
2861
);
2862
}else
2863
src+= step; // src points to begin of the 8x8 Block
2864
2865
if(eq_mask != -1LL){
2866
uint8_t *temp_src= src;
2867
asm volatile(
2868
"pxor %%mm7, %%mm7 \n\t"
2869
"lea -40(%%"REG_SP"), %%"REG_c" \n\t" // make space for 4 8-byte vars
2870
"and "ALIGN_MASK", %%"REG_c" \n\t" // align
2946
2871
// 0 1 2 3 4 5 6 7 8 9
2947
2872
// %0 eax eax+%1 eax+2%1 %0+4%1 ecx ecx+%1 ecx+2%1 %1+8%1 ecx+4%1
2948
2873
2949
"movq (%0), %%mm0 \n\t"
2950
"movq %%mm0, %%mm1 \n\t"
2951
"punpcklbw %%mm7, %%mm0 \n\t" // low part of line 0
2952
"punpckhbw %%mm7, %%mm1 \n\t" // high part of line 0
2953
2954
"movq (%0, %1), %%mm2 \n\t"
2955
"lea (%0, %1, 2), %%"REG_a" \n\t"
2956
"movq %%mm2, %%mm3 \n\t"
2957
"punpcklbw %%mm7, %%mm2 \n\t" // low part of line 1
2958
"punpckhbw %%mm7, %%mm3 \n\t" // high part of line 1
2959
2960
"movq (%%"REG_a"), %%mm4 \n\t"
2961
"movq %%mm4, %%mm5 \n\t"
2962
"punpcklbw %%mm7, %%mm4 \n\t" // low part of line 2
2963
"punpckhbw %%mm7, %%mm5 \n\t" // high part of line 2
2964
2965
"paddw %%mm0, %%mm0 \n\t" // 2L0
2966
"paddw %%mm1, %%mm1 \n\t" // 2H0
2967
"psubw %%mm4, %%mm2 \n\t" // L1 - L2
2968
"psubw %%mm5, %%mm3 \n\t" // H1 - H2
2969
"psubw %%mm2, %%mm0 \n\t" // 2L0 - L1 + L2
2970
"psubw %%mm3, %%mm1 \n\t" // 2H0 - H1 + H2
2971
2972
"psllw $2, %%mm2 \n\t" // 4L1 - 4L2
2973
"psllw $2, %%mm3 \n\t" // 4H1 - 4H2
2974
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2
2975
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2
2976
2977
"movq (%%"REG_a", %1), %%mm2 \n\t"
2978
"movq %%mm2, %%mm3 \n\t"
2979
"punpcklbw %%mm7, %%mm2 \n\t" // L3
2980
"punpckhbw %%mm7, %%mm3 \n\t" // H3
2981
2982
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2 - L3
2983
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2 - H3
2984
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2 - 2L3
2985
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2 - 2H3
2986
"movq %%mm0, (%%"REG_c") \n\t" // 2L0 - 5L1 + 5L2 - 2L3
2987
"movq %%mm1, 8(%%"REG_c") \n\t" // 2H0 - 5H1 + 5H2 - 2H3
2988
2989
"movq (%%"REG_a", %1, 2), %%mm0 \n\t"
2990
"movq %%mm0, %%mm1 \n\t"
2991
"punpcklbw %%mm7, %%mm0 \n\t" // L4
2992
"punpckhbw %%mm7, %%mm1 \n\t" // H4
2993
2994
"psubw %%mm0, %%mm2 \n\t" // L3 - L4
2995
"psubw %%mm1, %%mm3 \n\t" // H3 - H4
2996
"movq %%mm2, 16(%%"REG_c") \n\t" // L3 - L4
2997
"movq %%mm3, 24(%%"REG_c") \n\t" // H3 - H4
2998
"paddw %%mm4, %%mm4 \n\t" // 2L2
2999
"paddw %%mm5, %%mm5 \n\t" // 2H2
3000
"psubw %%mm2, %%mm4 \n\t" // 2L2 - L3 + L4
3001
"psubw %%mm3, %%mm5 \n\t" // 2H2 - H3 + H4
3002
3003
"lea (%%"REG_a", %1), %0 \n\t"
3004
"psllw $2, %%mm2 \n\t" // 4L3 - 4L4
3005
"psllw $2, %%mm3 \n\t" // 4H3 - 4H4
3006
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4
3007
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4
2874
"movq (%0), %%mm0 \n\t"
2875
"movq %%mm0, %%mm1 \n\t"
2876
"punpcklbw %%mm7, %%mm0 \n\t" // low part of line 0
2877
"punpckhbw %%mm7, %%mm1 \n\t" // high part of line 0
2878
2879
"movq (%0, %1), %%mm2 \n\t"
2880
"lea (%0, %1, 2), %%"REG_a" \n\t"
2881
"movq %%mm2, %%mm3 \n\t"
2882
"punpcklbw %%mm7, %%mm2 \n\t" // low part of line 1
2883
"punpckhbw %%mm7, %%mm3 \n\t" // high part of line 1
2884
2885
"movq (%%"REG_a"), %%mm4 \n\t"
2886
"movq %%mm4, %%mm5 \n\t"
2887
"punpcklbw %%mm7, %%mm4 \n\t" // low part of line 2
2888
"punpckhbw %%mm7, %%mm5 \n\t" // high part of line 2
2889
2890
"paddw %%mm0, %%mm0 \n\t" // 2L0
2891
"paddw %%mm1, %%mm1 \n\t" // 2H0
2892
"psubw %%mm4, %%mm2 \n\t" // L1 - L2
2893
"psubw %%mm5, %%mm3 \n\t" // H1 - H2
2894
"psubw %%mm2, %%mm0 \n\t" // 2L0 - L1 + L2
2895
"psubw %%mm3, %%mm1 \n\t" // 2H0 - H1 + H2
2896
2897
"psllw $2, %%mm2 \n\t" // 4L1 - 4L2
2898
"psllw $2, %%mm3 \n\t" // 4H1 - 4H2
2899
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2
2900
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2
2901
2902
"movq (%%"REG_a", %1), %%mm2 \n\t"
2903
"movq %%mm2, %%mm3 \n\t"
2904
"punpcklbw %%mm7, %%mm2 \n\t" // L3
2905
"punpckhbw %%mm7, %%mm3 \n\t" // H3
2906
2907
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2 - L3
2908
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2 - H3
2909
"psubw %%mm2, %%mm0 \n\t" // 2L0 - 5L1 + 5L2 - 2L3
2910
"psubw %%mm3, %%mm1 \n\t" // 2H0 - 5H1 + 5H2 - 2H3
2911
"movq %%mm0, (%%"REG_c") \n\t" // 2L0 - 5L1 + 5L2 - 2L3
2912
"movq %%mm1, 8(%%"REG_c") \n\t" // 2H0 - 5H1 + 5H2 - 2H3
2913
2914
"movq (%%"REG_a", %1, 2), %%mm0 \n\t"
2915
"movq %%mm0, %%mm1 \n\t"
2916
"punpcklbw %%mm7, %%mm0 \n\t" // L4
2917
"punpckhbw %%mm7, %%mm1 \n\t" // H4
2918
2919
"psubw %%mm0, %%mm2 \n\t" // L3 - L4
2920
"psubw %%mm1, %%mm3 \n\t" // H3 - H4
2921
"movq %%mm2, 16(%%"REG_c") \n\t" // L3 - L4
2922
"movq %%mm3, 24(%%"REG_c") \n\t" // H3 - H4
2923
"paddw %%mm4, %%mm4 \n\t" // 2L2
2924
"paddw %%mm5, %%mm5 \n\t" // 2H2
2925
"psubw %%mm2, %%mm4 \n\t" // 2L2 - L3 + L4
2926
"psubw %%mm3, %%mm5 \n\t" // 2H2 - H3 + H4
2927
2928
"lea (%%"REG_a", %1), %0 \n\t"
2929
"psllw $2, %%mm2 \n\t" // 4L3 - 4L4
2930
"psllw $2, %%mm3 \n\t" // 4H3 - 4H4
2931
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4
2932
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4
3008
2933
//50 opcodes so far
3009
"movq (%0, %1, 2), %%mm2 \n\t"
3010
"movq %%mm2, %%mm3 \n\t"
3011
"punpcklbw %%mm7, %%mm2 \n\t" // L5
3012
"punpckhbw %%mm7, %%mm3 \n\t" // H5
3013
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4 - L5
3014
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4 - H5
3015
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4 - 2L5
3016
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4 - 2H5
3017
3018
"movq (%%"REG_a", %1, 4), %%mm6 \n\t"
3019
"punpcklbw %%mm7, %%mm6 \n\t" // L6
3020
"psubw %%mm6, %%mm2 \n\t" // L5 - L6
3021
"movq (%%"REG_a", %1, 4), %%mm6 \n\t"
3022
"punpckhbw %%mm7, %%mm6 \n\t" // H6
3023
"psubw %%mm6, %%mm3 \n\t" // H5 - H6
3024
3025
"paddw %%mm0, %%mm0 \n\t" // 2L4
3026
"paddw %%mm1, %%mm1 \n\t" // 2H4
3027
"psubw %%mm2, %%mm0 \n\t" // 2L4 - L5 + L6
3028
"psubw %%mm3, %%mm1 \n\t" // 2H4 - H5 + H6
3029
3030
"psllw $2, %%mm2 \n\t" // 4L5 - 4L6
3031
"psllw $2, %%mm3 \n\t" // 4H5 - 4H6
3032
"psubw %%mm2, %%mm0 \n\t" // 2L4 - 5L5 + 5L6
3033
"psubw %%mm3, %%mm1 \n\t" // 2H4 - 5H5 + 5H6
3034
3035
"movq (%0, %1, 4), %%mm2 \n\t"
3036
"movq %%mm2, %%mm3 \n\t"
3037
"punpcklbw %%mm7, %%mm2 \n\t" // L7
3038
"punpckhbw %%mm7, %%mm3 \n\t" // H7
3039
3040
"paddw %%mm2, %%mm2 \n\t" // 2L7
3041
"paddw %%mm3, %%mm3 \n\t" // 2H7
3042
"psubw %%mm2, %%mm0 \n\t" // 2L4 - 5L5 + 5L6 - 2L7
3043
"psubw %%mm3, %%mm1 \n\t" // 2H4 - 5H5 + 5H6 - 2H7
3044
3045
"movq (%%"REG_c"), %%mm2 \n\t" // 2L0 - 5L1 + 5L2 - 2L3
3046
"movq 8(%%"REG_c"), %%mm3 \n\t" // 2H0 - 5H1 + 5H2 - 2H3
3047
3048
#ifdef HAVE_MMX2
3049
"movq %%mm7, %%mm6 \n\t" // 0
3050
"psubw %%mm0, %%mm6 \n\t"
3051
"pmaxsw %%mm6, %%mm0 \n\t" // |2L4 - 5L5 + 5L6 - 2L7|
3052
"movq %%mm7, %%mm6 \n\t" // 0
3053
"psubw %%mm1, %%mm6 \n\t"
3054
"pmaxsw %%mm6, %%mm1 \n\t" // |2H4 - 5H5 + 5H6 - 2H7|
3055
"movq %%mm7, %%mm6 \n\t" // 0
3056
"psubw %%mm2, %%mm6 \n\t"
3057
"pmaxsw %%mm6, %%mm2 \n\t" // |2L0 - 5L1 + 5L2 - 2L3|
3058
"movq %%mm7, %%mm6 \n\t" // 0
3059
"psubw %%mm3, %%mm6 \n\t"
3060
"pmaxsw %%mm6, %%mm3 \n\t" // |2H0 - 5H1 + 5H2 - 2H3|
3061
#else
3062
"movq %%mm7, %%mm6 \n\t" // 0
3063
"pcmpgtw %%mm0, %%mm6 \n\t"
3064
"pxor %%mm6, %%mm0 \n\t"
3065
"psubw %%mm6, %%mm0 \n\t" // |2L4 - 5L5 + 5L6 - 2L7|
3066
"movq %%mm7, %%mm6 \n\t" // 0
3067
"pcmpgtw %%mm1, %%mm6 \n\t"
3068
"pxor %%mm6, %%mm1 \n\t"
3069
"psubw %%mm6, %%mm1 \n\t" // |2H4 - 5H5 + 5H6 - 2H7|
3070
"movq %%mm7, %%mm6 \n\t" // 0
3071
"pcmpgtw %%mm2, %%mm6 \n\t"
3072
"pxor %%mm6, %%mm2 \n\t"
3073
"psubw %%mm6, %%mm2 \n\t" // |2L0 - 5L1 + 5L2 - 2L3|
3074
"movq %%mm7, %%mm6 \n\t" // 0
3075
"pcmpgtw %%mm3, %%mm6 \n\t"
3076
"pxor %%mm6, %%mm3 \n\t"
3077
"psubw %%mm6, %%mm3 \n\t" // |2H0 - 5H1 + 5H2 - 2H3|
3078
#endif
3079
3080
#ifdef HAVE_MMX2
3081
"pminsw %%mm2, %%mm0 \n\t"
3082
"pminsw %%mm3, %%mm1 \n\t"
3083
#else
3084
"movq %%mm0, %%mm6 \n\t"
3085
"psubusw %%mm2, %%mm6 \n\t"
3086
"psubw %%mm6, %%mm0 \n\t"
3087
"movq %%mm1, %%mm6 \n\t"
3088
"psubusw %%mm3, %%mm6 \n\t"
3089
"psubw %%mm6, %%mm1 \n\t"
3090
#endif
3091
3092
"movd %2, %%mm2 \n\t" // QP
3093
"punpcklbw %%mm7, %%mm2 \n\t"
3094
3095
"movq %%mm7, %%mm6 \n\t" // 0
3096
"pcmpgtw %%mm4, %%mm6 \n\t" // sign(2L2 - 5L3 + 5L4 - 2L5)
3097
"pxor %%mm6, %%mm4 \n\t"
3098
"psubw %%mm6, %%mm4 \n\t" // |2L2 - 5L3 + 5L4 - 2L5|
3099
"pcmpgtw %%mm5, %%mm7 \n\t" // sign(2H2 - 5H3 + 5H4 - 2H5)
3100
"pxor %%mm7, %%mm5 \n\t"
3101
"psubw %%mm7, %%mm5 \n\t" // |2H2 - 5H3 + 5H4 - 2H5|
2934
"movq (%0, %1, 2), %%mm2 \n\t"
2935
"movq %%mm2, %%mm3 \n\t"
2936
"punpcklbw %%mm7, %%mm2 \n\t" // L5
2937
"punpckhbw %%mm7, %%mm3 \n\t" // H5
2938
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4 - L5
2939
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4 - H5
2940
"psubw %%mm2, %%mm4 \n\t" // 2L2 - 5L3 + 5L4 - 2L5
2941
"psubw %%mm3, %%mm5 \n\t" // 2H2 - 5H3 + 5H4 - 2H5
2942
2943
"movq (%%"REG_a", %1, 4), %%mm6 \n\t"
2944
"punpcklbw %%mm7, %%mm6 \n\t" // L6
2945
"psubw %%mm6, %%mm2 \n\t" // L5 - L6
2946
"movq (%%"REG_a", %1, 4), %%mm6 \n\t"
2947
"punpckhbw %%mm7, %%mm6 \n\t" // H6
2948
"psubw %%mm6, %%mm3 \n\t" // H5 - H6
2949
2950
"paddw %%mm0, %%mm0 \n\t" // 2L4
2951
"paddw %%mm1, %%mm1 \n\t" // 2H4
2952
"psubw %%mm2, %%mm0 \n\t" // 2L4 - L5 + L6
2953
"psubw %%mm3, %%mm1 \n\t" // 2H4 - H5 + H6
2954
2955
"psllw $2, %%mm2 \n\t" // 4L5 - 4L6
2956
"psllw $2, %%mm3 \n\t" // 4H5 - 4H6
2957
"psubw %%mm2, %%mm0 \n\t" // 2L4 - 5L5 + 5L6
2958
"psubw %%mm3, %%mm1 \n\t" // 2H4 - 5H5 + 5H6
2959
2960
"movq (%0, %1, 4), %%mm2 \n\t"
2961
"movq %%mm2, %%mm3 \n\t"
2962
"punpcklbw %%mm7, %%mm2 \n\t" // L7
2963
"punpckhbw %%mm7, %%mm3 \n\t" // H7
2964
2965
"paddw %%mm2, %%mm2 \n\t" // 2L7
2966
"paddw %%mm3, %%mm3 \n\t" // 2H7
2967
"psubw %%mm2, %%mm0 \n\t" // 2L4 - 5L5 + 5L6 - 2L7
2968
"psubw %%mm3, %%mm1 \n\t" // 2H4 - 5H5 + 5H6 - 2H7
2969
2970
"movq (%%"REG_c"), %%mm2 \n\t" // 2L0 - 5L1 + 5L2 - 2L3
2971
"movq 8(%%"REG_c"), %%mm3 \n\t" // 2H0 - 5H1 + 5H2 - 2H3
2972
2973
#ifdef HAVE_MMX2
2974
"movq %%mm7, %%mm6 \n\t" // 0
2975
"psubw %%mm0, %%mm6 \n\t"
2976
"pmaxsw %%mm6, %%mm0 \n\t" // |2L4 - 5L5 + 5L6 - 2L7|
2977
"movq %%mm7, %%mm6 \n\t" // 0
2978
"psubw %%mm1, %%mm6 \n\t"
2979
"pmaxsw %%mm6, %%mm1 \n\t" // |2H4 - 5H5 + 5H6 - 2H7|
2980
"movq %%mm7, %%mm6 \n\t" // 0
2981
"psubw %%mm2, %%mm6 \n\t"
2982
"pmaxsw %%mm6, %%mm2 \n\t" // |2L0 - 5L1 + 5L2 - 2L3|
2983
"movq %%mm7, %%mm6 \n\t" // 0
2984
"psubw %%mm3, %%mm6 \n\t"
2985
"pmaxsw %%mm6, %%mm3 \n\t" // |2H0 - 5H1 + 5H2 - 2H3|
2986
#else
2987
"movq %%mm7, %%mm6 \n\t" // 0
2988
"pcmpgtw %%mm0, %%mm6 \n\t"
2989
"pxor %%mm6, %%mm0 \n\t"
2990
"psubw %%mm6, %%mm0 \n\t" // |2L4 - 5L5 + 5L6 - 2L7|
2991
"movq %%mm7, %%mm6 \n\t" // 0
2992
"pcmpgtw %%mm1, %%mm6 \n\t"
2993
"pxor %%mm6, %%mm1 \n\t"
2994
"psubw %%mm6, %%mm1 \n\t" // |2H4 - 5H5 + 5H6 - 2H7|
2995
"movq %%mm7, %%mm6 \n\t" // 0
2996
"pcmpgtw %%mm2, %%mm6 \n\t"
2997
"pxor %%mm6, %%mm2 \n\t"
2998
"psubw %%mm6, %%mm2 \n\t" // |2L0 - 5L1 + 5L2 - 2L3|
2999
"movq %%mm7, %%mm6 \n\t" // 0
3000
"pcmpgtw %%mm3, %%mm6 \n\t"
3001
"pxor %%mm6, %%mm3 \n\t"
3002
"psubw %%mm6, %%mm3 \n\t" // |2H0 - 5H1 + 5H2 - 2H3|
3003
#endif
3004
3005
#ifdef HAVE_MMX2
3006
"pminsw %%mm2, %%mm0 \n\t"
3007
"pminsw %%mm3, %%mm1 \n\t"
3008
#else
3009
"movq %%mm0, %%mm6 \n\t"
3010
"psubusw %%mm2, %%mm6 \n\t"
3011
"psubw %%mm6, %%mm0 \n\t"
3012
"movq %%mm1, %%mm6 \n\t"
3013
"psubusw %%mm3, %%mm6 \n\t"
3014
"psubw %%mm6, %%mm1 \n\t"
3015
#endif
3016
3017
"movd %2, %%mm2 \n\t" // QP
3018
"punpcklbw %%mm7, %%mm2 \n\t"
3019
3020
"movq %%mm7, %%mm6 \n\t" // 0
3021
"pcmpgtw %%mm4, %%mm6 \n\t" // sign(2L2 - 5L3 + 5L4 - 2L5)
3022
"pxor %%mm6, %%mm4 \n\t"
3023
"psubw %%mm6, %%mm4 \n\t" // |2L2 - 5L3 + 5L4 - 2L5|
3024
"pcmpgtw %%mm5, %%mm7 \n\t" // sign(2H2 - 5H3 + 5H4 - 2H5)
3025
"pxor %%mm7, %%mm5 \n\t"
3026
"psubw %%mm7, %%mm5 \n\t" // |2H2 - 5H3 + 5H4 - 2H5|
3102
3027
// 100 opcodes
3103
"psllw $3, %%mm2 \n\t" // 8QP
3104
"movq %%mm2, %%mm3 \n\t" // 8QP
3105
"pcmpgtw %%mm4, %%mm2 \n\t"
3106
"pcmpgtw %%mm5, %%mm3 \n\t"
3107
"pand %%mm2, %%mm4 \n\t"
3108
"pand %%mm3, %%mm5 \n\t"
3109
3110
3111
"psubusw %%mm0, %%mm4 \n\t" // hd
3112
"psubusw %%mm1, %%mm5 \n\t" // ld
3113
3114
3115
"movq "MANGLE(w05)", %%mm2 \n\t" // 5
3116
"pmullw %%mm2, %%mm4 \n\t"
3117
"pmullw %%mm2, %%mm5 \n\t"
3118
"movq "MANGLE(w20)", %%mm2 \n\t" // 32
3119
"paddw %%mm2, %%mm4 \n\t"
3120
"paddw %%mm2, %%mm5 \n\t"
3121
"psrlw $6, %%mm4 \n\t"
3122
"psrlw $6, %%mm5 \n\t"
3123
3124
"movq 16(%%"REG_c"), %%mm0 \n\t" // L3 - L4
3125
"movq 24(%%"REG_c"), %%mm1 \n\t" // H3 - H4
3126
3127
"pxor %%mm2, %%mm2 \n\t"
3128
"pxor %%mm3, %%mm3 \n\t"
3129
3130
"pcmpgtw %%mm0, %%mm2 \n\t" // sign (L3-L4)
3131
"pcmpgtw %%mm1, %%mm3 \n\t" // sign (H3-H4)
3132
"pxor %%mm2, %%mm0 \n\t"
3133
"pxor %%mm3, %%mm1 \n\t"
3134
"psubw %%mm2, %%mm0 \n\t" // |L3-L4|
3135
"psubw %%mm3, %%mm1 \n\t" // |H3-H4|
3136
"psrlw $1, %%mm0 \n\t" // |L3 - L4|/2
3137
"psrlw $1, %%mm1 \n\t" // |H3 - H4|/2
3138
3139
"pxor %%mm6, %%mm2 \n\t"
3140
"pxor %%mm7, %%mm3 \n\t"
3141
"pand %%mm2, %%mm4 \n\t"
3142
"pand %%mm3, %%mm5 \n\t"
3028
"psllw $3, %%mm2 \n\t" // 8QP
3029
"movq %%mm2, %%mm3 \n\t" // 8QP
3030
"pcmpgtw %%mm4, %%mm2 \n\t"
3031
"pcmpgtw %%mm5, %%mm3 \n\t"
3032
"pand %%mm2, %%mm4 \n\t"
3033
"pand %%mm3, %%mm5 \n\t"
3034
3035
3036
"psubusw %%mm0, %%mm4 \n\t" // hd
3037
"psubusw %%mm1, %%mm5 \n\t" // ld
3038
3039
3040
"movq "MANGLE(w05)", %%mm2 \n\t" // 5
3041
"pmullw %%mm2, %%mm4 \n\t"
3042
"pmullw %%mm2, %%mm5 \n\t"
3043
"movq "MANGLE(w20)", %%mm2 \n\t" // 32
3044
"paddw %%mm2, %%mm4 \n\t"
3045
"paddw %%mm2, %%mm5 \n\t"
3046
"psrlw $6, %%mm4 \n\t"
3047
"psrlw $6, %%mm5 \n\t"
3048
3049
"movq 16(%%"REG_c"), %%mm0 \n\t" // L3 - L4
3050
"movq 24(%%"REG_c"), %%mm1 \n\t" // H3 - H4
3051
3052
"pxor %%mm2, %%mm2 \n\t"
3053
"pxor %%mm3, %%mm3 \n\t"
3054
3055
"pcmpgtw %%mm0, %%mm2 \n\t" // sign (L3-L4)
3056
"pcmpgtw %%mm1, %%mm3 \n\t" // sign (H3-H4)
3057
"pxor %%mm2, %%mm0 \n\t"
3058
"pxor %%mm3, %%mm1 \n\t"
3059
"psubw %%mm2, %%mm0 \n\t" // |L3-L4|
3060
"psubw %%mm3, %%mm1 \n\t" // |H3-H4|
3061
"psrlw $1, %%mm0 \n\t" // |L3 - L4|/2
3062
"psrlw $1, %%mm1 \n\t" // |H3 - H4|/2
3063
3064
"pxor %%mm6, %%mm2 \n\t"
3065
"pxor %%mm7, %%mm3 \n\t"
3066
"pand %%mm2, %%mm4 \n\t"
3067
"pand %%mm3, %%mm5 \n\t"
3143
3068
3144
3069
#ifdef HAVE_MMX2
3145
"pminsw %%mm0, %%mm4 \n\t"
3146
"pminsw %%mm1, %%mm5 \n\t"
3070
"pminsw %%mm0, %%mm4 \n\t"
3071
"pminsw %%mm1, %%mm5 \n\t"
3147
3072
#else
3148
"movq %%mm4, %%mm2 \n\t"
3149
"psubusw %%mm0, %%mm2 \n\t"
3150
"psubw %%mm2, %%mm4 \n\t"
3151
"movq %%mm5, %%mm2 \n\t"
3152
"psubusw %%mm1, %%mm2 \n\t"
3153
"psubw %%mm2, %%mm5 \n\t"
3073
"movq %%mm4, %%mm2 \n\t"
3074
"psubusw %%mm0, %%mm2 \n\t"
3075
"psubw %%mm2, %%mm4 \n\t"
3076
"movq %%mm5, %%mm2 \n\t"
3077
"psubusw %%mm1, %%mm2 \n\t"
3078
"psubw %%mm2, %%mm5 \n\t"
3154
3079
#endif
3155
"pxor %%mm6, %%mm4 \n\t"
3156
"pxor %%mm7, %%mm5 \n\t"
3157
"psubw %%mm6, %%mm4 \n\t"
3158
"psubw %%mm7, %%mm5 \n\t"
3159
"packsswb %%mm5, %%mm4 \n\t"
3160
"movq %3, %%mm1 \n\t"
3161
"pandn %%mm4, %%mm1 \n\t"
3162
"movq (%0), %%mm0 \n\t"
3163
"paddb %%mm1, %%mm0 \n\t"
3164
"movq %%mm0, (%0) \n\t"
3165
"movq (%0, %1), %%mm0 \n\t"
3166
"psubb %%mm1, %%mm0 \n\t"
3167
"movq %%mm0, (%0, %1) \n\t"
3080
"pxor %%mm6, %%mm4 \n\t"
3081
"pxor %%mm7, %%mm5 \n\t"
3082
"psubw %%mm6, %%mm4 \n\t"
3083
"psubw %%mm7, %%mm5 \n\t"
3084
"packsswb %%mm5, %%mm4 \n\t"
3085
"movq %3, %%mm1 \n\t"
3086
"pandn %%mm4, %%mm1 \n\t"
3087
"movq (%0), %%mm0 \n\t"
3088
"paddb %%mm1, %%mm0 \n\t"
3089
"movq %%mm0, (%0) \n\t"
3090
"movq (%0, %1), %%mm0 \n\t"
3091
"psubb %%mm1, %%mm0 \n\t"
3092
"movq %%mm0, (%0, %1) \n\t"
3168
3093
3169
: "+r" (temp_src)
3170
: "r" ((long)step), "m" (c->pQPb), "m"(eq_mask)
3171
: "%"REG_a, "%"REG_c
3172
);
3173
}
3094
: "+r" (temp_src)
3095
: "r" ((long)step), "m" (c->pQPb), "m"(eq_mask)
3096
: "%"REG_a, "%"REG_c
3097
);
3098
}
3174
3099
/*if(step==16){
3175
3100
STOP_TIMER("step16")
3176
3101
}else{
3179
3104
}
3180
3105
#endif //HAVE_MMX
3181
3106
3182
static void RENAME(postProcess)(uint8_t src[], int srcStride, uint8_t dst[], int dstStride, int width, int height,
3183
QP_STORE_T QPs[], int QPStride, int isColor, PPContext *c);
3107
static void RENAME(postProcess)(const uint8_t src[], int srcStride, uint8_t dst[], int dstStride, int width, int height,
3108
const QP_STORE_T QPs[], int QPStride, int isColor, PPContext *c);
3184
3109
3185
3110
/**
3186
* Copies a block from src to dst and fixes the blacklevel
3187
* levelFix == 0 -> dont touch the brighness & contrast
3111
* Copies a block from src to dst and fixes the blacklevel.
3112
* levelFix == 0 -> do not touch the brighness & contrast
3188
3113
*/
3189
3114
#undef SCALED_CPY
3190
3115
3191
static inline void RENAME(blockCopy)(uint8_t dst[], int dstStride, uint8_t src[], int srcStride,
3192
int levelFix, int64_t *packedOffsetAndScale)
3116
static inline void RENAME(blockCopy)(uint8_t dst[], int dstStride, const uint8_t src[], int srcStride,
3117
int levelFix, int64_t *packedOffsetAndScale)
3193
3118
{
3194
3119
#ifndef HAVE_MMX
3195
int i;
3120
int i;
3196
3121
#endif
3197
if(levelFix)
3198
{
3122
if(levelFix){
3199
3123
#ifdef HAVE_MMX
3200
asm volatile(
3201
"movq (%%"REG_a"), %%mm2 \n\t" // packedYOffset
3202
"movq 8(%%"REG_a"), %%mm3 \n\t" // packedYScale
3203
"lea (%2,%4), %%"REG_a" \n\t"
3204
"lea (%3,%5), %%"REG_d" \n\t"
3205
"pxor %%mm4, %%mm4 \n\t"
3124
asm volatile(
3125
"movq (%%"REG_a"), %%mm2 \n\t" // packedYOffset
3126
"movq 8(%%"REG_a"), %%mm3 \n\t" // packedYScale
3127
"lea (%2,%4), %%"REG_a" \n\t"
3128
"lea (%3,%5), %%"REG_d" \n\t"
3129
"pxor %%mm4, %%mm4 \n\t"
3206
3130
#ifdef HAVE_MMX2
3207
3131
#define REAL_SCALED_CPY(src1, src2, dst1, dst2) \
3208
"movq " #src1 ", %%mm0 \n\t"\
3209
"movq " #src1 ", %%mm5 \n\t"\
3210
"movq " #src2 ", %%mm1 \n\t"\
3211
"movq " #src2 ", %%mm6 \n\t"\
3212
"punpcklbw %%mm0, %%mm0 \n\t"\
3213
"punpckhbw %%mm5, %%mm5 \n\t"\
3214
"punpcklbw %%mm1, %%mm1 \n\t"\
3215
"punpckhbw %%mm6, %%mm6 \n\t"\
3216
"pmulhuw %%mm3, %%mm0 \n\t"\
3217
"pmulhuw %%mm3, %%mm5 \n\t"\
3218
"pmulhuw %%mm3, %%mm1 \n\t"\
3219
"pmulhuw %%mm3, %%mm6 \n\t"\
3220
"psubw %%mm2, %%mm0 \n\t"\
3221
"psubw %%mm2, %%mm5 \n\t"\
3222
"psubw %%mm2, %%mm1 \n\t"\
3223
"psubw %%mm2, %%mm6 \n\t"\
3224
"packuswb %%mm5, %%mm0 \n\t"\
3225
"packuswb %%mm6, %%mm1 \n\t"\
3226
"movq %%mm0, " #dst1 " \n\t"\
3227
"movq %%mm1, " #dst2 " \n\t"\
3132
"movq " #src1 ", %%mm0 \n\t"\
3133
"movq " #src1 ", %%mm5 \n\t"\
3134
"movq " #src2 ", %%mm1 \n\t"\
3135
"movq " #src2 ", %%mm6 \n\t"\
3136
"punpcklbw %%mm0, %%mm0 \n\t"\
3137
"punpckhbw %%mm5, %%mm5 \n\t"\
3138
"punpcklbw %%mm1, %%mm1 \n\t"\
3139
"punpckhbw %%mm6, %%mm6 \n\t"\
3140
"pmulhuw %%mm3, %%mm0 \n\t"\
3141
"pmulhuw %%mm3, %%mm5 \n\t"\
3142
"pmulhuw %%mm3, %%mm1 \n\t"\
3143
"pmulhuw %%mm3, %%mm6 \n\t"\
3144
"psubw %%mm2, %%mm0 \n\t"\
3145
"psubw %%mm2, %%mm5 \n\t"\
3146
"psubw %%mm2, %%mm1 \n\t"\
3147
"psubw %%mm2, %%mm6 \n\t"\
3148
"packuswb %%mm5, %%mm0 \n\t"\
3149
"packuswb %%mm6, %%mm1 \n\t"\
3150
"movq %%mm0, " #dst1 " \n\t"\
3151
"movq %%mm1, " #dst2 " \n\t"\
3228
3152
3229
3153
#else //HAVE_MMX2
3230
3154
#define REAL_SCALED_CPY(src1, src2, dst1, dst2) \
3231
"movq " #src1 ", %%mm0 \n\t"\
3232
"movq " #src1 ", %%mm5 \n\t"\
3233
"punpcklbw %%mm4, %%mm0 \n\t"\
3234
"punpckhbw %%mm4, %%mm5 \n\t"\
3235
"psubw %%mm2, %%mm0 \n\t"\
3236
"psubw %%mm2, %%mm5 \n\t"\
3237
"movq " #src2 ", %%mm1 \n\t"\
3238
"psllw $6, %%mm0 \n\t"\
3239
"psllw $6, %%mm5 \n\t"\
3240
"pmulhw %%mm3, %%mm0 \n\t"\
3241
"movq " #src2 ", %%mm6 \n\t"\
3242
"pmulhw %%mm3, %%mm5 \n\t"\
3243
"punpcklbw %%mm4, %%mm1 \n\t"\
3244
"punpckhbw %%mm4, %%mm6 \n\t"\
3245
"psubw %%mm2, %%mm1 \n\t"\
3246
"psubw %%mm2, %%mm6 \n\t"\
3247
"psllw $6, %%mm1 \n\t"\
3248
"psllw $6, %%mm6 \n\t"\
3249
"pmulhw %%mm3, %%mm1 \n\t"\
3250
"pmulhw %%mm3, %%mm6 \n\t"\
3251
"packuswb %%mm5, %%mm0 \n\t"\
3252
"packuswb %%mm6, %%mm1 \n\t"\
3253
"movq %%mm0, " #dst1 " \n\t"\
3254
"movq %%mm1, " #dst2 " \n\t"\
3155
"movq " #src1 ", %%mm0 \n\t"\
3156
"movq " #src1 ", %%mm5 \n\t"\
3157
"punpcklbw %%mm4, %%mm0 \n\t"\
3158
"punpckhbw %%mm4, %%mm5 \n\t"\
3159
"psubw %%mm2, %%mm0 \n\t"\
3160
"psubw %%mm2, %%mm5 \n\t"\
3161
"movq " #src2 ", %%mm1 \n\t"\
3162
"psllw $6, %%mm0 \n\t"\
3163
"psllw $6, %%mm5 \n\t"\
3164
"pmulhw %%mm3, %%mm0 \n\t"\
3165
"movq " #src2 ", %%mm6 \n\t"\
3166
"pmulhw %%mm3, %%mm5 \n\t"\
3167
"punpcklbw %%mm4, %%mm1 \n\t"\
3168
"punpckhbw %%mm4, %%mm6 \n\t"\
3169
"psubw %%mm2, %%mm1 \n\t"\
3170
"psubw %%mm2, %%mm6 \n\t"\
3171
"psllw $6, %%mm1 \n\t"\
3172
"psllw $6, %%mm6 \n\t"\
3173
"pmulhw %%mm3, %%mm1 \n\t"\
3174
"pmulhw %%mm3, %%mm6 \n\t"\
3175
"packuswb %%mm5, %%mm0 \n\t"\
3176
"packuswb %%mm6, %%mm1 \n\t"\
3177
"movq %%mm0, " #dst1 " \n\t"\
3178
"movq %%mm1, " #dst2 " \n\t"\
3255
3179
3256
3180
#endif //HAVE_MMX2
3257
3181
#define SCALED_CPY(src1, src2, dst1, dst2)\
3260
3184
SCALED_CPY((%2) , (%2, %4) , (%3) , (%3, %5))
3261
3185
SCALED_CPY((%2, %4, 2), (%%REGa, %4, 2), (%3, %5, 2), (%%REGd, %5, 2))
3262
3186
SCALED_CPY((%2, %4, 4), (%%REGa, %4, 4), (%3, %5, 4), (%%REGd, %5, 4))
3263
"lea (%%"REG_a",%4,4), %%"REG_a" \n\t"
3264
"lea (%%"REG_d",%5,4), %%"REG_d" \n\t"
3187
"lea (%%"REG_a",%4,4), %%"REG_a" \n\t"
3188
"lea (%%"REG_d",%5,4), %%"REG_d" \n\t"
3265
3189
SCALED_CPY((%%REGa, %4), (%%REGa, %4, 2), (%%REGd, %5), (%%REGd, %5, 2))
3266
3190
3267
3191
3268
: "=&a" (packedOffsetAndScale)
3269
: "0" (packedOffsetAndScale),
3270
"r"(src),
3271
"r"(dst),
3272
"r" ((long)srcStride),
3273
"r" ((long)dstStride)
3274
: "%"REG_d
3275
);
3192
: "=&a" (packedOffsetAndScale)
3193
: "0" (packedOffsetAndScale),
3194
"r"(src),
3195
"r"(dst),
3196
"r" ((long)srcStride),
3197
"r" ((long)dstStride)
3198
: "%"REG_d
3199
);
3276
3200
#else //HAVE_MMX
3277
for(i=0; i<8; i++)
3278
memcpy( &(dst[dstStride*i]),
3279
&(src[srcStride*i]), BLOCK_SIZE);
3201
for(i=0; i<8; i++)
3202
memcpy( &(dst[dstStride*i]),
3203
&(src[srcStride*i]), BLOCK_SIZE);
3280
3204
#endif //HAVE_MMX
3281
}
3282
else
3283
{
3205
}else{
3284
3206
#ifdef HAVE_MMX
3285
asm volatile(
3286
"lea (%0,%2), %%"REG_a" \n\t"
3287
"lea (%1,%3), %%"REG_d" \n\t"
3207
asm volatile(
3208
"lea (%0,%2), %%"REG_a" \n\t"
3209
"lea (%1,%3), %%"REG_d" \n\t"
3288
3210
3289
3211
#define REAL_SIMPLE_CPY(src1, src2, dst1, dst2) \
3290
"movq " #src1 ", %%mm0 \n\t"\
3291
"movq " #src2 ", %%mm1 \n\t"\
3292
"movq %%mm0, " #dst1 " \n\t"\
3293
"movq %%mm1, " #dst2 " \n\t"\
3212
"movq " #src1 ", %%mm0 \n\t"\
3213
"movq " #src2 ", %%mm1 \n\t"\
3214
"movq %%mm0, " #dst1 " \n\t"\
3215
"movq %%mm1, " #dst2 " \n\t"\
3294
3216
3295
3217
#define SIMPLE_CPY(src1, src2, dst1, dst2)\
3296
3218
REAL_SIMPLE_CPY(src1, src2, dst1, dst2)
3298
3220
SIMPLE_CPY((%0) , (%0, %2) , (%1) , (%1, %3))
3299
3221
SIMPLE_CPY((%0, %2, 2), (%%REGa, %2, 2), (%1, %3, 2), (%%REGd, %3, 2))
3300
3222
SIMPLE_CPY((%0, %2, 4), (%%REGa, %2, 4), (%1, %3, 4), (%%REGd, %3, 4))
3301
"lea (%%"REG_a",%2,4), %%"REG_a" \n\t"
3302
"lea (%%"REG_d",%3,4), %%"REG_d" \n\t"
3223
"lea (%%"REG_a",%2,4), %%"REG_a" \n\t"
3224
"lea (%%"REG_d",%3,4), %%"REG_d" \n\t"
3303
3225
SIMPLE_CPY((%%REGa, %2), (%%REGa, %2, 2), (%%REGd, %3), (%%REGd, %3, 2))
3304
3226
3305
: : "r" (src),
3306
"r" (dst),
3307
"r" ((long)srcStride),
3308
"r" ((long)dstStride)
3309
: "%"REG_a, "%"REG_d
3310
);
3227
: : "r" (src),
3228
"r" (dst),
3229
"r" ((long)srcStride),
3230
"r" ((long)dstStride)
3231
: "%"REG_a, "%"REG_d
3232
);
3311
3233
#else //HAVE_MMX
3312
for(i=0; i<8; i++)
3313
memcpy( &(dst[dstStride*i]),
3314
&(src[srcStride*i]), BLOCK_SIZE);
3234
for(i=0; i<8; i++)
3235
memcpy( &(dst[dstStride*i]),
3236
&(src[srcStride*i]), BLOCK_SIZE);
3315
3237
#endif //HAVE_MMX
3316
}
3238
}
3317
3239
}
3318
3240
3319
3241
/**
3322
3244
static inline void RENAME(duplicate)(uint8_t src[], int stride)
3323
3245
{
3324
3246
#ifdef HAVE_MMX
3325
asm volatile(
3326
"movq (%0), %%mm0 \n\t"
3327
"add %1, %0 \n\t"
3328
"movq %%mm0, (%0) \n\t"
3329
"movq %%mm0, (%0, %1) \n\t"
3330
"movq %%mm0, (%0, %1, 2) \n\t"
3331
: "+r" (src)
3332
: "r" ((long)-stride)
3333
);
3247
asm volatile(
3248
"movq (%0), %%mm0 \n\t"
3249
"add %1, %0 \n\t"
3250
"movq %%mm0, (%0) \n\t"
3251
"movq %%mm0, (%0, %1) \n\t"
3252
"movq %%mm0, (%0, %1, 2) \n\t"
3253
: "+r" (src)
3254
: "r" ((long)-stride)
3255
);
3334
3256
#else
3335
int i;
3336
uint8_t *p=src;
3337
for(i=0; i<3; i++)
3338
{
3339
p-= stride;
3340
memcpy(p, src, 8);
3341
}
3257
int i;
3258
uint8_t *p=src;
3259
for(i=0; i<3; i++){
3260
p-= stride;
3261
memcpy(p, src, 8);
3262
}
3342
3263
#endif
3343
3264
}
3344
3265
3345
3266
/**
3346
3267
* Filters array of bytes (Y or U or V values)
3347
3268
*/
3348
static void RENAME(postProcess)(uint8_t src[], int srcStride, uint8_t dst[], int dstStride, int width, int height,
3349
QP_STORE_T QPs[], int QPStride, int isColor, PPContext *c2)
3269
static void RENAME(postProcess)(const uint8_t src[], int srcStride, uint8_t dst[], int dstStride, int width, int height,
3270
const QP_STORE_T QPs[], int QPStride, int isColor, PPContext *c2)
3350
3271
{
3351
PPContext __attribute__((aligned(8))) c= *c2; //copy to stack for faster access
3352
int x,y;
3272
DECLARE_ALIGNED(8, PPContext, c)= *c2; //copy to stack for faster access
3273
int x,y;
3353
3274
#ifdef COMPILE_TIME_MODE
3354
const int mode= COMPILE_TIME_MODE;
3275
const int mode= COMPILE_TIME_MODE;
3355
3276
#else
3356
const int mode= isColor ? c.ppMode.chromMode : c.ppMode.lumMode;
3357
#endif
3358
int black=0, white=255; // blackest black and whitest white in the picture
3359
int QPCorrecture= 256*256;
3360
3361
int copyAhead;
3362
#ifdef HAVE_MMX
3277
const int mode= isColor ? c.ppMode.chromMode : c.ppMode.lumMode;
3278
#endif
3279
int black=0, white=255; // blackest black and whitest white in the picture
3280
int QPCorrecture= 256*256;
3281
3282
int copyAhead;
3283
#ifdef HAVE_MMX
3284
int i;
3285
#endif
3286
3287
const int qpHShift= isColor ? 4-c.hChromaSubSample : 4;
3288
const int qpVShift= isColor ? 4-c.vChromaSubSample : 4;
3289
3290
//FIXME remove
3291
uint64_t * const yHistogram= c.yHistogram;
3292
uint8_t * const tempSrc= srcStride > 0 ? c.tempSrc : c.tempSrc - 23*srcStride;
3293
uint8_t * const tempDst= dstStride > 0 ? c.tempDst : c.tempDst - 23*dstStride;
3294
//const int mbWidth= isColor ? (width+7)>>3 : (width+15)>>4;
3295
3296
#ifdef HAVE_MMX
3297
for(i=0; i<57; i++){
3298
int offset= ((i*c.ppMode.baseDcDiff)>>8) + 1;
3299
int threshold= offset*2 + 1;
3300
c.mmxDcOffset[i]= 0x7F - offset;
3301
c.mmxDcThreshold[i]= 0x7F - threshold;
3302
c.mmxDcOffset[i]*= 0x0101010101010101LL;
3303
c.mmxDcThreshold[i]*= 0x0101010101010101LL;
3304
}
3305
#endif
3306
3307
if(mode & CUBIC_IPOL_DEINT_FILTER) copyAhead=16;
3308
else if( (mode & LINEAR_BLEND_DEINT_FILTER)
3309
|| (mode & FFMPEG_DEINT_FILTER)
3310
|| (mode & LOWPASS5_DEINT_FILTER)) copyAhead=14;
3311
else if( (mode & V_DEBLOCK)
3312
|| (mode & LINEAR_IPOL_DEINT_FILTER)
3313
|| (mode & MEDIAN_DEINT_FILTER)
3314
|| (mode & V_A_DEBLOCK)) copyAhead=13;
3315
else if(mode & V_X1_FILTER) copyAhead=11;
3316
// else if(mode & V_RK1_FILTER) copyAhead=10;
3317
else if(mode & DERING) copyAhead=9;
3318
else copyAhead=8;
3319
3320
copyAhead-= 8;
3321
3322
if(!isColor){
3323
uint64_t sum= 0;
3363
3324
int i;
3364
#endif
3365
3366
const int qpHShift= isColor ? 4-c.hChromaSubSample : 4;
3367
const int qpVShift= isColor ? 4-c.vChromaSubSample : 4;
3368
3369
//FIXME remove
3370
uint64_t * const yHistogram= c.yHistogram;
3371
uint8_t * const tempSrc= srcStride > 0 ? c.tempSrc : c.tempSrc - 23*srcStride;
3372
uint8_t * const tempDst= dstStride > 0 ? c.tempDst : c.tempDst - 23*dstStride;
3373
//const int mbWidth= isColor ? (width+7)>>3 : (width+15)>>4;
3374
3375
#ifdef HAVE_MMX
3376
for(i=0; i<57; i++){
3377
int offset= ((i*c.ppMode.baseDcDiff)>>8) + 1;
3378
int threshold= offset*2 + 1;
3379
c.mmxDcOffset[i]= 0x7F - offset;
3380
c.mmxDcThreshold[i]= 0x7F - threshold;
3381
c.mmxDcOffset[i]*= 0x0101010101010101LL;
3382
c.mmxDcThreshold[i]*= 0x0101010101010101LL;
3383
}
3384
#endif
3385
3386
if(mode & CUBIC_IPOL_DEINT_FILTER) copyAhead=16;
3387
else if( (mode & LINEAR_BLEND_DEINT_FILTER)
3388
|| (mode & FFMPEG_DEINT_FILTER)
3389
|| (mode & LOWPASS5_DEINT_FILTER)) copyAhead=14;
3390
else if( (mode & V_DEBLOCK)
3391
|| (mode & LINEAR_IPOL_DEINT_FILTER)
3392
|| (mode & MEDIAN_DEINT_FILTER)
3393
|| (mode & V_A_DEBLOCK)) copyAhead=13;
3394
else if(mode & V_X1_FILTER) copyAhead=11;
3395
// else if(mode & V_RK1_FILTER) copyAhead=10;
3396
else if(mode & DERING) copyAhead=9;
3397
else copyAhead=8;
3398
3399
copyAhead-= 8;
3400
3401
if(!isColor)
3402
{
3403
uint64_t sum= 0;
3404
int i;
3405
uint64_t maxClipped;
3406
uint64_t clipped;
3407
double scale;
3408
3409
c.frameNum++;
3410
// first frame is fscked so we ignore it
3411
if(c.frameNum == 1) yHistogram[0]= width*height/64*15/256;
3412
3413
for(i=0; i<256; i++)
3414
{
3415
sum+= yHistogram[i];
3416
}
3417
3418
/* we allways get a completly black picture first */
3419
maxClipped= (uint64_t)(sum * c.ppMode.maxClippedThreshold);
3420
3421
clipped= sum;
3422
for(black=255; black>0; black--)
3423
{
3424
if(clipped < maxClipped) break;
3425
clipped-= yHistogram[black];
3426
}
3427
3428
clipped= sum;
3429
for(white=0; white<256; white++)
3430
{
3431
if(clipped < maxClipped) break;
3432
clipped-= yHistogram[white];
3433
}
3434
3435
scale= (double)(c.ppMode.maxAllowedY - c.ppMode.minAllowedY) / (double)(white-black);
3325
uint64_t maxClipped;
3326
uint64_t clipped;
3327
double scale;
3328
3329
c.frameNum++;
3330
// first frame is fscked so we ignore it
3331
if(c.frameNum == 1) yHistogram[0]= width*height/64*15/256;
3332
3333
for(i=0; i<256; i++){
3334
sum+= yHistogram[i];
3335
}
3336
3337
/* We always get a completely black picture first. */
3338
maxClipped= (uint64_t)(sum * c.ppMode.maxClippedThreshold);
3339
3340
clipped= sum;
3341
for(black=255; black>0; black--){
3342
if(clipped < maxClipped) break;
3343
clipped-= yHistogram[black];
3344
}
3345
3346
clipped= sum;
3347
for(white=0; white<256; white++){
3348
if(clipped < maxClipped) break;
3349
clipped-= yHistogram[white];
3350
}
3351
3352
scale= (double)(c.ppMode.maxAllowedY - c.ppMode.minAllowedY) / (double)(white-black);
3436
3353
3437
3354
#ifdef HAVE_MMX2
3438
c.packedYScale= (uint16_t)(scale*256.0 + 0.5);
3439
c.packedYOffset= (((black*c.packedYScale)>>8) - c.ppMode.minAllowedY) & 0xFFFF;
3355
c.packedYScale= (uint16_t)(scale*256.0 + 0.5);
3356
c.packedYOffset= (((black*c.packedYScale)>>8) - c.ppMode.minAllowedY) & 0xFFFF;
3440
3357
#else
3441
c.packedYScale= (uint16_t)(scale*1024.0 + 0.5);
3442
c.packedYOffset= (black - c.ppMode.minAllowedY) & 0xFFFF;
3443
#endif
3444
3445
c.packedYOffset|= c.packedYOffset<<32;
3446
c.packedYOffset|= c.packedYOffset<<16;
3447
3448
c.packedYScale|= c.packedYScale<<32;
3449
c.packedYScale|= c.packedYScale<<16;
3450
3451
if(mode & LEVEL_FIX) QPCorrecture= (int)(scale*256*256 + 0.5);
3452
else QPCorrecture= 256*256;
3453
}
3454
else
3455
{
3456
c.packedYScale= 0x0100010001000100LL;
3457
c.packedYOffset= 0;
3458
QPCorrecture= 256*256;
3459
}
3460
3461
/* copy & deinterlace first row of blocks */
3462
y=-BLOCK_SIZE;
3463
{
3464
uint8_t *srcBlock= &(src[y*srcStride]);
3465
uint8_t *dstBlock= tempDst + dstStride;
3466
3467
// From this point on it is guaranteed that we can read and write 16 lines downward
3468
// finish 1 block before the next otherwise we might have a problem
3469
// with the L1 Cache of the P4 ... or only a few blocks at a time or soemthing
3470
for(x=0; x<width; x+=BLOCK_SIZE)
3471
{
3472
3473
#ifdef HAVE_MMX2
3474
/*
3475
prefetchnta(srcBlock + (((x>>2)&6) + 5)*srcStride + 32);
3476
prefetchnta(srcBlock + (((x>>2)&6) + 6)*srcStride + 32);
3477
prefetcht0(dstBlock + (((x>>2)&6) + 5)*dstStride + 32);
3478
prefetcht0(dstBlock + (((x>>2)&6) + 6)*dstStride + 32);
3479
*/
3480
3481
asm(
3482
"mov %4, %%"REG_a" \n\t"
3483
"shr $2, %%"REG_a" \n\t"
3484
"and $6, %%"REG_a" \n\t"
3485
"add %5, %%"REG_a" \n\t"
3486
"mov %%"REG_a", %%"REG_d" \n\t"
3487
"imul %1, %%"REG_a" \n\t"
3488
"imul %3, %%"REG_d" \n\t"
3489
"prefetchnta 32(%%"REG_a", %0) \n\t"
3490
"prefetcht0 32(%%"REG_d", %2) \n\t"
3491
"add %1, %%"REG_a" \n\t"
3492
"add %3, %%"REG_d" \n\t"
3493
"prefetchnta 32(%%"REG_a", %0) \n\t"
3494
"prefetcht0 32(%%"REG_d", %2) \n\t"
3495
:: "r" (srcBlock), "r" ((long)srcStride), "r" (dstBlock), "r" ((long)dstStride),
3496
"g" ((long)x), "g" ((long)copyAhead)
3497
: "%"REG_a, "%"REG_d
3498
);
3499
3500
#elif defined(HAVE_3DNOW)
3501
//FIXME check if this is faster on an 3dnow chip or if its faster without the prefetch or ...
3502
/* prefetch(srcBlock + (((x>>3)&3) + 5)*srcStride + 32);
3503
prefetch(srcBlock + (((x>>3)&3) + 9)*srcStride + 32);
3504
prefetchw(dstBlock + (((x>>3)&3) + 5)*dstStride + 32);
3505
prefetchw(dstBlock + (((x>>3)&3) + 9)*dstStride + 32);
3506
*/
3507
#endif
3508
3509
RENAME(blockCopy)(dstBlock + dstStride*8, dstStride,
3510
srcBlock + srcStride*8, srcStride, mode & LEVEL_FIX, &c.packedYOffset);
3511
3512
RENAME(duplicate)(dstBlock + dstStride*8, dstStride);
3513
3514
if(mode & LINEAR_IPOL_DEINT_FILTER)
3515
RENAME(deInterlaceInterpolateLinear)(dstBlock, dstStride);
3516
else if(mode & LINEAR_BLEND_DEINT_FILTER)
3517
RENAME(deInterlaceBlendLinear)(dstBlock, dstStride, c.deintTemp + x);
3518
else if(mode & MEDIAN_DEINT_FILTER)
3519
RENAME(deInterlaceMedian)(dstBlock, dstStride);
3520
else if(mode & CUBIC_IPOL_DEINT_FILTER)
3521
RENAME(deInterlaceInterpolateCubic)(dstBlock, dstStride);
3522
else if(mode & FFMPEG_DEINT_FILTER)
3523
RENAME(deInterlaceFF)(dstBlock, dstStride, c.deintTemp + x);
3524
else if(mode & LOWPASS5_DEINT_FILTER)
3525
RENAME(deInterlaceL5)(dstBlock, dstStride, c.deintTemp + x, c.deintTemp + width + x);
3526
/* else if(mode & CUBIC_BLEND_DEINT_FILTER)
3527
RENAME(deInterlaceBlendCubic)(dstBlock, dstStride);
3528
*/
3529
dstBlock+=8;
3530
srcBlock+=8;
3531
}
3532
if(width==FFABS(dstStride))
3533
linecpy(dst, tempDst + 9*dstStride, copyAhead, dstStride);
3534
else
3535
{
3536
int i;
3537
for(i=0; i<copyAhead; i++)
3538
{
3539
memcpy(dst + i*dstStride, tempDst + (9+i)*dstStride, width);
3540
}
3541
}
3542
}
3543
3544
for(y=0; y<height; y+=BLOCK_SIZE)
3545
{
3546
//1% speedup if these are here instead of the inner loop
3547
uint8_t *srcBlock= &(src[y*srcStride]);
3548
uint8_t *dstBlock= &(dst[y*dstStride]);
3549
#ifdef HAVE_MMX
3550
uint8_t *tempBlock1= c.tempBlocks;
3551
uint8_t *tempBlock2= c.tempBlocks + 8;
3552
#endif
3553
int8_t *QPptr= &QPs[(y>>qpVShift)*QPStride];
3554
int8_t *nonBQPptr= &c.nonBQPTable[(y>>qpVShift)*FFABS(QPStride)];
3555
int QP=0;
3556
/* can we mess with a 8x16 block from srcBlock/dstBlock downwards and 1 line upwards
3557
if not than use a temporary buffer */
3558
if(y+15 >= height)
3559
{
3560
int i;
3561
/* copy from line (copyAhead) to (copyAhead+7) of src, these will be copied with
3562
blockcopy to dst later */
3563
linecpy(tempSrc + srcStride*copyAhead, srcBlock + srcStride*copyAhead,
3564
FFMAX(height-y-copyAhead, 0), srcStride);
3565
3566
/* duplicate last line of src to fill the void upto line (copyAhead+7) */
3567
for(i=FFMAX(height-y, 8); i<copyAhead+8; i++)
3568
memcpy(tempSrc + srcStride*i, src + srcStride*(height-1), FFABS(srcStride));
3569
3570
/* copy up to (copyAhead+1) lines of dst (line -1 to (copyAhead-1))*/
3571
linecpy(tempDst, dstBlock - dstStride, FFMIN(height-y+1, copyAhead+1), dstStride);
3572
3573
/* duplicate last line of dst to fill the void upto line (copyAhead) */
3574
for(i=height-y+1; i<=copyAhead; i++)
3575
memcpy(tempDst + dstStride*i, dst + dstStride*(height-1), FFABS(dstStride));
3576
3577
dstBlock= tempDst + dstStride;
3578
srcBlock= tempSrc;
3579
}
3580
3581
// From this point on it is guaranteed that we can read and write 16 lines downward
3582
// finish 1 block before the next otherwise we might have a problem
3583
// with the L1 Cache of the P4 ... or only a few blocks at a time or soemthing
3584
for(x=0; x<width; x+=BLOCK_SIZE)
3585
{
3586
const int stride= dstStride;
3587
#ifdef HAVE_MMX
3588
uint8_t *tmpXchg;
3589
#endif
3590
if(isColor)
3591
{
3592
QP= QPptr[x>>qpHShift];
3593
c.nonBQP= nonBQPptr[x>>qpHShift];
3594
}
3595
else
3596
{
3597
QP= QPptr[x>>4];
3598
QP= (QP* QPCorrecture + 256*128)>>16;
3599
c.nonBQP= nonBQPptr[x>>4];
3600
c.nonBQP= (c.nonBQP* QPCorrecture + 256*128)>>16;
3601
yHistogram[ srcBlock[srcStride*12 + 4] ]++;
3602
}
3603
c.QP= QP;
3604
#ifdef HAVE_MMX
3605
asm volatile(
3606
"movd %1, %%mm7 \n\t"
3607
"packuswb %%mm7, %%mm7 \n\t" // 0, 0, 0, QP, 0, 0, 0, QP
3608
"packuswb %%mm7, %%mm7 \n\t" // 0,QP, 0, QP, 0,QP, 0, QP
3609
"packuswb %%mm7, %%mm7 \n\t" // QP,..., QP
3610
"movq %%mm7, %0 \n\t"
3611
: "=m" (c.pQPb)
3612
: "r" (QP)
3613
);
3614
#endif
3615
3616
3617
#ifdef HAVE_MMX2
3618
/*
3619
prefetchnta(srcBlock + (((x>>2)&6) + 5)*srcStride + 32);
3620
prefetchnta(srcBlock + (((x>>2)&6) + 6)*srcStride + 32);
3621
prefetcht0(dstBlock + (((x>>2)&6) + 5)*dstStride + 32);
3622
prefetcht0(dstBlock + (((x>>2)&6) + 6)*dstStride + 32);
3623
*/
3624
3625
asm(
3626
"mov %4, %%"REG_a" \n\t"
3627
"shr $2, %%"REG_a" \n\t"
3628
"and $6, %%"REG_a" \n\t"
3629
"add %5, %%"REG_a" \n\t"
3630
"mov %%"REG_a", %%"REG_d" \n\t"
3631
"imul %1, %%"REG_a" \n\t"
3632
"imul %3, %%"REG_d" \n\t"
3633
"prefetchnta 32(%%"REG_a", %0) \n\t"
3634
"prefetcht0 32(%%"REG_d", %2) \n\t"
3635
"add %1, %%"REG_a" \n\t"
3636
"add %3, %%"REG_d" \n\t"
3637
"prefetchnta 32(%%"REG_a", %0) \n\t"
3638
"prefetcht0 32(%%"REG_d", %2) \n\t"
3639
:: "r" (srcBlock), "r" ((long)srcStride), "r" (dstBlock), "r" ((long)dstStride),
3640
"g" ((long)x), "g" ((long)copyAhead)
3641
: "%"REG_a, "%"REG_d
3642
);
3643
3644
#elif defined(HAVE_3DNOW)
3645
//FIXME check if this is faster on an 3dnow chip or if its faster without the prefetch or ...
3646
/* prefetch(srcBlock + (((x>>3)&3) + 5)*srcStride + 32);
3647
prefetch(srcBlock + (((x>>3)&3) + 9)*srcStride + 32);
3648
prefetchw(dstBlock + (((x>>3)&3) + 5)*dstStride + 32);
3649
prefetchw(dstBlock + (((x>>3)&3) + 9)*dstStride + 32);
3650
*/
3651
#endif
3652
3653
RENAME(blockCopy)(dstBlock + dstStride*copyAhead, dstStride,
3654
srcBlock + srcStride*copyAhead, srcStride, mode & LEVEL_FIX, &c.packedYOffset);
3655
3656
if(mode & LINEAR_IPOL_DEINT_FILTER)
3657
RENAME(deInterlaceInterpolateLinear)(dstBlock, dstStride);
3658
else if(mode & LINEAR_BLEND_DEINT_FILTER)
3659
RENAME(deInterlaceBlendLinear)(dstBlock, dstStride, c.deintTemp + x);
3660
else if(mode & MEDIAN_DEINT_FILTER)
3661
RENAME(deInterlaceMedian)(dstBlock, dstStride);
3662
else if(mode & CUBIC_IPOL_DEINT_FILTER)
3663
RENAME(deInterlaceInterpolateCubic)(dstBlock, dstStride);
3664
else if(mode & FFMPEG_DEINT_FILTER)
3665
RENAME(deInterlaceFF)(dstBlock, dstStride, c.deintTemp + x);
3666
else if(mode & LOWPASS5_DEINT_FILTER)
3667
RENAME(deInterlaceL5)(dstBlock, dstStride, c.deintTemp + x, c.deintTemp + width + x);
3668
/* else if(mode & CUBIC_BLEND_DEINT_FILTER)
3669
RENAME(deInterlaceBlendCubic)(dstBlock, dstStride);
3670
*/
3671
3672
/* only deblock if we have 2 blocks */
3673
if(y + 8 < height)
3674
{
3675
if(mode & V_X1_FILTER)
3676
RENAME(vertX1Filter)(dstBlock, stride, &c);
3677
else if(mode & V_DEBLOCK)
3678
{
3679
const int t= RENAME(vertClassify)(dstBlock, stride, &c);
3680
3681
if(t==1)
3682
RENAME(doVertLowPass)(dstBlock, stride, &c);
3683
else if(t==2)
3684
RENAME(doVertDefFilter)(dstBlock, stride, &c);
3685
}else if(mode & V_A_DEBLOCK){
3686
RENAME(do_a_deblock)(dstBlock, stride, 1, &c);
3687
}
3688
}
3689
3690
#ifdef HAVE_MMX
3691
RENAME(transpose1)(tempBlock1, tempBlock2, dstBlock, dstStride);
3692
#endif
3693
/* check if we have a previous block to deblock it with dstBlock */
3694
if(x - 8 >= 0)
3695
{
3696
#ifdef HAVE_MMX
3697
if(mode & H_X1_FILTER)
3698
RENAME(vertX1Filter)(tempBlock1, 16, &c);
3699
else if(mode & H_DEBLOCK)
3700
{
3358
c.packedYScale= (uint16_t)(scale*1024.0 + 0.5);
3359
c.packedYOffset= (black - c.ppMode.minAllowedY) & 0xFFFF;
3360
#endif
3361
3362
c.packedYOffset|= c.packedYOffset<<32;
3363
c.packedYOffset|= c.packedYOffset<<16;
3364
3365
c.packedYScale|= c.packedYScale<<32;
3366
c.packedYScale|= c.packedYScale<<16;
3367
3368
if(mode & LEVEL_FIX) QPCorrecture= (int)(scale*256*256 + 0.5);
3369
else QPCorrecture= 256*256;
3370
}else{
3371
c.packedYScale= 0x0100010001000100LL;
3372
c.packedYOffset= 0;
3373
QPCorrecture= 256*256;
3374
}
3375
3376
/* copy & deinterlace first row of blocks */
3377
y=-BLOCK_SIZE;
3378
{
3379
const uint8_t *srcBlock= &(src[y*srcStride]);
3380
uint8_t *dstBlock= tempDst + dstStride;
3381
3382
// From this point on it is guaranteed that we can read and write 16 lines downward
3383
// finish 1 block before the next otherwise we might have a problem
3384
// with the L1 Cache of the P4 ... or only a few blocks at a time or soemthing
3385
for(x=0; x<width; x+=BLOCK_SIZE){
3386
3387
#ifdef HAVE_MMX2
3388
/*
3389
prefetchnta(srcBlock + (((x>>2)&6) + 5)*srcStride + 32);
3390
prefetchnta(srcBlock + (((x>>2)&6) + 6)*srcStride + 32);
3391
prefetcht0(dstBlock + (((x>>2)&6) + 5)*dstStride + 32);
3392
prefetcht0(dstBlock + (((x>>2)&6) + 6)*dstStride + 32);
3393
*/
3394
3395
asm(
3396
"mov %4, %%"REG_a" \n\t"
3397
"shr $2, %%"REG_a" \n\t"
3398
"and $6, %%"REG_a" \n\t"
3399
"add %5, %%"REG_a" \n\t"
3400
"mov %%"REG_a", %%"REG_d" \n\t"
3401
"imul %1, %%"REG_a" \n\t"
3402
"imul %3, %%"REG_d" \n\t"
3403
"prefetchnta 32(%%"REG_a", %0) \n\t"
3404
"prefetcht0 32(%%"REG_d", %2) \n\t"
3405
"add %1, %%"REG_a" \n\t"
3406
"add %3, %%"REG_d" \n\t"
3407
"prefetchnta 32(%%"REG_a", %0) \n\t"
3408
"prefetcht0 32(%%"REG_d", %2) \n\t"
3409
:: "r" (srcBlock), "r" ((long)srcStride), "r" (dstBlock), "r" ((long)dstStride),
3410
"g" ((long)x), "g" ((long)copyAhead)
3411
: "%"REG_a, "%"REG_d
3412
);
3413
3414
#elif defined(HAVE_3DNOW)
3415
//FIXME check if this is faster on an 3dnow chip or if it is faster without the prefetch or ...
3416
/* prefetch(srcBlock + (((x>>3)&3) + 5)*srcStride + 32);
3417
prefetch(srcBlock + (((x>>3)&3) + 9)*srcStride + 32);
3418
prefetchw(dstBlock + (((x>>3)&3) + 5)*dstStride + 32);
3419
prefetchw(dstBlock + (((x>>3)&3) + 9)*dstStride + 32);
3420
*/
3421
#endif
3422
3423
RENAME(blockCopy)(dstBlock + dstStride*8, dstStride,
3424
srcBlock + srcStride*8, srcStride, mode & LEVEL_FIX, &c.packedYOffset);
3425
3426
RENAME(duplicate)(dstBlock + dstStride*8, dstStride);
3427
3428
if(mode & LINEAR_IPOL_DEINT_FILTER)
3429
RENAME(deInterlaceInterpolateLinear)(dstBlock, dstStride);
3430
else if(mode & LINEAR_BLEND_DEINT_FILTER)
3431
RENAME(deInterlaceBlendLinear)(dstBlock, dstStride, c.deintTemp + x);
3432
else if(mode & MEDIAN_DEINT_FILTER)
3433
RENAME(deInterlaceMedian)(dstBlock, dstStride);
3434
else if(mode & CUBIC_IPOL_DEINT_FILTER)
3435
RENAME(deInterlaceInterpolateCubic)(dstBlock, dstStride);
3436
else if(mode & FFMPEG_DEINT_FILTER)
3437
RENAME(deInterlaceFF)(dstBlock, dstStride, c.deintTemp + x);
3438
else if(mode & LOWPASS5_DEINT_FILTER)
3439
RENAME(deInterlaceL5)(dstBlock, dstStride, c.deintTemp + x, c.deintTemp + width + x);
3440
/* else if(mode & CUBIC_BLEND_DEINT_FILTER)
3441
RENAME(deInterlaceBlendCubic)(dstBlock, dstStride);
3442
*/
3443
dstBlock+=8;
3444
srcBlock+=8;
3445
}
3446
if(width==FFABS(dstStride))
3447
linecpy(dst, tempDst + 9*dstStride, copyAhead, dstStride);
3448
else{
3449
int i;
3450
for(i=0; i<copyAhead; i++){
3451
memcpy(dst + i*dstStride, tempDst + (9+i)*dstStride, width);
3452
}
3453
}
3454
}
3455
3456
for(y=0; y<height; y+=BLOCK_SIZE){
3457
//1% speedup if these are here instead of the inner loop
3458
const uint8_t *srcBlock= &(src[y*srcStride]);
3459
uint8_t *dstBlock= &(dst[y*dstStride]);
3460
#ifdef HAVE_MMX
3461
uint8_t *tempBlock1= c.tempBlocks;
3462
uint8_t *tempBlock2= c.tempBlocks + 8;
3463
#endif
3464
const int8_t *QPptr= &QPs[(y>>qpVShift)*QPStride];
3465
int8_t *nonBQPptr= &c.nonBQPTable[(y>>qpVShift)*FFABS(QPStride)];
3466
int QP=0;
3467
/* can we mess with a 8x16 block from srcBlock/dstBlock downwards and 1 line upwards
3468
if not than use a temporary buffer */
3469
if(y+15 >= height){
3470
int i;
3471
/* copy from line (copyAhead) to (copyAhead+7) of src, these will be copied with
3472
blockcopy to dst later */
3473
linecpy(tempSrc + srcStride*copyAhead, srcBlock + srcStride*copyAhead,
3474
FFMAX(height-y-copyAhead, 0), srcStride);
3475
3476
/* duplicate last line of src to fill the void upto line (copyAhead+7) */
3477
for(i=FFMAX(height-y, 8); i<copyAhead+8; i++)
3478
memcpy(tempSrc + srcStride*i, src + srcStride*(height-1), FFABS(srcStride));
3479
3480
/* copy up to (copyAhead+1) lines of dst (line -1 to (copyAhead-1))*/
3481
linecpy(tempDst, dstBlock - dstStride, FFMIN(height-y+1, copyAhead+1), dstStride);
3482
3483
/* duplicate last line of dst to fill the void upto line (copyAhead) */
3484
for(i=height-y+1; i<=copyAhead; i++)
3485
memcpy(tempDst + dstStride*i, dst + dstStride*(height-1), FFABS(dstStride));
3486
3487
dstBlock= tempDst + dstStride;
3488
srcBlock= tempSrc;
3489
}
3490
3491
// From this point on it is guaranteed that we can read and write 16 lines downward
3492
// finish 1 block before the next otherwise we might have a problem
3493
// with the L1 Cache of the P4 ... or only a few blocks at a time or soemthing
3494
for(x=0; x<width; x+=BLOCK_SIZE){
3495
const int stride= dstStride;
3496
#ifdef HAVE_MMX
3497
uint8_t *tmpXchg;
3498
#endif
3499
if(isColor){
3500
QP= QPptr[x>>qpHShift];
3501
c.nonBQP= nonBQPptr[x>>qpHShift];
3502
}else{
3503
QP= QPptr[x>>4];
3504
QP= (QP* QPCorrecture + 256*128)>>16;
3505
c.nonBQP= nonBQPptr[x>>4];
3506
c.nonBQP= (c.nonBQP* QPCorrecture + 256*128)>>16;
3507
yHistogram[ srcBlock[srcStride*12 + 4] ]++;
3508
}
3509
c.QP= QP;
3510
#ifdef HAVE_MMX
3511
asm volatile(
3512
"movd %1, %%mm7 \n\t"
3513
"packuswb %%mm7, %%mm7 \n\t" // 0, 0, 0, QP, 0, 0, 0, QP
3514
"packuswb %%mm7, %%mm7 \n\t" // 0,QP, 0, QP, 0,QP, 0, QP
3515
"packuswb %%mm7, %%mm7 \n\t" // QP,..., QP
3516
"movq %%mm7, %0 \n\t"
3517
: "=m" (c.pQPb)
3518
: "r" (QP)
3519
);
3520
#endif
3521
3522
3523
#ifdef HAVE_MMX2
3524
/*
3525
prefetchnta(srcBlock + (((x>>2)&6) + 5)*srcStride + 32);
3526
prefetchnta(srcBlock + (((x>>2)&6) + 6)*srcStride + 32);
3527
prefetcht0(dstBlock + (((x>>2)&6) + 5)*dstStride + 32);
3528
prefetcht0(dstBlock + (((x>>2)&6) + 6)*dstStride + 32);
3529
*/
3530
3531
asm(
3532
"mov %4, %%"REG_a" \n\t"
3533
"shr $2, %%"REG_a" \n\t"
3534
"and $6, %%"REG_a" \n\t"
3535
"add %5, %%"REG_a" \n\t"
3536
"mov %%"REG_a", %%"REG_d" \n\t"
3537
"imul %1, %%"REG_a" \n\t"
3538
"imul %3, %%"REG_d" \n\t"
3539
"prefetchnta 32(%%"REG_a", %0) \n\t"
3540
"prefetcht0 32(%%"REG_d", %2) \n\t"
3541
"add %1, %%"REG_a" \n\t"
3542
"add %3, %%"REG_d" \n\t"
3543
"prefetchnta 32(%%"REG_a", %0) \n\t"
3544
"prefetcht0 32(%%"REG_d", %2) \n\t"
3545
:: "r" (srcBlock), "r" ((long)srcStride), "r" (dstBlock), "r" ((long)dstStride),
3546
"g" ((long)x), "g" ((long)copyAhead)
3547
: "%"REG_a, "%"REG_d
3548
);
3549
3550
#elif defined(HAVE_3DNOW)
3551
//FIXME check if this is faster on an 3dnow chip or if it is faster without the prefetch or ...
3552
/* prefetch(srcBlock + (((x>>3)&3) + 5)*srcStride + 32);
3553
prefetch(srcBlock + (((x>>3)&3) + 9)*srcStride + 32);
3554
prefetchw(dstBlock + (((x>>3)&3) + 5)*dstStride + 32);
3555
prefetchw(dstBlock + (((x>>3)&3) + 9)*dstStride + 32);
3556
*/
3557
#endif
3558
3559
RENAME(blockCopy)(dstBlock + dstStride*copyAhead, dstStride,
3560
srcBlock + srcStride*copyAhead, srcStride, mode & LEVEL_FIX, &c.packedYOffset);
3561
3562
if(mode & LINEAR_IPOL_DEINT_FILTER)
3563
RENAME(deInterlaceInterpolateLinear)(dstBlock, dstStride);
3564
else if(mode & LINEAR_BLEND_DEINT_FILTER)
3565
RENAME(deInterlaceBlendLinear)(dstBlock, dstStride, c.deintTemp + x);
3566
else if(mode & MEDIAN_DEINT_FILTER)
3567
RENAME(deInterlaceMedian)(dstBlock, dstStride);
3568
else if(mode & CUBIC_IPOL_DEINT_FILTER)
3569
RENAME(deInterlaceInterpolateCubic)(dstBlock, dstStride);
3570
else if(mode & FFMPEG_DEINT_FILTER)
3571
RENAME(deInterlaceFF)(dstBlock, dstStride, c.deintTemp + x);
3572
else if(mode & LOWPASS5_DEINT_FILTER)
3573
RENAME(deInterlaceL5)(dstBlock, dstStride, c.deintTemp + x, c.deintTemp + width + x);
3574
/* else if(mode & CUBIC_BLEND_DEINT_FILTER)
3575
RENAME(deInterlaceBlendCubic)(dstBlock, dstStride);
3576
*/
3577
3578
/* only deblock if we have 2 blocks */
3579
if(y + 8 < height){
3580
if(mode & V_X1_FILTER)
3581
RENAME(vertX1Filter)(dstBlock, stride, &c);
3582
else if(mode & V_DEBLOCK){
3583
const int t= RENAME(vertClassify)(dstBlock, stride, &c);
3584
3585
if(t==1)
3586
RENAME(doVertLowPass)(dstBlock, stride, &c);
3587
else if(t==2)
3588
RENAME(doVertDefFilter)(dstBlock, stride, &c);
3589
}else if(mode & V_A_DEBLOCK){
3590
RENAME(do_a_deblock)(dstBlock, stride, 1, &c);
3591
}
3592
}
3593
3594
#ifdef HAVE_MMX
3595
RENAME(transpose1)(tempBlock1, tempBlock2, dstBlock, dstStride);
3596
#endif
3597
/* check if we have a previous block to deblock it with dstBlock */
3598
if(x - 8 >= 0){
3599
#ifdef HAVE_MMX
3600
if(mode & H_X1_FILTER)
3601
RENAME(vertX1Filter)(tempBlock1, 16, &c);
3602
else if(mode & H_DEBLOCK){
3701
3603
//START_TIMER
3702
const int t= RENAME(vertClassify)(tempBlock1, 16, &c);
3604
const int t= RENAME(vertClassify)(tempBlock1, 16, &c);
3703
3605
//STOP_TIMER("dc & minmax")
3704
if(t==1)
3705
RENAME(doVertLowPass)(tempBlock1, 16, &c);
3706
else if(t==2)
3707
RENAME(doVertDefFilter)(tempBlock1, 16, &c);
3708
}else if(mode & H_A_DEBLOCK){
3709
RENAME(do_a_deblock)(tempBlock1, 16, 1, &c);
3710
}
3606
if(t==1)
3607
RENAME(doVertLowPass)(tempBlock1, 16, &c);
3608
else if(t==2)
3609
RENAME(doVertDefFilter)(tempBlock1, 16, &c);
3610
}else if(mode & H_A_DEBLOCK){
3611
RENAME(do_a_deblock)(tempBlock1, 16, 1, &c);
3612
}
3711
3613
3712
RENAME(transpose2)(dstBlock-4, dstStride, tempBlock1 + 4*16);
3614
RENAME(transpose2)(dstBlock-4, dstStride, tempBlock1 + 4*16);
3713
3615
3714
3616
#else
3715
if(mode & H_X1_FILTER)
3716
horizX1Filter(dstBlock-4, stride, QP);
3717
else if(mode & H_DEBLOCK)
3718
{
3617
if(mode & H_X1_FILTER)
3618
horizX1Filter(dstBlock-4, stride, QP);
3619
else if(mode & H_DEBLOCK){
3719
3620
#ifdef HAVE_ALTIVEC
3720
unsigned char __attribute__ ((aligned(16))) tempBlock[272];
3721
transpose_16x8_char_toPackedAlign_altivec(tempBlock, dstBlock - (4 + 1), stride);
3621
DECLARE_ALIGNED(16, unsigned char, tempBlock[272]);
3622
transpose_16x8_char_toPackedAlign_altivec(tempBlock, dstBlock - (4 + 1), stride);
3722
3623
3723
const int t=vertClassify_altivec(tempBlock-48, 16, &c);
3724
if(t==1) {
3725
doVertLowPass_altivec(tempBlock-48, 16, &c);
3726
transpose_8x16_char_fromPackedAlign_altivec(dstBlock - (4 + 1), tempBlock, stride);
3727
}
3728
else if(t==2) {
3729
doVertDefFilter_altivec(tempBlock-48, 16, &c);
3730
transpose_8x16_char_fromPackedAlign_altivec(dstBlock - (4 + 1), tempBlock, stride);
3731
}
3624
const int t=vertClassify_altivec(tempBlock-48, 16, &c);
3625
if(t==1) {
3626
doVertLowPass_altivec(tempBlock-48, 16, &c);
3627
transpose_8x16_char_fromPackedAlign_altivec(dstBlock - (4 + 1), tempBlock, stride);
3628
}
3629
else if(t==2) {
3630
doVertDefFilter_altivec(tempBlock-48, 16, &c);
3631
transpose_8x16_char_fromPackedAlign_altivec(dstBlock - (4 + 1), tempBlock, stride);
3632
}
3732
3633
#else
3733
const int t= RENAME(horizClassify)(dstBlock-4, stride, &c);
3634
const int t= RENAME(horizClassify)(dstBlock-4, stride, &c);
3734
3635
3735
if(t==1)
3736
RENAME(doHorizLowPass)(dstBlock-4, stride, &c);
3737
else if(t==2)
3738
RENAME(doHorizDefFilter)(dstBlock-4, stride, &c);
3636
if(t==1)
3637
RENAME(doHorizLowPass)(dstBlock-4, stride, &c);
3638
else if(t==2)
3639
RENAME(doHorizDefFilter)(dstBlock-4, stride, &c);
3739
3640
#endif
3740
}else if(mode & H_A_DEBLOCK){
3741
RENAME(do_a_deblock)(dstBlock-8, 1, stride, &c);
3742
}
3641
}else if(mode & H_A_DEBLOCK){
3642
RENAME(do_a_deblock)(dstBlock-8, 1, stride, &c);
3643
}
3743
3644
#endif //HAVE_MMX
3744
if(mode & DERING)
3745
{
3746
//FIXME filter first line
3747
if(y>0) RENAME(dering)(dstBlock - stride - 8, stride, &c);
3748
}
3749
3750
if(mode & TEMP_NOISE_FILTER)
3751
{
3752
RENAME(tempNoiseReducer)(dstBlock-8, stride,
3753
c.tempBlured[isColor] + y*dstStride + x,
3754
c.tempBluredPast[isColor] + (y>>3)*256 + (x>>3),
3755
c.ppMode.maxTmpNoise);
3756
}
3757
}
3758
3759
dstBlock+=8;
3760
srcBlock+=8;
3645
if(mode & DERING){
3646
//FIXME filter first line
3647
if(y>0) RENAME(dering)(dstBlock - stride - 8, stride, &c);
3648
}
3649
3650
if(mode & TEMP_NOISE_FILTER)
3651
{
3652
RENAME(tempNoiseReducer)(dstBlock-8, stride,
3653
c.tempBlurred[isColor] + y*dstStride + x,
3654
c.tempBlurredPast[isColor] + (y>>3)*256 + (x>>3),
3655
c.ppMode.maxTmpNoise);
3656
}
3657
}
3658
3659
dstBlock+=8;
3660
srcBlock+=8;
3761
3661
3762
3662
#ifdef HAVE_MMX
3763
tmpXchg= tempBlock1;
3764
tempBlock1= tempBlock2;
3765
tempBlock2 = tmpXchg;
3663
tmpXchg= tempBlock1;
3664
tempBlock1= tempBlock2;
3665
tempBlock2 = tmpXchg;
3766
3666
#endif
3767
}
3768
3769
if(mode & DERING)
3770
{
3771
if(y > 0) RENAME(dering)(dstBlock - dstStride - 8, dstStride, &c);
3772
}
3773
3774
if((mode & TEMP_NOISE_FILTER))
3775
{
3776
RENAME(tempNoiseReducer)(dstBlock-8, dstStride,
3777
c.tempBlured[isColor] + y*dstStride + x,
3778
c.tempBluredPast[isColor] + (y>>3)*256 + (x>>3),
3779
c.ppMode.maxTmpNoise);
3780
}
3781
3782
/* did we use a tmp buffer for the last lines*/
3783
if(y+15 >= height)
3784
{
3785
uint8_t *dstBlock= &(dst[y*dstStride]);
3786
if(width==FFABS(dstStride))
3787
linecpy(dstBlock, tempDst + dstStride, height-y, dstStride);
3788
else
3789
{
3790
int i;
3791
for(i=0; i<height-y; i++)
3792
{
3793
memcpy(dstBlock + i*dstStride, tempDst + (i+1)*dstStride, width);
3794
}
3795
}
3796
}
3667
}
3668
3669
if(mode & DERING){
3670
if(y > 0) RENAME(dering)(dstBlock - dstStride - 8, dstStride, &c);
3671
}
3672
3673
if((mode & TEMP_NOISE_FILTER)){
3674
RENAME(tempNoiseReducer)(dstBlock-8, dstStride,
3675
c.tempBlurred[isColor] + y*dstStride + x,
3676
c.tempBlurredPast[isColor] + (y>>3)*256 + (x>>3),
3677
c.ppMode.maxTmpNoise);
3678
}
3679
3680
/* did we use a tmp buffer for the last lines*/
3681
if(y+15 >= height){
3682
uint8_t *dstBlock= &(dst[y*dstStride]);
3683
if(width==FFABS(dstStride))
3684
linecpy(dstBlock, tempDst + dstStride, height-y, dstStride);
3685
else{
3686
int i;
3687
for(i=0; i<height-y; i++){
3688
memcpy(dstBlock + i*dstStride, tempDst + (i+1)*dstStride, width);
3689
}
3690
}
3691
}
3797
3692
/*
3798
for(x=0; x<width; x+=32)
3799
{
3800
volatile int i;
3801
i+= + dstBlock[x + 7*dstStride] + dstBlock[x + 8*dstStride]
3802
+ dstBlock[x + 9*dstStride] + dstBlock[x +10*dstStride]
3803
+ dstBlock[x +11*dstStride] + dstBlock[x +12*dstStride];
3804
// + dstBlock[x +13*dstStride]
3805
// + dstBlock[x +14*dstStride] + dstBlock[x +15*dstStride];
3806
}*/
3807
}
3693
for(x=0; x<width; x+=32){
3694
volatile int i;
3695
i+= + dstBlock[x + 7*dstStride] + dstBlock[x + 8*dstStride]
3696
+ dstBlock[x + 9*dstStride] + dstBlock[x +10*dstStride]
3697
+ dstBlock[x +11*dstStride] + dstBlock[x +12*dstStride];
3698
+ dstBlock[x +13*dstStride]
3699
+ dstBlock[x +14*dstStride] + dstBlock[x +15*dstStride];
3700
}*/
3701
}
3808
3702
#ifdef HAVE_3DNOW
3809
asm volatile("femms");
3703
asm volatile("femms");
3810
3704
#elif defined (HAVE_MMX)
3811
asm volatile("emms");
3705
asm volatile("emms");
3812
3706
#endif
3813
3707
3814
3708
#ifdef DEBUG_BRIGHTNESS
3815
if(!isColor)
3816
{
3817
int max=1;
3818
int i;
3819
for(i=0; i<256; i++)
3820
if(yHistogram[i] > max) max=yHistogram[i];
3821
3822
for(i=1; i<256; i++)
3823
{
3824
int x;
3825
int start=yHistogram[i-1]/(max/256+1);
3826
int end=yHistogram[i]/(max/256+1);
3827
int inc= end > start ? 1 : -1;
3828
for(x=start; x!=end+inc; x+=inc)
3829
dst[ i*dstStride + x]+=128;
3830
}
3831
3832
for(i=0; i<100; i+=2)
3833
{
3834
dst[ (white)*dstStride + i]+=128;
3835
dst[ (black)*dstStride + i]+=128;
3836
}
3837
3838
}
3709
if(!isColor){
3710
int max=1;
3711
int i;
3712
for(i=0; i<256; i++)
3713
if(yHistogram[i] > max) max=yHistogram[i];
3714
3715
for(i=1; i<256; i++){
3716
int x;
3717
int start=yHistogram[i-1]/(max/256+1);
3718
int end=yHistogram[i]/(max/256+1);
3719
int inc= end > start ? 1 : -1;
3720
for(x=start; x!=end+inc; x+=inc)
3721
dst[ i*dstStride + x]+=128;
3722
}
3723
3724
for(i=0; i<100; i+=2){
3725
dst[ (white)*dstStride + i]+=128;
3726
dst[ (black)*dstStride + i]+=128;
3727
}
3728
}
3839
3729
#endif
3840
3730
3841
*c2= c; //copy local context back
3731
*c2= c; //copy local context back
3842
3732
3843
3733
}
Loggerhead is a web-based interface for Breezy
Version: 2.0.1