[nihav.git] / nihav-codec-support / src / codecs / h263 / decoder.rs

//use std::mem;
use nihav_core::codecs::DecoderError;
use nihav_core::frame::*;
use super::super::*;
use super::super::blockdsp;
use super::*;
//use super::code::*;
use nihav_core::formats;

#[allow(dead_code)]
struct MVInfo {
    mv:         Vec<MV>,
    mb_w:       usize,
    mb_stride:  usize,
    mb_start:   usize,
    top:        bool,
    mvmode:     MVMode,
}

impl MVInfo {
    fn new() -> Self { MVInfo{ mv: Vec::new(), mb_w: 0, mb_stride: 0, mb_start: 0, top: true, mvmode: MVMode::Old } }
    fn reset(&mut self, mb_w: usize, mb_start: usize, mvmode: MVMode) {
        self.mb_start  = mb_start;
        self.mb_w      = mb_w;
        self.mb_stride = mb_w * 2 + 2;
        self.mv.resize(self.mb_stride * 3, ZERO_MV);
        self.mvmode    = mvmode;
    }
    fn update_row(&mut self) {
        self.mb_start = self.mb_w + 1;
        self.top      = false;
        for i in 0..self.mb_stride {
            self.mv[i] = self.mv[self.mb_stride * 2 + i];
        }
    }
    #[allow(non_snake_case)]
    fn predict(&mut self, mb_x: usize, blk_no: usize, use4: bool, diff: MV, first_line: bool, first_mb: bool) -> MV {
        let A;
        let B;
        let C;
        let last = mb_x == self.mb_w - 1;
        match blk_no {
            0 => {
                    if mb_x != self.mb_start {
                        A = if !first_mb   { self.mv[self.mb_stride + mb_x * 2 - 1] } else { ZERO_MV };
                        B = if !first_line { self.mv[                 mb_x * 2] } else { A };
                        C = if !first_line && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV };
                    } else {
                        A = ZERO_MV; B = ZERO_MV; C = ZERO_MV;
                    }
                },
            1 => {
                    A = self.mv[self.mb_stride + mb_x * 2];
                    B = if !first_line { self.mv[mb_x * 2 + 1] } else { A };
                    C = if !first_line && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV/*A*/ };
                },
            2 => {
                    A = if mb_x != self.mb_start { self.mv[self.mb_stride * 2 + mb_x * 2 - 1] } else { ZERO_MV };
                    B = self.mv[self.mb_stride + mb_x * 2];
                    C = self.mv[self.mb_stride + mb_x * 2 + 1];
                },
            3 => {
                    A = self.mv[self.mb_stride * 2 + mb_x * 2];
                    B = self.mv[self.mb_stride * 1 + mb_x * 2 + 1];
                    C = self.mv[self.mb_stride * 1 + mb_x * 2];
                },
            _ => { return ZERO_MV; }
        }
        let pred_mv = MV::pred(A, B, C);
        let new_mv = MV::add_umv(pred_mv, diff, self.mvmode);
        if !use4 {
            self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv;
            self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv;
            self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv;
            self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv;
        } else {
            match blk_no {
                0 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv; },
                1 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv; },
                2 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv; },
                3 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv; },
                _ => {},
            };
        }

        new_mv
    }
    fn set_zero_mv(&mut self, mb_x: usize) {
        self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = ZERO_MV;
        self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = ZERO_MV;
        self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = ZERO_MV;
        self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = ZERO_MV;
    }
    fn get_mv(&self, mb_x: usize, blk_no: usize) -> MV {
        self.mv[self.mb_stride + mb_x * 2 + (blk_no & 1) + (blk_no >> 1) * self.mb_stride]
    }
}

#[allow(dead_code)]
#[derive(Clone,Copy)]
struct BMB {
    num_mv: usize,
    mv_f:   [MV; 4],
    mv_b:   [MV; 4],
    fwd:    bool,
    blk:    [[i16; 64]; 6],
    cbp:    u8,
}

impl BMB {
    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} }
}

#[derive(Clone,Copy)]
struct PredCoeffs {
    hor: [[i16; 8]; 6],
    ver: [[i16; 8]; 6],
}

const ZERO_PRED_COEFFS: PredCoeffs = PredCoeffs { hor: [[0; 8]; 6], ver: [[0; 8]; 6] };

pub struct H263BaseDecoder {
    w:          usize,
    h:          usize,
    mb_w:       usize,
    mb_h:       usize,
    num_mb:     usize,
    ftype:      Type,
    ipbs:       IPBShuffler,
    next_ts:    u16,
    last_ts:    u16,
    tsdiff:     u16,
    has_b:      bool,
    b_data:     Vec<BMB>,
    pred_coeffs: Vec<PredCoeffs>,
    is_gob:     bool,
    slice_reset: bool,
    may_have_b_frames: bool,
    mv_data:    Vec<BlockMVInfo>,
}

#[inline]
fn clip_dc(dc: i16) -> i16 {
    if dc <= 0 { 0 }
    else if dc > 2046 { 2047 }
    else { dc | 1 }
}

#[inline]
fn clip_ac(ac: i16) -> i16 {
    if ac < -2048 { -2048 }
    else if ac > 2047 { 2047 }
    else { ac }
}

#[allow(dead_code)]
impl H263BaseDecoder {
    pub fn new_with_opts(is_gob: bool, slice_reset: bool, may_have_b_frames: bool) -> Self {
        H263BaseDecoder{
            w: 0, h: 0, mb_w: 0, mb_h: 0, num_mb: 0,
            ftype: Type::Special,
            ipbs: IPBShuffler::new(),
            last_ts: 0, next_ts: 0, tsdiff: 0,
            has_b: false, b_data: Vec::new(),
            pred_coeffs: Vec::new(),
            is_gob, slice_reset,
            may_have_b_frames,
            mv_data: Vec::new(),
        }
    }
    pub fn new(is_gob: bool) -> Self {
        Self::new_with_opts(is_gob, true, false)
    }
    pub fn new_b_frames(is_gob: bool) -> Self {
        Self::new_with_opts(is_gob, true, true)
    }

    pub fn is_intra(&self) -> bool { self.ftype == Type::I }
    pub fn get_frame_type(&self) -> FrameType {
        match self.ftype {
            Type::I       => FrameType::I,
            Type::P       => FrameType::P,
            Type::B       => FrameType::B,
            Type::PB      => FrameType::P,
            Type::Skip    => FrameType::Skip,
            Type::Special => FrameType::Skip,
        }
    }
    pub fn get_dimensions(&self) -> (usize, usize) { (self.w, self.h) }

    pub fn parse_frame(&mut self, bd: &mut BlockDecoder, bdsp: &BlockDSP) -> DecoderResult<NABufferType> {
        let pinfo = bd.decode_pichdr()?;
        let mut mvi = MVInfo::new();
        let mut mvi2 = MVInfo::new();
        let mut cbpi = CBPInfo::new();

//todo handle res change
        self.w = pinfo.w;
        self.h = pinfo.h;
        self.mb_w = (pinfo.w + 15) >> 4;
        self.mb_h = (pinfo.h + 15) >> 4;
        self.num_mb = self.mb_w * self.mb_h;
        self.ftype = pinfo.mode;
        self.has_b = pinfo.is_pb();

        if self.has_b {
            self.mv_data.truncate(0);
        }

        let save_b_data = pinfo.mode.is_ref() && self.may_have_b_frames;
        if save_b_data {
            self.mv_data.truncate(0);
        }
        let is_b = pinfo.mode == Type::B;

        let tsdiff = if pinfo.is_pb() { pinfo.ts.wrapping_sub(self.last_ts) >> 1 }
                     else { self.last_ts.wrapping_sub(self.next_ts) >> 1 };
        let bsdiff = if pinfo.is_pb() { (pinfo.get_pbinfo().get_trb() as u16) << 7 }
                     else { pinfo.ts.wrapping_sub(self.next_ts) >> 1 };

        let fmt = formats::YUV420_FORMAT;
        let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
        let bufinfo = alloc_video_buffer(vinfo, 4)?;
        let mut buf = bufinfo.get_vbuf().unwrap();

        let mut slice = if self.is_gob {
                SliceInfo::get_default_slice(&pinfo)
            } else {
                bd.decode_slice_header(&pinfo)?
            };
        mvi.reset(self.mb_w, 0, pinfo.get_mvmode());
        if is_b || pinfo.is_pb() {
            mvi2.reset(self.mb_w, 0, pinfo.get_mvmode());
        }
        cbpi.reset(self.mb_w);

        let mut blk: [[i16; 64]; 6] = [[0; 64]; 6];
        let mut sstate = SliceState::new(pinfo.mode == Type::I);
        let mut mb_pos = 0;
        let apply_acpred = (pinfo.mode == Type::I) && pinfo.plusinfo.is_some() && pinfo.plusinfo.unwrap().aic;
        if apply_acpred {
            self.pred_coeffs.truncate(0);
            self.pred_coeffs.resize(self.mb_w * self.mb_h, ZERO_PRED_COEFFS);
        }
        sstate.quant = slice.quant;
        for mb_y in 0..self.mb_h {
            for mb_x in 0..self.mb_w {
                for i in 0..6 { for j in 0..64 { blk[i][j] = 0; } }

                if slice.is_at_end(mb_pos) || (slice.needs_check() && mb_pos > 0 && bd.is_slice_end()) {
                    slice = bd.decode_slice_header(&pinfo)?;
                    if !self.is_gob && self.slice_reset {
                        mvi.reset(self.mb_w, mb_x, pinfo.get_mvmode());
                        if is_b || pinfo.is_pb() {
                            mvi2.reset(self.mb_w, mb_x, pinfo.get_mvmode());
                        }
                        cbpi.reset(self.mb_w);
                        sstate.reset_slice(mb_x, mb_y);
                        sstate.quant = slice.quant;
                    }
                }

                let binfo = bd.decode_block_header(&pinfo, &slice, &sstate)?;
                let cbp = binfo.get_cbp();
                cbpi.set_cbp(mb_x, cbp);
                cbpi.set_q(mb_x, binfo.get_q());
                sstate.quant = binfo.get_q();
                if binfo.is_intra() {
                    if save_b_data {
                        self.mv_data.push(BlockMVInfo::Intra);
                    }
                    for i in 0..6 {
                        bd.decode_block_intra(&binfo, &sstate, binfo.get_q(), i, (cbp & (1 << (5 - i))) != 0, &mut blk[i])?;
                        if apply_acpred && (binfo.acpred != ACPredMode::None) {
                            let has_b = (i == 1) || (i == 3) || !sstate.first_mb;
                            let has_a = (i == 2) || (i == 3) || !sstate.first_line;
                            let (b_mb, b_blk) = if has_b {
                                    if (i == 1) || (i == 3) {
                                        (mb_pos, i - 1)
                                    } else if i < 4 {
                                        (mb_pos - 1, i + 1)
                                    } else {
                                        (mb_pos - 1, i)
                                    }
                                } else { (0, 0) };
                            let (a_mb, a_blk) = if has_a {
                                    if (i == 2) || (i == 3) {
                                        (mb_pos, i - 2)
                                    } else if i < 4 {
                                        (mb_pos - self.mb_w, i + 2)
                                    } else {
                                        (mb_pos - self.mb_w, i)
                                    }
                                } else { (0, 0) };
                            match binfo.acpred {
                                ACPredMode::DC   => {
                                            let dc;
                                            if has_a && has_b {
                                                dc = (self.pred_coeffs[b_mb].hor[b_blk][0] + self.pred_coeffs[a_mb].ver[a_blk][0]) / 2;
                                            } else if has_a {
                                                dc = self.pred_coeffs[a_mb].ver[a_blk][0];
                                            } else if has_b {
                                                dc = self.pred_coeffs[b_mb].hor[b_blk][0];
                                            } else {
                                                dc = 1024;
                                            }
                                            blk[i][0] = clip_dc(blk[i][0] + dc);
                                        },
                                ACPredMode::Hor  => {
                                        if has_b {
                                            for k in 0..8 {
                                                blk[i][k * 8] += self.pred_coeffs[b_mb].hor[b_blk][k];
                                            }
                                            for k in 1..8 {
                                                blk[i][k * 8] = clip_ac(blk[i][k * 8]);
                                            }
                                        } else {
                                            blk[i][0] += 1024;
                                        }
                                        blk[i][0] = clip_dc(blk[i][0]);
                                    },
                                ACPredMode::Ver  => {
                                        if has_a {
                                            for k in 0..8 {
                                                blk[i][k] += self.pred_coeffs[a_mb].ver[a_blk][k];
                                            }
                                            for k in 1..8 {
                                                blk[i][k] = clip_ac(blk[i][k]);
                                            }
                                        } else {
                                            blk[i][0] += 1024;
                                        }
                                        blk[i][0] = clip_dc(blk[i][0]);
                                    },
                                ACPredMode::None => {},
                            };
                            for t in 0..8 { self.pred_coeffs[mb_pos].hor[i][t] = blk[i][t * 8]; }
                            for t in 0..8 { self.pred_coeffs[mb_pos].ver[i][t] = blk[i][t]; }
                        }
                        bdsp.idct(&mut blk[i]);
                    }
                    blockdsp::put_blocks(&mut buf, mb_x, mb_y, &blk);
                    mvi.set_zero_mv(mb_x);
                    if is_b {
                        mvi2.set_zero_mv(mb_x);
                    } else if pinfo.is_pb() {
                        mvi2.predict(mb_x, 0, false, binfo.get_mv2(0), sstate.first_line, sstate.first_mb);
                    }
                } else if (binfo.mode != Type::B) && !binfo.is_skipped() {
                    if binfo.get_num_mvs() == 1 {
                        let mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb);
                        if save_b_data {
                            self.mv_data.push(BlockMVInfo::Inter_1MV(mv));
                        }
                        if let Some(ref srcbuf) = self.ipbs.get_lastref() {
                            bdsp.copy_blocks(&mut buf, srcbuf.clone(), mb_x * 16, mb_y * 16, mv);
                        }
                        if pinfo.is_pb() {
                            mvi2.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb);
                        }
                    } else {
                        let mut mv: [MV; 4] = [ZERO_MV, ZERO_MV, ZERO_MV, ZERO_MV];
                        for blk_no in 0..4 {
                            mv[blk_no] = mvi.predict(mb_x, blk_no, true, binfo.get_mv(blk_no), sstate.first_line, sstate.first_mb);
                        }
                        if let Some(ref srcbuf) = self.ipbs.get_lastref() {
                            bdsp.copy_blocks8x8(&mut buf, srcbuf.clone(), mb_x * 16, mb_y * 16, &mv);
                        }
                        if pinfo.is_pb() {
                            for blk_no in 0..4 {
                                mvi2.predict(mb_x, blk_no, true, binfo.get_mv(blk_no), sstate.first_line, sstate.first_mb);
                            }
                        }
                        if save_b_data {
                            self.mv_data.push(BlockMVInfo::Inter_4MV(mv));
                        }
                    }
                    for i in 0..6 {
                        bd.decode_block_inter(&binfo, &sstate, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?;
                        bdsp.idct(&mut blk[i]);
                    }
                    blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk);
                    if is_b && !pinfo.is_pb() {
                        mvi2.set_zero_mv(mb_x);
                    }
                } else if binfo.mode != Type::B {
                    self.mv_data.push(BlockMVInfo::Inter_1MV(ZERO_MV));
                    mvi.set_zero_mv(mb_x);
                    if is_b || pinfo.is_pb() {
                        mvi2.set_zero_mv(mb_x);
                    }
                    if let Some(ref srcbuf) = self.ipbs.get_lastref() {
                        bdsp.copy_blocks(&mut buf, srcbuf.clone(), mb_x * 16, mb_y * 16, ZERO_MV);
                    }
                } else {
                    let ref_mv_info = self.mv_data[mb_pos];
                    let has_fwd = binfo.get_num_mvs() > 0;
                    let has_bwd = binfo.get_num_mvs2() > 0;
//todo refactor
                    if has_fwd || has_bwd {
                        let fwd_mv;
                        if has_fwd {
                            fwd_mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb);
                        } else {
                            fwd_mv = ZERO_MV;
                            mvi.set_zero_mv(mb_x);
                        }
                        let bwd_mv;
                        if has_bwd {
                            bwd_mv = mvi2.predict(mb_x, 0, false, binfo.get_mv2(0), sstate.first_line, sstate.first_mb);
                        } else {
                            bwd_mv = ZERO_MV;
                            mvi2.set_zero_mv(mb_x);
                        }
                        if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) {
                            if has_fwd && has_bwd {
                                bdsp.copy_blocks(&mut buf, fwd_buf.clone(), mb_x * 16, mb_y * 16, fwd_mv);
                                bdsp.avg_blocks (&mut buf, bck_buf.clone(), mb_x * 16, mb_y * 16, bwd_mv);
                            } else if has_fwd {
                                bdsp.copy_blocks(&mut buf, fwd_buf.clone(), mb_x * 16, mb_y * 16, fwd_mv);
                            } else {
                                bdsp.copy_blocks(&mut buf, bck_buf.clone(), mb_x * 16, mb_y * 16, bwd_mv);
                            }
                        }
                    } else {
                        if let BlockMVInfo::Inter_4MV(mvs) = ref_mv_info {
                            let mut mv_f = [ZERO_MV; 4];
                            let mut mv_b = [ZERO_MV; 4];
                            for blk_no in 0..4 {
                                let ref_mv = mvs[blk_no];
                                let ref_mv_fwd = ref_mv.scale(bsdiff, tsdiff);
                                let ref_mv_bwd = ref_mv - ref_mv_fwd;
                                mv_f[blk_no] = ref_mv_fwd;
                                mv_b[blk_no] = ref_mv_bwd;
                            }
                            if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) {
                                bdsp.copy_blocks8x8(&mut buf, fwd_buf.clone(), mb_x * 16, mb_y * 16, &mv_f);
                                bdsp.avg_blocks8x8 (&mut buf, bck_buf.clone(), mb_x * 16, mb_y * 16, &mv_b);
                            }
                        } else {
                            let ref_mv = if let BlockMVInfo::Inter_1MV(mv_) = ref_mv_info { mv_ } else { ZERO_MV };
                            let ref_mv_fwd = ref_mv.scale(bsdiff, tsdiff);
                            let ref_mv_bwd = MV::b_sub(ref_mv, ref_mv_fwd, ZERO_MV, bsdiff, tsdiff);

                            if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) {
                                bdsp.copy_blocks(&mut buf, fwd_buf.clone(), mb_x * 16, mb_y * 16, ref_mv_fwd);
                                bdsp.avg_blocks (&mut buf, bck_buf.clone(), mb_x * 16, mb_y * 16, ref_mv_bwd);
                            }
                        }
                        mvi.set_zero_mv(mb_x);
                        mvi2.set_zero_mv(mb_x);
                    }
                    if cbp != 0 {
                        for i in 0..6 {
                            bd.decode_block_inter(&binfo, &sstate, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?;
                            bdsp.idct(&mut blk[i]);
                        }
                        blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk);
                    }
                }
                if pinfo.is_pb() {
                    let mut b_mb = BMB::new();
                    let cbp = binfo.get_cbp_b();
                    let bq = (((pinfo.get_pbinfo().get_dbquant() + 5) as u16) * (binfo.get_q() as u16)) >> 2;
                    let bquant;
                    if bq < 1 { bquant = 1; }
                    else if bq > 31 { bquant = 31; }
                    else { bquant = bq as u8; }

                    b_mb.cbp = cbp;
                    for i in 0..6 {
                        bd.decode_block_inter(&binfo, &sstate, bquant, i, (cbp & (1 << (5 - i))) != 0, &mut b_mb.blk[i])?;
                        bdsp.idct(&mut b_mb.blk[i]);
                    }

                    let is_fwd = binfo.is_b_fwd();
                    b_mb.fwd = is_fwd;
                    if binfo.get_num_mvs() != 4 {
                        let ref_mv = mvi2.get_mv(mb_x, 0);
                        let b_mv = if binfo.is_intra() { binfo.get_mv2(1) } else { binfo.get_mv2(0) };
                        let src_mv = if is_fwd { ZERO_MV } else { ref_mv.scale(bsdiff, tsdiff) };
                        let mv_f = MV::add_umv(src_mv, b_mv, pinfo.get_mvmode());
                        let mv_b = MV::b_sub(ref_mv, mv_f, b_mv, bsdiff, tsdiff);
                        b_mb.mv_f[0] = mv_f;
                        b_mb.mv_b[0] = mv_b;
                        b_mb.num_mv = 1;
                    } else {
                        for blk_no in 0..4 {
                            let src_mv = if is_fwd { ZERO_MV } else { mvi2.get_mv(mb_x, blk_no).scale(bsdiff, tsdiff) };
                            let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_mvmode());
                            let mv_b = MV::b_sub(mvi2.get_mv(mb_x, blk_no), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
                            b_mb.mv_f[blk_no] = mv_f;
                            b_mb.mv_b[blk_no] = mv_b;
                        }
                        b_mb.num_mv = 4;
                    }
                    self.b_data.push(b_mb);
                }
                sstate.next_mb();
                mb_pos += 1;
            }
            if let Some(plusinfo) = pinfo.plusinfo {
                if plusinfo.deblock {
                    bdsp.filter_row(&mut buf, mb_y, self.mb_w, &cbpi);
                }
            }
            mvi.update_row();
            if is_b || pinfo.is_pb() {
                mvi2.update_row();
            }
            cbpi.update_row();
            sstate.new_row();
        }

        if pinfo.mode.is_ref() {
            self.ipbs.add_frame(buf);
            self.next_ts = self.last_ts;
            self.last_ts = pinfo.ts;
            self.tsdiff  = tsdiff;
        }

        Ok(bufinfo)
    }
    pub fn flush(&mut self) {
        self.ipbs.clear();
    }

    pub fn get_bframe(&mut self, bdsp: &BlockDSP) -> DecoderResult<NABufferType> {
        if !self.has_b || self.ipbs.get_lastref().is_none() || self.ipbs.get_nextref().is_none() {
            return Err(DecoderError::MissingReference);
        }
        self.has_b = false;

        let fmt = formats::YUV420_FORMAT;
        let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
        let bufinfo = alloc_video_buffer(vinfo, 4)?;
        let b_buf = bufinfo.get_vbuf().unwrap();

        if let (Some(ref bck_buf), Some(ref fwd_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) {
            recon_b_frame(b_buf, fwd_buf.clone(), bck_buf.clone(), self.mb_w, self.mb_h, self.b_data.as_slice(), bdsp);
        }

        self.b_data.truncate(0);
        Ok(bufinfo)
    }
}

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