43 |
* Local data |
* Local data |
44 |
****************************************************************************/ |
****************************************************************************/ |
45 |
|
|
|
#define VM18P 3 |
|
|
#define VM18Q 4 |
|
|
|
|
46 |
/* divide-by-multiply table |
/* divide-by-multiply table |
47 |
* needs 17 bit shift (16 causes slight errors when q > 19) */ |
* needs 17 bit shift (16 causes slight errors when q > 19) */ |
48 |
|
|
|
#define SCALEBITS 17 |
|
49 |
#define FIX(X) ((1UL << SCALEBITS) / (X) + 1) |
#define FIX(X) ((1UL << SCALEBITS) / (X) + 1) |
50 |
|
|
51 |
static const uint32_t multipliers[32] = |
static const uint32_t multipliers[32] = |
65 |
****************************************************************************/ |
****************************************************************************/ |
66 |
|
|
67 |
/* quantize intra-block |
/* quantize intra-block |
|
* |
|
|
* const int32_t quantd = DIV_DIV(VM18P*quant, VM18Q); |
|
|
* level = DIV_DIV(16 * data[i], default_intra_matrix[i]); |
|
|
* coeff[i] = (level + quantd) / quant2; |
|
68 |
*/ |
*/ |
69 |
|
|
70 |
uint32_t |
uint32_t |
71 |
quant_mpeg_intra_c(int16_t * coeff, |
quant_mpeg_intra_c(int16_t * coeff, |
72 |
const int16_t * data, |
const int16_t * data, |
73 |
const uint32_t quant, |
const uint32_t quant, |
74 |
const uint32_t dcscalar) |
const uint32_t dcscalar, |
75 |
|
const uint16_t * mpeg_quant_matrices) |
76 |
{ |
{ |
77 |
const uint32_t quantd = ((VM18P * quant) + (VM18Q / 2)) / VM18Q; |
const uint16_t * intra_matrix_rec = mpeg_quant_matrices + 1*64; |
|
const uint32_t mult = multipliers[quant]; |
|
|
const int16_t *intra_matrix = get_intra_matrix(); |
|
78 |
int i; |
int i; |
79 |
|
int rounding = 1<<(SCALEBITS-1-3); |
80 |
|
|
81 |
coeff[0] = DIV_DIV(data[0], (int32_t) dcscalar); |
coeff[0] = DIV_DIV(data[0], (int32_t) dcscalar); |
82 |
|
|
83 |
for (i = 1; i < 64; i++) { |
for (i = 1; i < 64; i++) { |
84 |
if (data[i] < 0) { |
int level = data[i]; |
85 |
uint32_t level = -data[i]; |
level *= intra_matrix_rec[i]; |
86 |
|
level = (level + rounding)>>(SCALEBITS-3); |
|
level = ((level << 4) + (intra_matrix[i] >> 1)) / intra_matrix[i]; |
|
|
level = ((level + quantd) * mult) >> SCALEBITS; |
|
|
coeff[i] = -(int16_t) level; |
|
|
} else if (data[i] > 0) { |
|
|
uint32_t level = data[i]; |
|
|
|
|
|
level = ((level << 4) + (intra_matrix[i] >> 1)) / intra_matrix[i]; |
|
|
level = ((level + quantd) * mult) >> SCALEBITS; |
|
87 |
coeff[i] = level; |
coeff[i] = level; |
|
} else { |
|
|
coeff[i] = 0; |
|
|
} |
|
88 |
} |
} |
89 |
|
|
90 |
return(0); |
return(0); |
100 |
uint32_t |
uint32_t |
101 |
quant_mpeg_inter_c(int16_t * coeff, |
quant_mpeg_inter_c(int16_t * coeff, |
102 |
const int16_t * data, |
const int16_t * data, |
103 |
const uint32_t quant) |
const uint32_t quant, |
104 |
|
const uint16_t * mpeg_quant_matrices) |
105 |
{ |
{ |
106 |
const uint32_t mult = multipliers[quant]; |
const uint32_t mult = multipliers[quant]; |
107 |
const int16_t *inter_matrix = get_inter_matrix(); |
const uint16_t *inter_matrix = get_inter_matrix(mpeg_quant_matrices); |
108 |
uint32_t sum = 0; |
uint32_t sum = 0; |
109 |
int i; |
int i; |
110 |
|
|
140 |
dequant_mpeg_intra_c(int16_t * data, |
dequant_mpeg_intra_c(int16_t * data, |
141 |
const int16_t * coeff, |
const int16_t * coeff, |
142 |
const uint32_t quant, |
const uint32_t quant, |
143 |
const uint32_t dcscalar) |
const uint32_t dcscalar, |
144 |
|
const uint16_t * mpeg_quant_matrices) |
145 |
{ |
{ |
146 |
const int16_t *intra_matrix = get_intra_matrix(); |
const uint16_t *intra_matrix = get_intra_matrix(mpeg_quant_matrices); |
147 |
int i; |
int i; |
148 |
|
|
149 |
data[0] = coeff[0] * dcscalar; |
data[0] = coeff[0] * dcscalar; |
180 |
uint32_t |
uint32_t |
181 |
dequant_mpeg_inter_c(int16_t * data, |
dequant_mpeg_inter_c(int16_t * data, |
182 |
const int16_t * coeff, |
const int16_t * coeff, |
183 |
const uint32_t quant) |
const uint32_t quant, |
184 |
|
const uint16_t * mpeg_quant_matrices) |
185 |
{ |
{ |
186 |
uint32_t sum = 0; |
uint32_t sum = 0; |
187 |
const int16_t *inter_matrix = get_inter_matrix(); |
const uint16_t *inter_matrix = get_inter_matrix(mpeg_quant_matrices); |
188 |
int i; |
int i; |
189 |
|
|
190 |
for (i = 0; i < 64; i++) { |
for (i = 0; i < 64; i++) { |