[nihav.git] / src / codecs / blockdec.rs

use std::mem;
use std::ops::{Add, Sub};
use super::*;
use super::blockdsp;
use super::h263code::*;
use formats;

#[derive(Debug,Clone,Copy,PartialEq)]
pub enum Type {
    I, P, Skip, Special
}

#[allow(dead_code)]
#[derive(Debug,Clone,Copy)]
pub struct PBInfo {
    trb:        u8,
    dbquant:    u8,
}

impl PBInfo {
    pub fn new(trb: u8, dbquant: u8) -> Self {
        PBInfo{ trb: trb, dbquant: dbquant }
    }
    pub fn get_trb(&self) -> u8 { self.trb }
    pub fn get_dbquant(&self) -> u8 { self.dbquant }
}

#[allow(dead_code)]
#[derive(Debug,Clone,Copy)]
pub struct PicInfo {
    w:      usize,
    h:      usize,
    mode:   Type,
    quant:  u8,
    apm:    bool,
    umv:    bool,
    pb:     Option<PBInfo>,
    ts:     u8,
    deblock: bool,
}

#[allow(dead_code)]
impl PicInfo {
    pub fn new(w: usize, h: usize, mode: Type, quant: u8, apm: bool, umv: bool, ts: u8, pb: Option<PBInfo>, deblock: bool) -> Self {
        PicInfo{ w: w, h: h, mode: mode, quant: quant, apm: apm, umv: umv, ts: ts, pb: pb, deblock: deblock }
    }
    pub fn get_width(&self) -> usize { self.w }
    pub fn get_height(&self) -> usize { self.h }
    pub fn get_mode(&self) -> Type { self.mode }
    pub fn get_quant(&self) -> u8 { self.quant }
    pub fn get_apm(&self) -> bool { self.apm }
    pub fn get_umv(&self) -> bool { self.umv }
    pub fn is_pb(&self) -> bool { self.pb.is_some() }
    pub fn get_ts(&self) -> u8 { self.ts }
    pub fn get_pbinfo(&self) -> PBInfo { self.pb.unwrap() }
}

#[derive(Debug,Clone,Copy)]
pub struct Slice {
    mb_x:   usize,
    mb_y:   usize,
    quant:  u8,
}

impl Slice {
    pub fn new(mb_x: usize, mb_y: usize, quant: u8) -> Self {
        Slice{ mb_x: mb_x, mb_y: mb_y, quant: quant }
    }
    pub fn get_default_slice(pinfo: &PicInfo) -> Self {
        Slice{ mb_x: 0, mb_y: 0, quant: pinfo.get_quant() }
    }
    pub fn get_quant(&self) -> u8 { self.quant }
}

#[derive(Debug,Clone,Copy)]
pub struct MV {
    x: i16,
    y: i16,
}

impl MV {
    pub fn new(x: i16, y: i16) -> Self { MV{ x: x, y: y } }
    pub fn pred(a: MV, b: MV, c: MV) -> Self {
        let x;
        if a.x < b.x {
            if b.x < c.x {
                x = b.x;
            } else {
                if a.x < c.x { x = c.x; } else { x = a.x; }
            }
        } else {
            if b.x < c.x {
                if a.x < c.x { x = a.x; } else { x = c.x; }
            } else {
                x = b.x;
            }
        }
        let y;
        if a.y < b.y {
            if b.y < c.y {
                y = b.y;
            } else {
                if a.y < c.y { y = c.y; } else { y = a.y; }
            }
        } else {
            if b.y < c.y {
                if a.y < c.y { y = a.y; } else { y = c.y; }
            } else {
                y = b.y;
            }
        }
        MV { x: x, y: y }
    }
    fn add_umv(pred_mv: MV, add: MV, umv: bool) -> Self {
        let mut new_mv = pred_mv + add;
        if umv {
            if pred_mv.x >  32 && new_mv.x >  63 { new_mv.x -= 64; }
            if pred_mv.x < -31 && new_mv.x < -63 { new_mv.x += 64; }
            if pred_mv.y >  32 && new_mv.y >  63 { new_mv.y -= 64; }
            if pred_mv.y < -31 && new_mv.y < -63 { new_mv.y += 64; }
        } else {
            if      new_mv.x >  31 { new_mv.x -= 64; }
            else if new_mv.x < -32 { new_mv.x += 64; }
            if      new_mv.y >  31 { new_mv.y -= 64; }
            else if new_mv.y < -32 { new_mv.y += 64; }
        }
        new_mv
    }
    fn scale(&self, trb: u8, trd: u8) -> Self {
        if (trd == 0) || (trb == 0) {
            ZERO_MV
        } else {
            MV { x: (self.x * (trb as i16)) / (trd as i16), y: (self.y * (trb as i16)) / (trd as i16) }
        }
    }
    fn b_sub(pvec: MV, fwdvec: MV, bvec: MV, trb: u8, trd: u8) -> Self {
        let bscale = (trb as i16) - (trd as i16);
        let x = if bvec.x != 0 { fwdvec.x - pvec.x } else if trd != 0 { bscale * pvec.x / (trd as i16) } else { 0 };
        let y = if bvec.y != 0 { fwdvec.y - pvec.y } else if trd != 0 { bscale * pvec.y / (trd as i16) } else { 0 };
        MV { x: x, y: y }
    }
}

pub const ZERO_MV: MV = MV { x: 0, y: 0 };

impl Add for MV {
    type Output = MV;
    fn add(self, other: MV) -> MV { MV { x: self.x + other.x, y: self.y + other.y } }
}

impl Sub for MV {
    type Output = MV;
    fn sub(self, other: MV) -> MV { MV { x: self.x - other.x, y: self.y - other.y } }
}

#[derive(Debug,Clone,Copy)]
pub struct BlockInfo {
    intra:   bool,
    skip:    bool,
    mode:    Type,
    cbp:     u8,
    q:       u8,
    mv:      [MV; 4],
    num_mv:  usize,
    bpart:   bool,
    b_cbp:   u8,
    mv2:     [MV; 2],
    num_mv2: usize,
    fwd:     bool,
}

#[allow(dead_code)]
#[derive(Debug,Clone,Copy)]
pub struct BBlockInfo {
    present: bool,
    cbp:     u8,
    num_mv:  usize,
    fwd:     bool,
}

#[allow(dead_code)]
impl BlockInfo {
    pub fn new(mode: Type, cbp: u8, q: u8) -> Self {
        BlockInfo {
            intra:   mode == Type::I,
            skip:    (cbp == 0) && (mode != Type::I),
            mode:    mode,
            cbp:     cbp,
            q:       q,
            mv:      [MV::new(0, 0), MV::new(0, 0), MV::new(0, 0), MV::new(0, 0)],
            num_mv:  0,
            bpart:   false,
            b_cbp:   0,
            mv2:     [ZERO_MV, ZERO_MV],
            num_mv2: 0,
            fwd:     false,
        }
    }
    pub fn is_intra(&self) -> bool { self.intra }
    pub fn is_skipped(&self) -> bool { self.skip }
    pub fn get_mode(&self) -> Type { self.mode }
    pub fn get_cbp(&self) -> u8 { self.cbp }
    pub fn get_q(&self) -> u8 { self.q }
    pub fn get_num_mvs(&self) -> usize { self.num_mv }
    pub fn get_mv(&self, idx: usize) -> MV { self.mv[idx] }
    pub fn has_b_part(&self) -> bool { self.bpart }
    pub fn get_cbp_b(&self) -> u8 { self.b_cbp }
    pub fn get_num_mvs2(&self) -> usize { self.num_mv2 }
    pub fn get_mv2(&self, idx: usize) -> MV { self.mv2[idx] }
    pub fn set_mv(&mut self, mvs: &[MV]) {
        if mvs.len() > 0 { self.skip = false; }
        let mut mv_arr: [MV; 4] = [MV::new(0, 0), MV::new(0, 0), MV::new(0, 0), MV::new(0, 0)];
        for i in 0..mvs.len() { mv_arr[i] = mvs[i]; }
        self.mv     = mv_arr;
        self.num_mv = mvs.len();
    }
    pub fn set_bpart(&mut self, bbinfo: BBlockInfo) {
        self.bpart = bbinfo.present;
        self.b_cbp = bbinfo.cbp;
        self.fwd   = bbinfo.fwd;
        self.num_mv2 = bbinfo.get_num_mv();
    }
    pub fn set_b_mv(&mut self, mvs: &[MV]) {
        if mvs.len() > 0 { self.skip = false; }
        let mut mv_arr: [MV; 2] = [ZERO_MV, ZERO_MV];
        for i in 0..mvs.len() { mv_arr[i] = mvs[i]; }
        self.mv2    = mv_arr;
    }
    pub fn is_b_fwd(&self) -> bool { self.fwd }
}

impl BBlockInfo {
    pub fn new(present: bool, cbp: u8, num_mv: usize, fwd: bool) -> Self {
        BBlockInfo {
            present: present,
            cbp:     cbp,
            num_mv:  num_mv,
            fwd:     fwd,
        }
    }
    pub fn get_num_mv(&self) -> usize { self.num_mv }
}

pub trait BlockDecoder {
    fn decode_pichdr(&mut self) -> DecoderResult<PicInfo>;
    fn decode_slice_header(&mut self, pinfo: &PicInfo) -> DecoderResult<Slice>;
    fn decode_block_header(&mut self, pinfo: &PicInfo, sinfo: &Slice) -> DecoderResult<BlockInfo>;
    fn decode_block_intra(&mut self, info: &BlockInfo, quant: u8, no: usize, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()>;
    fn decode_block_inter(&mut self, info: &BlockInfo, quant: u8, no: usize, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()>;
    fn is_slice_end(&mut self) -> bool;

    fn filter_row(&mut self, buf: &mut NAVideoBuffer<u8>, mb_y: usize, mb_w: usize, cbpi: &CBPInfo);
}

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

impl MVInfo {
    fn new() -> Self { MVInfo{ mv: Vec::new(), mb_w: 0, mb_stride: 0, mb_start: 0, top: true, umv: false } }
    fn reset(&mut self, mb_w: usize, mb_start: usize, umv: bool) {
        self.mb_start  = mb_start;
        self.mb_w      = mb_w;
        self.mb_stride = mb_w * 2;
        self.top       = true;
        self.mv.resize(self.mb_stride * 3, ZERO_MV);
        self.umv       = umv;
    }
    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) -> MV {
        let A;
        let B;
        let C;
        let last = mb_x == self.mb_w - 1;
//println!("  pred from {}.{} blk {}.{}/{} top {}", diff.x, diff.y, mb_x, blk_no,self.mb_start,self.top);
        match blk_no {
            0 => {
                    if mb_x != self.mb_start {
                        A = if mb_x != 0 { self.mv[self.mb_stride + mb_x * 2 - 1] } else { ZERO_MV };
                        B = if !self.top { self.mv[                 mb_x * 2] } else { A };
                        C = if !self.top && !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 !self.top { self.mv[mb_x * 2 + 1] } else { A };
                    C = if !self.top && !last { self.mv[mb_x * 2 + 2] } else { 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; }
        }
//println!("     A = {}.{}  B = {}.{}  C = {}.{}", A.x,A.y,B.x,B.y,C.x,C.y);
        let pred_mv = MV::pred(A, B, C);
        let new_mv = MV::add_umv(pred_mv, diff, self.umv);
        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;
    }
}

#[allow(dead_code)]
pub struct CBPInfo {
    cbp:        Vec<u8>,
    q:          Vec<u8>,
    mb_w:       usize,
}

impl CBPInfo {
    fn new() -> Self { CBPInfo{ cbp: Vec::new(), q: Vec::new(), mb_w: 0 } }
    fn reset(&mut self, mb_w: usize) {
        self.mb_w = mb_w;
        self.cbp.truncate(0);
        self.cbp.resize(self.mb_w * 2, 0);
        self.q.truncate(0);
        self.q.resize(self.mb_w * 2, 0);
    }
    fn update_row(&mut self) {
        for i in 0..self.mb_w {
            self.cbp[i] = self.cbp[self.mb_w + i];
            self.q[i]   = self.q[self.mb_w + i];
        }
    }
    fn set_cbp(&mut self, mb_x: usize, cbp: u8) {
        self.cbp[self.mb_w + mb_x] = cbp;
    }
    fn set_q(&mut self, mb_x: usize, q: u8) {
        self.q[self.mb_w + mb_x] = q;
    }
    pub fn get_q(&self, mb_x: usize) -> u8 { self.q[mb_x] }
    pub fn is_coded(&self, mb_x: usize, blk_no: usize) -> bool {
        (self.cbp[self.mb_w + mb_x] & (1 << (5 - blk_no))) != 0
    }
    pub fn is_coded_top(&self, mb_x: usize, blk_no: usize) -> bool {
        let cbp     = self.cbp[self.mb_w + mb_x];
        let cbp_top = self.cbp[mb_x];
        match blk_no {
            0 => { (cbp_top & 0b001000) != 0 },
            1 => { (cbp_top & 0b000100) != 0 },
            2 => { (cbp     & 0b100000) != 0 },
            3 => { (cbp     & 0b010000) != 0 },
            4 => { (cbp_top & 0b000010) != 0 },
            _ => { (cbp_top & 0b000001) != 0 },
        }
    }
}

fn copy_blocks(dst: &mut NAVideoBuffer<u8>, src: &NAVideoBuffer<u8>, xpos: usize, ypos: usize, w: usize, h: usize, mv: MV) {
    let srcx = ((mv.x >> 1) as isize) + (xpos as isize);
    let srcy = ((mv.y >> 1) as isize) + (ypos as isize);
    let mode = ((mv.x & 1) + (mv.y & 1) * 2) as usize;

    blockdsp::copy_blocks(dst, src, xpos, ypos, srcx, srcy, w, h, 0, 1, mode, H263_INTERP_FUNCS);
}

fn avg_blocks(dst: &mut NAVideoBuffer<u8>, src: &NAVideoBuffer<u8>, xpos: usize, ypos: usize, w: usize, h: usize, mv: MV) {
    let srcx = ((mv.x >> 1) as isize) + (xpos as isize);
    let srcy = ((mv.y >> 1) as isize) + (ypos as isize);
    let mode = ((mv.x & 1) + (mv.y & 1) * 2) as usize;

    blockdsp::copy_blocks(dst, src, xpos, ypos, srcx, srcy, w, h, 0, 1, mode, H263_INTERP_AVG_FUNCS);
}

#[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} }
}

pub struct DCT8x8VideoDecoder {
    w:          usize,
    h:          usize,
    mb_w:       usize,
    mb_h:       usize,
    num_mb:     usize,
    ftype:      Type,
    prev_frm:   Option<NAVideoBuffer<u8>>,
    cur_frm:    Option<NAVideoBuffer<u8>>,
    last_ts:    u8,
    has_b:      bool,
    b_data:     Vec<BMB>,
}

#[allow(dead_code)]
impl DCT8x8VideoDecoder {
    pub fn new() -> Self {
        DCT8x8VideoDecoder{
            w: 0, h: 0, mb_w: 0, mb_h: 0, num_mb: 0,
            ftype: Type::Special,
            prev_frm: None, cur_frm: None,
            last_ts: 0,
            has_b: false, b_data: Vec::new(),
        }
    }

    pub fn is_intra(&self) -> bool { self.ftype == Type::I }
    pub fn get_dimensions(&self) -> (usize, usize) { (self.w, self.h) }

    pub fn parse_frame(&mut self, bd: &mut BlockDecoder) -> DecoderResult<NABufferType> {
        let pinfo = bd.decode_pichdr()?;
        let mut mvi = 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.b_data.truncate(0);
        }

        mem::swap(&mut self.cur_frm, &mut self.prev_frm);

        let tsdiff = pinfo.ts.wrapping_sub(self.last_ts);
        let bsdiff = if pinfo.is_pb() { pinfo.get_pbinfo().get_trb() } else { 0 };

        let fmt = formats::YUV420_FORMAT;
        let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
        let bufret = alloc_video_buffer(vinfo, 4);
        if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
        let mut bufinfo = bufret.unwrap();
        let mut buf = bufinfo.get_vbuf().unwrap();

        let mut slice = Slice::get_default_slice(&pinfo);
        mvi.reset(self.mb_w, 0, pinfo.get_umv());
        cbpi.reset(self.mb_w);

        let mut blk: [[i16; 64]; 6] = [[0; 64]; 6];
        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  ((mb_x != 0) || (mb_y != 0)) && bd.is_slice_end() {
//println!("new slice @{}.{}!",mb_x,mb_y);
                    slice = bd.decode_slice_header(&pinfo)?;
                    mvi.reset(self.mb_w, mb_x, pinfo.get_umv());
                    //cbpi.reset(self.mb_w);
                }

                let binfo = bd.decode_block_header(&pinfo, &slice)?;
                let cbp = binfo.get_cbp();
//println!("mb {}.{} CBP {:X} type {:?}, {} mvs skip {}", mb_x,mb_y, cbp, binfo.get_mode(), binfo.get_num_mvs(),binfo.is_skipped());
                cbpi.set_cbp(mb_x, cbp);
                cbpi.set_q(mb_x, binfo.get_q());
                if binfo.is_intra() {
                    for i in 0..6 {
                        bd.decode_block_intra(&binfo, binfo.get_q(), i, (cbp & (1 << (5 - i))) != 0, &mut blk[i])?;
                        h263_idct(&mut blk[i]);
                    }
                    blockdsp::put_blocks(&mut buf, mb_x, mb_y, &blk);
                    mvi.set_zero_mv(mb_x);
                } else if !binfo.is_skipped() {
                    if binfo.get_num_mvs() == 1 {
                        let mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0));
//println!(" 1MV {}.{}", mv.x, mv.y);
                        if let Some(ref srcbuf) = self.prev_frm {
                            copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, mv);
                        }
                    } else {
                        for blk_no in 0..4 {
                            let mv = mvi.predict(mb_x, blk_no, true, binfo.get_mv(blk_no));
//print!(" MV {}.{}", mv.x, mv.y);
                            if let Some(ref srcbuf) = self.prev_frm {
                                copy_blocks(&mut buf, srcbuf,
                                            mb_x * 16 + (blk_no & 1) * 8,
                                            mb_y * 16 + (blk_no & 2) * 4, 8, 8, mv);
                            }
                        }
//println!("");
                    }
                    for i in 0..6 {
                        bd.decode_block_inter(&binfo, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?;
                        h263_idct(&mut blk[i]);
                    }
                    blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk);
                } else {
                    mvi.set_zero_mv(mb_x);
                    if let Some(ref srcbuf) = self.prev_frm {
                        copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, ZERO_MV);
                    }
                }
                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, bquant, i, (cbp & (1 << (5 - i))) != 0, &mut b_mb.blk[i])?;
                        h263_idct(&mut b_mb.blk[i]);
                    }

                    let is_fwd = binfo.is_b_fwd();
                    b_mb.fwd = is_fwd;
                    b_mb.num_mv = binfo.get_num_mvs();
                    if binfo.get_num_mvs() == 0 {
                        b_mb.num_mv = 1;
                        b_mb.mv_f[0] = binfo.get_mv2(1);
                        b_mb.mv_b[0] = binfo.get_mv2(0);
                    } if binfo.get_num_mvs() == 1 {
                        let src_mv = if is_fwd { ZERO_MV } else { binfo.get_mv(0).scale(bsdiff, tsdiff) };
                        let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_umv());
                        let mv_b = MV::b_sub(binfo.get_mv(0), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
                        b_mb.mv_f[0] = mv_f;
                        b_mb.mv_b[0] = mv_b;
                    } else {
                        for blk_no in 0..4 {
                            let src_mv = if is_fwd { ZERO_MV } else { binfo.get_mv(blk_no).scale(bsdiff, tsdiff) };
                            let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_umv());
                            let mv_b = MV::b_sub(binfo.get_mv(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;
                        }
                    }
                    self.b_data.push(b_mb);
                }
            }
            if pinfo.deblock {
                bd.filter_row(&mut buf, mb_y, self.mb_w, &cbpi);
            }
            mvi.update_row();
            cbpi.update_row();
        }
        
        self.cur_frm = Some(buf);
        self.last_ts = pinfo.ts;
//println!("unpacked all");
        Ok(bufinfo)
    }

    pub fn get_bframe(&mut self) -> DecoderResult<NABufferType> {
        if !self.has_b || !self.cur_frm.is_some() || !self.prev_frm.is_some() {
            return Err(DecoderError::MissingReference);
        }
        self.has_b = false;

        let fmt = formats::YUV420_FORMAT;
        let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
        let bufret = alloc_video_buffer(vinfo, 4);
        if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
        let mut bufinfo = bufret.unwrap();
        let mut b_buf = bufinfo.get_vbuf().unwrap();

        if let Some(ref bck_buf) = self.prev_frm {
            if let Some(ref fwd_buf) = self.cur_frm {
                recon_b_frame(&mut b_buf, bck_buf, fwd_buf, self.mb_w, self.mb_h, &self.b_data);
            }
        }

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

fn recon_b_frame(b_buf: &mut NAVideoBuffer<u8>, bck_buf: &NAVideoBuffer<u8>, fwd_buf: &NAVideoBuffer<u8>,
                 mb_w: usize, mb_h: usize, b_data: &Vec<BMB>) {
    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 {
                copy_blocks(b_buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_f[0]);
                if !is_fwd {
                    avg_blocks(b_buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_b[0]);
                }
            } else {
                for blk_no in 0..4 {
                    let xpos = mb_x * 16 + (blk_no & 1) * 8;
                    let ypos = mb_y * 16 + (blk_no & 2) * 4;
                    copy_blocks(b_buf, bck_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_f[blk_no]);
                    if !is_fwd {
                        avg_blocks(b_buf, fwd_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_b[blk_no]);
                    }
                }
            }
            if cbp != 0 {
                blockdsp::add_blocks(b_buf, mb_x, mb_y, &b_data[cur_mb].blk);
            }
            cur_mb += 1;
        }
        cbpi.update_row();
    }
}
Commit	Line	Data
cf64af13	1	use std::mem;
21c16d5f	2	use std::ops::{Add, Sub};
cf64af13 KS	3	use super::*;
	4	use super::blockdsp;
	5	use super::h263code::*;
	6	use formats;
	7
	8	#[derive(Debug,Clone,Copy,PartialEq)]
	9	pub enum Type {
	10	I, P, Skip, Special
	11	}
	12
21c16d5f KS	13	#[allow(dead_code)]
	14	#[derive(Debug,Clone,Copy)]
	15	pub struct PBInfo {
	16	trb: u8,
	17	dbquant: u8,
	18	}
	19
	20	impl PBInfo {
	21	pub fn new(trb: u8, dbquant: u8) -> Self {
	22	PBInfo{ trb: trb, dbquant: dbquant }
	23	}
	24	pub fn get_trb(&self) -> u8 { self.trb }
	25	pub fn get_dbquant(&self) -> u8 { self.dbquant }
	26	}
	27
cf64af13 KS	28	#[allow(dead_code)]
	29	#[derive(Debug,Clone,Copy)]
	30	pub struct PicInfo {
	31	w: usize,
	32	h: usize,
	33	mode: Type,
	34	quant: u8,
	35	apm: bool,
	36	umv: bool,
21c16d5f	37	pb: Option<PBInfo>,
cf64af13	38	ts: u8,
f2f1afb2	39	deblock: bool,
cf64af13 KS	40	}
	41
	42	#[allow(dead_code)]
	43	impl PicInfo {
f2f1afb2 KS	44	pub fn new(w: usize, h: usize, mode: Type, quant: u8, apm: bool, umv: bool, ts: u8, pb: Option<PBInfo>, deblock: bool) -> Self {
f2f1afb2 KS	45	PicInfo{ w: w, h: h, mode: mode, quant: quant, apm: apm, umv: umv, ts: ts, pb: pb, deblock: deblock }
cf64af13 KS	46	}
	47	pub fn get_width(&self) -> usize { self.w }
	48	pub fn get_height(&self) -> usize { self.h }
	49	pub fn get_mode(&self) -> Type { self.mode }
	50	pub fn get_quant(&self) -> u8 { self.quant }
	51	pub fn get_apm(&self) -> bool { self.apm }
	52	pub fn get_umv(&self) -> bool { self.umv }
21c16d5f	53	pub fn is_pb(&self) -> bool { self.pb.is_some() }
cf64af13	54	pub fn get_ts(&self) -> u8 { self.ts }
21c16d5f	55	pub fn get_pbinfo(&self) -> PBInfo { self.pb.unwrap() }
cf64af13 KS	56	}
	57
	58	#[derive(Debug,Clone,Copy)]
	59	pub struct Slice {
	60	mb_x: usize,
	61	mb_y: usize,
	62	quant: u8,
	63	}
	64
	65	impl Slice {
	66	pub fn new(mb_x: usize, mb_y: usize, quant: u8) -> Self {
	67	Slice{ mb_x: mb_x, mb_y: mb_y, quant: quant }
	68	}
	69	pub fn get_default_slice(pinfo: &PicInfo) -> Self {
	70	Slice{ mb_x: 0, mb_y: 0, quant: pinfo.get_quant() }
	71	}
	72	pub fn get_quant(&self) -> u8 { self.quant }
	73	}
	74
	75	#[derive(Debug,Clone,Copy)]
	76	pub struct MV {
	77	x: i16,
	78	y: i16,
	79	}
	80
	81	impl MV {
	82	pub fn new(x: i16, y: i16) -> Self { MV{ x: x, y: y } }
	83	pub fn pred(a: MV, b: MV, c: MV) -> Self {
	84	let x;
	85	if a.x < b.x {
	86	if b.x < c.x {
	87	x = b.x;
	88	} else {
	89	if a.x < c.x { x = c.x; } else { x = a.x; }
	90	}
	91	} else {
	92	if b.x < c.x {
	93	if a.x < c.x { x = a.x; } else { x = c.x; }
	94	} else {
	95	x = b.x;
	96	}
	97	}
	98	let y;
	99	if a.y < b.y {
	100	if b.y < c.y {
	101	y = b.y;
	102	} else {
	103	if a.y < c.y { y = c.y; } else { y = a.y; }
	104	}
	105	} else {
	106	if b.y < c.y {
	107	if a.y < c.y { y = a.y; } else { y = c.y; }
	108	} else {
	109	y = b.y;
	110	}
	111	}
	112	MV { x: x, y: y }
	113	}
	114	fn add_umv(pred_mv: MV, add: MV, umv: bool) -> Self {
	115	let mut new_mv = pred_mv + add;
	116	if umv {
	117	if pred_mv.x > 32 && new_mv.x > 63 { new_mv.x -= 64; }
	118	if pred_mv.x < -31 && new_mv.x < -63 { new_mv.x += 64; }
	119	if pred_mv.y > 32 && new_mv.y > 63 { new_mv.y -= 64; }
120	if pred_mv.y < -31 && new_mv.y < -63 { new_mv.y += 64; }
121	} else {
122	if new_mv.x > 31 { new_mv.x -= 64; }
123	else if new_mv.x < -32 { new_mv.x += 64; }
124	if new_mv.y > 31 { new_mv.y -= 64; }
125	else if new_mv.y < -32 { new_mv.y += 64; }
126	}
127	new_mv
128	}
21c16d5f KS	129	fn scale(&self, trb: u8, trd: u8) -> Self {
	130	if (trd == 0) \|\| (trb == 0) {
	131	ZERO_MV
	132	} else {
	133	MV { x: (self.x * (trb as i16)) / (trd as i16), y: (self.y * (trb as i16)) / (trd as i16) }
	134	}
	135	}
	136	fn b_sub(pvec: MV, fwdvec: MV, bvec: MV, trb: u8, trd: u8) -> Self {
	137	let bscale = (trb as i16) - (trd as i16);
	138	let x = if bvec.x != 0 { fwdvec.x - pvec.x } else if trd != 0 { bscale * pvec.x / (trd as i16) } else { 0 };
	139	let y = if bvec.y != 0 { fwdvec.y - pvec.y } else if trd != 0 { bscale * pvec.y / (trd as i16) } else { 0 };
	140	MV { x: x, y: y }
	141	}
cf64af13 KS	142	}
	143
	144	pub const ZERO_MV: MV = MV { x: 0, y: 0 };
	145
	146	impl Add for MV {
	147	type Output = MV;
	148	fn add(self, other: MV) -> MV { MV { x: self.x + other.x, y: self.y + other.y } }
	149	}
	150
21c16d5f KS	151	impl Sub for MV {
	152	type Output = MV;
	153	fn sub(self, other: MV) -> MV { MV { x: self.x - other.x, y: self.y - other.y } }
	154	}
	155
cf64af13 KS	156	#[derive(Debug,Clone,Copy)]
	157	pub struct BlockInfo {
	158	intra: bool,
	159	skip: bool,
	160	mode: Type,
	161	cbp: u8,
	162	q: u8,
	163	mv: [MV; 4],
	164	num_mv: usize,
	165	bpart: bool,
	166	b_cbp: u8,
21c16d5f	167	mv2: [MV; 2],
cf64af13	168	num_mv2: usize,
21c16d5f KS	169	fwd: bool,
	170	}
	171
	172	#[allow(dead_code)]
	173	#[derive(Debug,Clone,Copy)]
	174	pub struct BBlockInfo {
	175	present: bool,
	176	cbp: u8,
	177	num_mv: usize,
	178	fwd: bool,
cf64af13 KS	179	}
	180
	181	#[allow(dead_code)]
	182	impl BlockInfo {
	183	pub fn new(mode: Type, cbp: u8, q: u8) -> Self {
	184	BlockInfo {
	185	intra: mode == Type::I,
	186	skip: (cbp == 0) && (mode != Type::I),
	187	mode: mode,
	188	cbp: cbp,
	189	q: q,
	190	mv: [MV::new(0, 0), MV::new(0, 0), MV::new(0, 0), MV::new(0, 0)],
	191	num_mv: 0,
	192	bpart: false,
	193	b_cbp: 0,
21c16d5f	194	mv2: [ZERO_MV, ZERO_MV],
cf64af13	195	num_mv2: 0,
21c16d5f	196	fwd: false,
cf64af13 KS	197	}
	198	}
	199	pub fn is_intra(&self) -> bool { self.intra }
	200	pub fn is_skipped(&self) -> bool { self.skip }
	201	pub fn get_mode(&self) -> Type { self.mode }
	202	pub fn get_cbp(&self) -> u8 { self.cbp }
	203	pub fn get_q(&self) -> u8 { self.q }
	204	pub fn get_num_mvs(&self) -> usize { self.num_mv }
	205	pub fn get_mv(&self, idx: usize) -> MV { self.mv[idx] }
	206	pub fn has_b_part(&self) -> bool { self.bpart }
	207	pub fn get_cbp_b(&self) -> u8 { self.b_cbp }
	208	pub fn get_num_mvs2(&self) -> usize { self.num_mv2 }
	209	pub fn get_mv2(&self, idx: usize) -> MV { self.mv2[idx] }
	210	pub fn set_mv(&mut self, mvs: &[MV]) {
	211	if mvs.len() > 0 { self.skip = false; }
cf64af13 KS	212	let mut mv_arr: [MV; 4] = [MV::new(0, 0), MV::new(0, 0), MV::new(0, 0), MV::new(0, 0)];
	213	for i in 0..mvs.len() { mv_arr[i] = mvs[i]; }
	214	self.mv = mv_arr;
	215	self.num_mv = mvs.len();
	216	}
21c16d5f KS	217	pub fn set_bpart(&mut self, bbinfo: BBlockInfo) {
	218	self.bpart = bbinfo.present;
	219	self.b_cbp = bbinfo.cbp;
	220	self.fwd = bbinfo.fwd;
	221	self.num_mv2 = bbinfo.get_num_mv();
	222	}
	223	pub fn set_b_mv(&mut self, mvs: &[MV]) {
	224	if mvs.len() > 0 { self.skip = false; }
	225	let mut mv_arr: [MV; 2] = [ZERO_MV, ZERO_MV];
cf64af13	226	for i in 0..mvs.len() { mv_arr[i] = mvs[i]; }
21c16d5f KS	227	self.mv2 = mv_arr;
	228	}
	229	pub fn is_b_fwd(&self) -> bool { self.fwd }
	230	}
	231
	232	impl BBlockInfo {
	233	pub fn new(present: bool, cbp: u8, num_mv: usize, fwd: bool) -> Self {
	234	BBlockInfo {
	235	present: present,
	236	cbp: cbp,
	237	num_mv: num_mv,
	238	fwd: fwd,
	239	}
cf64af13	240	}
21c16d5f	241	pub fn get_num_mv(&self) -> usize { self.num_mv }
cf64af13 KS	242	}
	243
	244	pub trait BlockDecoder {
	245	fn decode_pichdr(&mut self) -> DecoderResult<PicInfo>;
	246	fn decode_slice_header(&mut self, pinfo: &PicInfo) -> DecoderResult<Slice>;
	247	fn decode_block_header(&mut self, pinfo: &PicInfo, sinfo: &Slice) -> DecoderResult<BlockInfo>;
21c16d5f KS	248	fn decode_block_intra(&mut self, info: &BlockInfo, quant: u8, no: usize, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()>;
21c16d5f KS	249	fn decode_block_inter(&mut self, info: &BlockInfo, quant: u8, no: usize, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()>;
cf64af13	250	fn is_slice_end(&mut self) -> bool;
f2f1afb2 KS	251
f2f1afb2 KS	252	fn filter_row(&mut self, buf: &mut NAVideoBuffer<u8>, mb_y: usize, mb_w: usize, cbpi: &CBPInfo);
cf64af13 KS	253	}
	254
	255	#[allow(dead_code)]
	256	struct MVInfo {
	257	mv: Vec<MV>,
	258	mb_w: usize,
	259	mb_stride: usize,
	260	mb_start: usize,
	261	top: bool,
	262	umv: bool,
	263	}
	264
	265	impl MVInfo {
	266	fn new() -> Self { MVInfo{ mv: Vec::new(), mb_w: 0, mb_stride: 0, mb_start: 0, top: true, umv: false } }
	267	fn reset(&mut self, mb_w: usize, mb_start: usize, umv: bool) {
	268	self.mb_start = mb_start;
	269	self.mb_w = mb_w;
	270	self.mb_stride = mb_w * 2;
	271	self.top = true;
	272	self.mv.resize(self.mb_stride * 3, ZERO_MV);
	273	self.umv = umv;
	274	}
	275	fn update_row(&mut self) {
	276	self.mb_start = self.mb_w + 1;
	277	self.top = false;
	278	for i in 0..self.mb_stride {
	279	self.mv[i] = self.mv[self.mb_stride * 2 + i];
	280	}
	281	}
	282	#[allow(non_snake_case)]
	283	fn predict(&mut self, mb_x: usize, blk_no: usize, use4: bool, diff: MV) -> MV {
	284	let A;
	285	let B;
	286	let C;
	287	let last = mb_x == self.mb_w - 1;
	288	//println!(" pred from {}.{} blk {}.{}/{} top {}", diff.x, diff.y, mb_x, blk_no,self.mb_start,self.top);
	289	match blk_no {
	290	0 => {
	291	if mb_x != self.mb_start {
	292	A = if mb_x != 0 { self.mv[self.mb_stride + mb_x * 2 - 1] } else { ZERO_MV };
	293	B = if !self.top { self.mv[ mb_x * 2] } else { A };
	294	C = if !self.top && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV };
	295	} else {
	296	A = ZERO_MV; B = ZERO_MV; C = ZERO_MV;
	297	}
	298	},
	299	1 => {
	300	A = self.mv[self.mb_stride + mb_x * 2];
	301	B = if !self.top { self.mv[mb_x * 2 + 1] } else { A };
	302	C = if !self.top && !last { self.mv[mb_x * 2 + 2] } else { A };
	303	},
	304	2 => {
	305	A = if mb_x != self.mb_start { self.mv[self.mb_stride * 2 + mb_x * 2 - 1] } else { ZERO_MV };
	306	B = self.mv[self.mb_stride + mb_x * 2];
	307	C = self.mv[self.mb_stride + mb_x * 2 + 1];
	308	},
	309	3 => {
	310	A = self.mv[self.mb_stride * 2 + mb_x * 2];
	311	B = self.mv[self.mb_stride * 1 + mb_x * 2 + 1];
	312	C = self.mv[self.mb_stride * 1 + mb_x * 2];
	313	},
	314	_ => { return ZERO_MV; }
	315	}
	316	//println!(" A = {}.{} B = {}.{} C = {}.{}", A.x,A.y,B.x,B.y,C.x,C.y);
317	let pred_mv = MV::pred(A, B, C);
318	let new_mv = MV::add_umv(pred_mv, diff, self.umv);
319	if !use4 {
320	self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv;
321	self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv;
322	self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv;
323	self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv;
324	} else {
325	match blk_no {
326	0 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv; },
327	1 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv; },
328	2 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv; },
329	3 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv; },
330	_ => {},
331	};
332	}
333
334	new_mv
335	}
336	fn set_zero_mv(&mut self, mb_x: usize) {
337	self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = ZERO_MV;
338	self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = ZERO_MV;
339	self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = ZERO_MV;
340	self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = ZERO_MV;
341	}
342	}
343
f2f1afb2 KS	344	#[allow(dead_code)]
	345	pub struct CBPInfo {
	346	cbp: Vec<u8>,
	347	q: Vec<u8>,
	348	mb_w: usize,
	349	}
	350
	351	impl CBPInfo {
	352	fn new() -> Self { CBPInfo{ cbp: Vec::new(), q: Vec::new(), mb_w: 0 } }
	353	fn reset(&mut self, mb_w: usize) {
	354	self.mb_w = mb_w;
	355	self.cbp.truncate(0);
	356	self.cbp.resize(self.mb_w * 2, 0);
	357	self.q.truncate(0);
	358	self.q.resize(self.mb_w * 2, 0);
	359	}
	360	fn update_row(&mut self) {
	361	for i in 0..self.mb_w {
	362	self.cbp[i] = self.cbp[self.mb_w + i];
	363	self.q[i] = self.q[self.mb_w + i];
	364	}
	365	}
	366	fn set_cbp(&mut self, mb_x: usize, cbp: u8) {
	367	self.cbp[self.mb_w + mb_x] = cbp;
	368	}
	369	fn set_q(&mut self, mb_x: usize, q: u8) {
	370	self.q[self.mb_w + mb_x] = q;
	371	}
	372	pub fn get_q(&self, mb_x: usize) -> u8 { self.q[mb_x] }
	373	pub fn is_coded(&self, mb_x: usize, blk_no: usize) -> bool {
	374	(self.cbp[self.mb_w + mb_x] & (1 << (5 - blk_no))) != 0
	375	}
	376	pub fn is_coded_top(&self, mb_x: usize, blk_no: usize) -> bool {
	377	let cbp = self.cbp[self.mb_w + mb_x];
	378	let cbp_top = self.cbp[mb_x];
	379	match blk_no {
	380	0 => { (cbp_top & 0b001000) != 0 },
	381	1 => { (cbp_top & 0b000100) != 0 },
	382	2 => { (cbp & 0b100000) != 0 },
	383	3 => { (cbp & 0b010000) != 0 },
	384	4 => { (cbp_top & 0b000010) != 0 },
	385	_ => { (cbp_top & 0b000001) != 0 },
	386	}
	387	}
	388	}
	389
cf64af13 KS	390	fn copy_blocks(dst: &mut NAVideoBuffer<u8>, src: &NAVideoBuffer<u8>, xpos: usize, ypos: usize, w: usize, h: usize, mv: MV) {
	391	let srcx = ((mv.x >> 1) as isize) + (xpos as isize);
	392	let srcy = ((mv.y >> 1) as isize) + (ypos as isize);
	393	let mode = ((mv.x & 1) + (mv.y & 1) * 2) as usize;
	394
	395	blockdsp::copy_blocks(dst, src, xpos, ypos, srcx, srcy, w, h, 0, 1, mode, H263_INTERP_FUNCS);
	396	}
	397
21c16d5f KS	398	fn avg_blocks(dst: &mut NAVideoBuffer<u8>, src: &NAVideoBuffer<u8>, xpos: usize, ypos: usize, w: usize, h: usize, mv: MV) {
	399	let srcx = ((mv.x >> 1) as isize) + (xpos as isize);
	400	let srcy = ((mv.y >> 1) as isize) + (ypos as isize);
	401	let mode = ((mv.x & 1) + (mv.y & 1) * 2) as usize;
	402
	403	blockdsp::copy_blocks(dst, src, xpos, ypos, srcx, srcy, w, h, 0, 1, mode, H263_INTERP_AVG_FUNCS);
	404	}
	405
	406	#[allow(dead_code)]
	407	#[derive(Clone,Copy)]
	408	struct BMB {
	409	num_mv: usize,
	410	mv_f: [MV; 4],
	411	mv_b: [MV; 4],
	412	fwd: bool,
	413	blk: [[i16; 64]; 6],
	414	cbp: u8,
	415	}
	416
	417	impl BMB {
	418	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} }
	419	}
	420
cf64af13 KS	421	pub struct DCT8x8VideoDecoder {
	422	w: usize,
	423	h: usize,
	424	mb_w: usize,
	425	mb_h: usize,
	426	num_mb: usize,
	427	ftype: Type,
	428	prev_frm: Option<NAVideoBuffer<u8>>,
	429	cur_frm: Option<NAVideoBuffer<u8>>,
21c16d5f KS	430	last_ts: u8,
	431	has_b: bool,
	432	b_data: Vec<BMB>,
cf64af13 KS	433	}
	434
	435	#[allow(dead_code)]
	436	impl DCT8x8VideoDecoder {
	437	pub fn new() -> Self {
	438	DCT8x8VideoDecoder{
	439	w: 0, h: 0, mb_w: 0, mb_h: 0, num_mb: 0,
	440	ftype: Type::Special,
	441	prev_frm: None, cur_frm: None,
21c16d5f KS	442	last_ts: 0,
21c16d5f KS	443	has_b: false, b_data: Vec::new(),
cf64af13 KS	444	}
	445	}
	446
	447	pub fn is_intra(&self) -> bool { self.ftype == Type::I }
	448	pub fn get_dimensions(&self) -> (usize, usize) { (self.w, self.h) }
	449
	450	pub fn parse_frame(&mut self, bd: &mut BlockDecoder) -> DecoderResult<NABufferType> {
	451	let pinfo = bd.decode_pichdr()?;
21c16d5f	452	let mut mvi = MVInfo::new();
f2f1afb2	453	let mut cbpi = CBPInfo::new();
cf64af13 KS	454
	455	//todo handle res change
	456	self.w = pinfo.w;
	457	self.h = pinfo.h;
	458	self.mb_w = (pinfo.w + 15) >> 4;
	459	self.mb_h = (pinfo.h + 15) >> 4;
	460	self.num_mb = self.mb_w * self.mb_h;
	461	self.ftype = pinfo.mode;
21c16d5f KS	462	self.has_b = pinfo.is_pb();
	463
	464	if self.has_b {
	465	self.b_data.truncate(0);
	466	}
cf64af13 KS	467
cf64af13 KS	468	mem::swap(&mut self.cur_frm, &mut self.prev_frm);
cf64af13	469
21c16d5f KS	470	let tsdiff = pinfo.ts.wrapping_sub(self.last_ts);
	471	let bsdiff = if pinfo.is_pb() { pinfo.get_pbinfo().get_trb() } else { 0 };
	472
cf64af13 KS	473	let fmt = formats::YUV420_FORMAT;
	474	let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
	475	let bufret = alloc_video_buffer(vinfo, 4);
	476	if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
	477	let mut bufinfo = bufret.unwrap();
	478	let mut buf = bufinfo.get_vbuf().unwrap();
	479
cf64af13 KS	480	let mut slice = Slice::get_default_slice(&pinfo);
cf64af13 KS	481	mvi.reset(self.mb_w, 0, pinfo.get_umv());
f2f1afb2	482	cbpi.reset(self.mb_w);
cf64af13 KS	483
	484	let mut blk: [[i16; 64]; 6] = [[0; 64]; 6];
	485	for mb_y in 0..self.mb_h {
	486	for mb_x in 0..self.mb_w {
	487	for i in 0..6 { for j in 0..64 { blk[i][j] = 0; } }
	488
	489	if ((mb_x != 0) \|\| (mb_y != 0)) && bd.is_slice_end() {
	490	//println!("new slice @{}.{}!",mb_x,mb_y);
	491	slice = bd.decode_slice_header(&pinfo)?;
	492	mvi.reset(self.mb_w, mb_x, pinfo.get_umv());
f2f1afb2	493	//cbpi.reset(self.mb_w);
cf64af13 KS	494	}
	495
	496	let binfo = bd.decode_block_header(&pinfo, &slice)?;
	497	let cbp = binfo.get_cbp();
	498	//println!("mb {}.{} CBP {:X} type {:?}, {} mvs skip {}", mb_x,mb_y, cbp, binfo.get_mode(), binfo.get_num_mvs(),binfo.is_skipped());
f2f1afb2 KS	499	cbpi.set_cbp(mb_x, cbp);
f2f1afb2 KS	500	cbpi.set_q(mb_x, binfo.get_q());
cf64af13 KS	501	if binfo.is_intra() {
cf64af13 KS	502	for i in 0..6 {
21c16d5f	503	bd.decode_block_intra(&binfo, binfo.get_q(), i, (cbp & (1 << (5 - i))) != 0, &mut blk[i])?;
cf64af13 KS	504	h263_idct(&mut blk[i]);
	505	}
	506	blockdsp::put_blocks(&mut buf, mb_x, mb_y, &blk);
	507	mvi.set_zero_mv(mb_x);
	508	} else if !binfo.is_skipped() {
	509	if binfo.get_num_mvs() == 1 {
	510	let mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0));
	511	//println!(" 1MV {}.{}", mv.x, mv.y);
	512	if let Some(ref srcbuf) = self.prev_frm {
	513	copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, mv);
	514	}
	515	} else {
	516	for blk_no in 0..4 {
	517	let mv = mvi.predict(mb_x, blk_no, true, binfo.get_mv(blk_no));
	518	//print!(" MV {}.{}", mv.x, mv.y);
	519	if let Some(ref srcbuf) = self.prev_frm {
	520	copy_blocks(&mut buf, srcbuf,
	521	mb_x * 16 + (blk_no & 1) * 8,
	522	mb_y * 16 + (blk_no & 2) * 4, 8, 8, mv);
	523	}
	524	}
	525	//println!("");
	526	}
	527	for i in 0..6 {
21c16d5f	528	bd.decode_block_inter(&binfo, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?;
cf64af13 KS	529	h263_idct(&mut blk[i]);
	530	}
	531	blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk);
	532	} else {
	533	mvi.set_zero_mv(mb_x);
	534	if let Some(ref srcbuf) = self.prev_frm {
	535	copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, ZERO_MV);
	536	}
	537	}
21c16d5f KS	538	if pinfo.is_pb() {
21c16d5f KS	539	let mut b_mb = BMB::new();
cf64af13	540	let cbp = binfo.get_cbp_b();
21c16d5f KS	541	let bq = (((pinfo.get_pbinfo().get_dbquant() + 5) as u16) * (binfo.get_q() as u16)) >> 2;
	542	let bquant;
	543	if bq < 1 { bquant = 1; }
	544	else if bq > 31 { bquant = 31; }
	545	else { bquant = bq as u8; }
	546
	547	b_mb.cbp = cbp;
cf64af13	548	for i in 0..6 {
21c16d5f KS	549	bd.decode_block_inter(&binfo, bquant, i, (cbp & (1 << (5 - i))) != 0, &mut b_mb.blk[i])?;
21c16d5f KS	550	h263_idct(&mut b_mb.blk[i]);
cf64af13	551	}
21c16d5f KS	552
	553	let is_fwd = binfo.is_b_fwd();
	554	b_mb.fwd = is_fwd;
	555	b_mb.num_mv = binfo.get_num_mvs();
	556	if binfo.get_num_mvs() == 0 {
	557	b_mb.num_mv = 1;
	558	b_mb.mv_f[0] = binfo.get_mv2(1);
	559	b_mb.mv_b[0] = binfo.get_mv2(0);
	560	} if binfo.get_num_mvs() == 1 {
	561	let src_mv = if is_fwd { ZERO_MV } else { binfo.get_mv(0).scale(bsdiff, tsdiff) };
	562	let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_umv());
	563	let mv_b = MV::b_sub(binfo.get_mv(0), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
	564	b_mb.mv_f[0] = mv_f;
	565	b_mb.mv_b[0] = mv_b;
	566	} else {
	567	for blk_no in 0..4 {
	568	let src_mv = if is_fwd { ZERO_MV } else { binfo.get_mv(blk_no).scale(bsdiff, tsdiff) };
	569	let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_umv());
	570	let mv_b = MV::b_sub(binfo.get_mv(blk_no), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
	571	b_mb.mv_f[blk_no] = mv_f;
	572	b_mb.mv_b[blk_no] = mv_b;
cf64af13 KS	573	}
cf64af13 KS	574	}
21c16d5f	575	self.b_data.push(b_mb);
cf64af13	576	}
cf64af13	577	}
f2f1afb2 KS	578	if pinfo.deblock {
	579	bd.filter_row(&mut buf, mb_y, self.mb_w, &cbpi);
	580	}
cf64af13	581	mvi.update_row();
f2f1afb2	582	cbpi.update_row();
cf64af13	583	}
f2f1afb2	584
cf64af13	585	self.cur_frm = Some(buf);
21c16d5f KS	586	self.last_ts = pinfo.ts;
21c16d5f KS	587	//println!("unpacked all");
cf64af13 KS	588	Ok(bufinfo)
	589	}
	590
21c16d5f KS	591	pub fn get_bframe(&mut self) -> DecoderResult<NABufferType> {
	592	if !self.has_b \|\| !self.cur_frm.is_some() \|\| !self.prev_frm.is_some() {
	593	return Err(DecoderError::MissingReference);
	594	}
	595	self.has_b = false;
	596
	597	let fmt = formats::YUV420_FORMAT;
	598	let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
	599	let bufret = alloc_video_buffer(vinfo, 4);
	600	if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
	601	let mut bufinfo = bufret.unwrap();
	602	let mut b_buf = bufinfo.get_vbuf().unwrap();
	603
	604	if let Some(ref bck_buf) = self.prev_frm {
	605	if let Some(ref fwd_buf) = self.cur_frm {
	606	recon_b_frame(&mut b_buf, bck_buf, fwd_buf, self.mb_w, self.mb_h, &self.b_data);
	607	}
	608	}
	609
	610	self.b_data.truncate(0);
	611	Ok(bufinfo)
	612	}
	613	}
	614
	615	fn recon_b_frame(b_buf: &mut NAVideoBuffer<u8>, bck_buf: &NAVideoBuffer<u8>, fwd_buf: &NAVideoBuffer<u8>,
	616	mb_w: usize, mb_h: usize, b_data: &Vec<BMB>) {
f2f1afb2	617	let mut cbpi = CBPInfo::new();
21c16d5f	618	let mut cur_mb = 0;
f2f1afb2	619	cbpi.reset(mb_w);
21c16d5f KS	620	for mb_y in 0..mb_h {
	621	for mb_x in 0..mb_w {
	622	let num_mv = b_data[cur_mb].num_mv;
	623	let is_fwd = b_data[cur_mb].fwd;
f2f1afb2 KS	624	let cbp = b_data[cur_mb].cbp;
	625	cbpi.set_cbp(mb_x, cbp);
	626	if num_mv == 1 {
21c16d5f KS	627	copy_blocks(b_buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_f[0]);
	628	if !is_fwd {
	629	avg_blocks(b_buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_b[0]);
	630	}
	631	} else {
	632	for blk_no in 0..4 {
	633	let xpos = mb_x * 16 + (blk_no & 1) * 8;
	634	let ypos = mb_y * 16 + (blk_no & 2) * 4;
	635	copy_blocks(b_buf, bck_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_f[blk_no]);
	636	if !is_fwd {
	637	avg_blocks(b_buf, fwd_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_b[blk_no]);
	638	}
	639	}
	640	}
f2f1afb2	641	if cbp != 0 {
21c16d5f KS	642	blockdsp::add_blocks(b_buf, mb_x, mb_y, &b_data[cur_mb].blk);
	643	}
	644	cur_mb += 1;
cf64af13	645	}
f2f1afb2	646	cbpi.update_row();
cf64af13 KS	647	}
cf64af13 KS	648	}