| 1 |
#define FIX_0_298631336 ((s32) 2446) /* FIX(0.298631336) */ |
| 2 |
#define FIX_0_390180644 ((s32) 3196) /* FIX(0.390180644) */ |
| 3 |
#define FIX_0_541196100 ((s32) 4433) /* FIX(0.541196100) */ |
| 4 |
#define FIX_0_765366865 ((s32) 6270) /* FIX(0.765366865) */ |
| 5 |
#define FIX_0_899976223 ((s32) 7373) /* FIX(0.899976223) */ |
| 6 |
#define FIX_1_175875602 ((s32) 9633) /* FIX(1.175875602) */ |
| 7 |
#define FIX_1_501321110 ((s32) 12299) /* FIX(1.501321110) */ |
| 8 |
#define FIX_1_847759065 ((s32) 15137) /* FIX(1.847759065) */ |
| 9 |
#define FIX_1_961570560 ((s32) 16069) /* FIX(1.961570560) */ |
| 10 |
#define FIX_2_053119869 ((s32) 16819) /* FIX(2.053119869) */ |
| 11 |
#define FIX_2_562915447 ((s32) 20995) /* FIX(2.562915447) */ |
| 12 |
#define FIX_3_072711026 ((s32) 25172) /* FIX(3.072711026) */ |
| 13 |
|
| 14 |
#define MULTIPLY(var,const) ( (s32) ((var)*(const)) ) |
| 15 |
#define DESCALE(x,n) ((x)>>(n)) |
| 16 |
|
| 17 |
void RTjpeg_dct_init(void) |
| 18 |
{ |
| 19 |
} |
| 20 |
|
| 21 |
void RTjpeg_dct(u8 *idata, s16 *odata, int rskip) |
| 22 |
{ |
| 23 |
s32 tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7; |
| 24 |
s32 tmp10, tmp11, tmp12, tmp13; |
| 25 |
s32 z1, z2, z3, z4, z5; |
| 26 |
u8 *idataptr; |
| 27 |
s16 * odataptr; |
| 28 |
int ctr; |
| 29 |
|
| 30 |
idataptr = idata; |
| 31 |
odataptr = odata; |
| 32 |
for (ctr = 7; ctr >= 0; ctr--) { |
| 33 |
tmp0 = idataptr[0] + idataptr[7]; |
| 34 |
tmp7 = idataptr[0] - idataptr[7]; |
| 35 |
tmp1 = idataptr[1] + idataptr[6]; |
| 36 |
tmp6 = idataptr[1] - idataptr[6]; |
| 37 |
tmp2 = idataptr[2] + idataptr[5]; |
| 38 |
tmp5 = idataptr[2] - idataptr[5]; |
| 39 |
tmp3 = idataptr[3] + idataptr[4]; |
| 40 |
tmp4 = idataptr[3] - idataptr[4]; |
| 41 |
|
| 42 |
tmp10 = tmp0 + tmp3; |
| 43 |
tmp13 = tmp0 - tmp3; |
| 44 |
tmp11 = tmp1 + tmp2; |
| 45 |
tmp12 = tmp1 - tmp2; |
| 46 |
|
| 47 |
odataptr[0] = (s32) ((tmp10 + tmp11) << 2); |
| 48 |
odataptr[4] = (s32) ((tmp10 - tmp11) << 2); |
| 49 |
|
| 50 |
z1 = MULTIPLY(tmp12 + tmp13, FIX_0_541196100); |
| 51 |
odataptr[2] = (s32) DESCALE(z1 + MULTIPLY(tmp13, FIX_0_765366865), 11); |
| 52 |
odataptr[6] = (s32) DESCALE(z1 + MULTIPLY(tmp12, - FIX_1_847759065), 11); |
| 53 |
|
| 54 |
z1 = tmp4 + tmp7; |
| 55 |
z2 = tmp5 + tmp6; |
| 56 |
z3 = tmp4 + tmp6; |
| 57 |
z4 = tmp5 + tmp7; |
| 58 |
z5 = MULTIPLY(z3 + z4, FIX_1_175875602); /* sqrt(2) * c3 */ |
| 59 |
|
| 60 |
tmp4 = MULTIPLY(tmp4, FIX_0_298631336); /* sqrt(2) * (-c1+c3+c5-c7) */ |
| 61 |
tmp5 = MULTIPLY(tmp5, FIX_2_053119869); /* sqrt(2) * ( c1+c3-c5+c7) */ |
| 62 |
tmp6 = MULTIPLY(tmp6, FIX_3_072711026); /* sqrt(2) * ( c1+c3+c5-c7) */ |
| 63 |
tmp7 = MULTIPLY(tmp7, FIX_1_501321110); /* sqrt(2) * ( c1+c3-c5-c7) */ |
| 64 |
z1 = MULTIPLY(z1, - FIX_0_899976223); /* sqrt(2) * (c7-c3) */ |
| 65 |
z2 = MULTIPLY(z2, - FIX_2_562915447); /* sqrt(2) * (-c1-c3) */ |
| 66 |
z3 = MULTIPLY(z3, - FIX_1_961570560); /* sqrt(2) * (-c3-c5) */ |
| 67 |
z4 = MULTIPLY(z4, - FIX_0_390180644); /* sqrt(2) * (c5-c3) */ |
| 68 |
|
| 69 |
z3 += z5; |
| 70 |
z4 += z5; |
| 71 |
|
| 72 |
odataptr[7] = (s32) DESCALE(tmp4 + z1 + z3, 11); |
| 73 |
odataptr[5] = (s32) DESCALE(tmp5 + z2 + z4, 11); |
| 74 |
odataptr[3] = (s32) DESCALE(tmp6 + z2 + z3, 11); |
| 75 |
odataptr[1] = (s32) DESCALE(tmp7 + z1 + z4, 11); |
| 76 |
|
| 77 |
odataptr += 8; /* advance pointer to next row */ |
| 78 |
idataptr += rskip; |
| 79 |
} |
| 80 |
|
| 81 |
odataptr = odata; |
| 82 |
for (ctr = 7; ctr >= 0; ctr--) { |
| 83 |
tmp0 = odataptr[0] + odataptr[56]; |
| 84 |
tmp7 = odataptr[0] - odataptr[56]; |
| 85 |
tmp1 = odataptr[8] + odataptr[48]; |
| 86 |
tmp6 = odataptr[8] - odataptr[48]; |
| 87 |
tmp2 = odataptr[16] + odataptr[40]; |
| 88 |
tmp5 = odataptr[16] - odataptr[40]; |
| 89 |
tmp3 = odataptr[24] + odataptr[32]; |
| 90 |
tmp4 = odataptr[24] - odataptr[32]; |
| 91 |
|
| 92 |
tmp10 = tmp0 + tmp3; |
| 93 |
tmp13 = tmp0 - tmp3; |
| 94 |
tmp11 = tmp1 + tmp2; |
| 95 |
tmp12 = tmp1 - tmp2; |
| 96 |
|
| 97 |
odataptr[0] = (s32) DESCALE(tmp10 + tmp11, 2); |
| 98 |
odataptr[32] = (s32) DESCALE(tmp10 - tmp11, 2); |
| 99 |
|
| 100 |
z1 = MULTIPLY(tmp12 + tmp13, FIX_0_541196100); |
| 101 |
odataptr[16] = (s32) DESCALE(z1 + MULTIPLY(tmp13, FIX_0_765366865), 15); |
| 102 |
odataptr[48] = (s32) DESCALE(z1 + MULTIPLY(tmp12, - FIX_1_847759065), 15); |
| 103 |
|
| 104 |
z1 = tmp4 + tmp7; |
| 105 |
z2 = tmp5 + tmp6; |
| 106 |
z3 = tmp4 + tmp6; |
| 107 |
z4 = tmp5 + tmp7; |
| 108 |
z5 = MULTIPLY(z3 + z4, FIX_1_175875602); /* sqrt(2) * c3 */ |
| 109 |
|
| 110 |
tmp4 = MULTIPLY(tmp4, FIX_0_298631336); /* sqrt(2) * (-c1+c3+c5-c7) */ |
| 111 |
tmp5 = MULTIPLY(tmp5, FIX_2_053119869); /* sqrt(2) * ( c1+c3-c5+c7) */ |
| 112 |
tmp6 = MULTIPLY(tmp6, FIX_3_072711026); /* sqrt(2) * ( c1+c3+c5-c7) */ |
| 113 |
tmp7 = MULTIPLY(tmp7, FIX_1_501321110); /* sqrt(2) * ( c1+c3-c5-c7) */ |
| 114 |
z1 = MULTIPLY(z1, - FIX_0_899976223); /* sqrt(2) * (c7-c3) */ |
| 115 |
z2 = MULTIPLY(z2, - FIX_2_562915447); /* sqrt(2) * (-c1-c3) */ |
| 116 |
z3 = MULTIPLY(z3, - FIX_1_961570560); /* sqrt(2) * (-c3-c5) */ |
| 117 |
z4 = MULTIPLY(z4, - FIX_0_390180644); /* sqrt(2) * (c5-c3) */ |
| 118 |
|
| 119 |
z3 += z5; |
| 120 |
z4 += z5; |
| 121 |
|
| 122 |
odataptr[56] = (s32) DESCALE(tmp4 + z1 + z3, 15); |
| 123 |
odataptr[40] = (s32) DESCALE(tmp5 + z2 + z4, 15); |
| 124 |
odataptr[24] = (s32) DESCALE(tmp6 + z2 + z3, 15); |
| 125 |
odataptr[8] = (s32) DESCALE(tmp7 + z1 + z4, 15); |
| 126 |
|
| 127 |
odataptr++; /* advance pointer to next column */ |
| 128 |
} |
| 129 |
} |
