forked from len0rd/rockbox
Mpegplayer: Convert the assembler optimised ARM IDCT into a proper assembler file. Clean up the CPU selection in idct.c.
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@15158 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Jens Arnold
parent
4829f7835a
commit
45d4345405
4 changed files with 479 additions and 585 deletions
|
|
@ -1,22 +1,22 @@
|
||||||
alloc.c
|
alloc.c
|
||||||
decode.c
|
decode.c
|
||||||
header.c
|
header.c
|
||||||
|
|
||||||
motion_comp.c
|
|
||||||
|
|
||||||
#ifdef CPU_ARM
|
|
||||||
idct_arm_c.c
|
|
||||||
motion_comp_arm_c.c
|
|
||||||
motion_comp_arm_s.S
|
|
||||||
#else /* other CPU or SIM */
|
|
||||||
idct.c
|
idct.c
|
||||||
motion_comp_c.c
|
motion_comp.c
|
||||||
#endif /* CPU_* */
|
|
||||||
|
|
||||||
#ifdef CPU_COLDFIRE
|
#ifdef CPU_COLDFIRE
|
||||||
idct_coldfire.S
|
idct_coldfire.S
|
||||||
|
#elif defined CPU_ARM
|
||||||
|
idct_arm.S
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifdef CPU_ARM
|
||||||
|
motion_comp_arm_c.c
|
||||||
|
motion_comp_arm_s.S
|
||||||
|
#else /* other CPU or SIM */
|
||||||
|
motion_comp_c.c
|
||||||
|
#endif /* CPU_* */
|
||||||
|
|
||||||
slice.c
|
slice.c
|
||||||
video_out_rockbox.c
|
video_out_rockbox.c
|
||||||
mpeg_settings.c
|
mpeg_settings.c
|
||||||
|
|
|
||||||
|
|
@ -29,60 +29,42 @@
|
||||||
#include "attributes.h"
|
#include "attributes.h"
|
||||||
#include "mpeg2_internal.h"
|
#include "mpeg2_internal.h"
|
||||||
|
|
||||||
#define W1 2841 /* 2048 * sqrt (2) * cos (1 * pi / 16) */
|
|
||||||
#define W2 2676 /* 2048 * sqrt (2) * cos (2 * pi / 16) */
|
|
||||||
#define W3 2408 /* 2048 * sqrt (2) * cos (3 * pi / 16) */
|
|
||||||
#define W5 1609 /* 2048 * sqrt (2) * cos (5 * pi / 16) */
|
|
||||||
#define W6 1108 /* 2048 * sqrt (2) * cos (6 * pi / 16) */
|
|
||||||
#define W7 565 /* 2048 * sqrt (2) * cos (7 * pi / 16) */
|
|
||||||
|
|
||||||
/* idct main entry point */
|
/* idct main entry point */
|
||||||
void (* mpeg2_idct_copy) (int16_t * block, uint8_t * dest, int stride);
|
void (* mpeg2_idct_copy) (int16_t * block, uint8_t * dest, int stride);
|
||||||
void (* mpeg2_idct_add) (int last, int16_t * block,
|
void (* mpeg2_idct_add) (int last, int16_t * block,
|
||||||
uint8_t * dest, int stride);
|
uint8_t * dest, int stride);
|
||||||
|
|
||||||
/*
|
|
||||||
* In legal streams, the IDCT output should be between -384 and +384.
|
|
||||||
* In corrupted streams, it is possible to force the IDCT output to go
|
|
||||||
* to +-3826 - this is the worst case for a column IDCT where the
|
|
||||||
* column inputs are 16-bit values.
|
|
||||||
*/
|
|
||||||
#ifdef CPU_COLDFIRE
|
|
||||||
static inline unsigned CLIP(int value)
|
|
||||||
{
|
|
||||||
asm ( /* Note: Uses knowledge that only the low byte of the result is used */
|
|
||||||
"cmp.l #255,%[v] \n" /* overflow? */
|
|
||||||
"bls.b 1f \n" /* no: return value */
|
|
||||||
"spl.b %[v] \n" /* yes: set low byte to appropriate boundary */
|
|
||||||
"1: \n"
|
|
||||||
: /* outputs */
|
|
||||||
[v]"+d"(value)
|
|
||||||
);
|
|
||||||
return value;
|
|
||||||
}
|
|
||||||
#elif defined CPU_ARM
|
|
||||||
static inline unsigned CLIP(int value)
|
|
||||||
{
|
|
||||||
asm volatile ( /* Note: Uses knowledge that only the low byte of the result is used */
|
|
||||||
"cmp %[v], #255 \n"
|
|
||||||
"mvnhi %[v], %[v], asr #31 \n"
|
|
||||||
: /* outputs */
|
|
||||||
[v]"+r"(value)
|
|
||||||
);
|
|
||||||
return value;
|
|
||||||
}
|
|
||||||
#else
|
|
||||||
uint8_t mpeg2_clip[3840 * 2 + 256] IBSS_ATTR;
|
|
||||||
#define CLIP(i) ((mpeg2_clip + 3840)[i])
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef CPU_COLDFIRE
|
#ifdef CPU_COLDFIRE
|
||||||
/* assembler functions */
|
/* assembler functions */
|
||||||
extern void mpeg2_idct_copy_coldfire(int16_t * block, uint8_t * dest,
|
extern void mpeg2_idct_copy_coldfire(int16_t * block, uint8_t * dest,
|
||||||
const int stride);
|
const int stride);
|
||||||
extern void mpeg2_idct_add_coldfire(const int last, int16_t * block,
|
extern void mpeg2_idct_add_coldfire(const int last, int16_t * block,
|
||||||
uint8_t * dest, const int stride);
|
uint8_t * dest, const int stride);
|
||||||
#else /* !CPU_COLDFIE */
|
|
||||||
|
#elif defined CPU_ARM
|
||||||
|
/* assembler functions */
|
||||||
|
extern void mpeg2_idct_copy_arm(int16_t * block, uint8_t * dest,
|
||||||
|
const int stride);
|
||||||
|
extern void mpeg2_idct_add_arm(const int last, int16_t * block,
|
||||||
|
uint8_t * dest, const int stride);
|
||||||
|
|
||||||
|
#else /* !CPU_COLDFIE, !CPU_ARM */
|
||||||
|
|
||||||
|
#define W1 2841 /* 2048 * sqrt (2) * cos (1 * pi / 16) */
|
||||||
|
#define W2 2676 /* 2048 * sqrt (2) * cos (2 * pi / 16) */
|
||||||
|
#define W3 2408 /* 2048 * sqrt (2) * cos (3 * pi / 16) */
|
||||||
|
#define W5 1609 /* 2048 * sqrt (2) * cos (5 * pi / 16) */
|
||||||
|
#define W6 1108 /* 2048 * sqrt (2) * cos (6 * pi / 16) */
|
||||||
|
#define W7 565 /* 2048 * sqrt (2) * cos (7 * pi / 16) */
|
||||||
|
|
||||||
|
/*
|
||||||
|
* In legal streams, the IDCT output should be between -384 and +384.
|
||||||
|
* In corrupted streams, it is possible to force the IDCT output to go
|
||||||
|
* to +-3826 - this is the worst case for a column IDCT where the
|
||||||
|
* column inputs are 16-bit values.
|
||||||
|
*/
|
||||||
|
uint8_t mpeg2_clip[3840 * 2 + 256] IBSS_ATTR;
|
||||||
|
#define CLIP(i) ((mpeg2_clip + 3840)[i])
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
#define BUTTERFLY(t0,t1,W0,W1,d0,d1) \
|
#define BUTTERFLY(t0,t1,W0,W1,d0,d1) \
|
||||||
|
|
@ -266,7 +248,7 @@ static void mpeg2_idct_add_c (const int last, int16_t * block,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif /* !CPU_COLDFIRE */
|
#endif /* CPU selection */
|
||||||
|
|
||||||
void mpeg2_idct_init (void)
|
void mpeg2_idct_init (void)
|
||||||
{
|
{
|
||||||
|
|
@ -279,12 +261,13 @@ void mpeg2_idct_init (void)
|
||||||
#ifdef CPU_COLDFIRE
|
#ifdef CPU_COLDFIRE
|
||||||
mpeg2_idct_copy = mpeg2_idct_copy_coldfire;
|
mpeg2_idct_copy = mpeg2_idct_copy_coldfire;
|
||||||
mpeg2_idct_add = mpeg2_idct_add_coldfire;
|
mpeg2_idct_add = mpeg2_idct_add_coldfire;
|
||||||
|
#elif defined CPU_ARM
|
||||||
|
mpeg2_idct_copy = mpeg2_idct_copy_arm;
|
||||||
|
mpeg2_idct_add = mpeg2_idct_add_arm;
|
||||||
#else
|
#else
|
||||||
mpeg2_idct_copy = mpeg2_idct_copy_c;
|
mpeg2_idct_copy = mpeg2_idct_copy_c;
|
||||||
mpeg2_idct_add = mpeg2_idct_add_c;
|
mpeg2_idct_add = mpeg2_idct_add_c;
|
||||||
#endif
|
|
||||||
|
|
||||||
#if !defined(CPU_COLDFIRE) && !defined(CPU_ARM)
|
|
||||||
for (i = -3840; i < 3840 + 256; i++)
|
for (i = -3840; i < 3840 + 256; i++)
|
||||||
CLIP(i) = (i < 0) ? 0 : ((i > 255) ? 255 : i);
|
CLIP(i) = (i < 0) ? 0 : ((i > 255) ? 255 : i);
|
||||||
#endif
|
#endif
|
||||||
|
|
|
||||||
440
apps/plugins/mpegplayer/idct_arm.S
Normal file
440
apps/plugins/mpegplayer/idct_arm.S
Normal file
|
|
@ -0,0 +1,440 @@
|
||||||
|
/***************************************************************************
|
||||||
|
* __________ __ ___.
|
||||||
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
||||||
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
||||||
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
||||||
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
||||||
|
* \/ \/ \/ \/ \/
|
||||||
|
* $Id $
|
||||||
|
*
|
||||||
|
* Copyright (C) 2007 by Michael Sevakis
|
||||||
|
*
|
||||||
|
* All files in this archive are subject to the GNU General Public License.
|
||||||
|
* See the file COPYING in the source tree root for full license agreement.
|
||||||
|
*
|
||||||
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
||||||
|
* KIND, either express or implied.
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
.global mpeg2_idct_copy_arm
|
||||||
|
.type mpeg2_idct_copy_arm, %function
|
||||||
|
.global mpeg2_idct_add_arm
|
||||||
|
.type mpeg2_idct_add_arm, %function
|
||||||
|
|
||||||
|
|
||||||
|
/* Custom calling convention:
|
||||||
|
* r0 contains block pointer and is non-volatile
|
||||||
|
* all non-volatile c context saved and restored on its behalf
|
||||||
|
*/
|
||||||
|
.idct:
|
||||||
|
add r12, r0, #128
|
||||||
|
1:
|
||||||
|
ldrsh r1, [r0, #0] /* d0 */
|
||||||
|
ldrsh r2, [r0, #2] /* d1 */
|
||||||
|
ldrsh r3, [r0, #4] /* d2 */
|
||||||
|
ldrsh r4, [r0, #6] /* d3 */
|
||||||
|
ldrsh r5, [r0, #8] /* d0 */
|
||||||
|
ldrsh r6, [r0, #10] /* d1 */
|
||||||
|
ldrsh r7, [r0, #12] /* d2 */
|
||||||
|
ldrsh r8, [r0, #14] /* d3 */
|
||||||
|
orrs r9, r2, r3
|
||||||
|
orreqs r9, r4, r5
|
||||||
|
orreqs r9, r6, r7
|
||||||
|
cmpeq r8, #0
|
||||||
|
bne 2f
|
||||||
|
mov r1, r1, asl #15
|
||||||
|
bic r1, r1, #0x8000
|
||||||
|
orr r1, r1, r1, lsr #16
|
||||||
|
str r1, [r0], #4
|
||||||
|
str r1, [r0], #4
|
||||||
|
str r1, [r0], #4
|
||||||
|
str r1, [r0], #4
|
||||||
|
cmp r0, r12
|
||||||
|
blo 1b
|
||||||
|
b 3f
|
||||||
|
2:
|
||||||
|
mov r1, r1, asl #11 /* r1 = d0 = (block[0] << 11) + 2048 */
|
||||||
|
add r1, r1, #2048
|
||||||
|
add r1, r1, r3, asl #11 /* r1 = t0 = d0 + (block[2] << 11) */
|
||||||
|
sub r3, r1, r3, asl #12 /* r3 = t1 = d0 - (block[2] << 11) */
|
||||||
|
|
||||||
|
add r9, r2, r4 /* r9 = tmp = (d1+d3)*(1108/4) */
|
||||||
|
add r10, r9, r9, asl #2
|
||||||
|
add r10, r10, r9, asl #4
|
||||||
|
add r9, r10, r9, asl #8
|
||||||
|
|
||||||
|
add r10, r2, r2, asl #4 /* r2 = t2 = tmp + (d1*(1568/32)*8) */
|
||||||
|
add r2, r10, r2, asl #5
|
||||||
|
add r2, r9, r2, asl #3
|
||||||
|
|
||||||
|
add r10, r4, r4, asl #2 /* r4 = t3 = tmp - (d3*(3784/8)*2) */
|
||||||
|
rsb r10, r10, r4, asl #6
|
||||||
|
add r4, r4, r10, asl #3
|
||||||
|
sub r4, r9, r4, asl #1
|
||||||
|
/* t2 & t3 are 1/4 final value here */
|
||||||
|
add r1, r1, r2, asl #2 /* r1 = a0 = t0 + t2 */
|
||||||
|
sub r2, r1, r2, asl #3 /* r2 = a3 = t0 - t2 */
|
||||||
|
add r3, r3, r4, asl #2 /* r3 = a1 = t1 + t3 */
|
||||||
|
sub r4, r3, r4, asl #3 /* r4 = a2 = t1 - t3 */
|
||||||
|
|
||||||
|
add r9, r8, r5 /* r9 = tmp = 565*(d3 + d0) */
|
||||||
|
add r10, r9, r9, asl #4
|
||||||
|
add r10, r10, r10, asl #5
|
||||||
|
add r9, r10, r9, asl #2
|
||||||
|
|
||||||
|
add r10, r5, r5, asl #4 /* r5 = t0 = tmp + (((2276/4)*d0)*4) */
|
||||||
|
add r10, r10, r10, asl #5
|
||||||
|
add r5, r10, r5, asl #3
|
||||||
|
add r5, r9, r5, asl #2
|
||||||
|
|
||||||
|
add r10, r8, r8, asl #2 /* r8 = t1 = tmp - (((3406/2)*d3)*2) */
|
||||||
|
add r10, r10, r10, asl #4
|
||||||
|
add r10, r10, r8, asl #7
|
||||||
|
rsb r8, r8, r10, asl #3
|
||||||
|
sub r8, r9, r8, asl #1
|
||||||
|
|
||||||
|
add r9, r6, r7 /* r9 = tmp = (2408/8)*(d1 + d2) */
|
||||||
|
add r10, r9, r9, asl #3
|
||||||
|
add r10, r10, r10, asl #5
|
||||||
|
add r9, r10, r9, asl #2
|
||||||
|
|
||||||
|
add r10, r7, r7, asl #3 /* r7 = t2 = (tmp*8) - 799*d2 */
|
||||||
|
add r10, r10, r7, asl #4
|
||||||
|
rsb r7, r7, r10, asl #5
|
||||||
|
rsb r7, r7, r9, asl #3
|
||||||
|
|
||||||
|
sub r10, r6, r6, asl #4 /* r6 = t3 = (tmp*8) - 4017*d1 */
|
||||||
|
sub r10, r10, r6, asl #6
|
||||||
|
add r10, r10, r6, asl #12
|
||||||
|
add r6, r10, r6
|
||||||
|
rsb r6, r6, r9, asl #3
|
||||||
|
/* t0 = r5, t1 = r8, t2 = r7, t3 = r6*/
|
||||||
|
add r9, r5, r7 /* r9 = b0 = t0 + t2 */
|
||||||
|
add r10, r8, r6 /* r10 = b3 = t1 + t3 */
|
||||||
|
sub r5, r5, r7 /* t0 -= t2 */
|
||||||
|
sub r8, r8, r6 /* t1 -= t3 */
|
||||||
|
add r6, r5, r8 /* r6 = t0 + t1 */
|
||||||
|
sub r7, r5, r8 /* r7 = t0 - t1 */
|
||||||
|
|
||||||
|
add r11, r6, r6, asr #2 /* r6 = b1 = r6*(181/128) */
|
||||||
|
add r11, r11, r11, asr #5
|
||||||
|
add r6, r11, r6, asr #3
|
||||||
|
add r11, r7, r7, asr #2 /* r7 = b2 = r7*(181/128) */
|
||||||
|
add r11, r11, r11, asr #5
|
||||||
|
add r7, r11, r7, asr #3
|
||||||
|
/* r1 = a0, r3 = a1, r4 = a2, r2 = a3 */
|
||||||
|
/* r9 = b0, r6 = b1*2, r7 = b2*2, r10 = b3 */
|
||||||
|
add r5, r1, r9 /* block[0] = (a0 + b0) >> 12 */
|
||||||
|
mov r5, r5, asr #12
|
||||||
|
strh r5, [r0], #2
|
||||||
|
add r8, r3, r6, asr #1 /* block[1] = (a1 + b1) >> 12 */
|
||||||
|
mov r8, r8, asr #12
|
||||||
|
strh r8, [r0], #2
|
||||||
|
add r5, r4, r7, asr #1 /* block[2] = (a2 + b2) >> 12 */
|
||||||
|
mov r5, r5, asr #12
|
||||||
|
strh r5, [r0], #2
|
||||||
|
add r8, r2, r10 /* block[3] = (a3 + b3) >> 12 */
|
||||||
|
mov r8, r8, asr #12
|
||||||
|
strh r8, [r0], #2
|
||||||
|
sub r5, r2, r10 /* block[4] = (a3 - b3) >> 12 */
|
||||||
|
mov r5, r5, asr #12
|
||||||
|
strh r5, [r0], #2
|
||||||
|
sub r8, r4, r7, asr #1 /* block[5] = (a2 - b2) >> 12 */
|
||||||
|
mov r8, r8, asr #12
|
||||||
|
strh r8, [r0], #2
|
||||||
|
sub r5, r3, r6, asr #1 /* block[6] = (a1 - b1) >> 12 */
|
||||||
|
mov r5, r5, asr #12
|
||||||
|
strh r5, [r0], #2
|
||||||
|
sub r8, r1, r9 /* block[7] = (a0 - b0) >> 12 */
|
||||||
|
mov r8, r8, asr #12
|
||||||
|
strh r8, [r0], #2
|
||||||
|
cmp r0, r12
|
||||||
|
blo 1b
|
||||||
|
3:
|
||||||
|
sub r0, r0, #128
|
||||||
|
add r12, r0, #16
|
||||||
|
4:
|
||||||
|
ldrsh r1, [r0, #0*8] /* d0 */
|
||||||
|
ldrsh r2, [r0, #2*8] /* d1 */
|
||||||
|
ldrsh r3, [r0, #4*8] /* d2 */
|
||||||
|
ldrsh r4, [r0, #6*8] /* d3 */
|
||||||
|
ldrsh r5, [r0, #8*8] /* d0 */
|
||||||
|
ldrsh r6, [r0, #10*8] /* d1 */
|
||||||
|
ldrsh r7, [r0, #12*8] /* d2 */
|
||||||
|
ldrsh r8, [r0, #14*8] /* d3 */
|
||||||
|
|
||||||
|
mov r1, r1, asl #11 /* r1 = d0 = (block[0] << 11) + 2048 */
|
||||||
|
add r1, r1, #65536
|
||||||
|
add r1, r1, r3, asl #11 /* r1 = t0 = d0 + d2:(block[2] << 11) */
|
||||||
|
sub r3, r1, r3, asl #12 /* r3 = t1 = d0 - d2:(block[2] << 11) */
|
||||||
|
|
||||||
|
add r9, r2, r4 /* r9 = tmp = (d1+d3)*(1108/4) */
|
||||||
|
add r10, r9, r9, asl #2
|
||||||
|
add r10, r10, r9, asl #4
|
||||||
|
add r9, r10, r9, asl #8
|
||||||
|
|
||||||
|
add r11, r2, r2, asl #4 /* r2 = t2 = tmp + (d1*(1568/32)*8) */
|
||||||
|
add r2, r11, r2, asl #5
|
||||||
|
add r2, r9, r2, asl #3
|
||||||
|
|
||||||
|
add r10, r4, r4, asl #2 /* r4 = t3 = tmp - (d3*(3784/8)*2) */
|
||||||
|
rsb r10, r10, r4, asl #6
|
||||||
|
add r4, r4, r10, asl #3
|
||||||
|
sub r4, r9, r4, asl #1
|
||||||
|
/* t2 & t3 are 1/4 final value here */
|
||||||
|
add r1, r1, r2, asl #2 /* r1 = a0 = t0 + t2 */
|
||||||
|
sub r2, r1, r2, asl #3 /* r2 = a3 = t0 - t2 */
|
||||||
|
add r3, r3, r4, asl #2 /* r3 = a1 = t1 + t3 */
|
||||||
|
sub r4, r3, r4, asl #3 /* r4 = a2 = t1 - t3 */
|
||||||
|
|
||||||
|
add r9, r8, r5 /* r9 = tmp = 565*(d3 + d0) */
|
||||||
|
add r10, r9, r9, asl #4
|
||||||
|
add r10, r10, r10, asl #5
|
||||||
|
add r9, r10, r9, asl #2
|
||||||
|
|
||||||
|
add r10, r5, r5, asl #4 /* r5 = t0 = tmp + (((2276/4)*d0)*4) */
|
||||||
|
add r10, r10, r10, asl #5
|
||||||
|
add r5, r10, r5, asl #3
|
||||||
|
add r5, r9, r5, asl #2
|
||||||
|
|
||||||
|
add r10, r8, r8, asl #2 /* r8 = t1 = tmp - (((3406/2)*d3)*2) */
|
||||||
|
add r10, r10, r10, asl #4
|
||||||
|
add r10, r10, r8, asl #7
|
||||||
|
rsb r8, r8, r10, asl #3
|
||||||
|
sub r8, r9, r8, asl #1
|
||||||
|
|
||||||
|
add r9, r6, r7 /* r9 = tmp = (2408/8)*(d1 + d2) */
|
||||||
|
add r10, r9, r9, asl #3
|
||||||
|
add r10, r10, r10, asl #5
|
||||||
|
add r9, r10, r9, asl #2
|
||||||
|
|
||||||
|
add r10, r7, r7, asl #3 /* r7 = t2 = (tmp*8) - 799*d2 */
|
||||||
|
add r10, r10, r7, asl #4
|
||||||
|
rsb r7, r7, r10, asl #5
|
||||||
|
rsb r7, r7, r9, asl #3
|
||||||
|
|
||||||
|
sub r10, r6, r6, asl #4 /* r6 = t3 = (tmp*8) - 4017*d1 */
|
||||||
|
sub r10, r10, r6, asl #6
|
||||||
|
add r10, r10, r6, asl #12
|
||||||
|
add r6, r10, r6
|
||||||
|
rsb r6, r6, r9, asl #3
|
||||||
|
/* t0=r5, t1=r8, t2=r7, t3=r6*/
|
||||||
|
add r9, r5, r7 /* r9 = b0 = t0 + t2 */
|
||||||
|
add r10, r8, r6 /* r10 = b3 = t1 + t3 */
|
||||||
|
sub r5, r5, r7 /* t0 -= t2 */
|
||||||
|
sub r8, r8, r6 /* t1 -= t3 */
|
||||||
|
add r6, r5, r8 /* r6 = t0 + t1 */
|
||||||
|
sub r7, r5, r8 /* r7 = t0 - t1 */
|
||||||
|
|
||||||
|
add r11, r6, r6, asr #2 /* r6 = b1 = r5*(181/128) */
|
||||||
|
add r11, r11, r11, asr #5
|
||||||
|
add r6, r11, r6, asr #3
|
||||||
|
add r11, r7, r7, asr #2 /* r7 = b2 = r6*(181/128) */
|
||||||
|
add r11, r11, r11, asr #5
|
||||||
|
add r7, r11, r7, asr #3
|
||||||
|
/* r1 = a0, r3 = a1, r4 = a2, r2 = a3 */
|
||||||
|
/* r9 = b0, r6 = b1*2, r7 = b2*2, r10 = b3 */
|
||||||
|
add r5, r1, r9 /* block[0] = (a0 + b0) >> 17 */
|
||||||
|
mov r5, r5, asr #17
|
||||||
|
strh r5, [r0, #0*8]
|
||||||
|
add r8, r3, r6, asr #1 /* block[1] = (a1 + b1) >> 17 */
|
||||||
|
mov r8, r8, asr #17
|
||||||
|
strh r8, [r0, #2*8]
|
||||||
|
add r5, r4, r7, asr #1 /* block[2] = (a2 + b2) >> 17 */
|
||||||
|
mov r5, r5, asr #17
|
||||||
|
strh r5, [r0, #4*8]
|
||||||
|
add r8, r2, r10 /* block[3] = (a3 + b3) >> 17 */
|
||||||
|
mov r8, r8, asr #17
|
||||||
|
strh r8, [r0, #6*8]
|
||||||
|
sub r5, r2, r10 /* block[4] = (a3 - b3) >> 17 */
|
||||||
|
mov r5, r5, asr #17
|
||||||
|
strh r5, [r0, #8*8]
|
||||||
|
sub r8, r4, r7, asr #1 /* block[5] = (a2 - b2) >> 17 */
|
||||||
|
mov r8, r8, asr #17
|
||||||
|
strh r8, [r0, #10*8]
|
||||||
|
sub r5, r3, r6, asr #1 /* block[6] = (a1 - b1) >> 17 */
|
||||||
|
mov r5, r5, asr #17
|
||||||
|
strh r5, [r0, #12*8]
|
||||||
|
sub r8, r1, r9 /* block[7] = (a0 - b0) >> 17 */
|
||||||
|
mov r8, r8, asr #17
|
||||||
|
strh r8, [r0, #14*8]
|
||||||
|
add r0, r0, #2
|
||||||
|
cmp r0, r12
|
||||||
|
blo 4b
|
||||||
|
sub r0, r0, #16
|
||||||
|
bx lr
|
||||||
|
|
||||||
|
mpeg2_idct_copy_arm:
|
||||||
|
stmfd sp!, { r1-r2, r4-r12, lr }
|
||||||
|
bl .idct
|
||||||
|
ldmfd sp!, { r1-r2 }
|
||||||
|
mov r11, #0
|
||||||
|
add r12, r0, #128
|
||||||
|
1:
|
||||||
|
ldrsh r3, [r0, #0]
|
||||||
|
ldrsh r4, [r0, #2]
|
||||||
|
ldrsh r5, [r0, #4]
|
||||||
|
ldrsh r6, [r0, #6]
|
||||||
|
ldrsh r7, [r0, #8]
|
||||||
|
ldrsh r8, [r0, #10]
|
||||||
|
ldrsh r9, [r0, #12]
|
||||||
|
ldrsh r10, [r0, #14]
|
||||||
|
cmp r3, #255
|
||||||
|
mvnhi r3, r3, asr #31
|
||||||
|
strb r3, [r1, #0]
|
||||||
|
str r11, [r0], #4
|
||||||
|
cmp r4, #255
|
||||||
|
mvnhi r4, r4, asr #31
|
||||||
|
strb r4, [r1, #1]
|
||||||
|
cmp r5, #255
|
||||||
|
mvnhi r5, r5, asr #31
|
||||||
|
strb r5, [r1, #2]
|
||||||
|
str r11, [r0], #4
|
||||||
|
cmp r6, #255
|
||||||
|
mvnhi r6, r6, asr #31
|
||||||
|
strb r6, [r1, #3]
|
||||||
|
cmp r7, #255
|
||||||
|
mvnhi r7, r7, asr #31
|
||||||
|
strb r7, [r1, #4]
|
||||||
|
str r11, [r0], #4
|
||||||
|
cmp r8, #255
|
||||||
|
mvnhi r8, r8, asr #31
|
||||||
|
strb r8, [r1, #5]
|
||||||
|
cmp r9, #255
|
||||||
|
mvnhi r9, r9, asr #31
|
||||||
|
strb r9, [r1, #6]
|
||||||
|
str r11, [r0], #4
|
||||||
|
cmp r10, #255
|
||||||
|
mvnhi r10, r10, asr #31
|
||||||
|
strb r10, [r1, #7]
|
||||||
|
add r1, r1, r2
|
||||||
|
cmp r0, r12
|
||||||
|
blo 1b
|
||||||
|
ldmfd sp!, { r4-r12, pc }
|
||||||
|
|
||||||
|
mpeg2_idct_add_arm:
|
||||||
|
cmp r0, #129
|
||||||
|
mov r0, r1
|
||||||
|
ldreqsh r1, [r0, #0]
|
||||||
|
bne 1f
|
||||||
|
and r1, r1, #0x70
|
||||||
|
cmp r1, #0x40
|
||||||
|
bne 3f
|
||||||
|
1:
|
||||||
|
stmfd sp!, { r2-r12, lr }
|
||||||
|
bl .idct
|
||||||
|
ldmfd sp!, { r1-r2 }
|
||||||
|
mov r11, #0
|
||||||
|
add r12, r0, #128
|
||||||
|
2:
|
||||||
|
ldrb r3, [r1, #0]
|
||||||
|
ldrb r4, [r1, #1]
|
||||||
|
ldrb r5, [r1, #2]
|
||||||
|
ldrb r6, [r1, #3]
|
||||||
|
ldrsh r7, [r0, #0]
|
||||||
|
ldrsh r8, [r0, #2]
|
||||||
|
ldrsh r9, [r0, #4]
|
||||||
|
ldrsh r10, [r0, #6]
|
||||||
|
add r7, r7, r3
|
||||||
|
ldrb r3, [r1, #4]
|
||||||
|
cmp r7, #255
|
||||||
|
mvnhi r7, r7, asr #31
|
||||||
|
strb r7, [r1, #0]
|
||||||
|
ldrsh r7, [r0, #8]
|
||||||
|
add r8, r8, r4
|
||||||
|
ldrb r4, [r1, #5]
|
||||||
|
cmp r8, #255
|
||||||
|
mvnhi r8, r8, asr #31
|
||||||
|
strb r8, [r1, #1]
|
||||||
|
ldrsh r8, [r0, #10]
|
||||||
|
add r9, r9, r5
|
||||||
|
ldrb r5, [r1, #6]
|
||||||
|
cmp r9, #255
|
||||||
|
mvnhi r9, r9, asr #31
|
||||||
|
strb r9, [r1, #2]
|
||||||
|
ldrsh r9, [r0, #12]
|
||||||
|
add r10, r10, r6
|
||||||
|
ldrb r6, [r1, #7]
|
||||||
|
cmp r10, #255
|
||||||
|
mvnhi r10, r10, asr #31
|
||||||
|
strb r10, [r1, #3]
|
||||||
|
ldrsh r10, [r0, #14]
|
||||||
|
str r11, [r0], #4
|
||||||
|
add r7, r7, r3
|
||||||
|
cmp r7, #255
|
||||||
|
mvnhi r7, r7, asr #31
|
||||||
|
strb r7, [r1, #4]
|
||||||
|
str r11, [r0], #4
|
||||||
|
add r8, r8, r4
|
||||||
|
cmp r8, #255
|
||||||
|
mvnhi r8, r8, asr #31
|
||||||
|
strb r8, [r1, #5]
|
||||||
|
str r11, [r0], #4
|
||||||
|
add r9, r9, r5
|
||||||
|
cmp r9, #255
|
||||||
|
mvnhi r9, r9, asr #31
|
||||||
|
strb r9, [r1, #6]
|
||||||
|
add r10, r10, r6
|
||||||
|
cmp r10, #255
|
||||||
|
mvnhi r10, r10, asr #31
|
||||||
|
strb r10, [r1, #7]
|
||||||
|
str r11, [r0], #4
|
||||||
|
add r1, r1, r2
|
||||||
|
cmp r0, r12
|
||||||
|
blo 2b
|
||||||
|
ldmfd sp!, { r4-r12, pc }
|
||||||
|
3:
|
||||||
|
stmfd sp!, { r4-r11 }
|
||||||
|
ldrsh r1, [r0, #0] /* r1 = block[0] */
|
||||||
|
mov r11, #0
|
||||||
|
strh r11, [r0, #0] /* block[0] = 0 */
|
||||||
|
strh r11, [r0, #126] /* block[63] = 0 */
|
||||||
|
add r1, r1, #64 /* r1 = DC << 7 */
|
||||||
|
add r0, r2, r3, asl #3
|
||||||
|
4:
|
||||||
|
ldrb r4, [r2, #0]
|
||||||
|
ldrb r5, [r2, #1]
|
||||||
|
ldrb r6, [r2, #2]
|
||||||
|
ldrb r7, [r2, #3]
|
||||||
|
ldrb r8, [r2, #4]
|
||||||
|
ldrb r9, [r2, #5]
|
||||||
|
ldrb r10, [r2, #6]
|
||||||
|
ldrb r11, [r2, #7]
|
||||||
|
add r4, r4, r1, asr #7
|
||||||
|
cmp r4, #255
|
||||||
|
mvnhi r4, r4, asr #31
|
||||||
|
strb r4, [r2, #0]
|
||||||
|
add r5, r5, r1, asr #7
|
||||||
|
cmp r5, #255
|
||||||
|
mvnhi r5, r5, asr #31
|
||||||
|
strb r5, [r2, #1]
|
||||||
|
add r6, r6, r1, asr #7
|
||||||
|
cmp r6, #255
|
||||||
|
mvnhi r6, r6, asr #31
|
||||||
|
strb r6, [r2, #2]
|
||||||
|
add r7, r7, r1, asr #7
|
||||||
|
cmp r7, #255
|
||||||
|
mvnhi r7, r7, asr #31
|
||||||
|
strb r7, [r2, #3]
|
||||||
|
add r8, r8, r1, asr #7
|
||||||
|
cmp r8, #255
|
||||||
|
mvnhi r8, r8, asr #31
|
||||||
|
strb r8, [r2, #4]
|
||||||
|
add r9, r9, r1, asr #7
|
||||||
|
cmp r9, #255
|
||||||
|
mvnhi r9, r9, asr #31
|
||||||
|
strb r9, [r2, #5]
|
||||||
|
add r10, r10, r1, asr #7
|
||||||
|
cmp r10, #255
|
||||||
|
mvnhi r10, r10, asr #31
|
||||||
|
strb r10, [r2, #6]
|
||||||
|
add r11, r11, r1, asr #7
|
||||||
|
cmp r11, #255
|
||||||
|
mvnhi r11, r11, asr #31
|
||||||
|
strb r11, [r2, #7]
|
||||||
|
add r2, r2, r3
|
||||||
|
cmp r2, r0
|
||||||
|
blo 4b
|
||||||
|
ldmfd sp!, { r4-r11 }
|
||||||
|
bx lr
|
||||||
|
|
@ -1,529 +0,0 @@
|
||||||
/*
|
|
||||||
* idct.c
|
|
||||||
* Copyright (C) 2000-2003 Michel Lespinasse <walken@zoy.org>
|
|
||||||
* Copyright (C) 1999-2000 Aaron Holtzman <aholtzma@ess.engr.uvic.ca>
|
|
||||||
*
|
|
||||||
* This file is part of mpeg2dec, a free MPEG-2 video stream decoder.
|
|
||||||
* See http://libmpeg2.sourceforge.net/ for updates.
|
|
||||||
*
|
|
||||||
* mpeg2dec is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License as published by
|
|
||||||
* the Free Software Foundation; either version 2 of the License, or
|
|
||||||
* (at your option) any later version.
|
|
||||||
*
|
|
||||||
* mpeg2dec is distributed in the hope that it will be useful,
|
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
||||||
* GNU General Public License for more details.
|
|
||||||
*
|
|
||||||
* You should have received a copy of the GNU General Public License
|
|
||||||
* along with this program; if not, write to the Free Software
|
|
||||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "plugin.h"
|
|
||||||
|
|
||||||
#include "mpeg2dec_config.h"
|
|
||||||
|
|
||||||
#include "mpeg2.h"
|
|
||||||
#include "attributes.h"
|
|
||||||
#include "mpeg2_internal.h"
|
|
||||||
|
|
||||||
/* 101100011001 */
|
|
||||||
#define W1 2841 /* 2048 * sqrt (2) * cos (1 * pi / 16) */
|
|
||||||
/* 101001110100 */
|
|
||||||
#define W2 2676 /* 2048 * sqrt (2) * cos (2 * pi / 16) */
|
|
||||||
/* 100101101000 */
|
|
||||||
#define W3 2408 /* 2048 * sqrt (2) * cos (3 * pi / 16) */
|
|
||||||
/* 011001001001 */
|
|
||||||
#define W5 1609 /* 2048 * sqrt (2) * cos (5 * pi / 16) */
|
|
||||||
/* 010001010100 */
|
|
||||||
#define W6 1108 /* 2048 * sqrt (2) * cos (6 * pi / 16) */
|
|
||||||
/* 001000110101 */
|
|
||||||
#define W7 565 /* 2048 * sqrt (2) * cos (7 * pi / 16) */
|
|
||||||
|
|
||||||
/* idct main entry point */
|
|
||||||
void (* mpeg2_idct_copy) (int16_t * block, uint8_t * dest, int stride);
|
|
||||||
void (* mpeg2_idct_add) (int last, int16_t * block,
|
|
||||||
uint8_t * dest, int stride);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* In legal streams, the IDCT output should be between -384 and +384.
|
|
||||||
* In corrupted streams, it is possible to force the IDCT output to go
|
|
||||||
* to +-3826 - this is the worst case for a column IDCT where the
|
|
||||||
* column inputs are 16-bit values.
|
|
||||||
*/
|
|
||||||
#if 0
|
|
||||||
#define BUTTERFLY(t0,t1,W0,W1,d0,d1) \
|
|
||||||
do { \
|
|
||||||
t0 = W0 * d0 + W1 * d1; \
|
|
||||||
t1 = W0 * d1 - W1 * d0; \
|
|
||||||
} while (0)
|
|
||||||
#else
|
|
||||||
#define BUTTERFLY(t0,t1,W0,W1,d0,d1) \
|
|
||||||
do { \
|
|
||||||
int tmp = W0 * (d0 + d1); \
|
|
||||||
t0 = tmp + (W1 - W0) * d1; \
|
|
||||||
t1 = tmp - (W1 + W0) * d0; \
|
|
||||||
} while (0)
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/* Custom calling convention:
|
|
||||||
* r0 contains block pointer and is non-volatile
|
|
||||||
* all non-volatile c context saved and restored on its behalf
|
|
||||||
*/
|
|
||||||
static void idct (int16_t * block) __attribute__((naked,used));
|
|
||||||
static void idct (int16_t * block)
|
|
||||||
{
|
|
||||||
asm volatile (
|
|
||||||
"add r12, r0, #128 \n"
|
|
||||||
"1: \n"
|
|
||||||
"ldrsh r1, [r0, #0] \n" /* d0 */
|
|
||||||
"ldrsh r2, [r0, #2] \n" /* d1 */
|
|
||||||
"ldrsh r3, [r0, #4] \n" /* d2 */
|
|
||||||
"ldrsh r4, [r0, #6] \n" /* d3 */
|
|
||||||
"ldrsh r5, [r0, #8] \n" /* d0 */
|
|
||||||
"ldrsh r6, [r0, #10] \n" /* d1 */
|
|
||||||
"ldrsh r7, [r0, #12] \n" /* d2 */
|
|
||||||
"ldrsh r8, [r0, #14] \n" /* d3 */
|
|
||||||
"orrs r9, r2, r3 \n"
|
|
||||||
"orreqs r9, r4, r5 \n"
|
|
||||||
"orreqs r9, r6, r7 \n"
|
|
||||||
"cmpeq r8, #0 \n"
|
|
||||||
"bne 2f \n"
|
|
||||||
"mov r1, r1, asl #15 \n"
|
|
||||||
"bic r1, r1, #0x8000 \n"
|
|
||||||
"orr r1, r1, r1, lsr #16 \n"
|
|
||||||
"str r1, [r0], #4 \n"
|
|
||||||
"str r1, [r0], #4 \n"
|
|
||||||
"str r1, [r0], #4 \n"
|
|
||||||
"str r1, [r0], #4 \n"
|
|
||||||
"cmp r0, r12 \n"
|
|
||||||
"blo 1b \n"
|
|
||||||
"b 3f \n"
|
|
||||||
"2: \n"
|
|
||||||
"mov r1, r1, asl #11 \n" /* r1 = d0 = (block[0] << 11) + 2048 */
|
|
||||||
"add r1, r1, #2048 \n"
|
|
||||||
"add r1, r1, r3, asl #11 \n" /* r1 = t0 = d0 + (block[2] << 11) */
|
|
||||||
"sub r3, r1, r3, asl #12 \n" /* r3 = t1 = d0 - (block[2] << 11) */
|
|
||||||
|
|
||||||
"add r9, r2, r4 \n" /* r9 = tmp = (d1+d3)*(1108/4) */
|
|
||||||
"add r10, r9, r9, asl #2 \n"
|
|
||||||
"add r10, r10, r9, asl #4 \n"
|
|
||||||
"add r9, r10, r9, asl #8 \n"
|
|
||||||
|
|
||||||
"add r10, r2, r2, asl #4 \n" /* r2 = t2 = tmp + (d1*(1568/32)*8) */
|
|
||||||
"add r2, r10, r2, asl #5 \n"
|
|
||||||
"add r2, r9, r2, asl #3 \n"
|
|
||||||
|
|
||||||
"add r10, r4, r4, asl #2 \n" /* r4 = t3 = tmp - (d3*(3784/8)*2) */
|
|
||||||
"rsb r10, r10, r4, asl #6 \n"
|
|
||||||
"add r4, r4, r10, asl #3 \n"
|
|
||||||
"sub r4, r9, r4, asl #1 \n"
|
|
||||||
/* t2 & t3 are 1/4 final value here */
|
|
||||||
"add r1, r1, r2, asl #2 \n" /* r1 = a0 = t0 + t2 */
|
|
||||||
"sub r2, r1, r2, asl #3 \n" /* r2 = a3 = t0 - t2 */
|
|
||||||
"add r3, r3, r4, asl #2 \n" /* r3 = a1 = t1 + t3 */
|
|
||||||
"sub r4, r3, r4, asl #3 \n" /* r4 = a2 = t1 - t3 */
|
|
||||||
|
|
||||||
"add r9, r8, r5 \n" /* r9 = tmp = 565*(d3 + d0) */
|
|
||||||
"add r10, r9, r9, asl #4 \n"
|
|
||||||
"add r10, r10, r10, asl #5 \n"
|
|
||||||
"add r9, r10, r9, asl #2 \n"
|
|
||||||
|
|
||||||
"add r10, r5, r5, asl #4 \n" /* r5 = t0 = tmp + (((2276/4)*d0)*4) */
|
|
||||||
"add r10, r10, r10, asl #5 \n"
|
|
||||||
"add r5, r10, r5, asl #3 \n"
|
|
||||||
"add r5, r9, r5, asl #2 \n"
|
|
||||||
|
|
||||||
"add r10, r8, r8, asl #2 \n" /* r8 = t1 = tmp - (((3406/2)*d3)*2) */
|
|
||||||
"add r10, r10, r10, asl #4 \n"
|
|
||||||
"add r10, r10, r8, asl #7 \n"
|
|
||||||
"rsb r8, r8, r10, asl #3 \n"
|
|
||||||
"sub r8, r9, r8, asl #1 \n"
|
|
||||||
|
|
||||||
"add r9, r6, r7 \n" /* r9 = tmp = (2408/8)*(d1 + d2) */
|
|
||||||
"add r10, r9, r9, asl #3 \n"
|
|
||||||
"add r10, r10, r10, asl #5 \n"
|
|
||||||
"add r9, r10, r9, asl #2 \n"
|
|
||||||
|
|
||||||
"add r10, r7, r7, asl #3 \n" /* r7 = t2 = (tmp*8) - 799*d2 */
|
|
||||||
"add r10, r10, r7, asl #4 \n"
|
|
||||||
"rsb r7, r7, r10, asl #5 \n"
|
|
||||||
"rsb r7, r7, r9, asl #3 \n"
|
|
||||||
|
|
||||||
"sub r10, r6, r6, asl #4 \n" /* r6 = t3 = (tmp*8) - 4017*d1 */
|
|
||||||
"sub r10, r10, r6, asl #6 \n"
|
|
||||||
"add r10, r10, r6, asl #12 \n"
|
|
||||||
"add r6, r10, r6 \n"
|
|
||||||
"rsb r6, r6, r9, asl #3 \n"
|
|
||||||
/* t0 = r5, t1 = r8, t2 = r7, t3 = r6*/
|
|
||||||
"add r9, r5, r7 \n" /* r9 = b0 = t0 + t2 */
|
|
||||||
"add r10, r8, r6 \n" /* r10 = b3 = t1 + t3 */
|
|
||||||
"sub r5, r5, r7 \n" /* t0 -= t2 */
|
|
||||||
"sub r8, r8, r6 \n" /* t1 -= t3 */
|
|
||||||
"add r6, r5, r8 \n" /* r6 = t0 + t1 */
|
|
||||||
"sub r7, r5, r8 \n" /* r7 = t0 - t1 */
|
|
||||||
|
|
||||||
"add r11, r6, r6, asr #2 \n" /* r6 = b1 = r6*(181/128) */
|
|
||||||
"add r11, r11, r11, asr #5 \n"
|
|
||||||
"add r6, r11, r6, asr #3 \n"
|
|
||||||
"add r11, r7, r7, asr #2 \n" /* r7 = b2 = r7*(181/128) */
|
|
||||||
"add r11, r11, r11, asr #5 \n"
|
|
||||||
"add r7, r11, r7, asr #3 \n"
|
|
||||||
/* r1 = a0, r3 = a1, r4 = a2, r2 = a3 */
|
|
||||||
/* r9 = b0, r6 = b1*2, r7 = b2*2, r10 = b3 */
|
|
||||||
"add r5, r1, r9 \n" /* block[0] = (a0 + b0) >> 12 */
|
|
||||||
"mov r5, r5, asr #12 \n"
|
|
||||||
"strh r5, [r0], #2 \n"
|
|
||||||
"add r8, r3, r6, asr #1 \n" /* block[1] = (a1 + b1) >> 12 */
|
|
||||||
"mov r8, r8, asr #12 \n"
|
|
||||||
"strh r8, [r0], #2 \n"
|
|
||||||
"add r5, r4, r7, asr #1 \n" /* block[2] = (a2 + b2) >> 12 */
|
|
||||||
"mov r5, r5, asr #12 \n"
|
|
||||||
"strh r5, [r0], #2 \n"
|
|
||||||
"add r8, r2, r10 \n" /* block[3] = (a3 + b3) >> 12 */
|
|
||||||
"mov r8, r8, asr #12 \n"
|
|
||||||
"strh r8, [r0], #2 \n"
|
|
||||||
"sub r5, r2, r10 \n" /* block[4] = (a3 - b3) >> 12 */
|
|
||||||
"mov r5, r5, asr #12 \n"
|
|
||||||
"strh r5, [r0], #2 \n"
|
|
||||||
"sub r8, r4, r7, asr #1 \n" /* block[5] = (a2 - b2) >> 12 */
|
|
||||||
"mov r8, r8, asr #12 \n"
|
|
||||||
"strh r8, [r0], #2 \n"
|
|
||||||
"sub r5, r3, r6, asr #1 \n" /* block[6] = (a1 - b1) >> 12 */
|
|
||||||
"mov r5, r5, asr #12 \n"
|
|
||||||
"strh r5, [r0], #2 \n"
|
|
||||||
"sub r8, r1, r9 \n" /* block[7] = (a0 - b0) >> 12 */
|
|
||||||
"mov r8, r8, asr #12 \n"
|
|
||||||
"strh r8, [r0], #2 \n"
|
|
||||||
"cmp r0, r12 \n"
|
|
||||||
"blo 1b \n"
|
|
||||||
"3: \n"
|
|
||||||
"sub r0, r0, #128 \n"
|
|
||||||
"add r12, r0, #16 \n"
|
|
||||||
"4: \n"
|
|
||||||
"ldrsh r1, [r0, #0*8] \n" /* d0 */
|
|
||||||
"ldrsh r2, [r0, #2*8] \n" /* d1 */
|
|
||||||
"ldrsh r3, [r0, #4*8] \n" /* d2 */
|
|
||||||
"ldrsh r4, [r0, #6*8] \n" /* d3 */
|
|
||||||
"ldrsh r5, [r0, #8*8] \n" /* d0 */
|
|
||||||
"ldrsh r6, [r0, #10*8] \n" /* d1 */
|
|
||||||
"ldrsh r7, [r0, #12*8] \n" /* d2 */
|
|
||||||
"ldrsh r8, [r0, #14*8] \n" /* d3 */
|
|
||||||
|
|
||||||
"mov r1, r1, asl #11 \n" /* r1 = d0 = (block[0] << 11) + 2048 */
|
|
||||||
"add r1, r1, #65536 \n"
|
|
||||||
"add r1, r1, r3, asl #11 \n" /* r1 = t0 = d0 + d2:(block[2] << 11) */
|
|
||||||
"sub r3, r1, r3, asl #12 \n" /* r3 = t1 = d0 - d2:(block[2] << 11) */
|
|
||||||
|
|
||||||
"add r9, r2, r4 \n" /* r9 = tmp = (d1+d3)*(1108/4) */
|
|
||||||
"add r10, r9, r9, asl #2 \n"
|
|
||||||
"add r10, r10, r9, asl #4 \n"
|
|
||||||
"add r9, r10, r9, asl #8 \n"
|
|
||||||
|
|
||||||
"add r11, r2, r2, asl #4 \n" /* r2 = t2 = tmp + (d1*(1568/32)*8) */
|
|
||||||
"add r2, r11, r2, asl #5 \n"
|
|
||||||
"add r2, r9, r2, asl #3 \n"
|
|
||||||
|
|
||||||
"add r10, r4, r4, asl #2 \n" /* r4 = t3 = tmp - (d3*(3784/8)*2) */
|
|
||||||
"rsb r10, r10, r4, asl #6 \n"
|
|
||||||
"add r4, r4, r10, asl #3 \n"
|
|
||||||
"sub r4, r9, r4, asl #1 \n"
|
|
||||||
/* t2 & t3 are 1/4 final value here */
|
|
||||||
"add r1, r1, r2, asl #2 \n" /* r1 = a0 = t0 + t2 */
|
|
||||||
"sub r2, r1, r2, asl #3 \n" /* r2 = a3 = t0 - t2 */
|
|
||||||
"add r3, r3, r4, asl #2 \n" /* r3 = a1 = t1 + t3 */
|
|
||||||
"sub r4, r3, r4, asl #3 \n" /* r4 = a2 = t1 - t3 */
|
|
||||||
|
|
||||||
"add r9, r8, r5 \n" /* r9 = tmp = 565*(d3 + d0) */
|
|
||||||
"add r10, r9, r9, asl #4 \n"
|
|
||||||
"add r10, r10, r10, asl #5 \n"
|
|
||||||
"add r9, r10, r9, asl #2 \n"
|
|
||||||
|
|
||||||
"add r10, r5, r5, asl #4 \n" /* r5 = t0 = tmp + (((2276/4)*d0)*4) */
|
|
||||||
"add r10, r10, r10, asl #5 \n"
|
|
||||||
"add r5, r10, r5, asl #3 \n"
|
|
||||||
"add r5, r9, r5, asl #2 \n"
|
|
||||||
|
|
||||||
"add r10, r8, r8, asl #2 \n" /* r8 = t1 = tmp - (((3406/2)*d3)*2) */
|
|
||||||
"add r10, r10, r10, asl #4 \n"
|
|
||||||
"add r10, r10, r8, asl #7 \n"
|
|
||||||
"rsb r8, r8, r10, asl #3 \n"
|
|
||||||
"sub r8, r9, r8, asl #1 \n"
|
|
||||||
|
|
||||||
"add r9, r6, r7 \n" /* r9 = tmp = (2408/8)*(d1 + d2) */
|
|
||||||
"add r10, r9, r9, asl #3 \n"
|
|
||||||
"add r10, r10, r10, asl #5 \n"
|
|
||||||
"add r9, r10, r9, asl #2 \n"
|
|
||||||
|
|
||||||
"add r10, r7, r7, asl #3 \n" /* r7 = t2 = (tmp*8) - 799*d2 */
|
|
||||||
"add r10, r10, r7, asl #4 \n"
|
|
||||||
"rsb r7, r7, r10, asl #5 \n"
|
|
||||||
"rsb r7, r7, r9, asl #3 \n"
|
|
||||||
|
|
||||||
"sub r10, r6, r6, asl #4 \n" /* r6 = t3 = (tmp*8) - 4017*d1 */
|
|
||||||
"sub r10, r10, r6, asl #6 \n"
|
|
||||||
"add r10, r10, r6, asl #12 \n"
|
|
||||||
"add r6, r10, r6 \n"
|
|
||||||
"rsb r6, r6, r9, asl #3 \n"
|
|
||||||
/* t0=r5, t1=r8, t2=r7, t3=r6*/
|
|
||||||
"add r9, r5, r7 \n" /* r9 = b0 = t0 + t2 */
|
|
||||||
"add r10, r8, r6 \n" /* r10 = b3 = t1 + t3 */
|
|
||||||
"sub r5, r5, r7 \n" /* t0 -= t2 */
|
|
||||||
"sub r8, r8, r6 \n" /* t1 -= t3 */
|
|
||||||
"add r6, r5, r8 \n" /* r6 = t0 + t1 */
|
|
||||||
"sub r7, r5, r8 \n" /* r7 = t0 - t1 */
|
|
||||||
|
|
||||||
"add r11, r6, r6, asr #2 \n" /* r6 = b1 = r5*(181/128) */
|
|
||||||
"add r11, r11, r11, asr #5 \n"
|
|
||||||
"add r6, r11, r6, asr #3 \n"
|
|
||||||
"add r11, r7, r7, asr #2 \n" /* r7 = b2 = r6*(181/128) */
|
|
||||||
"add r11, r11, r11, asr #5 \n"
|
|
||||||
"add r7, r11, r7, asr #3 \n"
|
|
||||||
/* r1 = a0, r3 = a1, r4 = a2, r2 = a3 */
|
|
||||||
/* r9 = b0, r6 = b1*2, r7 = b2*2, r10 = b3 */
|
|
||||||
"add r5, r1, r9 \n" /* block[0] = (a0 + b0) >> 17 */
|
|
||||||
"mov r5, r5, asr #17 \n"
|
|
||||||
"strh r5, [r0, #0*8] \n"
|
|
||||||
"add r8, r3, r6, asr #1 \n" /* block[1] = (a1 + b1) >> 17 */
|
|
||||||
"mov r8, r8, asr #17 \n"
|
|
||||||
"strh r8, [r0, #2*8] \n"
|
|
||||||
"add r5, r4, r7, asr #1 \n" /* block[2] = (a2 + b2) >> 17 */
|
|
||||||
"mov r5, r5, asr #17 \n"
|
|
||||||
"strh r5, [r0, #4*8] \n"
|
|
||||||
"add r8, r2, r10 \n" /* block[3] = (a3 + b3) >> 17 */
|
|
||||||
"mov r8, r8, asr #17 \n"
|
|
||||||
"strh r8, [r0, #6*8] \n"
|
|
||||||
"sub r5, r2, r10 \n" /* block[4] = (a3 - b3) >> 17 */
|
|
||||||
"mov r5, r5, asr #17 \n"
|
|
||||||
"strh r5, [r0, #8*8] \n"
|
|
||||||
"sub r8, r4, r7, asr #1 \n" /* block[5] = (a2 - b2) >> 17 */
|
|
||||||
"mov r8, r8, asr #17 \n"
|
|
||||||
"strh r8, [r0, #10*8] \n"
|
|
||||||
"sub r5, r3, r6, asr #1 \n" /* block[6] = (a1 - b1) >> 17 */
|
|
||||||
"mov r5, r5, asr #17 \n"
|
|
||||||
"strh r5, [r0, #12*8] \n"
|
|
||||||
"sub r8, r1, r9 \n" /* block[7] = (a0 - b0) >> 17 */
|
|
||||||
"mov r8, r8, asr #17 \n"
|
|
||||||
"strh r8, [r0, #14*8] \n"
|
|
||||||
"add r0, r0, #2 \n"
|
|
||||||
"cmp r0, r12 \n"
|
|
||||||
"blo 4b \n"
|
|
||||||
"sub r0, r0, #16 \n"
|
|
||||||
"bx lr \n"
|
|
||||||
);
|
|
||||||
(void)block;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void mpeg2_idct_copy_c (int16_t * block, uint8_t * dest,
|
|
||||||
const int stride) __attribute__((naked));
|
|
||||||
static void mpeg2_idct_copy_c (int16_t * block, uint8_t * dest,
|
|
||||||
const int stride)
|
|
||||||
{
|
|
||||||
asm volatile(
|
|
||||||
"stmfd sp!, { r1-r2, \
|
|
||||||
r4-r12, lr } \n"
|
|
||||||
"bl idct \n"
|
|
||||||
"ldmfd sp!, { r1-r2 } \n"
|
|
||||||
"mov r11, #0 \n"
|
|
||||||
"add r12, r0, #128 \n"
|
|
||||||
"1: \n"
|
|
||||||
"ldrsh r3, [r0, #0] \n"
|
|
||||||
"ldrsh r4, [r0, #2] \n"
|
|
||||||
"ldrsh r5, [r0, #4] \n"
|
|
||||||
"ldrsh r6, [r0, #6] \n"
|
|
||||||
"ldrsh r7, [r0, #8] \n"
|
|
||||||
"ldrsh r8, [r0, #10] \n"
|
|
||||||
"ldrsh r9, [r0, #12] \n"
|
|
||||||
"ldrsh r10, [r0, #14] \n"
|
|
||||||
"cmp r3, #255 \n"
|
|
||||||
"mvnhi r3, r3, asr #31 \n"
|
|
||||||
"strb r3, [r1, #0] \n"
|
|
||||||
"str r11, [r0], #4 \n"
|
|
||||||
"cmp r4, #255 \n"
|
|
||||||
"mvnhi r4, r4, asr #31 \n"
|
|
||||||
"strb r4, [r1, #1] \n"
|
|
||||||
"cmp r5, #255 \n"
|
|
||||||
"mvnhi r5, r5, asr #31 \n"
|
|
||||||
"strb r5, [r1, #2] \n"
|
|
||||||
"str r11, [r0], #4 \n"
|
|
||||||
"cmp r6, #255 \n"
|
|
||||||
"mvnhi r6, r6, asr #31 \n"
|
|
||||||
"strb r6, [r1, #3] \n"
|
|
||||||
"cmp r7, #255 \n"
|
|
||||||
"mvnhi r7, r7, asr #31 \n"
|
|
||||||
"strb r7, [r1, #4] \n"
|
|
||||||
"str r11, [r0], #4 \n"
|
|
||||||
"cmp r8, #255 \n"
|
|
||||||
"mvnhi r8, r8, asr #31 \n"
|
|
||||||
"strb r8, [r1, #5] \n"
|
|
||||||
"cmp r9, #255 \n"
|
|
||||||
"mvnhi r9, r9, asr #31 \n"
|
|
||||||
"strb r9, [r1, #6] \n"
|
|
||||||
"str r11, [r0], #4 \n"
|
|
||||||
"cmp r10, #255 \n"
|
|
||||||
"mvnhi r10, r10, asr #31 \n"
|
|
||||||
"strb r10, [r1, #7] \n"
|
|
||||||
"add r1, r1, r2 \n"
|
|
||||||
"cmp r0, r12 \n"
|
|
||||||
"blo 1b \n"
|
|
||||||
"ldmfd sp!, { r4-r12, pc } \n"
|
|
||||||
);
|
|
||||||
(void)block; (void)dest; (void)stride;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void mpeg2_idct_add_c (int last, int16_t * block,
|
|
||||||
uint8_t * dest, const int stride) __attribute__((naked));
|
|
||||||
static void mpeg2_idct_add_c (int last, int16_t * block,
|
|
||||||
uint8_t * dest, const int stride)
|
|
||||||
{
|
|
||||||
asm volatile (
|
|
||||||
"cmp r0, #129 \n"
|
|
||||||
"mov r0, r1 \n"
|
|
||||||
"ldreqsh r1, [r0, #0] \n"
|
|
||||||
"bne 1f \n"
|
|
||||||
"and r1, r1, #0x70 \n"
|
|
||||||
"cmp r1, #0x40 \n"
|
|
||||||
"bne 3f \n"
|
|
||||||
"1: \n"
|
|
||||||
"stmfd sp!, { r2-r12, lr } \n"
|
|
||||||
"bl idct \n"
|
|
||||||
"ldmfd sp!, { r1-r2 } \n"
|
|
||||||
"mov r11, #0 \n"
|
|
||||||
"add r12, r0, #128 \n"
|
|
||||||
"2: \n"
|
|
||||||
"ldrb r3, [r1, #0] \n"
|
|
||||||
"ldrb r4, [r1, #1] \n"
|
|
||||||
"ldrb r5, [r1, #2] \n"
|
|
||||||
"ldrb r6, [r1, #3] \n"
|
|
||||||
"ldrsh r7, [r0, #0] \n"
|
|
||||||
"ldrsh r8, [r0, #2] \n"
|
|
||||||
"ldrsh r9, [r0, #4] \n"
|
|
||||||
"ldrsh r10, [r0, #6] \n"
|
|
||||||
"add r7, r7, r3 \n"
|
|
||||||
"ldrb r3, [r1, #4] \n"
|
|
||||||
"cmp r7, #255 \n"
|
|
||||||
"mvnhi r7, r7, asr #31 \n"
|
|
||||||
"strb r7, [r1, #0] \n"
|
|
||||||
"ldrsh r7, [r0, #8] \n"
|
|
||||||
"add r8, r8, r4 \n"
|
|
||||||
"ldrb r4, [r1, #5] \n"
|
|
||||||
"cmp r8, #255 \n"
|
|
||||||
"mvnhi r8, r8, asr #31 \n"
|
|
||||||
"strb r8, [r1, #1] \n"
|
|
||||||
"ldrsh r8, [r0, #10] \n"
|
|
||||||
"add r9, r9, r5 \n"
|
|
||||||
"ldrb r5, [r1, #6] \n"
|
|
||||||
"cmp r9, #255 \n"
|
|
||||||
"mvnhi r9, r9, asr #31 \n"
|
|
||||||
"strb r9, [r1, #2] \n"
|
|
||||||
"ldrsh r9, [r0, #12] \n"
|
|
||||||
"add r10, r10, r6 \n"
|
|
||||||
"ldrb r6, [r1, #7] \n"
|
|
||||||
"cmp r10, #255 \n"
|
|
||||||
"mvnhi r10, r10, asr #31 \n"
|
|
||||||
"strb r10, [r1, #3] \n"
|
|
||||||
"ldrsh r10, [r0, #14] \n"
|
|
||||||
"str r11, [r0], #4 \n"
|
|
||||||
"add r7, r7, r3 \n"
|
|
||||||
"cmp r7, #255 \n"
|
|
||||||
"mvnhi r7, r7, asr #31 \n"
|
|
||||||
"strb r7, [r1, #4] \n"
|
|
||||||
"str r11, [r0], #4 \n"
|
|
||||||
"add r8, r8, r4 \n"
|
|
||||||
"cmp r8, #255 \n"
|
|
||||||
"mvnhi r8, r8, asr #31 \n"
|
|
||||||
"strb r8, [r1, #5] \n"
|
|
||||||
"str r11, [r0], #4 \n"
|
|
||||||
"add r9, r9, r5 \n"
|
|
||||||
"cmp r9, #255 \n"
|
|
||||||
"mvnhi r9, r9, asr #31 \n"
|
|
||||||
"strb r9, [r1, #6] \n"
|
|
||||||
"add r10, r10, r6 \n"
|
|
||||||
"cmp r10, #255 \n"
|
|
||||||
"mvnhi r10, r10, asr #31 \n"
|
|
||||||
"strb r10, [r1, #7] \n"
|
|
||||||
"str r11, [r0], #4 \n"
|
|
||||||
"add r1, r1, r2 \n"
|
|
||||||
"cmp r0, r12 \n"
|
|
||||||
"blo 2b \n"
|
|
||||||
"ldmfd sp!, { r4-r12, pc } \n"
|
|
||||||
"3: \n"
|
|
||||||
"stmfd sp!, { r4-r11 } \n"
|
|
||||||
"ldrsh r1, [r0, #0] \n" /* r1 = block[0] */
|
|
||||||
"mov r11, #0 \n"
|
|
||||||
"strh r11, [r0, #0] \n" /* block[0] = 0 */
|
|
||||||
"strh r11, [r0, #126] \n" /* block[63] = 0 */
|
|
||||||
"add r1, r1, #64 \n" /* r1 = DC << 7 */
|
|
||||||
"add r0, r2, r3, asl #3 \n"
|
|
||||||
"4: \n"
|
|
||||||
"ldrb r4, [r2, #0] \n"
|
|
||||||
"ldrb r5, [r2, #1] \n"
|
|
||||||
"ldrb r6, [r2, #2] \n"
|
|
||||||
"ldrb r7, [r2, #3] \n"
|
|
||||||
"ldrb r8, [r2, #4] \n"
|
|
||||||
"ldrb r9, [r2, #5] \n"
|
|
||||||
"ldrb r10, [r2, #6] \n"
|
|
||||||
"ldrb r11, [r2, #7] \n"
|
|
||||||
"add r4, r4, r1, asr #7 \n"
|
|
||||||
"cmp r4, #255 \n"
|
|
||||||
"mvnhi r4, r4, asr #31 \n"
|
|
||||||
"strb r4, [r2, #0] \n"
|
|
||||||
"add r5, r5, r1, asr #7 \n"
|
|
||||||
"cmp r5, #255 \n"
|
|
||||||
"mvnhi r5, r5, asr #31 \n"
|
|
||||||
"strb r5, [r2, #1] \n"
|
|
||||||
"add r6, r6, r1, asr #7 \n"
|
|
||||||
"cmp r6, #255 \n"
|
|
||||||
"mvnhi r6, r6, asr #31 \n"
|
|
||||||
"strb r6, [r2, #2] \n"
|
|
||||||
"add r7, r7, r1, asr #7 \n"
|
|
||||||
"cmp r7, #255 \n"
|
|
||||||
"mvnhi r7, r7, asr #31 \n"
|
|
||||||
"strb r7, [r2, #3] \n"
|
|
||||||
"add r8, r8, r1, asr #7 \n"
|
|
||||||
"cmp r8, #255 \n"
|
|
||||||
"mvnhi r8, r8, asr #31 \n"
|
|
||||||
"strb r8, [r2, #4] \n"
|
|
||||||
"add r9, r9, r1, asr #7 \n"
|
|
||||||
"cmp r9, #255 \n"
|
|
||||||
"mvnhi r9, r9, asr #31 \n"
|
|
||||||
"strb r9, [r2, #5] \n"
|
|
||||||
"add r10, r10, r1, asr #7 \n"
|
|
||||||
"cmp r10, #255 \n"
|
|
||||||
"mvnhi r10, r10, asr #31 \n"
|
|
||||||
"strb r10, [r2, #6] \n"
|
|
||||||
"add r11, r11, r1, asr #7 \n"
|
|
||||||
"cmp r11, #255 \n"
|
|
||||||
"mvnhi r11, r11, asr #31 \n"
|
|
||||||
"strb r11, [r2, #7] \n"
|
|
||||||
"add r2, r2, r3 \n"
|
|
||||||
"cmp r2, r0 \n"
|
|
||||||
"blo 4b \n"
|
|
||||||
"ldmfd sp!, { r4-r11 } \n"
|
|
||||||
"bx lr \n"
|
|
||||||
);
|
|
||||||
(void)last; (void)block; (void)dest; (void)stride;
|
|
||||||
}
|
|
||||||
|
|
||||||
void mpeg2_idct_init (void)
|
|
||||||
{
|
|
||||||
extern uint8_t default_mpeg2_scan_norm[64];
|
|
||||||
extern uint8_t default_mpeg2_scan_alt[64];
|
|
||||||
extern uint8_t mpeg2_scan_norm[64];
|
|
||||||
extern uint8_t mpeg2_scan_alt[64];
|
|
||||||
int i, j;
|
|
||||||
|
|
||||||
mpeg2_idct_copy = mpeg2_idct_copy_c;
|
|
||||||
mpeg2_idct_add = mpeg2_idct_add_c;
|
|
||||||
|
|
||||||
for (i = 0; i < 64; i++)
|
|
||||||
{
|
|
||||||
j = default_mpeg2_scan_norm[i];
|
|
||||||
mpeg2_scan_norm[i] = ((j & 0x36) >> 1) | ((j & 0x09) << 2);
|
|
||||||
|
|
||||||
j = default_mpeg2_scan_alt[i];
|
|
||||||
mpeg2_scan_alt[i] = ((j & 0x36) >> 1) | ((j & 0x09) << 2);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue