Initial commit of mpg123-1.29.3
This commit is contained in:
Sam Lantinga
512
src/libmpg123/synth_stereo_sse_accurate.S
Normal file
512
src/libmpg123/synth_stereo_sse_accurate.S
Normal file
@@ -0,0 +1,512 @@
|
||||
/*
|
||||
synth_stereo_sse_accurate: SSE optimized synth (stereo specific, MPEG-compliant 16bit output version)
|
||||
|
||||
copyright 1995-2009 by the mpg123 project - free software under the terms of the LGPL 2.1
|
||||
see COPYING and AUTHORS files in distribution or http://mpg123.org
|
||||
initially written by Taihei Monma
|
||||
*/
|
||||
|
||||
#include "mangle.h"
|
||||
|
||||
/* real *window; */
|
||||
#define WINDOW %ebx
|
||||
/* real *b0l; */
|
||||
#define B0L %edx
|
||||
/* real *b0r; */
|
||||
#define B0R %esi
|
||||
/* real *samples; */
|
||||
#define SAMPLES %edi
|
||||
|
||||
#define TEMP(n) (12+16*n)(%esp)
|
||||
#define MMREG_CLIP %mm7
|
||||
|
||||
/*
|
||||
int synth_1to1_s_sse_accurate_asm(real *window, real *b0l, real *b0r, short *samples, int bo1);
|
||||
return value: number of clipped samples
|
||||
*/
|
||||
|
||||
#if !defined ( __APPLE__) && !defined (__OS2__)
|
||||
.section .rodata
|
||||
#else
|
||||
.data
|
||||
#endif
|
||||
ALIGN32
|
||||
maxmin_s16:
|
||||
.long 1191181824 /* 32767.0 */
|
||||
.long 1191181824
|
||||
.long 1191181824
|
||||
.long 1191181824
|
||||
.long -956301312 /* -32768.0 */
|
||||
.long -956301312
|
||||
.long -956301312
|
||||
.long -956301312
|
||||
.text
|
||||
ALIGN16
|
||||
.globl ASM_NAME(synth_1to1_s_sse_accurate_asm)
|
||||
ASM_NAME(synth_1to1_s_sse_accurate_asm):
|
||||
pushl %ebp
|
||||
movl %esp, %ebp
|
||||
andl $-16, %esp
|
||||
subl $128, %esp
|
||||
pushl %ebx
|
||||
pushl %esi
|
||||
pushl %edi
|
||||
|
||||
pxor MMREG_CLIP, MMREG_CLIP
|
||||
|
||||
movl 8(%ebp), WINDOW
|
||||
movl 12(%ebp), B0L
|
||||
movl 16(%ebp), B0R
|
||||
movl 20(%ebp), SAMPLES
|
||||
movl 24(%ebp), %eax
|
||||
shll $2, %eax
|
||||
|
||||
leal 64(WINDOW), WINDOW
|
||||
subl %eax, WINDOW
|
||||
|
||||
#undef _EBX_
|
||||
#define _EBX_ %eax
|
||||
GET_GOT
|
||||
|
||||
movl $4, %ecx
|
||||
|
||||
ALIGN16
|
||||
1:
|
||||
movups (WINDOW), %xmm0
|
||||
movups 16(WINDOW), %xmm1
|
||||
movups 32(WINDOW), %xmm2
|
||||
movups 48(WINDOW), %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
movaps %xmm1, %xmm5
|
||||
movaps %xmm2, %xmm6
|
||||
movaps %xmm3, %xmm7
|
||||
mulps 0(B0L), %xmm0
|
||||
mulps 16(B0L), %xmm1
|
||||
mulps 32(B0L), %xmm2
|
||||
mulps 48(B0L), %xmm3
|
||||
mulps 0(B0R), %xmm4
|
||||
mulps 16(B0R), %xmm5
|
||||
mulps 32(B0R), %xmm6
|
||||
mulps 48(B0R), %xmm7
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm3, %xmm2
|
||||
addps %xmm5, %xmm4
|
||||
addps %xmm7, %xmm6
|
||||
addps %xmm2, %xmm0
|
||||
addps %xmm6, %xmm4
|
||||
movaps %xmm0, TEMP(0)
|
||||
movaps %xmm4, TEMP(4)
|
||||
|
||||
leal 128(WINDOW), WINDOW
|
||||
leal 64(B0L), B0L
|
||||
leal 64(B0R), B0R
|
||||
|
||||
movups (WINDOW), %xmm0
|
||||
movups 16(WINDOW), %xmm1
|
||||
movups 32(WINDOW), %xmm2
|
||||
movups 48(WINDOW), %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
movaps %xmm1, %xmm5
|
||||
movaps %xmm2, %xmm6
|
||||
movaps %xmm3, %xmm7
|
||||
mulps 0(B0L), %xmm0
|
||||
mulps 16(B0L), %xmm1
|
||||
mulps 32(B0L), %xmm2
|
||||
mulps 48(B0L), %xmm3
|
||||
mulps 0(B0R), %xmm4
|
||||
mulps 16(B0R), %xmm5
|
||||
mulps 32(B0R), %xmm6
|
||||
mulps 48(B0R), %xmm7
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm3, %xmm2
|
||||
addps %xmm5, %xmm4
|
||||
addps %xmm7, %xmm6
|
||||
addps %xmm2, %xmm0
|
||||
addps %xmm6, %xmm4
|
||||
movaps %xmm0, TEMP(1)
|
||||
movaps %xmm4, TEMP(5)
|
||||
|
||||
leal 128(WINDOW), WINDOW
|
||||
leal 64(B0L), B0L
|
||||
leal 64(B0R), B0R
|
||||
|
||||
movups (WINDOW), %xmm0
|
||||
movups 16(WINDOW), %xmm1
|
||||
movups 32(WINDOW), %xmm2
|
||||
movups 48(WINDOW), %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
movaps %xmm1, %xmm5
|
||||
movaps %xmm2, %xmm6
|
||||
movaps %xmm3, %xmm7
|
||||
mulps 0(B0L), %xmm0
|
||||
mulps 16(B0L), %xmm1
|
||||
mulps 32(B0L), %xmm2
|
||||
mulps 48(B0L), %xmm3
|
||||
mulps 0(B0R), %xmm4
|
||||
mulps 16(B0R), %xmm5
|
||||
mulps 32(B0R), %xmm6
|
||||
mulps 48(B0R), %xmm7
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm3, %xmm2
|
||||
addps %xmm5, %xmm4
|
||||
addps %xmm7, %xmm6
|
||||
addps %xmm2, %xmm0
|
||||
addps %xmm6, %xmm4
|
||||
movaps %xmm0, TEMP(2)
|
||||
movaps %xmm4, TEMP(6)
|
||||
|
||||
leal 128(WINDOW), WINDOW
|
||||
leal 64(B0L), B0L
|
||||
leal 64(B0R), B0R
|
||||
|
||||
movups (WINDOW), %xmm0
|
||||
movups 16(WINDOW), %xmm1
|
||||
movups 32(WINDOW), %xmm2
|
||||
movups 48(WINDOW), %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
movaps %xmm1, %xmm5
|
||||
movaps %xmm2, %xmm6
|
||||
movaps %xmm3, %xmm7
|
||||
mulps 0(B0L), %xmm0
|
||||
mulps 16(B0L), %xmm1
|
||||
mulps 32(B0L), %xmm2
|
||||
mulps 48(B0L), %xmm3
|
||||
mulps 0(B0R), %xmm4
|
||||
mulps 16(B0R), %xmm5
|
||||
mulps 32(B0R), %xmm6
|
||||
mulps 48(B0R), %xmm7
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm3, %xmm2
|
||||
addps %xmm5, %xmm4
|
||||
addps %xmm7, %xmm6
|
||||
addps %xmm2, %xmm0
|
||||
addps %xmm6, %xmm4
|
||||
movaps %xmm0, %xmm7
|
||||
movaps %xmm4, TEMP(7)
|
||||
|
||||
leal 128(WINDOW), WINDOW
|
||||
leal 64(B0L), B0L
|
||||
leal 64(B0R), B0R
|
||||
|
||||
movaps TEMP(0), %xmm4
|
||||
movaps TEMP(1), %xmm5
|
||||
movaps TEMP(2), %xmm6
|
||||
movaps %xmm4, %xmm0
|
||||
movaps %xmm6, %xmm1
|
||||
unpcklps %xmm5, %xmm4
|
||||
unpcklps %xmm7, %xmm6
|
||||
unpckhps %xmm5, %xmm0
|
||||
unpckhps %xmm7, %xmm1
|
||||
movaps %xmm4, %xmm2
|
||||
movaps %xmm0, %xmm3
|
||||
movlhps %xmm6, %xmm4
|
||||
movhlps %xmm2, %xmm6
|
||||
movlhps %xmm1, %xmm0
|
||||
movhlps %xmm3, %xmm1
|
||||
subps %xmm6, %xmm4
|
||||
subps %xmm1, %xmm0
|
||||
addps %xmm4, %xmm0
|
||||
movaps %xmm0, %xmm2
|
||||
|
||||
movaps TEMP(4), %xmm4
|
||||
movaps TEMP(5), %xmm5
|
||||
movaps TEMP(6), %xmm6
|
||||
movaps TEMP(7), %xmm7
|
||||
movaps %xmm4, %xmm0
|
||||
movaps %xmm6, %xmm1
|
||||
unpcklps %xmm5, %xmm4
|
||||
unpcklps %xmm7, %xmm6
|
||||
unpckhps %xmm5, %xmm0
|
||||
unpckhps %xmm7, %xmm1
|
||||
movaps %xmm2, %xmm5
|
||||
movaps %xmm4, %xmm2
|
||||
movaps %xmm0, %xmm3
|
||||
movlhps %xmm6, %xmm4
|
||||
movhlps %xmm2, %xmm6
|
||||
movlhps %xmm1, %xmm0
|
||||
movhlps %xmm3, %xmm1
|
||||
subps %xmm6, %xmm4
|
||||
subps %xmm1, %xmm0
|
||||
addps %xmm4, %xmm0
|
||||
|
||||
movaps %xmm5, %xmm1
|
||||
movaps %xmm5, %xmm2
|
||||
movaps %xmm0, %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
cmpnleps LOCAL_VAR(maxmin_s16), %xmm1
|
||||
cmpltps 16+LOCAL_VAR(maxmin_s16), %xmm2
|
||||
cmpnleps LOCAL_VAR(maxmin_s16), %xmm3
|
||||
cmpltps 16+LOCAL_VAR(maxmin_s16), %xmm4
|
||||
cvtps2pi %xmm5, %mm0
|
||||
cvtps2pi %xmm0, %mm1
|
||||
movhlps %xmm5, %xmm5
|
||||
movhlps %xmm0, %xmm0
|
||||
cvtps2pi %xmm5, %mm2
|
||||
cvtps2pi %xmm0, %mm3
|
||||
packssdw %mm2, %mm0
|
||||
packssdw %mm3, %mm1
|
||||
movq %mm0, %mm2
|
||||
punpcklwd %mm1, %mm0
|
||||
punpckhwd %mm1, %mm2
|
||||
movq %mm0, (SAMPLES)
|
||||
movq %mm2, 8(SAMPLES)
|
||||
|
||||
cvtps2pi %xmm1, %mm2
|
||||
cvtps2pi %xmm3, %mm3
|
||||
movhlps %xmm1, %xmm1
|
||||
movhlps %xmm3, %xmm3
|
||||
cvtps2pi %xmm1, %mm4
|
||||
cvtps2pi %xmm3, %mm5
|
||||
packssdw %mm4, %mm2
|
||||
packssdw %mm5, %mm3
|
||||
psrlw $15, %mm2
|
||||
psrlw $15, %mm3
|
||||
cvtps2pi %xmm2, %mm0
|
||||
cvtps2pi %xmm4, %mm1
|
||||
movhlps %xmm2, %xmm2
|
||||
movhlps %xmm4, %xmm4
|
||||
cvtps2pi %xmm2, %mm4
|
||||
cvtps2pi %xmm4, %mm5
|
||||
packssdw %mm4, %mm0
|
||||
packssdw %mm5, %mm1
|
||||
psrlw $15, %mm0
|
||||
psrlw $15, %mm1
|
||||
paddw %mm3, %mm2
|
||||
paddw %mm1, %mm0
|
||||
paddw %mm2, %mm0
|
||||
paddw %mm0, MMREG_CLIP
|
||||
|
||||
leal 16(SAMPLES), SAMPLES
|
||||
decl %ecx
|
||||
jnz 1b
|
||||
|
||||
movl $4, %ecx
|
||||
|
||||
ALIGN16
|
||||
1:
|
||||
movups (WINDOW), %xmm0
|
||||
movups 16(WINDOW), %xmm1
|
||||
movups 32(WINDOW), %xmm2
|
||||
movups 48(WINDOW), %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
movaps %xmm1, %xmm5
|
||||
movaps %xmm2, %xmm6
|
||||
movaps %xmm3, %xmm7
|
||||
mulps 0(B0L), %xmm0
|
||||
mulps 16(B0L), %xmm1
|
||||
mulps 32(B0L), %xmm2
|
||||
mulps 48(B0L), %xmm3
|
||||
mulps 0(B0R), %xmm4
|
||||
mulps 16(B0R), %xmm5
|
||||
mulps 32(B0R), %xmm6
|
||||
mulps 48(B0R), %xmm7
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm3, %xmm2
|
||||
addps %xmm5, %xmm4
|
||||
addps %xmm7, %xmm6
|
||||
addps %xmm2, %xmm0
|
||||
addps %xmm6, %xmm4
|
||||
movaps %xmm0, TEMP(0)
|
||||
movaps %xmm4, TEMP(4)
|
||||
|
||||
leal 128(WINDOW), WINDOW
|
||||
leal -64(B0L), B0L
|
||||
leal -64(B0R), B0R
|
||||
|
||||
movups (WINDOW), %xmm0
|
||||
movups 16(WINDOW), %xmm1
|
||||
movups 32(WINDOW), %xmm2
|
||||
movups 48(WINDOW), %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
movaps %xmm1, %xmm5
|
||||
movaps %xmm2, %xmm6
|
||||
movaps %xmm3, %xmm7
|
||||
mulps 0(B0L), %xmm0
|
||||
mulps 16(B0L), %xmm1
|
||||
mulps 32(B0L), %xmm2
|
||||
mulps 48(B0L), %xmm3
|
||||
mulps 0(B0R), %xmm4
|
||||
mulps 16(B0R), %xmm5
|
||||
mulps 32(B0R), %xmm6
|
||||
mulps 48(B0R), %xmm7
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm3, %xmm2
|
||||
addps %xmm5, %xmm4
|
||||
addps %xmm7, %xmm6
|
||||
addps %xmm2, %xmm0
|
||||
addps %xmm6, %xmm4
|
||||
movaps %xmm0, TEMP(1)
|
||||
movaps %xmm4, TEMP(5)
|
||||
|
||||
leal 128(WINDOW), WINDOW
|
||||
leal -64(B0L), B0L
|
||||
leal -64(B0R), B0R
|
||||
|
||||
movups (WINDOW), %xmm0
|
||||
movups 16(WINDOW), %xmm1
|
||||
movups 32(WINDOW), %xmm2
|
||||
movups 48(WINDOW), %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
movaps %xmm1, %xmm5
|
||||
movaps %xmm2, %xmm6
|
||||
movaps %xmm3, %xmm7
|
||||
mulps 0(B0L), %xmm0
|
||||
mulps 16(B0L), %xmm1
|
||||
mulps 32(B0L), %xmm2
|
||||
mulps 48(B0L), %xmm3
|
||||
mulps 0(B0R), %xmm4
|
||||
mulps 16(B0R), %xmm5
|
||||
mulps 32(B0R), %xmm6
|
||||
mulps 48(B0R), %xmm7
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm3, %xmm2
|
||||
addps %xmm5, %xmm4
|
||||
addps %xmm7, %xmm6
|
||||
addps %xmm2, %xmm0
|
||||
addps %xmm6, %xmm4
|
||||
movaps %xmm0, TEMP(2)
|
||||
movaps %xmm4, TEMP(6)
|
||||
|
||||
leal 128(WINDOW), WINDOW
|
||||
leal -64(B0L), B0L
|
||||
leal -64(B0R), B0R
|
||||
|
||||
movups (WINDOW), %xmm0
|
||||
movups 16(WINDOW), %xmm1
|
||||
movups 32(WINDOW), %xmm2
|
||||
movups 48(WINDOW), %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
movaps %xmm1, %xmm5
|
||||
movaps %xmm2, %xmm6
|
||||
movaps %xmm3, %xmm7
|
||||
mulps 0(B0L), %xmm0
|
||||
mulps 16(B0L), %xmm1
|
||||
mulps 32(B0L), %xmm2
|
||||
mulps 48(B0L), %xmm3
|
||||
mulps 0(B0R), %xmm4
|
||||
mulps 16(B0R), %xmm5
|
||||
mulps 32(B0R), %xmm6
|
||||
mulps 48(B0R), %xmm7
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm3, %xmm2
|
||||
addps %xmm5, %xmm4
|
||||
addps %xmm7, %xmm6
|
||||
addps %xmm2, %xmm0
|
||||
addps %xmm6, %xmm4
|
||||
movaps %xmm0, %xmm7
|
||||
movaps %xmm4, TEMP(7)
|
||||
|
||||
leal 128(WINDOW), WINDOW
|
||||
leal -64(B0L), B0L
|
||||
leal -64(B0R), B0R
|
||||
|
||||
movaps TEMP(0), %xmm4
|
||||
movaps TEMP(1), %xmm5
|
||||
movaps TEMP(2), %xmm6
|
||||
movaps %xmm4, %xmm0
|
||||
movaps %xmm6, %xmm1
|
||||
unpcklps %xmm5, %xmm4
|
||||
unpcklps %xmm7, %xmm6
|
||||
unpckhps %xmm5, %xmm0
|
||||
unpckhps %xmm7, %xmm1
|
||||
movaps %xmm4, %xmm2
|
||||
movaps %xmm0, %xmm3
|
||||
movlhps %xmm6, %xmm4
|
||||
movhlps %xmm2, %xmm6
|
||||
movlhps %xmm1, %xmm0
|
||||
movhlps %xmm3, %xmm1
|
||||
addps %xmm6, %xmm4
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm4, %xmm0
|
||||
movaps %xmm0, %xmm2
|
||||
|
||||
movaps TEMP(4), %xmm4
|
||||
movaps TEMP(5), %xmm5
|
||||
movaps TEMP(6), %xmm6
|
||||
movaps TEMP(7), %xmm7
|
||||
movaps %xmm4, %xmm0
|
||||
movaps %xmm6, %xmm1
|
||||
unpcklps %xmm5, %xmm4
|
||||
unpcklps %xmm7, %xmm6
|
||||
unpckhps %xmm5, %xmm0
|
||||
unpckhps %xmm7, %xmm1
|
||||
movaps %xmm2, %xmm5
|
||||
movaps %xmm4, %xmm2
|
||||
movaps %xmm0, %xmm3
|
||||
movlhps %xmm6, %xmm4
|
||||
movhlps %xmm2, %xmm6
|
||||
movlhps %xmm1, %xmm0
|
||||
movhlps %xmm3, %xmm1
|
||||
addps %xmm6, %xmm4
|
||||
addps %xmm1, %xmm0
|
||||
addps %xmm4, %xmm0
|
||||
|
||||
movaps %xmm5, %xmm1
|
||||
movaps %xmm5, %xmm2
|
||||
movaps %xmm0, %xmm3
|
||||
movaps %xmm0, %xmm4
|
||||
cmpnleps LOCAL_VAR(maxmin_s16), %xmm1
|
||||
cmpltps 16+LOCAL_VAR(maxmin_s16), %xmm2
|
||||
cmpnleps LOCAL_VAR(maxmin_s16), %xmm3
|
||||
cmpltps 16+LOCAL_VAR(maxmin_s16), %xmm4
|
||||
cvtps2pi %xmm5, %mm0
|
||||
cvtps2pi %xmm0, %mm1
|
||||
movhlps %xmm5, %xmm5
|
||||
movhlps %xmm0, %xmm0
|
||||
cvtps2pi %xmm5, %mm2
|
||||
cvtps2pi %xmm0, %mm3
|
||||
packssdw %mm2, %mm0
|
||||
packssdw %mm3, %mm1
|
||||
movq %mm0, %mm2
|
||||
punpcklwd %mm1, %mm0
|
||||
punpckhwd %mm1, %mm2
|
||||
movq %mm0, (SAMPLES)
|
||||
movq %mm2, 8(SAMPLES)
|
||||
|
||||
cvtps2pi %xmm1, %mm2
|
||||
cvtps2pi %xmm3, %mm3
|
||||
movhlps %xmm1, %xmm1
|
||||
movhlps %xmm3, %xmm3
|
||||
cvtps2pi %xmm1, %mm4
|
||||
cvtps2pi %xmm3, %mm5
|
||||
packssdw %mm4, %mm2
|
||||
packssdw %mm5, %mm3
|
||||
psrlw $15, %mm2
|
||||
psrlw $15, %mm3
|
||||
cvtps2pi %xmm2, %mm0
|
||||
cvtps2pi %xmm4, %mm1
|
||||
movhlps %xmm2, %xmm2
|
||||
movhlps %xmm4, %xmm4
|
||||
cvtps2pi %xmm2, %mm4
|
||||
cvtps2pi %xmm4, %mm5
|
||||
packssdw %mm4, %mm0
|
||||
packssdw %mm5, %mm1
|
||||
psrlw $15, %mm0
|
||||
psrlw $15, %mm1
|
||||
paddw %mm3, %mm2
|
||||
paddw %mm1, %mm0
|
||||
paddw %mm2, %mm0
|
||||
paddw %mm0, MMREG_CLIP
|
||||
|
||||
leal 16(SAMPLES), SAMPLES
|
||||
decl %ecx
|
||||
jnz 1b
|
||||
|
||||
pshufw $0xee, MMREG_CLIP, %mm0
|
||||
paddw MMREG_CLIP, %mm0
|
||||
pshufw $0x55, %mm0, %mm1
|
||||
paddw %mm1, %mm0
|
||||
movd %mm0, %eax
|
||||
andl $0xffff, %eax
|
||||
|
||||
popl %edi
|
||||
popl %esi
|
||||
popl %ebx
|
||||
movl %ebp, %esp
|
||||
popl %ebp
|
||||
|
||||
emms
|
||||
|
||||
ret
|
||||
|
||||
NONEXEC_STACK
|
||||
Reference in New Issue
Block a user