50 |
* exception also makes it possible to release a modified version which |
* exception also makes it possible to release a modified version which |
51 |
* carries forward this exception. |
* carries forward this exception. |
52 |
* |
* |
53 |
* $Id: quant_mpeg4.c,v 1.6 2002-11-17 00:41:19 edgomez Exp $ |
* $Id: quant_mpeg4.c,v 1.8 2002-12-15 01:21:12 edgomez Exp $ |
54 |
* |
* |
55 |
****************************************************************************/ |
****************************************************************************/ |
56 |
|
|
100 |
* Functions |
* Functions |
101 |
****************************************************************************/ |
****************************************************************************/ |
102 |
|
|
103 |
/* quantize intra-block |
#if 0 |
104 |
|
/* quantize intra-block */ |
105 |
|
|
106 |
// const int32_t quantd = DIV_DIV(VM18P*quant, VM18Q); |
// const int32_t quantd = DIV_DIV(VM18P*quant, VM18Q); |
107 |
// |
// |
108 |
// level = DIV_DIV(16 * data[i], default_intra_matrix[i]); |
// level = DIV_DIV(16 * data[i], default_intra_matrix[i]); |
109 |
// coeff[i] = (level + quantd) / quant2; |
// coeff[i] = (level + quantd) / quant2; |
110 |
*/ |
#endif |
111 |
|
|
112 |
void |
void |
113 |
quant4_intra_c(int16_t * coeff, |
quant4_intra_c(int16_t * coeff, |
122 |
|
|
123 |
intra_matrix = get_intra_matrix(); |
intra_matrix = get_intra_matrix(); |
124 |
|
|
125 |
coeff[0] = DIV_DIV(data[0], (int32_t) dcscalar); |
coeff[0] = (int16_t)(DIV_DIV(data[0], (int32_t) dcscalar)); |
126 |
|
|
127 |
for (i = 1; i < 64; i++) { |
for (i = 1; i < 64; i++) { |
128 |
if (data[i] < 0) { |
if (data[i] < 0) { |
136 |
|
|
137 |
level = ((level << 4) + (intra_matrix[i] >> 1)) / intra_matrix[i]; |
level = ((level << 4) + (intra_matrix[i] >> 1)) / intra_matrix[i]; |
138 |
level = ((level + quantd) * mult) >> 17; |
level = ((level + quantd) * mult) >> 17; |
139 |
coeff[i] = level; |
coeff[i] = (int16_t)level; |
140 |
} else { |
} else { |
141 |
coeff[i] = 0; |
coeff[i] = 0; |
142 |
} |
} |
145 |
|
|
146 |
|
|
147 |
|
|
148 |
/* dequantize intra-block & clamp to [-2048,2047] |
/* dequantize intra-block & clamp to [-2048,2047] */ |
149 |
// data[i] = (coeff[i] * default_intra_matrix[i] * quant2) >> 4; |
/* data[i] = (coeff[i] * default_intra_matrix[i] * quant2) >> 4; */ |
150 |
*/ |
|
151 |
|
|
152 |
void |
void |
153 |
dequant4_intra_c(int16_t * data, |
dequant4_intra_c(int16_t * data, |
160 |
|
|
161 |
intra_matrix = get_intra_matrix(); |
intra_matrix = get_intra_matrix(); |
162 |
|
|
163 |
data[0] = coeff[0] * dcscalar; |
data[0] = (int16_t)(coeff[0] * dcscalar); |
164 |
if (data[0] < -2048) { |
if (data[0] < -2048) { |
165 |
data[0] = -2048; |
data[0] = -2048; |
166 |
} else if (data[0] > 2047) { |
} else if (data[0] > 2047) { |
175 |
|
|
176 |
level = (level * intra_matrix[i] * quant) >> 3; |
level = (level * intra_matrix[i] * quant) >> 3; |
177 |
data[i] = (level <= 2048 ? -(int16_t) level : -2048); |
data[i] = (level <= 2048 ? -(int16_t) level : -2048); |
178 |
} else // if (coeff[i] > 0) |
} else /* if (coeff[i] > 0) */ |
179 |
{ |
{ |
180 |
uint32_t level = coeff[i]; |
uint32_t level = coeff[i]; |
181 |
|
|
182 |
level = (level * intra_matrix[i] * quant) >> 3; |
level = (level * intra_matrix[i] * quant) >> 3; |
183 |
data[i] = (level <= 2047 ? level : 2047); |
data[i] = (int16_t)(level <= 2047 ? level : 2047); |
184 |
} |
} |
185 |
} |
} |
186 |
} |
} |
187 |
|
|
188 |
|
|
189 |
|
|
190 |
/* quantize inter-block |
#if 0 |
191 |
|
/* quantize inter-block */ |
192 |
|
|
193 |
// level = DIV_DIV(16 * data[i], default_intra_matrix[i]); |
// level = DIV_DIV(16 * data[i], default_intra_matrix[i]); |
194 |
// coeff[i] = (level + quantd) / quant2; |
// coeff[i] = (level + quantd) / quant2; |
195 |
// sum += abs(level); |
// sum += abs(level); |
196 |
*/ |
#endif |
197 |
|
|
198 |
uint32_t |
uint32_t |
199 |
quant4_inter_c(int16_t * coeff, |
quant4_inter_c(int16_t * coeff, |
221 |
level = ((level << 4) + (inter_matrix[i] >> 1)) / inter_matrix[i]; |
level = ((level << 4) + (inter_matrix[i] >> 1)) / inter_matrix[i]; |
222 |
level = (level * mult) >> 17; |
level = (level * mult) >> 17; |
223 |
sum += level; |
sum += level; |
224 |
coeff[i] = level; |
coeff[i] = (int16_t)level; |
225 |
} else { |
} else { |
226 |
coeff[i] = 0; |
coeff[i] = 0; |
227 |
} |
} |
254 |
|
|
255 |
level = ((2 * level + 1) * inter_matrix[i] * quant) >> 4; |
level = ((2 * level + 1) * inter_matrix[i] * quant) >> 4; |
256 |
data[i] = (level <= 2048 ? -level : -2048); |
data[i] = (level <= 2048 ? -level : -2048); |
257 |
} else // if (coeff[i] > 0) |
} else /* if (coeff[i] > 0) */ |
258 |
{ |
{ |
259 |
uint32_t level = coeff[i]; |
uint32_t level = coeff[i]; |
260 |
|
|
261 |
level = ((2 * level + 1) * inter_matrix[i] * quant) >> 4; |
level = ((2 * level + 1) * inter_matrix[i] * quant) >> 4; |
262 |
data[i] = (level <= 2047 ? level : 2047); |
data[i] = (int16_t)(level <= 2047 ? level : 2047); |
263 |
} |
} |
264 |
|
|
265 |
sum ^= data[i]; |
sum ^= data[i]; |
266 |
} |
} |
267 |
|
|
268 |
// mismatch control |
/* mismatch control */ |
269 |
|
|
270 |
if ((sum & 1) == 0) { |
if ((sum & 1) == 0) { |
271 |
data[63] ^= 1; |
data[63] ^= 1; |