uint32_t
dequant_mpeg_intra_mxu(int16_t * data,
// const int16_t * coeff,
const uint32_t quant,
const uint32_t dcscalar,
const uint16_t * mpeg_quant_matrices)
{
const uint16_t *intra_matrix = mpeg_quant_matrices;
int32_t i = 0;
/* deal with data[0] then save to xr6 */
S32I2M(xr3,-2048);
S32I2M(xr4,2047);
S32I2M(xr5,quant);
S32MUL(xr0,xr6,(int32_t)data[0],dcscalar);
S32LUI(xr9,1,0);
D16MUL_WW(xr0,xr6,xr9,xr6);
S32MIN(xr6,xr6,xr4);
S32MAX(xr6,xr6,xr3);
data-=2;
intra_matrix-=2;
for (i = 0; i < 32; i++) {
S32LDI(xr1,data,4);
S32LDI(xr2,intra_matrix,4);
D16MUL_LW(xr13,xr9,xr1,xr14); // resave values of data[i] and data[i+1]
D16CPS(xr1,xr1,xr1);
/* abs(level) *( intra_matrix[i]*quant) >> 3 */
D16MUL_LW(xr7,xr5,xr2,xr8);
S32SFL(xr15,xr7,xr8,xr2,3);
D16MUL_WW(xr7,xr1,xr2,xr8);
D32SLR(xr7,xr7,xr8,xr8,3);
/* -2048 < data[i+1] < 2047 */
S32CPS(xr7,xr7,xr13);
S32MAX(xr10,xr7,xr3);
S32MIN(xr10,xr10,xr4);
/* -2048 < data[i] < 2047 */
S32CPS(xr8,xr8,xr14);
S32MAX(xr11,xr8,xr3);
S32MIN(xr11,xr11,xr4);
S32SFL(xr0,xr10,xr11,xr12,3);
S32STD(xr12,data,0);
}
S16STD(xr6,data,-62*2,0);//xr6 to data[0]
return(0);
}
static inline void ifft4(buf)
{
uint32_t tm4=(uint32_t)(buf);
S32LDI(xr1, tm4, 0);
S32LDI(xr2, tm4, 8);
S32LDI(xr3, tm4, 8);
S32LDI(xr4, tm4, 8);
D32ADD_AS(xr5, xr1, xr2, xr6);
D32ADD_AS(xr7, xr4, xr3, xr8);
D32ADD_AS(xr9, xr5, xr7, xr10);
S32SDI(xr10,tm4,-8);
S32SDI(xr9,tm4,-16);
S32LDI(xr1, tm4, 4);
S32LDI(xr2, tm4, 8);
S32LDI(xr3, tm4, 8);
S32LDI(xr4, tm4, 8);
D32ADD_AS(xr5, xr1, xr2, xr9);
D32ADD_AS(xr7, xr3, xr4, xr10);
D32ADD_AS(xr1,xr5,xr7,xr2);
D32ADD_AS(xr11,xr6,xr10,xr12);
D32ADD_AS(xr13,xr9,xr8,xr14);
S32SDI(xr14,tm4,0);
S32SDI(xr12,tm4,-4);
S32SDI(xr2, tm4,-4);
S32SDI(xr13,tm4,-8);
S32SDI(xr11,tm4,-4);
S32SDI(xr1, tm4,-4);
}
static void ff_vp3_idct_add_mxu(uint8_t *src, int stride, DCTELEM *input, uint8_t idct_row)
{
int i;
DCTELEM *blk;
int32_t wf = (int32_t)whirl_idct;
S32LDD(xr5, wf, 0x0); // xr5(w7, w3)
S32LDD(xr6, wf, 0x4); // xr6(w9, w8)
S32LDD(xr7, wf, 0x8); // xr7(w11,w10)
S32LDD(xr8, wf, 0xc); // xr8(w13,w12)
S32LDD(xr9, wf, 0x10); // xr9(w6, w0)
S32LDD(xr10,wf, 0x14);
blk = input - 8;
/* Inverse DCT on the rows now */
for (i=0; i<idct_row; i++) {
S32LDI(xr1, blk, 0x10); // xr1 (x4, x0)
S32LDD(xr2, blk, 0x4); // xr2 (x7, x3)
S32LDD(xr3, blk, 0x8); // xr3 (x6, x1)
S32LDD(xr4, blk, 0xc); // xr4 (x5, x2)
S32OR(xr12, xr2,xr3);
S32OR(xr11,xr12,xr4);
S32OR(xr12,xr11,xr1);
if (S32M2I(xr12) == 0) {
continue; //blk[0]= blk[1]=blk[2]=blk[3]=blk[4]=blk[5]=blk[6]=blk[7]=0
}
S32SFL(xr12,xr0,xr1,xr13,ptn3);
S32OR(xr11,xr11,xr12);
if (S32M2I(xr11) == 0 && S32M2I(xr13) != 0) {
D16MUL_HW(xr0,xr5,xr13,xr13);
D32SAR(xr0,xr0,xr13,xr13,15);
S32SFL(xr0,xr13,xr13,xr13,ptn3);
S32STD(xr13,blk, 0x0);
S32STD(xr13,blk, 0x4);
S32STD(xr13,blk, 0x8);
S32STD(xr13,blk, 0xc);
continue; //blk[0]!=0, and blk[1]=blk[2]=blk[3]=blk[4]=blk[5]=blk[6]=blk[7]=0
}
S32SFL(xr1,xr1,xr2,xr2, ptn3); //xr1:s1, s3, xr2: s0, s2
S32SFL(xr3,xr3,xr4,xr4, ptn3); //xr3:s5, s7, xr4: s4, s6
D16MUL_WW(xr11, xr2, xr5, xr12);//xr11: s0*c4, xr12: s2*c2
D16MAC_AA_WW(xr11,xr4,xr6,xr12);//xr11: s0*c4+s4*c4, xr12: s2*c2+s6*c6
D16MUL_WW(xr13, xr2, xr6, xr14);//xr13: s0*c4, xr14: s2*c6
D16MAC_SS_WW(xr13,xr4,xr5,xr14);//xr13: s0*c4 - s4*c4, xr14: s2*c6-s6*c2
D16MUL_HW(xr2, xr1, xr7, xr4); //xr2: s1*c1, xr4: s1*c3
D16MAC_AS_LW(xr2,xr1,xr9,xr4); //xr2: s1*c1+s3*c3, xr4: s1*c3-s3*c7
D16MAC_AS_HW(xr2,xr3,xr10,xr4); //xr2: s1*c1+s3*c3+s5*c5,
// xr4: s1*c3-s3*c7-s5*c1
D16MAC_AS_LW(xr2,xr3,xr8,xr4); //xr2: s1*c1+s3*c3+s5*c5+s7*c7,
//xr4: s1*c3-s3*c7-s5*c1-s7*c5
D32SAR(xr11, xr11,xr13,xr13,15);
S32SFL(xr0, xr11,xr13,xr11,ptn3);
D32SAR(xr12,xr12,xr14,xr14,15);
S32SFL(xr0, xr12,xr14,xr12,ptn3);
D32SAR(xr2, xr2,xr4,xr4,15);
S32SFL(xr0, xr2,xr4,xr2,ptn3);
D16MUL_HW(xr4, xr1, xr8, xr15); //xr4: s1*c7, xr15:s1*c5
D16MAC_SS_LW(xr4,xr1,xr10,xr15); //xr4: s1*c7-s3*c5, xr15: s1*c5-s3*c1
D16MAC_AA_HW(xr4,xr3,xr9,xr15); //xr4: s1*c7-s3*c5+s5*c3, xr15: s1*c5-s3*c1+s5*c7
D16MAC_SA_LW(xr4,xr3,xr7,xr15); //xr4: s1*c7-s3*c5+s5*c3-s7*c1
//xr15: s1*c5-s3*c1+s5*c7+s7*c3
Q16ADD_AS_WW(xr11,xr11,xr12,xr12); //xr11: rnd(s0*c4+s4*c4)>>15+rnd(s2*c2+s6*c6)>>15
// rnd(s0*c4-s4*c4)>>15+rnd(s2*c6-s6*c2)>>15
//xr12: rnd(s0*c4+s4*c4)>>15-rnd(s2*c2+s6*c6)>>15
// rnd(s0*c4-s4*c4)>>15-rnd(s2*c6-s6*c2)>>15
D32SAR(xr15,xr15,xr4,xr4,15);
S32SFL(xr0,xr15,xr4,xr15,ptn3);
Q16ADD_AS_WW(xr11, xr11, xr2, xr2);
//xr11: rnd(s0*c4+s4*c4)>>15+rnd(s2*c2+s6*c6)>>15 + rnd(s1*c1+s3*c3+s5*c5+s7*c7)>>15
// : rnd(s0*c4-s4*c4)>>15+rnd(s2*c6-s6*c2)>>15 + rnd(s1*c3-s3*c7-s5*c1-s7*c5)>>15
//xr2: rnd(s0*c4+s4*c4)>>15+rnd(s2*c2+s6*c6)>>15 - rnd(s1*c1+s3*c3+s5*c5+s7*c7)>>15
// : rnd(s0*c4-s4*c4)>>15+rnd(s2*c6-s6*c2)>>15 - rnd(s1*c3-s3*c7-s5*c1-s7*c5)>>15
Q16ADD_AS_XW(xr12, xr12, xr15, xr15);
//xr12: rnd(s0*c4+s4*c4)>>15-rnd(s2*c2+s6*c6)>>15+rnd(s1*c5-s3*c1+s5*c7+s7*c3)>>15
// : rnd(s0*c4-s4*c4)>>15+rnd(s2*c6-s6*c2)>>15+rnd(s1*c7-s3*c5+s5*c3-s7*c1)>>15
//xr15: rnd(s0*c4+s4*c4)>>15-rnd(s2*c2+s6*c6)>>15-rnd(s1*c5-s3*c1+s5*c7+s7*c3)>>15
// : rnd(s0*c4-s4*c4)>>15+rnd(s2*c6-s6*c2)>>15-rnd(s1*c7-s3*c5+s5*c3-s7*c1)>>15
S32SFL(xr11,xr11,xr12,xr12, ptn3);
//xr11: rnd(s0*c4+s4*c4)>>15+rnd(s2*c2+s6*c6)>>15 + rnd(s1*c1+s3*c3+s5*c5+s7*c7)>>15
// : rnd(s0*c4+s4*c4)>>15-rnd(s2*c2+s6*c6)>>15+rnd(s1*c5-s3*c1+s5*c7+s7*c3)>>15
//xr12: rnd(s0*c4-s4*c4)>>15+rnd(s2*c6-s6*c2)>>15 + rnd(s1*c3-s3*c7-s5*c1-s7*c5)>>15
// : rnd(s0*c4-s4*c4)>>15+rnd(s2*c6-s6*c2)>>15+rnd(s1*c7-s3*c5+s5*c3-s7*c1)>>15
S32SFL(xr12,xr12,xr11,xr11, ptn3);
//xr12: rnd(s0*c4-s4*c4)>>16+rnd(s2*c6-s6*c2)>>16 + rnd(s1*c3-s3*c7-s5*c1-s7*c5)>>16
// : rnd(s0*c4+s4*c4)>>16+rnd(s2*c2+s6*c6)>>16 + rnd(s1*c1+s3*c3+s5*c5+s7*c7)>>16
//xr11: rnd(s0*c4-s4*c4)>>16+rnd(s2*c6-s6*c2)>>16+rnd(s1*c7-s3*c5+s5*c3-s7*c1)>>16
// : rnd(s0*c4+s4*c4)>>16-rnd(s2*c2+s6*c6)>>16+rnd(s1*c5-s3*c1+s5*c7+s7*c3)>>16
S32STD(xr12, blk, 0x0);
S32STD(xr11, blk, 0x4);
S32STD(xr15, blk, 0x8);
S32STD(xr2, blk, 0xc);
}
blk = input - 2;
for (i=0; i<4; i++) /* idct columns */
{
S32I2M(xr5,wxr5); //xr5: c4 , c2
S32I2M(xr6,wxr6); //xr5: c4 , c2
S32LDI(xr1, blk, 0x4); //xr1: ss0, s0
S32LDD(xr3, blk, 0x20); //xr3: ss2, s2
S32LDD(xr11, blk, 0x40); //xr11: ss4, s4
S32LDD(xr13, blk, 0x60); //xr13: ss6, s6
D16MUL_HW(xr15, xr5, xr1, xr2); //xr15: ss0*c4, xr9: s0*c4
D16MAC_AA_HW(xr15,xr5,xr11,xr2); //xr15: ss0*c4+ss4*c4, xr9: s0*c4+s4*c4
D16MUL_LW(xr10, xr5, xr3, xr9); //xr10: ss2*c2, xr9: s2*c2
D16MAC_AA_LW(xr10,xr6,xr13,xr9); //xr10: ss2*c2+ss6*c6, xr9: s2*c2+s6*c6
D32SAR(xr15,xr15,xr2,xr2,15);
S32SFL(xr0,xr15,xr2,xr15,ptn3); //xr15: (ss0*c4+ss4*c4)>>15
D32SAR(xr10,xr10,xr9,xr9,15);
S32SFL(xr0,xr10,xr9,xr10,ptn3); //xr10: (ss2*c2+ss6*c6)>>15
S32LDD(xr2, blk, 0x10); //xr2: ss1, s1
S32LDD(xr4, blk, 0x30); //xr4: ss3, s3
Q16ADD_AS_WW(xr15,xr15,xr10,xr9); //xr15: rnd(ss0*c4+ss4*c4)>>15+rnd(ss2*c2+ss6*c6)>>15
// :rnd(s0*c4+s4*c4)>>15 + rnd(s2*c2 + s6*c6)>>15
//xr9: rnd(ss0*c4+ss4*c4)>>15 - rnd(ss2*c2+ss6*c6)>>15
// : rnd(s0*c4+s4*c4)>>15 - rnd(s2*c2 + s6*c6)>>15
D16MUL_HW(xr10, xr5, xr1, xr1); //xr10: ss0*c4, xr1: s0*c4
D16MAC_SS_HW(xr10,xr5,xr11,xr1); //xr10: ss0*c4-ss4*c4, xr1: s0*c4 - s4*c4
D16MUL_LW(xr11, xr6, xr3, xr12); //xr11: ss2*c6, xr1: s2*c6
D16MAC_SS_LW(xr11,xr5,xr13,xr12); //xr11: ss2*c6-ss6*c2, xr1: s2*c6-s6*c2
D32SAR(xr10,xr10,xr1,xr1,15);
S32SFL(xr0,xr10,xr1,xr10,ptn3); //xr10: (ss0*c4-ss4*c4)>>15 // : (s0*c4 - s4*c4)>>15
D32SAR(xr11,xr11,xr12,xr12,15);
S32SFL(xr0,xr11,xr12,xr11,ptn3); //xr11:(ss2*c6-ss6*c2)>>15
// :(s2*c6-s6*c2)>>15
S32LDD(xr12, blk, 0x50); //xr12: ss5, s5
S32LDD(xr14, blk, 0x70); //xr14: ss7, s7
Q16ADD_AS_WW(xr10,xr10,xr11,xr1); //xr10: rnd(ss0*c4-ss4*c4)>>15)+rnd(ss2*c6-ss6*c2)>>15
// : rnd(s0*c4 - s4*c4)>>15 +rnd(s2*c6 - s6*c2)>>15
//xr1 : rnd(ss0*c4-ss4*c4)>>15-rnd(ss2*c6-ss6*c2)>>15
// : rnd(s0*c4 - s4*c4)>>15-rnd(s2*c6 - s6*c2)>>15
D16MUL_HW(xr11, xr7, xr2, xr13); //xr11: ss1*c1, xr13: s1*c1
D16MAC_AA_LW(xr11,xr7,xr4,xr13); //xr11: ss1*c1+ss3*c3, xr13: s1*c1+s3*c3
D16MAC_AA_LW(xr11,xr8,xr12,xr13); //xr11: ss1*c1+ss3*c3+ss5*c5 //xr13: s1*c1+s3*c3+s5*c5
D16MAC_AA_HW(xr11,xr8,xr14,xr13); //xr11: ss1*c1+ss3*c3+ss5*c5+ss7*c7
//xr13: s1*c1+s3*c3+s5*c5+s7*c7
D16MUL_LW(xr3, xr7, xr2, xr5); //xr3: ss1*c3, xr13: s1*c3
D16MAC_SS_HW(xr3,xr8,xr4,xr5); //xr3: ss1*c3-ss3*c7, xr13: s1*c3-s3*c7
D16MAC_SS_HW(xr3,xr7,xr12,xr5); //xr3: ss1*c3-ss3*c7-ss5*c1
//xr13: s1*c3-s3*c7-s5*c1
D16MAC_SS_LW(xr3,xr8,xr14,xr5); //xr3: ss1*c3-ss3*c7-ss5*c1-ss7*c5
//xr13: s1*c3-s3*c7-s7*c5
D32SAR(xr11,xr11,xr13,xr13,15);
S32SFL(xr0,xr11,xr13,xr11,ptn3); //xr11: (ss1*c1+ss3*c3+ss5*c5+ss7*c7)>>15 // : (s1*c1+s3*c3+s5*c5+s7*c7)>>15
D32SAR(xr3,xr3,xr5,xr5,15);
S32SFL(xr0,xr3,xr5,xr3,ptn3); //xr3: (ss1*c3-ss3*c7-ss5*c1-ss7*c5)>>15
// : (s1*c3-s3*c7-s7*c5)>>15
D16MUL_LW(xr5, xr8, xr2, xr13); //xr5: ss1*c5, xr13:s1*c5
D16MAC_SS_HW(xr5,xr7,xr4,xr13); //xr5: ss1*c5-ss3*c1, xr13:s1*c5-s3*c1
D16MAC_AA_HW(xr5,xr8,xr12,xr13); //xr5: ss1*c5-ss3*c1+ss5*c7
// : s1*c5 - s3*c1+ s5*c7
D16MAC_AA_LW(xr5,xr7,xr14,xr13); //xr5: ss1*c5-ss3*c1+ss5*c7+ss7*c1
// : s1*c5 - s3*c1+ s5*c7+ s7*c1
D16MUL_HW(xr2, xr8, xr2, xr6); //xr2: ss1*c7, xr13: s1*c7
D16MAC_SS_LW(xr2,xr8,xr4,xr6); //xr2: ss1*c7-ss3*c5, xr13: s1*c7-s3*c5
D16MAC_AA_LW(xr2,xr7,xr12,xr6); //xr2: ss1*c7-ss3*c5+ss5*c1 //xr13: s1*c7-s3*c5+s5*c1
D16MAC_SS_HW(xr2,xr7,xr14,xr6); //xr2: ss1*c7-ss3*c5+ss5*c1-ss7*c3
//xr13: s1*c7-s3*c5+s5*c1-s7*c3
D32SAR(xr5,xr5,xr13,xr13,15);
S32SFL(xr0,xr5,xr13,xr5,ptn3); //xr5: (ss1*c5-ss3*c1+ss5*c7+ss7*c1)>>15 // :(s1*c5 - s3*c1+ s5*c7+ s7*c1)>>15
D32SAR(xr2,xr2,xr6,xr6,15);
S32SFL(xr0,xr2,xr6,xr2,ptn3); //xr2:(ss1*c7-ss3*c5+ss5*c1-ss7*c3)>>15
// :(s1*c7-s3*c5+s5*c1-s7*c3)>>15
S32I2M(xr4, 0x00080008);//round value 8;
Q16ADD_AS_WW(xr15,xr15,xr11,xr11); //xr15:rnd(ss0*c4+ss4*c4)>>16+rnd(ss2*c2+ss6*c6)>>16+
// rnd(ss1*c1+ss3*c3+ss5*c5+ss7*c7)>>16
// rnd(s0*c4+s4*c4)>>16 + rnd(s2*c2 + s6*c6)>>16+
// rnd(s1*c1+s3*c3+s5*c5+s7*c7)>>16
//xr11:rnd(ss0*c4+ss4*c4)>>16+rnd(ss2*c2+ss6*c6)>>16-
// rnd(ss1*c1+ss3*c3+ss5*c5+ss7*c7)>>16
// rnd(s0*c4+s4*c4)>>16 + rnd(s2*c2 + s6*c6)>>16-
// rnd(s1*c1+s3*c3+s5*c5+s7*c7)>>16
Q16ADD_AS_WW(xr10,xr10,xr3,xr3); //xr10:rnd(ss0*c4-ss4*c4)>>16)+rnd(ss2*c6-ss6*c2)>>16+
// rnd(ss1*c3-ss3*c7-ss5*c1-ss7*c5)>>16
// rnd(s0*c4 - s4*c4)>>16 +rnd(s2*c6 - s6*c2)>>16+
// rnd(s1*c3-s3*c7-s7*c5)>>16
//xr10:rnd(ss0*c4-ss4*c4)>>16)+rnd(ss2*c6-ss6*c2)>>16-
// rnd(ss1*c3-ss3*c7-ss5*c1-ss7*c5)>>16
// rnd(s0*c4 - s4*c4)>>16 +rnd(s2*c6 - s6*c2)>>16-
// rnd(s1*c3-s3*c7-s7*c5)>>16
Q16ADD_AS_WW(xr1,xr1,xr5,xr5); //xr1: rnd(ss0*c4-ss4*c4)>>16-rnd(ss2*c6-ss6*c2)>>16+
// rnd(ss1*c5-ss3*c1+ss5*c7+ss7*c1)>>16
// rnd(s0*c4 - s4*c4)>>16 +rnd(s2*c6 - s6*c2)>>16+
// rnd(s1*c5 - s3*c1+ s5*c7+ s7*c1)>>16
//xr1: rnd(ss0*c4-ss4*c4)>>16-rnd(ss2*c6-ss6*c2)>>16-
// rnd(ss1*c5-ss3*c1+ss5*c7+ss7*c1)>>16
// rnd(s0*c4 - s4*c4)>>16 +rnd(s2*c6 - s6*c2)>>16-
// rnd(s1*c5 - s3*c1+ s5*c7+ s7*c1)>>16
Q16ADD_AS_WW(xr9,xr9,xr2,xr2); //xr9: rnd(ss0*c4+ss4*c4)>>16 - rnd(ss2*c2+ss6*c6)>>16+
// rnd(ss1*c7-ss3*c5+ss5*c1-ss7*c3)>>16
// rnd(s0*c4+s4*c4)>>16 - rnd(s2*c2 + s6*c6)>>16+
// rnd(s1*c7-s3*c5+s5*c1-s7*c3)>>16
//xr9: rnd(ss0*c4+ss4*c4)>>16 - rnd(ss2*c2+ss6*c6)>>16-
// rnd(ss1*c7-ss3*c5+ss5*c1-ss7*c3)>>16
// rnd(s0*c4+s4*c4)>>16 - rnd(s2*c2 + s6*c6)>>16-
// rnd(s1*c7-s3*c5+s5*c1-s7*c3)>>16
Q16ACCM_AA(xr15,xr4,xr4,xr10);
Q16ACCM_AA(xr11,xr4,xr4,xr1);
Q16ACCM_AA(xr9,xr4,xr4,xr2);
Q16ACCM_AA(xr5,xr4,xr4,xr3);
Q16SAR(xr15,xr15,xr10,xr10,4);
Q16SAR(xr11,xr11,xr1,xr1,4);
Q16SAR(xr9,xr9,xr2,xr2,4);
Q16SAR(xr5,xr5,xr3,xr3,4);
S32STD(xr15, blk, 0x00);
S32STD(xr10, blk, 0x10);
S32STD(xr1, blk, 0x20);
S32STD(xr9, blk, 0x30);
S32STD(xr2, blk, 0x40);
S32STD(xr5, blk, 0x50);
S32STD(xr3, blk, 0x60);
S32STD(xr11, blk, 0x70);
}
blk = input - 8;
src -= stride;
for (i=0; i<8; i++) {
S32LDIV(xr1, src, stride, 0x0);
S32LDI(xr3, blk, 0x10);
S32LDD(xr4, blk, 0x4);
Q8ACCE_AA(xr4, xr1, xr0, xr3);
S32LDD(xr2, src, 0x4);
S32LDD(xr5, blk, 0x8);
S32LDD(xr6, blk, 0xc);
Q8ACCE_AA(xr6, xr2, xr0, xr5);
Q16SAT(xr1, xr4, xr3);
S32STD(xr1, src, 0x0);
Q16SAT(xr2, xr6, xr5);
S32STD(xr2, src, 0x4);
}
}
uint32_t
dequant_h263_intra_mxu(int16_t * data, uint8_t yuv_len,
const uint32_t quant,
const uint32_t dcscalar,
const uint16_t * mpeg_quant_matrices)
{
uint32_t i = 0;
S32LUI(xr9,1,0);
S32I2M(xr1,quant);
D32SLL(xr5,xr1,xr0,xr0,1);// quant_m_2
/* quant_add */
S32AND(xr15,xr1,xr9);
S32MOVN(xr2,xr15,xr1);
D32ADD_SS(xr1,xr1,xr9,xr3);
S32MOVZ(xr2,xr15,xr1);
S32I2M(xr3,-2048);
S32I2M(xr4,2047);
/* part1 */
//S32MUL(xr4,xr6,*data,dcscalar);
S32MUL(xr0,xr6,(int32_t)data[0],dcscalar);
D16MUL_WW(xr0,xr6,xr9,xr6);
S32MIN(xr6,xr6,xr4);
S32MAX(xr6,xr6,xr3);
/* part2 */
yuv_len = ((yuv_len&~1)+3)>>1;
data-=2;
for (i = 0; i < yuv_len; i++) {
S32LDI(xr1,data,4);
D16MUL_LW(xr13,xr9,xr1,xr14);// resave sign of data[i] and data[i+1]
D16CPS(xr1,xr1,xr1);
/* quant_m_2 * acLevel + quant_add */
D16MUL_LW(xr7,xr5,xr1,xr8);
D32ADD_AA(xr7,xr7,xr2,xr0);
D32ADD_AA(xr8,xr8,xr2,xr0);
#if 0
/* -2048 < data[i+1] <2047 */
S32CPS(xr7,xr7,xr13);
S32MAX(xr10,xr7,xr3);
S32MIN(xr10,xr10,xr4);
S32MOVZ(xr10,xr13,xr13);
/* -2048 < data[i] <2047 */
S32CPS(xr8,xr8,xr14);
S32MAX(xr11,xr8,xr3);
S32MIN(xr11,xr11,xr4);
S32MOVZ(xr11,xr14,xr14);
#else
/* -2048 < data[i+1] <2047 */
S32AND(xr7,xr7,xr4);
S32CPS(xr10,xr7,xr13);
S32MOVZ(xr10,xr13,xr13);
/* -2048 < data[i] <2047 */
S32AND(xr8,xr8,xr4);
S32CPS(xr11,xr8,xr14);
S32MOVZ(xr11,xr14,xr14);
#endif
S32SFL(xr0,xr10,xr11,xr12,3);
S32STD(xr12,data,0);
}
S16STD(xr6,data-(yuv_len*2-2),0,0);// data[0]
return(0);
}
static void rv40_dequant4x4(DCTELEM *block,uint32_t *dst, int n)
{
int i;
uint32_t src=block-4;
uint32_t dst_t = dst-4;
#if 0
for(i = 0; i < n; i++){
S32LDI(xr1,src,0x8);
S32LDD(xr2,src,0x4);
S32LDI(xr7,src,0x8);
S32LDD(xr8,src,0x4);
D16MUL_LW(xr4,xr12,xr1,xr3);
D16MUL_LW(xr10,xr12,xr7,xr9);
D16MUL_LW(xr14,xr12,xr8,xr15);
D32ASUM_AA(xr3,xr13,xr13,xr4);
D16MUL_LW(xr6,xr12,xr2,xr5);
D32SLR(xr3,xr3,xr4,xr4,4);
D32ASUM_AA(xr5,xr13,xr13,xr6);
D32ASUM_AA(xr9,xr13,xr13,xr10);
D32SLR(xr5,xr5,xr6,xr6,4);
D32SLR(xr9,xr9,xr10,xr10,4);
D32ASUM_AA(xr15,xr13,xr13,xr14);
S32SDI(xr3,dst_t,0x10);
S32STD(xr4,dst_t,0x4);
S32STD(xr5,dst_t,0x8);
S32STD(xr6,dst_t,0xc);
D32SLR(xr15,xr15,xr14,xr14,4);
S32SDI(xr9,dst_t,0x10);
S32STD(xr10,dst_t,0x4);
S32STD(xr15,dst_t,0x8);
S32STD(xr14,dst_t,0xc);
}
#else
/////////////////////
if(n == 1){
S32LDI(xr1,src,0x8);
S32LDI(xr2,src,0x8);
S32LDI(xr7,src,0x8);
S32LDI(xr8,src,0x8);
D16MUL_XW(xr4,xr12,xr1,xr3);
D16MUL_LW(xr10,xr12,xr7,xr9);
D16MUL_LW(xr14,xr12,xr8,xr15);
D32ASUM_AA(xr3,xr13,xr13,xr4);
D16MUL_LW(xr6,xr12,xr2,xr5);
D32SLR(xr3,xr3,xr4,xr4,4);
D32ASUM_AA(xr5,xr13,xr13,xr6);
D32ASUM_AA(xr9,xr13,xr13,xr10);
D32SLR(xr5,xr5,xr6,xr6,4);
D32SLR(xr9,xr9,xr10,xr10,4);
D32ASUM_AA(xr15,xr13,xr13,xr14);
S32SDI(xr3,dst_t,0x10);
S32STD(xr4,dst_t,0x4);
S32STD(xr0,dst_t,0x8);
S32STD(xr0,dst_t,0xc);
S32SDI(xr5,dst_t,0x10);
S32STD(xr6,dst_t,0x4);
S32STD(xr0,dst_t,0x8);
S32STD(xr0,dst_t,0xc);
D32SLR(xr15,xr15,xr14,xr14,4);
S32SDI(xr9,dst_t,0x10);
S32STD(xr10,dst_t,0x4);
S32STD(xr0,dst_t,0x8);
S32STD(xr0,dst_t,0xc);
//S32STD(xr15,dst_t,0x8);
//S32STD(xr14,dst_t,0xc);
S32SDI(xr15,dst_t,0x10);
S32STD(xr14,dst_t,0x4);
S32STD(xr0,dst_t,0x8);
S32STD(xr0,dst_t,0xc);
}
else if(n==2)
{
S32LDI(xr1,src,0x8);
S32LDD(xr2,src,0x4);
S32LDI(xr7,src,0x8);
S32LDD(xr8,src,0x4);
D16MUL_XW(xr4,xr12,xr1,xr3);
D16MUL_LW(xr10,xr12,xr7,xr9);
D16MUL_LW(xr14,xr12,xr8,xr15);
D32ASUM_AA(xr3,xr13,xr13,xr4);
D16MUL_LW(xr6,xr12,xr2,xr5);
D32SLR(xr3,xr3,xr4,xr4,4);
D32ASUM_AA(xr5,xr13,xr13,xr6);
D32ASUM_AA(xr9,xr13,xr13,xr10);
D32SLR(xr5,xr5,xr6,xr6,4);
D32SLR(xr9,xr9,xr10,xr10,4);
D32ASUM_AA(xr15,xr13,xr13,xr14);
S32SDI(xr3,dst_t,0x10);
S32STD(xr4,dst_t,0x4);
S32STD(xr5,dst_t,0x8);
S32STD(xr6,dst_t,0xc);
D32SLR(xr15,xr15,xr14,xr14,4);
S32SDI(xr9,dst_t,0x10);
S32STD(xr10,dst_t,0x4);
S32STD(xr15,dst_t,0x8);
S32STD(xr14,dst_t,0xc);
S32SDI(xr0,dst_t,0x10);
S32STD(xr0,dst_t,0x4);
S32STD(xr0,dst_t,0x8);
S32STD(xr0,dst_t,0xc);
S32SDI(xr0,dst_t,0x10);
S32STD(xr0,dst_t,0x4);
S32STD(xr0,dst_t,0x8);
S32STD(xr0,dst_t,0xc);
}
else
{
S32LDI(xr1,src,0x8);
S32LDD(xr2,src,0x4);
S32LDI(xr7,src,0x8);
S32LDD(xr8,src,0x4);
D16MUL_XW(xr4,xr12,xr1,xr3);
D16MUL_LW(xr10,xr12,xr7,xr9);
D16MUL_LW(xr14,xr12,xr8,xr15);
D32ASUM_AA(xr3,xr13,xr13,xr4);
D16MUL_LW(xr6,xr12,xr2,xr5);
D32SLR(xr3,xr3,xr4,xr4,4);
D32ASUM_AA(xr5,xr13,xr13,xr6);
D32ASUM_AA(xr9,xr13,xr13,xr10);
D32SLR(xr5,xr5,xr6,xr6,4);
D32SLR(xr9,xr9,xr10,xr10,4);
D32ASUM_AA(xr15,xr13,xr13,xr14);
S32SDI(xr3,dst_t,0x10);
S32STD(xr4,dst_t,0x4);
S32STD(xr5,dst_t,0x8);
S32STD(xr6,dst_t,0xc);
D32SLR(xr15,xr15,xr14,xr14,4);
S32SDI(xr9,dst_t,0x10);
S32STD(xr10,dst_t,0x4);
S32STD(xr15,dst_t,0x8);
S32STD(xr14,dst_t,0xc);
S32LDI(xr1,src,0x8);
S32LDD(xr2,src,0x4);
S32LDI(xr7,src,0x8);
S32LDD(xr8,src,0x4);
D16MUL_LW(xr4,xr12,xr1,xr3);
D16MUL_LW(xr10,xr12,xr7,xr9);
D16MUL_LW(xr14,xr12,xr8,xr15);
D32ASUM_AA(xr3,xr13,xr13,xr4);
D16MUL_LW(xr6,xr12,xr2,xr5);
D32SLR(xr3,xr3,xr4,xr4,4);
D32ASUM_AA(xr5,xr13,xr13,xr6);
D32ASUM_AA(xr9,xr13,xr13,xr10);
D32SLR(xr5,xr5,xr6,xr6,4);
D32SLR(xr9,xr9,xr10,xr10,4);
D32ASUM_AA(xr15,xr13,xr13,xr14);
S32SDI(xr3,dst_t,0x10);
S32STD(xr4,dst_t,0x4);
S32STD(xr5,dst_t,0x8);
S32STD(xr6,dst_t,0xc);
D32SLR(xr15,xr15,xr14,xr14,4);
S32SDI(xr9,dst_t,0x10);
S32STD(xr10,dst_t,0x4);
S32STD(xr15,dst_t,0x8);
S32STD(xr14,dst_t,0xc);
}
#endif
}
void ff_init_cabac_states_mxu(CABACContext *c){
uint32_t i = 0;
uint8_t *p_lps_range = lps_range[0]-4;
uint8_t *p_mps_state = mps_state-4;
uint8_t *p_lps_state = lps_state-4;
uint8_t *p_ff_h264_mlps_state1 = &ff_h264_mlps_state[0]+124;
uint8_t *p_ff_h264_mlps_state2 = &ff_h264_mlps_state[0]+128;//
uint8_t *p_ff_h264_lps_range = ff_h264_lps_range-128;
S32I2M(xr15,0x1010101);
for(i=0; i<16; i++){
/* load 32 */
S32LDI(xr1,p_lps_range,4);
S32LDI(xr2,p_lps_range,4);
S32LDI(xr3,p_lps_range,4);
S32LDI(xr4,p_lps_range,4);
S32SFL(xr7,xr2,xr1,xr8,0);
S32SFL(xr9,xr4,xr3,xr10,0);
S32SFL(xr11,xr7,xr7,xr12,0);
S32SFL(xr13,xr8,xr8,xr14,0);
S32SFL(xr1,xr9,xr9,xr2,0);
S32SFL(xr3,xr10,xr10,xr4,0);
S32SDI(xr14,p_ff_h264_lps_range,128);
S32SDI(xr4,p_ff_h264_lps_range,4);
S32SDI(xr13,p_ff_h264_lps_range,124);
S32SDI(xr3,p_ff_h264_lps_range,4);
S32SDI(xr12,p_ff_h264_lps_range,124);
S32SDI(xr2,p_ff_h264_lps_range,4);
S32SDI(xr11,p_ff_h264_lps_range,124);
S32SDI(xr1,p_ff_h264_lps_range,4);
p_ff_h264_lps_range-=128*4-4;
/* part2 */
S32LDI(xr1,p_mps_state,4);
Q8ADD_AA(xr3,xr1,xr1);// 2*mps_state[i]+0
Q8ADD_AA(xr4,xr3,xr15);//2*mps_state[i]+1
S32SFL(xr11,xr4,xr3,xr12,0);
S32SDI(xr12,p_ff_h264_mlps_state1,4);// ff_h264_mlps_state[128+2*i+1]= 2*mps_state[i]+0;
S32SDI(xr11,p_ff_h264_mlps_state1,4);
/*part3 */
S32LDI(xr1,p_lps_state,4);
Q8ADD_AA(xr3,xr1,xr1);// 2*mps_state[i]+0
Q8ADD_AA(xr4,xr3,xr15);//2*mps_state[i]+1
S32SFL(xr11,xr3,xr4,xr12,0);
S32ALN(xr11,xr11,xr11,2);
S32ALN(xr12,xr12,xr12,2);
S32SDI(xr12,p_ff_h264_mlps_state2,-4);
S32SDI(xr11,p_ff_h264_mlps_state2,-4);
}
ff_h264_mlps_state[127]= 1;
ff_h264_mlps_state[126]= 0;
}
