h263: make is_gob a part of init
[nihav.git] / src / codecs / h263 / decoder.rs
CommitLineData
cf64af13 1use std::mem;
88c58b1b
KS
2use frame::*;
3use super::super::*;
4use super::super::blockdsp;
cf64af13 5use super::*;
88c58b1b 6use super::code::*;
cf64af13
KS
7use formats;
8
cf64af13
KS
9#[allow(dead_code)]
10struct MVInfo {
11 mv: Vec<MV>,
12 mb_w: usize,
13 mb_stride: usize,
14 mb_start: usize,
15 top: bool,
2324f30b 16 mvmode: MVMode,
cf64af13
KS
17}
18
19impl MVInfo {
2324f30b
KS
20 fn new() -> Self { MVInfo{ mv: Vec::new(), mb_w: 0, mb_stride: 0, mb_start: 0, top: true, mvmode: MVMode::Old } }
21 fn reset(&mut self, mb_w: usize, mb_start: usize, mvmode: MVMode) {
cf64af13
KS
22 self.mb_start = mb_start;
23 self.mb_w = mb_w;
24 self.mb_stride = mb_w * 2;
25 self.top = true;
26 self.mv.resize(self.mb_stride * 3, ZERO_MV);
2324f30b 27 self.mvmode = mvmode;
cf64af13
KS
28 }
29 fn update_row(&mut self) {
30 self.mb_start = self.mb_w + 1;
31 self.top = false;
32 for i in 0..self.mb_stride {
33 self.mv[i] = self.mv[self.mb_stride * 2 + i];
34 }
35 }
36 #[allow(non_snake_case)]
37 fn predict(&mut self, mb_x: usize, blk_no: usize, use4: bool, diff: MV) -> MV {
38 let A;
39 let B;
40 let C;
41 let last = mb_x == self.mb_w - 1;
cf64af13
KS
42 match blk_no {
43 0 => {
44 if mb_x != self.mb_start {
45 A = if mb_x != 0 { self.mv[self.mb_stride + mb_x * 2 - 1] } else { ZERO_MV };
46 B = if !self.top { self.mv[ mb_x * 2] } else { A };
47 C = if !self.top && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV };
48 } else {
49 A = ZERO_MV; B = ZERO_MV; C = ZERO_MV;
50 }
51 },
52 1 => {
53 A = self.mv[self.mb_stride + mb_x * 2];
54 B = if !self.top { self.mv[mb_x * 2 + 1] } else { A };
55 C = if !self.top && !last { self.mv[mb_x * 2 + 2] } else { A };
56 },
57 2 => {
58 A = if mb_x != self.mb_start { self.mv[self.mb_stride * 2 + mb_x * 2 - 1] } else { ZERO_MV };
59 B = self.mv[self.mb_stride + mb_x * 2];
60 C = self.mv[self.mb_stride + mb_x * 2 + 1];
61 },
62 3 => {
63 A = self.mv[self.mb_stride * 2 + mb_x * 2];
64 B = self.mv[self.mb_stride * 1 + mb_x * 2 + 1];
65 C = self.mv[self.mb_stride * 1 + mb_x * 2];
66 },
67 _ => { return ZERO_MV; }
68 }
cf64af13 69 let pred_mv = MV::pred(A, B, C);
2324f30b 70 let new_mv = MV::add_umv(pred_mv, diff, self.mvmode);
cf64af13
KS
71 if !use4 {
72 self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv;
73 self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv;
74 self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv;
75 self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv;
76 } else {
77 match blk_no {
78 0 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv; },
79 1 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv; },
80 2 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv; },
81 3 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv; },
82 _ => {},
83 };
84 }
85
86 new_mv
87 }
88 fn set_zero_mv(&mut self, mb_x: usize) {
89 self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = ZERO_MV;
90 self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = ZERO_MV;
91 self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = ZERO_MV;
92 self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = ZERO_MV;
93 }
94}
95
21c16d5f
KS
96#[allow(dead_code)]
97#[derive(Clone,Copy)]
98struct BMB {
99 num_mv: usize,
100 mv_f: [MV; 4],
101 mv_b: [MV; 4],
102 fwd: bool,
103 blk: [[i16; 64]; 6],
104 cbp: u8,
105}
106
107impl BMB {
108 fn new() -> Self { BMB {blk: [[0; 64]; 6], cbp: 0, fwd: false, mv_f: [ZERO_MV; 4], mv_b: [ZERO_MV; 4], num_mv: 0} }
109}
110
ef3209c7
KS
111#[derive(Clone,Copy)]
112struct PredCoeffs {
113 hor: [[i16; 8]; 6],
114 ver: [[i16; 8]; 6],
115}
116
117const ZERO_PRED_COEFFS: PredCoeffs = PredCoeffs { hor: [[0; 8]; 6], ver: [[0; 8]; 6] };
118
88c58b1b 119pub struct H263BaseDecoder {
cf64af13
KS
120 w: usize,
121 h: usize,
122 mb_w: usize,
123 mb_h: usize,
124 num_mb: usize,
125 ftype: Type,
126 prev_frm: Option<NAVideoBuffer<u8>>,
127 cur_frm: Option<NAVideoBuffer<u8>>,
21c16d5f
KS
128 last_ts: u8,
129 has_b: bool,
130 b_data: Vec<BMB>,
ef3209c7 131 pred_coeffs: Vec<PredCoeffs>,
42a59352 132 is_gob: bool,
ef3209c7
KS
133}
134
135#[inline]
136fn clip_dc(dc: i16) -> i16 {
137 if dc < 0 { 0 }
138 else if dc > 2046 { 2046 }
139 else { (dc + 1) & !1 }
140}
141
142#[inline]
143fn clip_ac(ac: i16) -> i16 {
144 if ac < -2048 { -2048 }
145 else if ac > 2047 { 2047 }
146 else { ac }
cf64af13
KS
147}
148
149#[allow(dead_code)]
88c58b1b 150impl H263BaseDecoder {
42a59352 151 pub fn new(is_gob: bool) -> Self {
88c58b1b 152 H263BaseDecoder{
cf64af13
KS
153 w: 0, h: 0, mb_w: 0, mb_h: 0, num_mb: 0,
154 ftype: Type::Special,
155 prev_frm: None, cur_frm: None,
21c16d5f
KS
156 last_ts: 0,
157 has_b: false, b_data: Vec::new(),
ef3209c7 158 pred_coeffs: Vec::new(),
42a59352 159 is_gob: is_gob,
cf64af13
KS
160 }
161 }
162
163 pub fn is_intra(&self) -> bool { self.ftype == Type::I }
164 pub fn get_dimensions(&self) -> (usize, usize) { (self.w, self.h) }
165
2a2aa421 166 pub fn parse_frame(&mut self, bd: &mut BlockDecoder, bdsp: &BlockDSP) -> DecoderResult<NABufferType> {
cf64af13 167 let pinfo = bd.decode_pichdr()?;
21c16d5f 168 let mut mvi = MVInfo::new();
f2f1afb2 169 let mut cbpi = CBPInfo::new();
cf64af13
KS
170
171//todo handle res change
172 self.w = pinfo.w;
173 self.h = pinfo.h;
174 self.mb_w = (pinfo.w + 15) >> 4;
175 self.mb_h = (pinfo.h + 15) >> 4;
176 self.num_mb = self.mb_w * self.mb_h;
177 self.ftype = pinfo.mode;
21c16d5f
KS
178 self.has_b = pinfo.is_pb();
179
180 if self.has_b {
181 self.b_data.truncate(0);
182 }
cf64af13
KS
183
184 mem::swap(&mut self.cur_frm, &mut self.prev_frm);
cf64af13 185
21c16d5f
KS
186 let tsdiff = pinfo.ts.wrapping_sub(self.last_ts);
187 let bsdiff = if pinfo.is_pb() { pinfo.get_pbinfo().get_trb() } else { 0 };
188
cf64af13
KS
189 let fmt = formats::YUV420_FORMAT;
190 let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
191 let bufret = alloc_video_buffer(vinfo, 4);
192 if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
193 let mut bufinfo = bufret.unwrap();
194 let mut buf = bufinfo.get_vbuf().unwrap();
195
42a59352 196 let mut slice = if self.is_gob {
2a2aa421
KS
197 SliceInfo::get_default_slice(&pinfo)
198 } else {
199 bd.decode_slice_header(&pinfo)?
200 };
2324f30b 201 mvi.reset(self.mb_w, 0, pinfo.get_mvmode());
f2f1afb2 202 cbpi.reset(self.mb_w);
cf64af13
KS
203
204 let mut blk: [[i16; 64]; 6] = [[0; 64]; 6];
2a2aa421
KS
205 let mut sstate = SliceState::new(pinfo.mode == Type::I);
206 let mut mb_pos = 0;
ef3209c7
KS
207 let apply_acpred = (pinfo.mode == Type::I) && pinfo.plusinfo.is_some() && pinfo.plusinfo.unwrap().aic;
208 if apply_acpred {
209 self.pred_coeffs.truncate(0);
210 self.pred_coeffs.resize(self.mb_w * self.mb_h, ZERO_PRED_COEFFS);
211 }
cf64af13
KS
212 for mb_y in 0..self.mb_h {
213 for mb_x in 0..self.mb_w {
214 for i in 0..6 { for j in 0..64 { blk[i][j] = 0; } }
215
2a2aa421 216 if slice.is_at_end(mb_pos) || (slice.needs_check() && mb_pos > 0 && bd.is_slice_end()) {
cf64af13 217 slice = bd.decode_slice_header(&pinfo)?;
2324f30b 218 //mvi.reset(self.mb_w, mb_x, pinfo.get_mvmode());
f2f1afb2 219 //cbpi.reset(self.mb_w);
cf64af13
KS
220 }
221
2a2aa421 222 let binfo = bd.decode_block_header(&pinfo, &slice, &sstate)?;
cf64af13 223 let cbp = binfo.get_cbp();
f2f1afb2
KS
224 cbpi.set_cbp(mb_x, cbp);
225 cbpi.set_q(mb_x, binfo.get_q());
cf64af13
KS
226 if binfo.is_intra() {
227 for i in 0..6 {
2a2aa421 228 bd.decode_block_intra(&binfo, &sstate, binfo.get_q(), i, (cbp & (1 << (5 - i))) != 0, &mut blk[i])?;
ef3209c7
KS
229 if apply_acpred && (binfo.acpred != ACPredMode::None) {
230 let has_b = (i == 1) || (i == 3) || (mb_x > 0);
231 let has_a = (i == 2) || (i == 3) || (mb_y > 0);
232 let (b_mb, b_blk) = if has_b {
233 if (i == 1) || (i == 3) {
234 (mb_pos, i - 1)
235 } else if i < 4 {
236 (mb_pos - 1, i + 1)
237 } else {
238 (mb_pos - 1, i)
239 }
240 } else { (0, 0) };
241 let (a_mb, a_blk) = if has_a {
242 if (i == 2) || (i == 3) {
243 (mb_pos, i - 2)
244 } else if i < 4 {
245 (mb_pos - self.mb_w, i + 2)
246 } else {
247 (mb_pos - self.mb_w, i)
248 }
249 } else { (0, 0) };
250 match binfo.acpred {
251 ACPredMode::DC => {
252 let dc;
253 if has_a && has_b {
254 dc = (self.pred_coeffs[b_mb].hor[b_blk][0] + self.pred_coeffs[a_mb].ver[a_blk][0]) / 2;
255 } else if has_a {
256 dc = self.pred_coeffs[a_mb].ver[a_blk][0];
257 } else if has_b {
258 dc = self.pred_coeffs[b_mb].hor[b_blk][0];
259 } else {
260 dc = 1024;
261 }
262 blk[i][0] = clip_dc(blk[i][0] + dc);
263 },
264 ACPredMode::Hor => {
265 if has_b {
266 for k in 0..8 {
267 blk[i][k * 8] += self.pred_coeffs[b_mb].hor[b_blk][k];
268 }
269 for k in 1..8 {
270 blk[i][k * 8] = clip_ac(blk[i][k * 8]);
271 }
272 } else {
273 blk[i][0] += 1024;
274 }
275 blk[i][0] = clip_dc(blk[i][0]);
276 },
277 ACPredMode::Ver => {
278 if has_a {
279 for k in 0..8 {
280 blk[i][k] += self.pred_coeffs[a_mb].ver[a_blk][k];
281 }
282 for k in 1..8 {
283 blk[i][k] = clip_ac(blk[i][k]);
284 }
285 } else {
286 blk[i][0] += 1024;
287 }
288 blk[i][0] = clip_dc(blk[i][0]);
289 },
290 ACPredMode::None => {},
291 };
292 for t in 0..8 { self.pred_coeffs[mb_pos].hor[i][t] = blk[i][t * 8]; }
293 for t in 0..8 { self.pred_coeffs[mb_pos].ver[i][t] = blk[i][t]; }
294 }
cf64af13
KS
295 h263_idct(&mut blk[i]);
296 }
297 blockdsp::put_blocks(&mut buf, mb_x, mb_y, &blk);
298 mvi.set_zero_mv(mb_x);
299 } else if !binfo.is_skipped() {
300 if binfo.get_num_mvs() == 1 {
301 let mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0));
cf64af13 302 if let Some(ref srcbuf) = self.prev_frm {
2a2aa421 303 bdsp.copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, mv);
cf64af13
KS
304 }
305 } else {
306 for blk_no in 0..4 {
307 let mv = mvi.predict(mb_x, blk_no, true, binfo.get_mv(blk_no));
cf64af13 308 if let Some(ref srcbuf) = self.prev_frm {
2a2aa421
KS
309 bdsp.copy_blocks(&mut buf, srcbuf,
310 mb_x * 16 + (blk_no & 1) * 8,
311 mb_y * 16 + (blk_no & 2) * 4, 8, 8, mv);
cf64af13
KS
312 }
313 }
cf64af13
KS
314 }
315 for i in 0..6 {
2a2aa421 316 bd.decode_block_inter(&binfo, &sstate, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?;
cf64af13
KS
317 h263_idct(&mut blk[i]);
318 }
319 blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk);
320 } else {
321 mvi.set_zero_mv(mb_x);
322 if let Some(ref srcbuf) = self.prev_frm {
2a2aa421 323 bdsp.copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, ZERO_MV);
cf64af13
KS
324 }
325 }
21c16d5f
KS
326 if pinfo.is_pb() {
327 let mut b_mb = BMB::new();
cf64af13 328 let cbp = binfo.get_cbp_b();
21c16d5f
KS
329 let bq = (((pinfo.get_pbinfo().get_dbquant() + 5) as u16) * (binfo.get_q() as u16)) >> 2;
330 let bquant;
331 if bq < 1 { bquant = 1; }
332 else if bq > 31 { bquant = 31; }
333 else { bquant = bq as u8; }
334
335 b_mb.cbp = cbp;
cf64af13 336 for i in 0..6 {
2a2aa421 337 bd.decode_block_inter(&binfo, &sstate, bquant, i, (cbp & (1 << (5 - i))) != 0, &mut b_mb.blk[i])?;
21c16d5f 338 h263_idct(&mut b_mb.blk[i]);
cf64af13 339 }
21c16d5f 340
88c58b1b 341 let is_fwd = !binfo.is_b_fwd();
21c16d5f
KS
342 b_mb.fwd = is_fwd;
343 b_mb.num_mv = binfo.get_num_mvs();
344 if binfo.get_num_mvs() == 0 {
345 b_mb.num_mv = 1;
346 b_mb.mv_f[0] = binfo.get_mv2(1);
347 b_mb.mv_b[0] = binfo.get_mv2(0);
88c58b1b
KS
348 } else if binfo.get_num_mvs() == 1 {
349 let src_mv = binfo.get_mv(0).scale(bsdiff, tsdiff);
2324f30b 350 let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_mvmode());
21c16d5f
KS
351 let mv_b = MV::b_sub(binfo.get_mv(0), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
352 b_mb.mv_f[0] = mv_f;
353 b_mb.mv_b[0] = mv_b;
354 } else {
355 for blk_no in 0..4 {
88c58b1b 356 let src_mv = binfo.get_mv(blk_no).scale(bsdiff, tsdiff);
2324f30b 357 let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_mvmode());
21c16d5f
KS
358 let mv_b = MV::b_sub(binfo.get_mv(blk_no), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
359 b_mb.mv_f[blk_no] = mv_f;
360 b_mb.mv_b[blk_no] = mv_b;
cf64af13
KS
361 }
362 }
21c16d5f 363 self.b_data.push(b_mb);
cf64af13 364 }
2a2aa421
KS
365 sstate.next_mb();
366 mb_pos += 1;
cf64af13 367 }
2a2aa421
KS
368 if let Some(plusinfo) = pinfo.plusinfo {
369 if plusinfo.deblock {
370 bdsp.filter_row(&mut buf, mb_y, self.mb_w, &cbpi);
371 }
f2f1afb2 372 }
cf64af13 373 mvi.update_row();
f2f1afb2 374 cbpi.update_row();
2a2aa421 375 sstate.new_row();
cf64af13 376 }
f2f1afb2 377
cf64af13 378 self.cur_frm = Some(buf);
21c16d5f 379 self.last_ts = pinfo.ts;
cf64af13
KS
380 Ok(bufinfo)
381 }
382
2a2aa421 383 pub fn get_bframe(&mut self, bdsp: &BlockDSP) -> DecoderResult<NABufferType> {
21c16d5f
KS
384 if !self.has_b || !self.cur_frm.is_some() || !self.prev_frm.is_some() {
385 return Err(DecoderError::MissingReference);
386 }
387 self.has_b = false;
388
389 let fmt = formats::YUV420_FORMAT;
390 let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
391 let bufret = alloc_video_buffer(vinfo, 4);
392 if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
393 let mut bufinfo = bufret.unwrap();
394 let mut b_buf = bufinfo.get_vbuf().unwrap();
395
396 if let Some(ref bck_buf) = self.prev_frm {
397 if let Some(ref fwd_buf) = self.cur_frm {
2a2aa421 398 recon_b_frame(&mut b_buf, bck_buf, fwd_buf, self.mb_w, self.mb_h, &self.b_data, bdsp);
21c16d5f
KS
399 }
400 }
401
402 self.b_data.truncate(0);
403 Ok(bufinfo)
404 }
405}
406
407fn recon_b_frame(b_buf: &mut NAVideoBuffer<u8>, bck_buf: &NAVideoBuffer<u8>, fwd_buf: &NAVideoBuffer<u8>,
2a2aa421 408 mb_w: usize, mb_h: usize, b_data: &Vec<BMB>, bdsp: &BlockDSP) {
f2f1afb2 409 let mut cbpi = CBPInfo::new();
21c16d5f 410 let mut cur_mb = 0;
f2f1afb2 411 cbpi.reset(mb_w);
21c16d5f
KS
412 for mb_y in 0..mb_h {
413 for mb_x in 0..mb_w {
414 let num_mv = b_data[cur_mb].num_mv;
415 let is_fwd = b_data[cur_mb].fwd;
f2f1afb2
KS
416 let cbp = b_data[cur_mb].cbp;
417 cbpi.set_cbp(mb_x, cbp);
418 if num_mv == 1 {
2a2aa421 419 bdsp.copy_blocks(b_buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_b[0]);
21c16d5f 420 if !is_fwd {
2a2aa421 421 bdsp.avg_blocks(b_buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_f[0]);
21c16d5f
KS
422 }
423 } else {
424 for blk_no in 0..4 {
425 let xpos = mb_x * 16 + (blk_no & 1) * 8;
426 let ypos = mb_y * 16 + (blk_no & 2) * 4;
2a2aa421 427 bdsp.copy_blocks(b_buf, fwd_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_b[blk_no]);
21c16d5f 428 if !is_fwd {
2a2aa421 429 bdsp.avg_blocks(b_buf, bck_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_f[blk_no]);
21c16d5f
KS
430 }
431 }
432 }
f2f1afb2 433 if cbp != 0 {
21c16d5f
KS
434 blockdsp::add_blocks(b_buf, mb_x, mb_y, &b_data[cur_mb].blk);
435 }
436 cur_mb += 1;
cf64af13 437 }
f2f1afb2 438 cbpi.update_row();
cf64af13
KS
439 }
440}