[nihav.git] / src / codecs / h263 / decoder.rs

use std::mem;
use frame::*;
use super::super::*;
use super::super::blockdsp;
use super::*;
use super::code::*;
use 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;
        self.top       = true;
        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) -> 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 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; }
        }
        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 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 H263BaseDecoder {
    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 H263BaseDecoder {
    pub fn new() -> Self {
        H263BaseDecoder{
            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_mvmode());
        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() {
                    slice = bd.decode_slice_header(&pinfo)?;
                    //mvi.reset(self.mb_w, mb_x, pinfo.get_mvmode());
                    //cbpi.reset(self.mb_w);
                }

                let binfo = bd.decode_block_header(&pinfo, &slice)?;
                let cbp = binfo.get_cbp();
                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));
                        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));
                            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);
                            }
                        }
                    }
                    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);
                    } else if binfo.get_num_mvs() == 1 {
                        let src_mv = binfo.get_mv(0).scale(bsdiff, tsdiff);
                        let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_mvmode());
                        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 = binfo.get_mv(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(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;
        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, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_b[0]);
                if !is_fwd {
                    avg_blocks(b_buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_f[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, fwd_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_b[blk_no]);
                    if !is_fwd {
                        avg_blocks(b_buf, bck_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_f[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;
88c58b1b KS	2	use frame::*;
	3	use super::super::*;
	4	use super::super::blockdsp;
cf64af13	5	use super::*;
88c58b1b	6	use super::code::*;
cf64af13 KS	7	use formats;
cf64af13 KS	8
cf64af13 KS	9	#[allow(dead_code)]
	10	struct MVInfo {
	11	mv: Vec<MV>,
	12	mb_w: usize,
	13	mb_stride: usize,
	14	mb_start: usize,
	15	top: bool,
2324f30b	16	mvmode: MVMode,
cf64af13 KS	17	}
	18
	19	impl MVInfo {
2324f30b KS	20	fn new() -> Self { MVInfo{ mv: Vec::new(), mb_w: 0, mb_stride: 0, mb_start: 0, top: true, mvmode: MVMode::Old } }
2324f30b KS	21	fn reset(&mut self, mb_w: usize, mb_start: usize, mvmode: MVMode) {
cf64af13 KS	22	self.mb_start = mb_start;
	23	self.mb_w = mb_w;
	24	self.mb_stride = mb_w * 2;
	25	self.top = true;
	26	self.mv.resize(self.mb_stride * 3, ZERO_MV);
2324f30b	27	self.mvmode = mvmode;
cf64af13 KS	28	}
	29	fn update_row(&mut self) {
	30	self.mb_start = self.mb_w + 1;
	31	self.top = false;
	32	for i in 0..self.mb_stride {
	33	self.mv[i] = self.mv[self.mb_stride * 2 + i];
	34	}
	35	}
	36	#[allow(non_snake_case)]
	37	fn predict(&mut self, mb_x: usize, blk_no: usize, use4: bool, diff: MV) -> MV {
	38	let A;
	39	let B;
	40	let C;
	41	let last = mb_x == self.mb_w - 1;
cf64af13 KS	42	match blk_no {
	43	0 => {
	44	if mb_x != self.mb_start {
	45	A = if mb_x != 0 { self.mv[self.mb_stride + mb_x * 2 - 1] } else { ZERO_MV };
	46	B = if !self.top { self.mv[ mb_x * 2] } else { A };
	47	C = if !self.top && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV };
	48	} else {
	49	A = ZERO_MV; B = ZERO_MV; C = ZERO_MV;
	50	}
	51	},
	52	1 => {
	53	A = self.mv[self.mb_stride + mb_x * 2];
	54	B = if !self.top { self.mv[mb_x * 2 + 1] } else { A };
	55	C = if !self.top && !last { self.mv[mb_x * 2 + 2] } else { A };
	56	},
	57	2 => {
	58	A = if mb_x != self.mb_start { self.mv[self.mb_stride * 2 + mb_x * 2 - 1] } else { ZERO_MV };
	59	B = self.mv[self.mb_stride + mb_x * 2];
	60	C = self.mv[self.mb_stride + mb_x * 2 + 1];
	61	},
	62	3 => {
	63	A = self.mv[self.mb_stride * 2 + mb_x * 2];
	64	B = self.mv[self.mb_stride * 1 + mb_x * 2 + 1];
	65	C = self.mv[self.mb_stride * 1 + mb_x * 2];
	66	},
	67	_ => { return ZERO_MV; }
	68	}
cf64af13	69	let pred_mv = MV::pred(A, B, C);
2324f30b	70	let new_mv = MV::add_umv(pred_mv, diff, self.mvmode);
cf64af13 KS	71	if !use4 {
	72	self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv;
	73	self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv;
	74	self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv;
	75	self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv;
	76	} else {
	77	match blk_no {
	78	0 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv; },
	79	1 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv; },
	80	2 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv; },
	81	3 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv; },
	82	_ => {},
	83	};
	84	}
	85
	86	new_mv
	87	}
	88	fn set_zero_mv(&mut self, mb_x: usize) {
	89	self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = ZERO_MV;
	90	self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = ZERO_MV;
	91	self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = ZERO_MV;
	92	self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = ZERO_MV;
	93	}
	94	}
	95
	96	fn copy_blocks(dst: &mut NAVideoBuffer<u8>, src: &NAVideoBuffer<u8>, xpos: usize, ypos: usize, w: usize, h: usize, mv: MV) {
	97	let srcx = ((mv.x >> 1) as isize) + (xpos as isize);
	98	let srcy = ((mv.y >> 1) as isize) + (ypos as isize);
	99	let mode = ((mv.x & 1) + (mv.y & 1) * 2) as usize;
	100
	101	blockdsp::copy_blocks(dst, src, xpos, ypos, srcx, srcy, w, h, 0, 1, mode, H263_INTERP_FUNCS);
	102	}
	103
21c16d5f KS	104	fn avg_blocks(dst: &mut NAVideoBuffer<u8>, src: &NAVideoBuffer<u8>, xpos: usize, ypos: usize, w: usize, h: usize, mv: MV) {
	105	let srcx = ((mv.x >> 1) as isize) + (xpos as isize);
	106	let srcy = ((mv.y >> 1) as isize) + (ypos as isize);
	107	let mode = ((mv.x & 1) + (mv.y & 1) * 2) as usize;
	108
	109	blockdsp::copy_blocks(dst, src, xpos, ypos, srcx, srcy, w, h, 0, 1, mode, H263_INTERP_AVG_FUNCS);
	110	}
	111
	112	#[allow(dead_code)]
	113	#[derive(Clone,Copy)]
	114	struct BMB {
	115	num_mv: usize,
	116	mv_f: [MV; 4],
	117	mv_b: [MV; 4],
	118	fwd: bool,
	119	blk: [[i16; 64]; 6],
	120	cbp: u8,
	121	}
	122
	123	impl BMB {
	124	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} }
	125	}
	126
88c58b1b	127	pub struct H263BaseDecoder {
cf64af13 KS	128	w: usize,
	129	h: usize,
	130	mb_w: usize,
	131	mb_h: usize,
	132	num_mb: usize,
	133	ftype: Type,
	134	prev_frm: Option<NAVideoBuffer<u8>>,
	135	cur_frm: Option<NAVideoBuffer<u8>>,
21c16d5f KS	136	last_ts: u8,
	137	has_b: bool,
	138	b_data: Vec<BMB>,
cf64af13 KS	139	}
	140
	141	#[allow(dead_code)]
88c58b1b	142	impl H263BaseDecoder {
cf64af13	143	pub fn new() -> Self {
88c58b1b	144	H263BaseDecoder{
cf64af13 KS	145	w: 0, h: 0, mb_w: 0, mb_h: 0, num_mb: 0,
	146	ftype: Type::Special,
	147	prev_frm: None, cur_frm: None,
21c16d5f KS	148	last_ts: 0,
21c16d5f KS	149	has_b: false, b_data: Vec::new(),
cf64af13 KS	150	}
	151	}
	152
	153	pub fn is_intra(&self) -> bool { self.ftype == Type::I }
	154	pub fn get_dimensions(&self) -> (usize, usize) { (self.w, self.h) }
	155
	156	pub fn parse_frame(&mut self, bd: &mut BlockDecoder) -> DecoderResult<NABufferType> {
	157	let pinfo = bd.decode_pichdr()?;
21c16d5f	158	let mut mvi = MVInfo::new();
f2f1afb2	159	let mut cbpi = CBPInfo::new();
cf64af13 KS	160
	161	//todo handle res change
	162	self.w = pinfo.w;
	163	self.h = pinfo.h;
	164	self.mb_w = (pinfo.w + 15) >> 4;
	165	self.mb_h = (pinfo.h + 15) >> 4;
	166	self.num_mb = self.mb_w * self.mb_h;
	167	self.ftype = pinfo.mode;
21c16d5f KS	168	self.has_b = pinfo.is_pb();
	169
	170	if self.has_b {
	171	self.b_data.truncate(0);
	172	}
cf64af13 KS	173
cf64af13 KS	174	mem::swap(&mut self.cur_frm, &mut self.prev_frm);
cf64af13	175
21c16d5f KS	176	let tsdiff = pinfo.ts.wrapping_sub(self.last_ts);
	177	let bsdiff = if pinfo.is_pb() { pinfo.get_pbinfo().get_trb() } else { 0 };
	178
cf64af13 KS	179	let fmt = formats::YUV420_FORMAT;
	180	let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
	181	let bufret = alloc_video_buffer(vinfo, 4);
	182	if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
	183	let mut bufinfo = bufret.unwrap();
	184	let mut buf = bufinfo.get_vbuf().unwrap();
	185
cf64af13	186	let mut slice = Slice::get_default_slice(&pinfo);
2324f30b	187	mvi.reset(self.mb_w, 0, pinfo.get_mvmode());
f2f1afb2	188	cbpi.reset(self.mb_w);
cf64af13 KS	189
	190	let mut blk: [[i16; 64]; 6] = [[0; 64]; 6];
	191	for mb_y in 0..self.mb_h {
	192	for mb_x in 0..self.mb_w {
	193	for i in 0..6 { for j in 0..64 { blk[i][j] = 0; } }
	194
	195	if ((mb_x != 0) \|\| (mb_y != 0)) && bd.is_slice_end() {
cf64af13	196	slice = bd.decode_slice_header(&pinfo)?;
2324f30b	197	//mvi.reset(self.mb_w, mb_x, pinfo.get_mvmode());
f2f1afb2	198	//cbpi.reset(self.mb_w);
cf64af13 KS	199	}
	200
	201	let binfo = bd.decode_block_header(&pinfo, &slice)?;
	202	let cbp = binfo.get_cbp();
f2f1afb2 KS	203	cbpi.set_cbp(mb_x, cbp);
f2f1afb2 KS	204	cbpi.set_q(mb_x, binfo.get_q());
cf64af13 KS	205	if binfo.is_intra() {
cf64af13 KS	206	for i in 0..6 {
21c16d5f	207	bd.decode_block_intra(&binfo, binfo.get_q(), i, (cbp & (1 << (5 - i))) != 0, &mut blk[i])?;
cf64af13 KS	208	h263_idct(&mut blk[i]);
	209	}
	210	blockdsp::put_blocks(&mut buf, mb_x, mb_y, &blk);
	211	mvi.set_zero_mv(mb_x);
	212	} else if !binfo.is_skipped() {
	213	if binfo.get_num_mvs() == 1 {
	214	let mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0));
cf64af13 KS	215	if let Some(ref srcbuf) = self.prev_frm {
	216	copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, mv);
	217	}
	218	} else {
	219	for blk_no in 0..4 {
	220	let mv = mvi.predict(mb_x, blk_no, true, binfo.get_mv(blk_no));
cf64af13 KS	221	if let Some(ref srcbuf) = self.prev_frm {
	222	copy_blocks(&mut buf, srcbuf,
	223	mb_x * 16 + (blk_no & 1) * 8,
	224	mb_y * 16 + (blk_no & 2) * 4, 8, 8, mv);
	225	}
	226	}
cf64af13 KS	227	}
cf64af13 KS	228	for i in 0..6 {
21c16d5f	229	bd.decode_block_inter(&binfo, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?;
cf64af13 KS	230	h263_idct(&mut blk[i]);
	231	}
	232	blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk);
	233	} else {
	234	mvi.set_zero_mv(mb_x);
	235	if let Some(ref srcbuf) = self.prev_frm {
	236	copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, ZERO_MV);
	237	}
	238	}
21c16d5f KS	239	if pinfo.is_pb() {
21c16d5f KS	240	let mut b_mb = BMB::new();
cf64af13	241	let cbp = binfo.get_cbp_b();
21c16d5f KS	242	let bq = (((pinfo.get_pbinfo().get_dbquant() + 5) as u16) * (binfo.get_q() as u16)) >> 2;
	243	let bquant;
	244	if bq < 1 { bquant = 1; }
	245	else if bq > 31 { bquant = 31; }
	246	else { bquant = bq as u8; }
	247
	248	b_mb.cbp = cbp;
cf64af13	249	for i in 0..6 {
21c16d5f KS	250	bd.decode_block_inter(&binfo, bquant, i, (cbp & (1 << (5 - i))) != 0, &mut b_mb.blk[i])?;
21c16d5f KS	251	h263_idct(&mut b_mb.blk[i]);
cf64af13	252	}
21c16d5f	253
88c58b1b	254	let is_fwd = !binfo.is_b_fwd();
21c16d5f KS	255	b_mb.fwd = is_fwd;
	256	b_mb.num_mv = binfo.get_num_mvs();
	257	if binfo.get_num_mvs() == 0 {
	258	b_mb.num_mv = 1;
	259	b_mb.mv_f[0] = binfo.get_mv2(1);
	260	b_mb.mv_b[0] = binfo.get_mv2(0);
88c58b1b KS	261	} else if binfo.get_num_mvs() == 1 {
88c58b1b KS	262	let src_mv = binfo.get_mv(0).scale(bsdiff, tsdiff);
2324f30b	263	let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_mvmode());
21c16d5f KS	264	let mv_b = MV::b_sub(binfo.get_mv(0), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
	265	b_mb.mv_f[0] = mv_f;
	266	b_mb.mv_b[0] = mv_b;
	267	} else {
	268	for blk_no in 0..4 {
88c58b1b	269	let src_mv = binfo.get_mv(blk_no).scale(bsdiff, tsdiff);
2324f30b	270	let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_mvmode());
21c16d5f KS	271	let mv_b = MV::b_sub(binfo.get_mv(blk_no), mv_f, binfo.get_mv2(0), bsdiff, tsdiff);
	272	b_mb.mv_f[blk_no] = mv_f;
	273	b_mb.mv_b[blk_no] = mv_b;
cf64af13 KS	274	}
cf64af13 KS	275	}
21c16d5f	276	self.b_data.push(b_mb);
cf64af13	277	}
cf64af13	278	}
f2f1afb2 KS	279	if pinfo.deblock {
	280	bd.filter_row(&mut buf, mb_y, self.mb_w, &cbpi);
	281	}
cf64af13	282	mvi.update_row();
f2f1afb2	283	cbpi.update_row();
cf64af13	284	}
f2f1afb2	285
cf64af13	286	self.cur_frm = Some(buf);
21c16d5f	287	self.last_ts = pinfo.ts;
cf64af13 KS	288	Ok(bufinfo)
	289	}
	290
21c16d5f KS	291	pub fn get_bframe(&mut self) -> DecoderResult<NABufferType> {
	292	if !self.has_b \|\| !self.cur_frm.is_some() \|\| !self.prev_frm.is_some() {
	293	return Err(DecoderError::MissingReference);
	294	}
	295	self.has_b = false;
	296
	297	let fmt = formats::YUV420_FORMAT;
	298	let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt);
	299	let bufret = alloc_video_buffer(vinfo, 4);
	300	if let Err(_) = bufret { return Err(DecoderError::InvalidData); }
	301	let mut bufinfo = bufret.unwrap();
	302	let mut b_buf = bufinfo.get_vbuf().unwrap();
	303
	304	if let Some(ref bck_buf) = self.prev_frm {
	305	if let Some(ref fwd_buf) = self.cur_frm {
	306	recon_b_frame(&mut b_buf, bck_buf, fwd_buf, self.mb_w, self.mb_h, &self.b_data);
	307	}
	308	}
	309
	310	self.b_data.truncate(0);
	311	Ok(bufinfo)
	312	}
	313	}
	314
	315	fn recon_b_frame(b_buf: &mut NAVideoBuffer<u8>, bck_buf: &NAVideoBuffer<u8>, fwd_buf: &NAVideoBuffer<u8>,
	316	mb_w: usize, mb_h: usize, b_data: &Vec<BMB>) {
f2f1afb2	317	let mut cbpi = CBPInfo::new();
21c16d5f	318	let mut cur_mb = 0;
f2f1afb2	319	cbpi.reset(mb_w);
21c16d5f KS	320	for mb_y in 0..mb_h {
	321	for mb_x in 0..mb_w {
	322	let num_mv = b_data[cur_mb].num_mv;
	323	let is_fwd = b_data[cur_mb].fwd;
f2f1afb2 KS	324	let cbp = b_data[cur_mb].cbp;
	325	cbpi.set_cbp(mb_x, cbp);
	326	if num_mv == 1 {
88c58b1b	327	copy_blocks(b_buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_b[0]);
21c16d5f	328	if !is_fwd {
88c58b1b	329	avg_blocks(b_buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_f[0]);
21c16d5f KS	330	}
	331	} else {
	332	for blk_no in 0..4 {
	333	let xpos = mb_x * 16 + (blk_no & 1) * 8;
	334	let ypos = mb_y * 16 + (blk_no & 2) * 4;
88c58b1b	335	copy_blocks(b_buf, fwd_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_b[blk_no]);
21c16d5f	336	if !is_fwd {
88c58b1b	337	avg_blocks(b_buf, bck_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_f[blk_no]);
21c16d5f KS	338	}
	339	}
	340	}
f2f1afb2	341	if cbp != 0 {
21c16d5f KS	342	blockdsp::add_blocks(b_buf, mb_x, mb_y, &b_data[cur_mb].blk);
	343	}
	344	cur_mb += 1;
cf64af13	345	}
f2f1afb2	346	cbpi.update_row();
cf64af13 KS	347	}
cf64af13 KS	348	}