src/codecs/h263/decoder.rs

   1 //use std::mem;
   2 use crate::frame::*;
   3 use super::super::*;
   4 use super::super::blockdsp;
   5 use super::*;
   6 //use super::code::*;
   7 use crate::formats;
   8
   9 #[allow(dead_code)]
  10 struct MVInfo {
  11     mv:         Vec<MV>,
  12     mb_w:       usize,
  13     mb_stride:  usize,
  14     mb_start:   usize,
  15     top:        bool,
  16     mvmode:     MVMode,
  17 }
  18
  19 impl MVInfo {
  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) {
  22         self.mb_start  = mb_start;
  23         self.mb_w      = mb_w;
  24         self.mb_stride = mb_w * 2;
  25         self.mv.resize(self.mb_stride * 3, ZERO_MV);
  26         self.mvmode    = mvmode;
  27     }
  28     fn update_row(&mut self) {
  29         self.mb_start = self.mb_w + 1;
  30         self.top      = false;
  31         for i in 0..self.mb_stride {
  32             self.mv[i] = self.mv[self.mb_stride * 2 + i];
  33         }
  34     }
  35     #[allow(non_snake_case)]
  36     fn predict(&mut self, mb_x: usize, blk_no: usize, use4: bool, diff: MV, first_line: bool, first_mb: bool) -> MV {
  37         let A;
  38         let B;
  39         let C;
  40         let last = mb_x == self.mb_w - 1;
  41         match blk_no {
  42             0 => {
  43                     if mb_x != self.mb_start {
  44                         A = if !first_mb   { self.mv[self.mb_stride + mb_x * 2 - 1] } else { ZERO_MV };
  45                         B = if !first_line { self.mv[                 mb_x * 2] } else { A };
  46                         C = if !first_line && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV };
  47                     } else {
  48                         A = ZERO_MV; B = ZERO_MV; C = ZERO_MV;
  49                     }
  50                 },
  51             1 => {
  52                     A = self.mv[self.mb_stride + mb_x * 2];
  53                     B = if !first_line { self.mv[mb_x * 2 + 1] } else { A };
  54                     C = if !first_line && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV/*A*/ };
  55                 },
  56             2 => {
  57                     A = if mb_x != self.mb_start { self.mv[self.mb_stride * 2 + mb_x * 2 - 1] } else { ZERO_MV };
  58                     B = self.mv[self.mb_stride + mb_x * 2];
  59                     C = self.mv[self.mb_stride + mb_x * 2 + 1];
  60                 },
  61             3 => {
  62                     A = self.mv[self.mb_stride * 2 + mb_x * 2];
  63                     B = self.mv[self.mb_stride * 1 + mb_x * 2 + 1];
  64                     C = self.mv[self.mb_stride * 1 + mb_x * 2];
  65                 },
  66             _ => { return ZERO_MV; }
  67         }
  68         let pred_mv = MV::pred(A, B, C);
  69         let new_mv = MV::add_umv(pred_mv, diff, self.mvmode);
  70         if !use4 {
  71             self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv;
  72             self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv;
  73             self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv;
  74             self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv;
  75         } else {
  76             match blk_no {
  77                 0 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv; },
  78                 1 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv; },
  79                 2 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv; },
  80                 3 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv; },
  81                 _ => {},
  82             };
  83         }
  84
  85         new_mv
  86     }
  87     fn set_zero_mv(&mut self, mb_x: usize) {
  88         self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = ZERO_MV;
  89         self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = ZERO_MV;
  90         self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = ZERO_MV;
  91         self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = ZERO_MV;
  92     }
  93     fn get_mv(&self, mb_x: usize, blk_no: usize) -> MV {
  94         self.mv[self.mb_stride + mb_x * 2 + (blk_no & 1) + (blk_no >> 1) * self.mb_stride]
  95     }
  96 }
  97
  98 #[allow(dead_code)]
  99 #[derive(Clone,Copy)]
 100 struct BMB {
 101     num_mv: usize,
 102     mv_f:   [MV; 4],
 103     mv_b:   [MV; 4],
 104     fwd:    bool,
 105     blk:    [[i16; 64]; 6],
 106     cbp:    u8,
 107 }
 108
 109 impl BMB {
 110     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} }
 111 }
 112
 113 #[derive(Clone,Copy)]
 114 struct PredCoeffs {
 115     hor: [[i16; 8]; 6],
 116     ver: [[i16; 8]; 6],
 117 }
 118
 119 const ZERO_PRED_COEFFS: PredCoeffs = PredCoeffs { hor: [[0; 8]; 6], ver: [[0; 8]; 6] };
 120
 121 pub struct H263BaseDecoder {
 122     w:          usize,
 123     h:          usize,
 124     mb_w:       usize,
 125     mb_h:       usize,
 126     num_mb:     usize,
 127     ftype:      Type,
 128     ipbs:       IPBShuffler,
 129     next_ts:    u16,
 130     last_ts:    u16,
 131     tsdiff:     u16,
 132     has_b:      bool,
 133     b_data:     Vec<BMB>,
 134     pred_coeffs: Vec<PredCoeffs>,
 135     is_gob:     bool,
 136     slice_reset: bool,
 137     may_have_b_frames: bool,
 138     mv_data:    Vec<BlockMVInfo>,
 139 }
 140
 141 #[inline]
 142 fn clip_dc(dc: i16) -> i16 {
 143     if dc < 0 { 0 }
 144     else if dc > 2046 { 2046 }
 145     else { (dc + 1) & !1 }
 146 }
 147
 148 #[inline]
 149 fn clip_ac(ac: i16) -> i16 {
 150     if ac < -2048 { -2048 }
 151     else if ac > 2047 { 2047 }
 152     else { ac }
 153 }
 154
 155 #[allow(dead_code)]
 156 impl H263BaseDecoder {
 157     pub fn new_with_opts(is_gob: bool, slice_reset: bool, may_have_b_frames: bool) -> Self {
 158         H263BaseDecoder{
 159             w: 0, h: 0, mb_w: 0, mb_h: 0, num_mb: 0,
 160             ftype: Type::Special,
 161             ipbs: IPBShuffler::new(),
 162             last_ts: 0, next_ts: 0, tsdiff: 0,
 163             has_b: false, b_data: Vec::new(),
 164             pred_coeffs: Vec::new(),
 165             is_gob: is_gob, slice_reset: slice_reset,
 166             may_have_b_frames: may_have_b_frames,
 167             mv_data: Vec::new(),
 168         }
 169     }
 170     pub fn new(is_gob: bool) -> Self {
 171         Self::new_with_opts(is_gob, true, false)
 172     }
 173     pub fn new_b_frames(is_gob: bool) -> Self {
 174         Self::new_with_opts(is_gob, true, true)
 175     }
 176
 177     pub fn is_intra(&self) -> bool { self.ftype == Type::I }
 178     pub fn get_frame_type(&self) -> FrameType {
 179         match self.ftype {
 180             Type::I       => FrameType::I,
 181             Type::P       => FrameType::P,
 182             Type::B       => FrameType::B,
 183             Type::PB      => FrameType::P,
 184             Type::Skip    => FrameType::Skip,
 185             Type::Special => FrameType::Skip,
 186         }
 187     }
 188     pub fn get_dimensions(&self) -> (usize, usize) { (self.w, self.h) }
 189
 190     pub fn parse_frame(&mut self, bd: &mut BlockDecoder, bdsp: &BlockDSP) -> DecoderResult<NABufferType> {
 191         let pinfo = bd.decode_pichdr()?;
 192         let mut mvi = MVInfo::new();
 193         let mut mvi2 = MVInfo::new();
 194         let mut cbpi = CBPInfo::new();
 195
 196 //todo handle res change
 197         self.w = pinfo.w;
 198         self.h = pinfo.h;
 199         self.mb_w = (pinfo.w + 15) >> 4;
 200         self.mb_h = (pinfo.h + 15) >> 4;
 201         self.num_mb = self.mb_w * self.mb_h;
 202         self.ftype = pinfo.mode;
 203         self.has_b = pinfo.is_pb();
 204
 205         if self.has_b {
 206             self.mv_data.truncate(0);
 207         }
 208
 209         let save_b_data = pinfo.mode.is_ref() && self.may_have_b_frames;
 210         if save_b_data {
 211             self.mv_data.truncate(0);
 212         }
 213         let is_b = pinfo.mode == Type::B;
 214
 215         let tsdiff = if pinfo.is_pb() { pinfo.ts.wrapping_sub(self.last_ts) >> 1 }
 216                      else { self.last_ts.wrapping_sub(self.next_ts) >> 1 };
 217         let bsdiff = if pinfo.is_pb() { (pinfo.get_pbinfo().get_trb() as u16) << 7 }
 218                      else { pinfo.ts.wrapping_sub(self.next_ts) >> 1 };
 219
 220         let fmt = formats::YUV420_FORMAT;
 221         let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
 222         let bufret = alloc_video_buffer(vinfo, 4);
 223         if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
 224         let mut bufinfo = bufret.unwrap();
 225         let mut buf = bufinfo.get_vbuf().unwrap();
 226
 227         let mut slice = if self.is_gob {
 228                 SliceInfo::get_default_slice(&pinfo)
 229             } else {
 230                 bd.decode_slice_header(&pinfo)?
 231             };
 232         mvi.reset(self.mb_w, 0, pinfo.get_mvmode());
 233         if is_b || pinfo.is_pb() {
 234             mvi2.reset(self.mb_w, 0, pinfo.get_mvmode());
 235         }
 236         cbpi.reset(self.mb_w);
 237
 238         let mut blk: [[i16; 64]; 6] = [[0; 64]; 6];
 239         let mut sstate = SliceState::new(pinfo.mode == Type::I);
 240         let mut mb_pos = 0;
 241         let apply_acpred = (pinfo.mode == Type::I) && pinfo.plusinfo.is_some() && pinfo.plusinfo.unwrap().aic;
 242         if apply_acpred {
 243             self.pred_coeffs.truncate(0);
 244             self.pred_coeffs.resize(self.mb_w * self.mb_h, ZERO_PRED_COEFFS);
 245         }
 246         sstate.quant = slice.quant;
 247         for mb_y in 0..self.mb_h {
 248             for mb_x in 0..self.mb_w {
 249                 for i in 0..6 { for j in 0..64 { blk[i][j] = 0; } }
 250
 251                 if slice.is_at_end(mb_pos) || (slice.needs_check() && mb_pos > 0 && bd.is_slice_end()) {
 252                     slice = bd.decode_slice_header(&pinfo)?;
 253                     if !self.is_gob && self.slice_reset {
 254                         mvi.reset(self.mb_w, mb_x, pinfo.get_mvmode());
 255                         if is_b || pinfo.is_pb() {
 256                             mvi2.reset(self.mb_w, mb_x, pinfo.get_mvmode());
 257                         }
 258                         cbpi.reset(self.mb_w);
 259                         sstate.reset_slice(mb_x, mb_y);
 260                         sstate.quant = slice.quant;
 261                     }
 262                 }
 263
 264                 let binfo = bd.decode_block_header(&pinfo, &slice, &sstate)?;
 265                 let cbp = binfo.get_cbp();
 266                 cbpi.set_cbp(mb_x, cbp);
 267                 cbpi.set_q(mb_x, binfo.get_q());
 268                 sstate.quant = binfo.get_q();
 269                 if binfo.is_intra() {
 270                     if save_b_data {
 271                         self.mv_data.push(BlockMVInfo::Intra);
 272                     }
 273                     for i in 0..6 {
 274                         bd.decode_block_intra(&binfo, &sstate, binfo.get_q(), i, (cbp & (1 << (5 - i))) != 0, &mut blk[i])?;
 275                         if apply_acpred && (binfo.acpred != ACPredMode::None) {
 276                             let has_b = (i == 1) || (i == 3) || !sstate.first_mb;
 277                             let has_a = (i == 2) || (i == 3) || !sstate.first_line;
 278                             let (b_mb, b_blk) = if has_b {
 279                                     if (i == 1) || (i == 3) {
 280                                         (mb_pos, i - 1)
 281                                     } else if i < 4 {
 282                                         (mb_pos - 1, i + 1)
 283                                     } else {
 284                                         (mb_pos - 1, i)
 285                                     }
 286                                 } else { (0, 0) };
 287                             let (a_mb, a_blk) = if has_a {
 288                                     if (i == 2) || (i == 3) {
 289                                         (mb_pos, i - 2)
 290                                     } else if i < 4 {
 291                                         (mb_pos - self.mb_w, i + 2)
 292                                     } else {
 293                                         (mb_pos - self.mb_w, i)
 294                                     }
 295                                 } else { (0, 0) };
 296                             match binfo.acpred {
 297                                 ACPredMode::DC   => {
 298                                             let dc;
 299                                             if has_a && has_b {
 300                                                 dc = (self.pred_coeffs[b_mb].hor[b_blk][0] + self.pred_coeffs[a_mb].ver[a_blk][0]) / 2;
 301                                             } else if has_a {
 302                                                 dc = self.pred_coeffs[a_mb].ver[a_blk][0];
 303                                             } else if has_b {
 304                                                 dc = self.pred_coeffs[b_mb].hor[b_blk][0];
 305                                             } else {
 306                                                 dc = 1024;
 307                                             }
 308                                             blk[i][0] = clip_dc(blk[i][0] + dc);
 309                                         },
 310                                 ACPredMode::Hor  => {
 311                                         if has_b {
 312                                             for k in 0..8 {
 313                                                 blk[i][k * 8] += self.pred_coeffs[b_mb].hor[b_blk][k];
 314                                             }
 315                                             for k in 1..8 {
 316                                                 blk[i][k * 8] = clip_ac(blk[i][k * 8]);
 317                                             }
 318                                         } else {
 319                                             blk[i][0] += 1024;
 320                                         }
 321                                         blk[i][0] = clip_dc(blk[i][0]);
 322                                     },
 323                                 ACPredMode::Ver  => {
 324                                         if has_a {
 325                                             for k in 0..8 {
 326                                                 blk[i][k] += self.pred_coeffs[a_mb].ver[a_blk][k];
 327                                             }
 328                                             for k in 1..8 {
 329                                                 blk[i][k] = clip_ac(blk[i][k]);
 330                                             }
 331                                         } else {
 332                                             blk[i][0] += 1024;
 333                                         }
 334                                         blk[i][0] = clip_dc(blk[i][0]);
 335                                     },
 336                                 ACPredMode::None => {},
 337                             };
 338                             for t in 0..8 { self.pred_coeffs[mb_pos].hor[i][t] = blk[i][t * 8]; }
 339                             for t in 0..8 { self.pred_coeffs[mb_pos].ver[i][t] = blk[i][t]; }
 340                         }
 341                         bdsp.idct(&mut blk[i]);
 342                     }
 343                     blockdsp::put_blocks(&mut buf, mb_x, mb_y, &blk);
 344                     mvi.set_zero_mv(mb_x);
 345                     if is_b {
 346                         mvi2.set_zero_mv(mb_x);
 347                     } else if pinfo.is_pb() {
 348                         mvi2.predict(mb_x, 0, false, binfo.get_mv2(0), sstate.first_line, sstate.first_mb);
 349                     }
 350                 } else if (binfo.mode != Type::B) && !binfo.is_skipped() {
 351                     if binfo.get_num_mvs() == 1 {
 352                         let mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb);
 353                         if save_b_data {
 354                             self.mv_data.push(BlockMVInfo::Inter_1MV(mv));
 355                         }
 356                         if let Some(ref srcbuf) = self.ipbs.get_lastref() {
 357                             bdsp.copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, mv);
 358                         }
 359                         if pinfo.is_pb() {
 360                             mvi2.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb);
 361                         }
 362                     } else {
 363                         let mut mv: [MV; 4] = [ZERO_MV, ZERO_MV, ZERO_MV, ZERO_MV];
 364                         for blk_no in 0..4 {
 365                             mv[blk_no] = mvi.predict(mb_x, blk_no, true, binfo.get_mv(blk_no), sstate.first_line, sstate.first_mb);
 366                             if let Some(ref srcbuf) = self.ipbs.get_lastref() {
 367                                 bdsp.copy_blocks(&mut buf, srcbuf,
 368                                                  mb_x * 16 + (blk_no & 1) * 8,
 369                                                  mb_y * 16 + (blk_no & 2) * 4, 8, 8, mv[blk_no]);
 370                             }
 371                         }
 372                         if pinfo.is_pb() {
 373                             for blk_no in 0..4 {
 374                                 mvi2.predict(mb_x, blk_no, true, binfo.get_mv(blk_no), sstate.first_line, sstate.first_mb);
 375                             }
 376                         }
 377                         if save_b_data {
 378                             self.mv_data.push(BlockMVInfo::Inter_4MV(mv));
 379                         }
 380                     }
 381                     for i in 0..6 {
 382                         bd.decode_block_inter(&binfo, &sstate, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?;
 383                         bdsp.idct(&mut blk[i]);
 384                     }
 385                     blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk);
 386                     if is_b && !pinfo.is_pb() {
 387                         mvi2.set_zero_mv(mb_x);
 388                     }
 389                 } else if binfo.mode != Type::B {
 390                     self.mv_data.push(BlockMVInfo::Inter_1MV(ZERO_MV));
 391                     mvi.set_zero_mv(mb_x);
 392                     if is_b || pinfo.is_pb() {
 393                         mvi2.set_zero_mv(mb_x);
 394                     }
 395                     if let Some(ref srcbuf) = self.ipbs.get_lastref() {
 396                         bdsp.copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, ZERO_MV);
 397                     }
 398                 } else {
 399                     let ref_mv_info = self.mv_data[mb_pos];
 400                     let has_fwd = binfo.get_num_mvs() > 0;
 401                     let has_bwd = binfo.get_num_mvs2() > 0;
 402 //todo refactor
 403                     if has_fwd || has_bwd {
 404                         let fwd_mv;
 405                         if has_fwd {
 406                             fwd_mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb);
 407                         } else {
 408                             fwd_mv = ZERO_MV;
 409                             mvi.set_zero_mv(mb_x);
 410                         }
 411                         let bwd_mv;
 412                         if has_bwd {
 413                             bwd_mv = mvi2.predict(mb_x, 0, false, binfo.get_mv2(0), sstate.first_line, sstate.first_mb);
 414                         } else {
 415                             bwd_mv = ZERO_MV;
 416                             mvi2.set_zero_mv(mb_x);
 417                         }
 418                         if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) {
 419                             if has_fwd && has_bwd {
 420                                 bdsp.copy_blocks(&mut buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, fwd_mv);
 421                                 bdsp.avg_blocks (&mut buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, bwd_mv);
 422                             } else if has_fwd {
 423                                 bdsp.copy_blocks(&mut buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, fwd_mv);
 424                             } else {
 425                                 bdsp.copy_blocks(&mut buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, bwd_mv);
 426                             }
 427                         }
 428                     } else {
 429                         if let BlockMVInfo::Inter_4MV(mvs) = ref_mv_info {
 430                             for blk_no in 0..4 {
 431                                 let ref_mv = mvs[blk_no];
 432                                 let ref_mv_fwd = ref_mv.scale(bsdiff, tsdiff);
 433                                 let ref_mv_bwd = ref_mv - ref_mv_fwd;
 434                                 let xoff = mb_x * 16 + (blk_no & 1) * 8;
 435                                 let yoff = mb_y * 16 + (blk_no & 2) * 4;
 436                                 if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) {
 437                                     bdsp.copy_blocks(&mut buf, fwd_buf, xoff, yoff, 8, 8, ref_mv_fwd);
 438                                     bdsp.avg_blocks (&mut buf, bck_buf, xoff, yoff, 8, 8, ref_mv_bwd);
 439                                 }
 440                             }
 441                         } else {
 442                             let ref_mv = if let BlockMVInfo::Inter_1MV(mv_) = ref_mv_info { mv_ } else { ZERO_MV };
 443                             let ref_mv_fwd = ref_mv.scale(bsdiff, tsdiff);
 444                             let ref_mv_bwd = MV::b_sub(ref_mv, ref_mv_fwd, ZERO_MV, bsdiff, tsdiff);
 445
 446                             if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) {
 447                                 bdsp.copy_blocks(&mut buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, ref_mv_fwd);
 448                                 bdsp.avg_blocks (&mut buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, ref_mv_bwd);
 449                             }
 450                         }
 451                         mvi.set_zero_mv(mb_x);
 452                         mvi2.set_zero_mv(mb_x);
 453                     }
 454                     if cbp != 0 {
 455                         for i in 0..6 {
 456                             bd.decode_block_inter(&binfo, &sstate, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?;
 457                             bdsp.idct(&mut blk[i]);
 458                         }
 459                         blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk);
 460                     }
 461                 }
 462                 if pinfo.is_pb() {
 463                     let mut b_mb = BMB::new();
 464                     let cbp = binfo.get_cbp_b();
 465                     let bq = (((pinfo.get_pbinfo().get_dbquant() + 5) as u16) * (binfo.get_q() as u16)) >> 2;
 466                     let bquant;
 467                     if bq < 1 { bquant = 1; }
 468                     else if bq > 31 { bquant = 31; }
 469                     else { bquant = bq as u8; }
 470
 471                     b_mb.cbp = cbp;
 472                     for i in 0..6 {
 473                         bd.decode_block_inter(&binfo, &sstate, bquant, i, (cbp & (1 << (5 - i))) != 0, &mut b_mb.blk[i])?;
 474                         bdsp.idct(&mut b_mb.blk[i]);
 475                     }
 476
 477                     let is_fwd = binfo.is_b_fwd();
 478                     b_mb.fwd = is_fwd;
 479                     if binfo.get_num_mvs() != 4 {
 480                         let ref_mv = mvi2.get_mv(mb_x, 0);
 481                         let b_mv = if binfo.is_intra() { binfo.get_mv2(1) } else { binfo.get_mv2(0) };
 482                         let src_mv = if is_fwd { ZERO_MV } else { ref_mv.scale(bsdiff, tsdiff) };
 483                         let mv_f = MV::add_umv(src_mv, b_mv, pinfo.get_mvmode());
 484                         let mv_b = MV::b_sub(ref_mv, mv_f, b_mv, bsdiff, tsdiff);
 485                         b_mb.mv_f[0] = mv_f;
 486                         b_mb.mv_b[0] = mv_b;
 487                         b_mb.num_mv = 1;
 488                     } else {
 489                         for blk_no in 0..4 {
 490                             let src_mv = if is_fwd { ZERO_MV } else { mvi2.get_mv(mb_x, blk_no).scale(bsdiff, tsdiff) };
 491                             let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_mvmode());
 492                             let mv_b = MV::b_sub(mvi2.get_mv(mb_x, blk_no), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
 493                             b_mb.mv_f[blk_no] = mv_f;
 494                             b_mb.mv_b[blk_no] = mv_b;
 495                         }
 496                         b_mb.num_mv = 4;
 497                     }
 498                     self.b_data.push(b_mb);
 499                 }
 500                 sstate.next_mb();
 501                 mb_pos += 1;
 502             }
 503             if let Some(plusinfo) = pinfo.plusinfo {
 504                 if plusinfo.deblock {
 505                     bdsp.filter_row(&mut buf, mb_y, self.mb_w, &cbpi);
 506                 }
 507             }
 508             mvi.update_row();
 509             if is_b || pinfo.is_pb() {
 510                 mvi2.update_row();
 511             }
 512             cbpi.update_row();
 513             sstate.new_row();
 514         }
 515
 516         if pinfo.mode.is_ref() {
 517             self.ipbs.add_frame(buf);
 518             self.next_ts = self.last_ts;
 519             self.last_ts = pinfo.ts;
 520             self.tsdiff  = tsdiff;
 521         }
 522
 523         Ok(bufinfo)
 524     }
 525
 526     pub fn get_bframe(&mut self, bdsp: &BlockDSP) -> DecoderResult<NABufferType> {
 527         if !self.has_b || !self.ipbs.get_lastref().is_some() || !self.ipbs.get_nextref().is_some() {
 528             return Err(DecoderError::MissingReference);
 529         }
 530         self.has_b = false;
 531
 532         let fmt = formats::YUV420_FORMAT;
 533         let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
 534         let bufret = alloc_video_buffer(vinfo, 4);
 535         if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
 536         let mut bufinfo = bufret.unwrap();
 537         let mut b_buf = bufinfo.get_vbuf().unwrap();
 538
 539         if let (Some(ref bck_buf), Some(ref fwd_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) {
 540             recon_b_frame(&mut b_buf, fwd_buf, bck_buf, self.mb_w, self.mb_h, &self.b_data, bdsp);
 541         }
 542
 543         self.b_data.truncate(0);
 544         Ok(bufinfo)
 545     }
 546 }
 547
 548 fn recon_b_frame(b_buf: &mut NAVideoBuffer<u8>, bck_buf: &NAVideoBuffer<u8>, fwd_buf: &NAVideoBuffer<u8>,
 549                  mb_w: usize, mb_h: usize, b_data: &Vec<BMB>, bdsp: &BlockDSP) {
 550     let mut cbpi = CBPInfo::new();
 551     let mut cur_mb = 0;
 552     cbpi.reset(mb_w);
 553     for mb_y in 0..mb_h {
 554         for mb_x in 0..mb_w {
 555             let num_mv = b_data[cur_mb].num_mv;
 556             let is_fwd = b_data[cur_mb].fwd;
 557             let cbp    = b_data[cur_mb].cbp;
 558             cbpi.set_cbp(mb_x, cbp);
 559             if num_mv == 1 {
 560                 bdsp.copy_blocks(b_buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_b[0]);
 561                 if !is_fwd {
 562                     bdsp.avg_blocks(b_buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_f[0]);
 563                 }
 564             } else {
 565                 for blk_no in 0..4 {
 566                     let xpos = mb_x * 16 + (blk_no & 1) * 8;
 567                     let ypos = mb_y * 16 + (blk_no & 2) * 4;
 568                     bdsp.copy_blocks(b_buf, fwd_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_b[blk_no]);
 569                     if !is_fwd {
 570                         bdsp.avg_blocks(b_buf, bck_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_f[blk_no]);
 571                     }
 572                 }
 573             }
 574             if cbp != 0 {
 575                 blockdsp::add_blocks(b_buf, mb_x, mb_y, &b_data[cur_mb].blk);
 576             }
 577             cur_mb += 1;
 578         }
 579         cbpi.update_row();
 580     }
 581 }