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

use io::bitreader::*;
use io::codebook::*;
use formats;
use super::super::*;
use super::*;
use super::decoder::*;
use super::data::*;

#[allow(dead_code)]
struct Tables {
    intra_mcbpc_cb: Codebook<u8>,
    inter_mcbpc_cb: Codebook<u8>,
    cbpy_cb:        Codebook<u8>,
    rl_cb:          Codebook<H263RLSym>,
    aic_rl_cb:      Codebook<H263RLSym>,
    mv_cb:          Codebook<u8>,
}

struct Intel263Decoder {
    info:    Rc<NACodecInfo>,
    dec:     H263BaseDecoder,
    tables:  Tables,
}

struct Intel263BR<'a> {
    br:     BitReader<'a>,
    tables: &'a Tables,
    gob_no: usize,
    mb_w:   usize,
    is_pb:  bool,
}

fn check_marker<'a>(br: &mut BitReader<'a>) -> DecoderResult<()> {
    let mark = br.read(1)?;
    validate!(mark == 1);
    Ok(())
}

impl<'a> Intel263BR<'a> {
    fn new(src: &'a [u8], tables: &'a Tables) -> Self {
        Intel263BR {
            br:     BitReader::new(src, src.len(), BitReaderMode::BE),
            tables: tables,
            gob_no: 0,
            mb_w:   0,
            is_pb:  false,
        }
    }

    fn decode_block(&mut self, quant: u8, intra: bool, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()> {
        let mut br = &mut self.br;
        let mut idx = 0;
        if intra {
            let mut dc = br.read(8)?;
            if dc == 255 { dc = 128; }
            blk[0] = (dc as i16) << 3;
            idx = 1;
        }
        if !coded { return Ok(()); }

        let rl_cb = &self.tables.rl_cb; // could be aic too
        let q_add = if quant == 0 { 0i16 } else { ((quant - 1) | 1) as i16 };
        let q = (quant * 2) as i16;
        while idx < 64 {
            let code = br.read_cb(rl_cb)?;
            let run;
            let mut level;
            let last;
            if !code.is_escape() {
                run   = code.get_run();
                level = code.get_level();
                last  = code.is_last();
                if br.read_bool()? { level = -level; }
                level = (level * q) + q_add;
            } else {
                last  = br.read_bool()?;
                run   = br.read(6)? as u8;
                level = br.read_s(8)? as i16;
                if level == -128 {
                    let low = br.read(5)? as i16;
                    let top = br.read_s(6)? as i16;
                    level = (top << 5) | low;
                }
                level = (level * q) + q_add;
                if level < -2048 { level = -2048; }
                if level >  2047 { level =  2047; }
            }
            idx += run;
            validate!(idx < 64);
            let oidx = H263_ZIGZAG[idx as usize];
            blk[oidx] = level;
            idx += 1;
            if last { break; }
        }
        Ok(())
    }
}

fn decode_mv_component(br: &mut BitReader, mv_cb: &Codebook<u8>) -> DecoderResult<i16> {
    let code = br.read_cb(mv_cb)? as i16;
    if code == 0 { return Ok(0) }
    if !br.read_bool()? {
        Ok(code)
    } else {
        Ok(-code)
    }
}

fn decode_mv(br: &mut BitReader, mv_cb: &Codebook<u8>) -> DecoderResult<MV> {
    let xval = decode_mv_component(br, mv_cb)?;
    let yval = decode_mv_component(br, mv_cb)?;
    Ok(MV::new(xval, yval))
}

fn decode_b_info(br: &mut BitReader, is_pb: bool, is_intra: bool) -> DecoderResult<BBlockInfo> {
    if is_pb { // as improved pb
        let pb_mv_add = if is_intra { 1 } else { 0 };
        if br.read_bool()?{
            if br.read_bool()? {
                let pb_mv_count = 1 - (br.read(1)? as usize);
                let cbpb = br.read(6)? as u8;
                Ok(BBlockInfo::new(true, cbpb, pb_mv_count + pb_mv_add, pb_mv_count == 1))
            } else {
                Ok(BBlockInfo::new(true, 0, 1 + pb_mv_add, true))
            }
        } else {
            Ok(BBlockInfo::new(true, 0, pb_mv_add, false))
        }
    } else {
        Ok(BBlockInfo::new(false, 0, 0, false))
    }
}

impl<'a> BlockDecoder for Intel263BR<'a> {

#[allow(unused_variables)]
    fn decode_pichdr(&mut self) -> DecoderResult<PicInfo> {
        let mut br = &mut self.br;
        let syncw = br.read(22)?;
        validate!(syncw == 0x000020);
        let tr = br.read(8)? as u8;
        check_marker(br)?;
        let id = br.read(1)?;
        validate!(id == 0);
        br.read(1)?; // split screen indicator
        br.read(1)?; // document camera indicator
        br.read(1)?; // freeze picture release
        let mut sfmt = br.read(3)?;
        validate!((sfmt != 0b000) && (sfmt != 0b110));
        let is_intra = !br.read_bool()?;
        let umv = br.read_bool()?;
        br.read(1)?; // syntax arithmetic coding
        let apm = br.read_bool()?;
        self.is_pb = br.read_bool()?;
        let deblock;
        if sfmt == 0b111 {
            sfmt = br.read(3)?;
            validate!((sfmt != 0b000) && (sfmt != 0b111));
            br.read(2)?; // unknown flags
            deblock = br.read_bool()?;
            br.read(1)?; // unknown flag
            let pbplus = br.read_bool()?;
            br.read(5)?; // unknown flags
            let marker = br.read(5)?;
            validate!(marker == 1);
        } else {
            deblock = false;
        }
        let w; let h;
        if sfmt == 0b110 {
            let par = br.read(4)?;
            w = ((br.read(9)? + 1) * 4) as usize;
            check_marker(br)?;
            h = ((br.read(9)? + 1) * 4) as usize;
            if par == 0b1111 {
                let pixw = br.read(8)?;
                let pixh = br.read(8)?;
                validate!((pixw != 0) && (pixh != 0));
            }
        } else {
            let (w_, h_) = H263_SIZES[sfmt as usize];
            w = w_;
            h = h_;
        }
        let quant = br.read(5)?;
        let cpm = br.read_bool()?;
        validate!(!cpm);

        let pbinfo;
        if self.is_pb {
            let trb = br.read(3)?;
            let dbquant = br.read(2)?;
            pbinfo = Some(PBInfo::new(trb as u8, dbquant as u8));
        } else {
            pbinfo = None;
        }
        while br.read_bool()? { // skip PEI
            br.read(8)?;
        }
//println!("frame {}x{} intra: {} q {} pb {} apm {} umv {} @{}", w, h, is_intra, quant, self.is_pb, apm, umv, br.tell());
        self.gob_no = 0;
        self.mb_w = (w + 15) >> 4;

        let ftype = if is_intra { Type::I } else { Type::P };
        let mvmode = if umv { MVMode::UMV } else { MVMode::Long };
        let picinfo = PicInfo::new(w, h, ftype, quant as u8, apm, mvmode, tr, pbinfo, deblock);
        Ok(picinfo)
    }

    #[allow(unused_variables)]
    fn decode_slice_header(&mut self, info: &PicInfo) -> DecoderResult<Slice> {
        let mut br = &mut self.br;
        let gbsc = br.read(17)?;
        validate!(gbsc == 1);
        let gn = br.read(5)?;
        let gfid = br.read(2)?;
        let gquant = br.read(5)?;
//println!("GOB gn {:X} id {} q {}", gn, gfid, gquant);
        let ret = Slice::new(0, self.gob_no, gquant as u8);
        self.gob_no += 1;
        Ok(ret)
    }

    fn decode_block_header(&mut self, info: &PicInfo, slice: &Slice) -> DecoderResult<BlockInfo> {
        let mut br = &mut self.br;
        let mut q = slice.get_quant();
        match info.get_mode() {
            Type::I => {
                    let mut cbpc = br.read_cb(&self.tables.intra_mcbpc_cb)?;
                    while cbpc == 8 { cbpc = br.read_cb(&self.tables.intra_mcbpc_cb)?; }
                    let cbpy = br.read_cb(&self.tables.cbpy_cb)?;
                    let cbp = (cbpy << 2) | (cbpc & 3);
                    let dquant = (cbpc & 4) != 0;
                    if dquant {
                        let idx = br.read(2)? as usize;
                        q = ((q as i16) + (H263_DQUANT_TAB[idx] as i16)) as u8;
                    }
                    Ok(BlockInfo::new(Type::I, cbp, q))
                },
            Type::P => {
                    if br.read_bool()? { return Ok(BlockInfo::new(Type::Skip, 0, info.get_quant())); }
                    let mut cbpc = br.read_cb(&self.tables.inter_mcbpc_cb)?;
                    while cbpc == 20 { cbpc = br.read_cb(&self.tables.inter_mcbpc_cb)?; }
                    let is_intra = (cbpc & 0x04) != 0;
                    let dquant   = (cbpc & 0x08) != 0;
                    let is_4x4   = (cbpc & 0x10) != 0;
                    if is_intra {
                        let mut mvec: Vec<MV> = Vec::new();
                        let bbinfo = decode_b_info(br, self.is_pb, true)?;
                        let cbpy = br.read_cb(&self.tables.cbpy_cb)?;
                        let cbp = (cbpy << 2) | (cbpc & 3);
                        if dquant {
                            let idx = br.read(2)? as usize;
                            q = ((q as i16) + (H263_DQUANT_TAB[idx] as i16)) as u8;
                        }
                        let mut binfo = BlockInfo::new(Type::I, cbp, q);
                        binfo.set_bpart(bbinfo);
                        if self.is_pb {
                            for _ in 0..bbinfo.get_num_mv() {
                                mvec.push(decode_mv(br, &self.tables.mv_cb)?);
                            }
                            binfo.set_b_mv(mvec.as_slice());
                        }
                        return Ok(binfo);
                    }

                    let bbinfo = decode_b_info(br, self.is_pb, false)?;
                    let mut cbpy = br.read_cb(&self.tables.cbpy_cb)?;
//                    if /* !aiv && */(cbpc & 3) != 3 {
                        cbpy ^= 0xF;
//                    }
                    let cbp = (cbpy << 2) | (cbpc & 3);
                    if dquant {
                        let idx = br.read(2)? as usize;
                        q = ((q as i16) + (H263_DQUANT_TAB[idx] as i16)) as u8;
                    }
                    let mut binfo = BlockInfo::new(Type::P, cbp, q);
                    binfo.set_bpart(bbinfo);
                    if !is_4x4 {
                        let mvec: [MV; 1] = [decode_mv(br, &self.tables.mv_cb)?];
                        binfo.set_mv(&mvec);
                    } else {
                        let mvec: [MV; 4] = [
                                decode_mv(br, &self.tables.mv_cb)?,
                                decode_mv(br, &self.tables.mv_cb)?,
                                decode_mv(br, &self.tables.mv_cb)?,
                                decode_mv(br, &self.tables.mv_cb)?
                            ];
                        binfo.set_mv(&mvec);
                    }
                    if self.is_pb {
                        let mut mvec: Vec<MV> = Vec::with_capacity(bbinfo.get_num_mv());
                        for _ in 0..bbinfo.get_num_mv() {
                            let mv = decode_mv(br, &self.tables.mv_cb)?;
                            mvec.push(mv);
                        }
                        binfo.set_b_mv(mvec.as_slice());
                    }
                    Ok(binfo)
                },
            _ => { Err(DecoderError::InvalidData) },
        }
    }

    #[allow(unused_variables)]
    fn decode_block_intra(&mut self, info: &BlockInfo, quant: u8, no: usize, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()> {
        self.decode_block(quant, true, coded, blk)
    }

    #[allow(unused_variables)]
    fn decode_block_inter(&mut self, info: &BlockInfo, quant: u8, no: usize, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()> {
        self.decode_block(quant, false, coded, blk)
    }

    fn is_slice_end(&mut self) -> bool { self.br.peek(16) == 0 }

    fn filter_row(&mut self, buf: &mut NAVideoBuffer<u8>, mb_y: usize, mb_w: usize, cbpi: &CBPInfo) {
        let stride  = buf.get_stride(0);
        let mut off = buf.get_offset(0) + mb_y * 16 * stride;
        for mb_x in 0..mb_w {
            let coff = off;
            let coded0 = cbpi.is_coded(mb_x, 0);
            let coded1 = cbpi.is_coded(mb_x, 1);
            let q = cbpi.get_q(mb_w + mb_x);
            if mb_y != 0 {
                if coded0 && cbpi.is_coded_top(mb_x, 0) { deblock_hor(buf, 0, q, coff); }
                if coded1 && cbpi.is_coded_top(mb_x, 1) { deblock_hor(buf, 0, q, coff + 8); }
            }
            let coff = off + 8 * stride;
            if cbpi.is_coded(mb_x, 2) && coded0 { deblock_hor(buf, 0, q, coff); }
            if cbpi.is_coded(mb_x, 3) && coded1 { deblock_hor(buf, 0, q, coff + 8); }
            off += 16;
        }
        let mut leftt = false;
        let mut leftc = false;
        let mut off = buf.get_offset(0) + mb_y * 16 * stride;
        for mb_x in 0..mb_w {
            let ctop0 = cbpi.is_coded_top(mb_x, 0);
            let ctop1 = cbpi.is_coded_top(mb_x, 0);
            let ccur0 = cbpi.is_coded(mb_x, 0);
            let ccur1 = cbpi.is_coded(mb_x, 1);
            let q = cbpi.get_q(mb_w + mb_x);
            if mb_y != 0 {
                let coff = off - 8 * stride;
                let qtop = cbpi.get_q(mb_x);
                if leftt && ctop0 { deblock_ver(buf, 0, qtop, coff); }
                if ctop0 && ctop1 { deblock_ver(buf, 0, qtop, coff + 8); }
            }
            if leftc && ccur0 { deblock_ver(buf, 0, q, off); }
            if ccur0 && ccur1 { deblock_ver(buf, 0, q, off + 8); }
            leftt = ctop1;
            leftc = ccur1;
            off += 16;
        }
        let strideu  = buf.get_stride(1);
        let stridev  = buf.get_stride(2);
        let offu = buf.get_offset(1) + mb_y * 8 * strideu;
        let offv = buf.get_offset(2) + mb_y * 8 * stridev;
        if mb_y != 0 {
            for mb_x in 0..mb_w {
                let ctu = cbpi.is_coded_top(mb_x, 4);
                let ccu = cbpi.is_coded(mb_x, 4);
                let ctv = cbpi.is_coded_top(mb_x, 5);
                let ccv = cbpi.is_coded(mb_x, 5);
                let q = cbpi.get_q(mb_w + mb_x);
                if ctu && ccu { deblock_hor(buf, 1, q, offu + mb_x * 8); }
                if ctv && ccv { deblock_hor(buf, 2, q, offv + mb_x * 8); }
            }
            let mut leftu = false;
            let mut leftv = false;
            let offu = buf.get_offset(1) + (mb_y - 1) * 8 * strideu;
            let offv = buf.get_offset(2) + (mb_y - 1) * 8 * stridev;
            for mb_x in 0..mb_w {
                let ctu = cbpi.is_coded_top(mb_x, 4);
                let ctv = cbpi.is_coded_top(mb_x, 5);
                let qt = cbpi.get_q(mb_x);
                if leftu && ctu { deblock_ver(buf, 1, qt, offu + mb_x * 8); }
                if leftv && ctv { deblock_ver(buf, 2, qt, offv + mb_x * 8); }
                leftu = ctu;
                leftv = ctv;
            }
        }
    }
}

fn deblock_hor(buf: &mut NAVideoBuffer<u8>, comp: usize, q: u8, off: usize) {
    let stride = buf.get_stride(comp);
    let mut dptr = buf.get_data_mut();
    let mut buf = dptr.as_mut_slice();
    for x in 0..8 {
        let a = buf[off - 2 * stride + x] as i16;
        let b = buf[off - 1 * stride + x] as i16;
        let c = buf[off + 0 * stride + x] as i16;
        let d = buf[off + 1 * stride + x] as i16;
        let diff = ((a - d) * 3 + (c - b) * 8) >> 4;
        if (diff != 0) && (diff >= -32) && (diff < 32) {
            let d0 = diff.abs() * 2 - (q as i16);
            let d1 = if d0 < 0 { 0 } else { d0 };
            let d2 = diff.abs() - d1;
            let d3 = if d2 < 0 { 0 } else { d2 };

            let delta = if diff < 0 { -d3 } else { d3 };

            let b1 = b + delta;
            if      b1 < 0   { buf[off - 1 * stride + x] = 0; }
            else if b1 > 255 { buf[off - 1 * stride + x] = 0xFF; }
            else             { buf[off - 1 * stride + x] = b1 as u8; }
            let c1 = c - delta;
            if      c1 < 0   { buf[off + x] = 0; }
            else if c1 > 255 { buf[off + x] = 0xFF; }
            else             { buf[off + x] = c1 as u8; }
        }
    }
}

fn deblock_ver(buf: &mut NAVideoBuffer<u8>, comp: usize, q: u8, off: usize) {
    let stride = buf.get_stride(comp);
    let mut dptr = buf.get_data_mut();
    let mut buf = dptr.as_mut_slice();
    for y in 0..8 {
        let a = buf[off - 2 + y * stride] as i16;
        let b = buf[off - 1 + y * stride] as i16;
        let c = buf[off + 0 + y * stride] as i16;
        let d = buf[off + 1 + y * stride] as i16;
        let diff = ((a - d) * 3 + (c - b) * 8) >> 4;
        if (diff != 0) && (diff >= -32) && (diff < 32) {
            let d0 = diff.abs() * 2 - (q as i16);
            let d1 = if d0 < 0 { 0 } else { d0 };
            let d2 = diff.abs() - d1;
            let d3 = if d2 < 0 { 0 } else { d2 };

            let delta = if diff < 0 { -d3 } else { d3 };

            let b1 = b + delta;
            if      b1 < 0   { buf[off - 1 + y * stride] = 0; }
            else if b1 > 255 { buf[off - 1 + y * stride] = 0xFF; }
            else             { buf[off - 1 + y * stride] = b1 as u8; }
            let c1 = c - delta;
            if      c1 < 0   { buf[off + y * stride] = 0; }
            else if c1 > 255 { buf[off + y * stride] = 0xFF; }
            else             { buf[off + y * stride] = c1 as u8; }
        }
    }
}

impl Intel263Decoder {
    fn new() -> Self {
        let mut coderead = H263ShortCodeReader::new(H263_INTRA_MCBPC);
        let intra_mcbpc_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
        let mut coderead = H263ShortCodeReader::new(H263_INTER_MCBPC);
        let inter_mcbpc_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
        let mut coderead = H263ShortCodeReader::new(H263_CBPY);
        let cbpy_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
        let mut coderead = H263RLCodeReader::new(H263_RL_CODES);
        let rl_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
        let mut coderead = H263RLCodeReader::new(H263_RL_CODES_AIC);
        let aic_rl_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
        let mut coderead = H263ShortCodeReader::new(H263_MV);
        let mv_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
        let tables = Tables {
            intra_mcbpc_cb: intra_mcbpc_cb,
            inter_mcbpc_cb: inter_mcbpc_cb,
            cbpy_cb:        cbpy_cb,
            rl_cb:          rl_cb,
            aic_rl_cb:      aic_rl_cb,
            mv_cb:          mv_cb,
        };

        Intel263Decoder{
            info:           Rc::new(DUMMY_CODEC_INFO),
            dec:            H263BaseDecoder::new(),
            tables:         tables,
        }
    }
}

impl NADecoder for Intel263Decoder {
    fn init(&mut self, info: Rc<NACodecInfo>) -> DecoderResult<()> {
        if let NACodecTypeInfo::Video(vinfo) = info.get_properties() {
            let w = vinfo.get_width();
            let h = vinfo.get_height();
            let fmt = formats::YUV420_FORMAT;
            let myinfo = NACodecTypeInfo::Video(NAVideoInfo::new(w, h, false, fmt));
            self.info = Rc::new(NACodecInfo::new_ref(info.get_name(), myinfo, info.get_extradata()));
            Ok(())
        } else {
            Err(DecoderError::InvalidData)
        }
    }
    fn decode(&mut self, pkt: &NAPacket) -> DecoderResult<NAFrameRef> {
        let src = pkt.get_buffer();

        if src.len() == 8 {
            let bret = self.dec.get_bframe();
            let buftype;
            let is_skip;
            if let Ok(btype) = bret {
                buftype = btype;
                is_skip = false;
            } else {
                buftype = NABufferType::None;
                is_skip = true;
            }
            let mut frm = NAFrame::new_from_pkt(pkt, self.info.clone(), buftype);
            frm.set_keyframe(false);
            frm.set_frame_type(if is_skip { FrameType::Skip } else { FrameType::B });
            return Ok(Rc::new(RefCell::new(frm)));
        }
        let mut ibr = Intel263BR::new(&src, &self.tables);

        let bufinfo = self.dec.parse_frame(&mut ibr)?;

        let mut frm = NAFrame::new_from_pkt(pkt, self.info.clone(), bufinfo);
        frm.set_keyframe(self.dec.is_intra());
        frm.set_frame_type(if self.dec.is_intra() { FrameType::I } else { FrameType::P });
        Ok(Rc::new(RefCell::new(frm)))
    }
}


pub fn get_decoder() -> Box<NADecoder> {
    Box::new(Intel263Decoder::new())
}

#[cfg(test)]
mod test {
    use test::dec_video::test_file_decoding;
    #[test]
    fn test_intel263() {
         test_file_decoding("avi", "assets/neal73_saber.avi", Some(16), true, false, None);
    }
}
Commit	Line	Data
cf64af13 KS	1	use io::bitreader::*;
	2	use io::codebook::*;
	3	use formats;
88c58b1b	4	use super::super::*;
cf64af13	5	use super::*;
88c58b1b KS	6	use super::decoder::*;
88c58b1b KS	7	use super::data::*;
cf64af13 KS	8
	9	#[allow(dead_code)]
	10	struct Tables {
	11	intra_mcbpc_cb: Codebook<u8>,
	12	inter_mcbpc_cb: Codebook<u8>,
	13	cbpy_cb: Codebook<u8>,
	14	rl_cb: Codebook<H263RLSym>,
	15	aic_rl_cb: Codebook<H263RLSym>,
	16	mv_cb: Codebook<u8>,
	17	}
	18
	19	struct Intel263Decoder {
	20	info: Rc<NACodecInfo>,
88c58b1b	21	dec: H263BaseDecoder,
cf64af13 KS	22	tables: Tables,
	23	}
	24
	25	struct Intel263BR<'a> {
	26	br: BitReader<'a>,
	27	tables: &'a Tables,
	28	gob_no: usize,
	29	mb_w: usize,
	30	is_pb: bool,
	31	}
	32
	33	fn check_marker<'a>(br: &mut BitReader<'a>) -> DecoderResult<()> {
	34	let mark = br.read(1)?;
	35	validate!(mark == 1);
	36	Ok(())
	37	}
	38
	39	impl<'a> Intel263BR<'a> {
	40	fn new(src: &'a [u8], tables: &'a Tables) -> Self {
	41	Intel263BR {
	42	br: BitReader::new(src, src.len(), BitReaderMode::BE),
	43	tables: tables,
	44	gob_no: 0,
	45	mb_w: 0,
	46	is_pb: false,
	47	}
	48	}
	49
	50	fn decode_block(&mut self, quant: u8, intra: bool, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()> {
	51	let mut br = &mut self.br;
	52	let mut idx = 0;
	53	if intra {
	54	let mut dc = br.read(8)?;
	55	if dc == 255 { dc = 128; }
	56	blk[0] = (dc as i16) << 3;
	57	idx = 1;
	58	}
	59	if !coded { return Ok(()); }
	60
	61	let rl_cb = &self.tables.rl_cb; // could be aic too
	62	let q_add = if quant == 0 { 0i16 } else { ((quant - 1) \| 1) as i16 };
	63	let q = (quant * 2) as i16;
	64	while idx < 64 {
	65	let code = br.read_cb(rl_cb)?;
	66	let run;
	67	let mut level;
	68	let last;
	69	if !code.is_escape() {
	70	run = code.get_run();
	71	level = code.get_level();
	72	last = code.is_last();
	73	if br.read_bool()? { level = -level; }
	74	level = (level * q) + q_add;
	75	} else {
	76	last = br.read_bool()?;
	77	run = br.read(6)? as u8;
	78	level = br.read_s(8)? as i16;
	79	if level == -128 {
	80	let low = br.read(5)? as i16;
	81	let top = br.read_s(6)? as i16;
	82	level = (top << 5) \| low;
	83	}
	84	level = (level * q) + q_add;
	85	if level < -2048 { level = -2048; }
86	if level > 2047 { level = 2047; }
87	}
88	idx += run;
89	validate!(idx < 64);
90	let oidx = H263_ZIGZAG[idx as usize];
91	blk[oidx] = level;
92	idx += 1;
93	if last { break; }
94	}
95	Ok(())
96	}
97	}
98
99	fn decode_mv_component(br: &mut BitReader, mv_cb: &Codebook<u8>) -> DecoderResult<i16> {
100	let code = br.read_cb(mv_cb)? as i16;
101	if code == 0 { return Ok(0) }
102	if !br.read_bool()? {
103	Ok(code)
104	} else {
105	Ok(-code)
106	}
107	}
108
109	fn decode_mv(br: &mut BitReader, mv_cb: &Codebook<u8>) -> DecoderResult<MV> {
110	let xval = decode_mv_component(br, mv_cb)?;
111	let yval = decode_mv_component(br, mv_cb)?;
112	Ok(MV::new(xval, yval))
113	}
114
21c16d5f KS	115	fn decode_b_info(br: &mut BitReader, is_pb: bool, is_intra: bool) -> DecoderResult<BBlockInfo> {
	116	if is_pb { // as improved pb
	117	let pb_mv_add = if is_intra { 1 } else { 0 };
	118	if br.read_bool()?{
	119	if br.read_bool()? {
	120	let pb_mv_count = 1 - (br.read(1)? as usize);
	121	let cbpb = br.read(6)? as u8;
	122	Ok(BBlockInfo::new(true, cbpb, pb_mv_count + pb_mv_add, pb_mv_count == 1))
	123	} else {
	124	Ok(BBlockInfo::new(true, 0, 1 + pb_mv_add, true))
	125	}
	126	} else {
	127	Ok(BBlockInfo::new(true, 0, pb_mv_add, false))
	128	}
	129	} else {
	130	Ok(BBlockInfo::new(false, 0, 0, false))
	131	}
	132	}
	133
cf64af13 KS	134	impl<'a> BlockDecoder for Intel263BR<'a> {
	135
	136	#[allow(unused_variables)]
	137	fn decode_pichdr(&mut self) -> DecoderResult<PicInfo> {
	138	let mut br = &mut self.br;
	139	let syncw = br.read(22)?;
	140	validate!(syncw == 0x000020);
	141	let tr = br.read(8)? as u8;
	142	check_marker(br)?;
	143	let id = br.read(1)?;
	144	validate!(id == 0);
	145	br.read(1)?; // split screen indicator
	146	br.read(1)?; // document camera indicator
	147	br.read(1)?; // freeze picture release
	148	let mut sfmt = br.read(3)?;
	149	validate!((sfmt != 0b000) && (sfmt != 0b110));
	150	let is_intra = !br.read_bool()?;
	151	let umv = br.read_bool()?;
	152	br.read(1)?; // syntax arithmetic coding
	153	let apm = br.read_bool()?;
	154	self.is_pb = br.read_bool()?;
f2f1afb2	155	let deblock;
cf64af13 KS	156	if sfmt == 0b111 {
	157	sfmt = br.read(3)?;
	158	validate!((sfmt != 0b000) && (sfmt != 0b111));
	159	br.read(2)?; // unknown flags
f2f1afb2	160	deblock = br.read_bool()?;
cf64af13 KS	161	br.read(1)?; // unknown flag
	162	let pbplus = br.read_bool()?;
	163	br.read(5)?; // unknown flags
	164	let marker = br.read(5)?;
	165	validate!(marker == 1);
f2f1afb2 KS	166	} else {
f2f1afb2 KS	167	deblock = false;
cf64af13 KS	168	}
	169	let w; let h;
	170	if sfmt == 0b110 {
	171	let par = br.read(4)?;
	172	w = ((br.read(9)? + 1) * 4) as usize;
	173	check_marker(br)?;
	174	h = ((br.read(9)? + 1) * 4) as usize;
	175	if par == 0b1111 {
	176	let pixw = br.read(8)?;
	177	let pixh = br.read(8)?;
	178	validate!((pixw != 0) && (pixh != 0));
	179	}
	180	} else {
	181	let (w_, h_) = H263_SIZES[sfmt as usize];
	182	w = w_;
	183	h = h_;
	184	}
	185	let quant = br.read(5)?;
	186	let cpm = br.read_bool()?;
	187	validate!(!cpm);
21c16d5f KS	188
21c16d5f KS	189	let pbinfo;
cf64af13 KS	190	if self.is_pb {
	191	let trb = br.read(3)?;
	192	let dbquant = br.read(2)?;
21c16d5f KS	193	pbinfo = Some(PBInfo::new(trb as u8, dbquant as u8));
	194	} else {
	195	pbinfo = None;
cf64af13 KS	196	}
	197	while br.read_bool()? { // skip PEI
	198	br.read(8)?;
	199	}
21c16d5f	200	//println!("frame {}x{} intra: {} q {} pb {} apm {} umv {} @{}", w, h, is_intra, quant, self.is_pb, apm, umv, br.tell());
cf64af13 KS	201	self.gob_no = 0;
	202	self.mb_w = (w + 15) >> 4;
	203
	204	let ftype = if is_intra { Type::I } else { Type::P };
2324f30b KS	205	let mvmode = if umv { MVMode::UMV } else { MVMode::Long };
2324f30b KS	206	let picinfo = PicInfo::new(w, h, ftype, quant as u8, apm, mvmode, tr, pbinfo, deblock);
cf64af13 KS	207	Ok(picinfo)
	208	}
	209
	210	#[allow(unused_variables)]
	211	fn decode_slice_header(&mut self, info: &PicInfo) -> DecoderResult<Slice> {
	212	let mut br = &mut self.br;
	213	let gbsc = br.read(17)?;
cf64af13 KS	214	validate!(gbsc == 1);
	215	let gn = br.read(5)?;
	216	let gfid = br.read(2)?;
	217	let gquant = br.read(5)?;
21c16d5f	218	//println!("GOB gn {:X} id {} q {}", gn, gfid, gquant);
cf64af13 KS	219	let ret = Slice::new(0, self.gob_no, gquant as u8);
	220	self.gob_no += 1;
	221	Ok(ret)
	222	}
	223
	224	fn decode_block_header(&mut self, info: &PicInfo, slice: &Slice) -> DecoderResult<BlockInfo> {
	225	let mut br = &mut self.br;
	226	let mut q = slice.get_quant();
	227	match info.get_mode() {
	228	Type::I => {
	229	let mut cbpc = br.read_cb(&self.tables.intra_mcbpc_cb)?;
	230	while cbpc == 8 { cbpc = br.read_cb(&self.tables.intra_mcbpc_cb)?; }
	231	let cbpy = br.read_cb(&self.tables.cbpy_cb)?;
	232	let cbp = (cbpy << 2) \| (cbpc & 3);
	233	let dquant = (cbpc & 4) != 0;
	234	if dquant {
	235	let idx = br.read(2)? as usize;
	236	q = ((q as i16) + (H263_DQUANT_TAB[idx] as i16)) as u8;
	237	}
cf64af13 KS	238	Ok(BlockInfo::new(Type::I, cbp, q))
	239	},
	240	Type::P => {
cf64af13 KS	241	if br.read_bool()? { return Ok(BlockInfo::new(Type::Skip, 0, info.get_quant())); }
	242	let mut cbpc = br.read_cb(&self.tables.inter_mcbpc_cb)?;
	243	while cbpc == 20 { cbpc = br.read_cb(&self.tables.inter_mcbpc_cb)?; }
	244	let is_intra = (cbpc & 0x04) != 0;
	245	let dquant = (cbpc & 0x08) != 0;
	246	let is_4x4 = (cbpc & 0x10) != 0;
	247	if is_intra {
	248	let mut mvec: Vec<MV> = Vec::new();
21c16d5f	249	let bbinfo = decode_b_info(br, self.is_pb, true)?;
cf64af13 KS	250	let cbpy = br.read_cb(&self.tables.cbpy_cb)?;
	251	let cbp = (cbpy << 2) \| (cbpc & 3);
	252	if dquant {
	253	let idx = br.read(2)? as usize;
	254	q = ((q as i16) + (H263_DQUANT_TAB[idx] as i16)) as u8;
	255	}
	256	let mut binfo = BlockInfo::new(Type::I, cbp, q);
21c16d5f	257	binfo.set_bpart(bbinfo);
cf64af13	258	if self.is_pb {
21c16d5f	259	for _ in 0..bbinfo.get_num_mv() {
cf64af13 KS	260	mvec.push(decode_mv(br, &self.tables.mv_cb)?);
cf64af13 KS	261	}
21c16d5f	262	binfo.set_b_mv(mvec.as_slice());
cf64af13	263	}
cf64af13 KS	264	return Ok(binfo);
	265	}
	266
21c16d5f	267	let bbinfo = decode_b_info(br, self.is_pb, false)?;
cf64af13 KS	268	let mut cbpy = br.read_cb(&self.tables.cbpy_cb)?;
	269	// if /* !aiv && */(cbpc & 3) != 3 {
	270	cbpy ^= 0xF;
	271	// }
	272	let cbp = (cbpy << 2) \| (cbpc & 3);
	273	if dquant {
	274	let idx = br.read(2)? as usize;
	275	q = ((q as i16) + (H263_DQUANT_TAB[idx] as i16)) as u8;
	276	}
	277	let mut binfo = BlockInfo::new(Type::P, cbp, q);
21c16d5f	278	binfo.set_bpart(bbinfo);
cf64af13 KS	279	if !is_4x4 {
cf64af13 KS	280	let mvec: [MV; 1] = [decode_mv(br, &self.tables.mv_cb)?];
cf64af13 KS	281	binfo.set_mv(&mvec);
	282	} else {
	283	let mvec: [MV; 4] = [
	284	decode_mv(br, &self.tables.mv_cb)?,
	285	decode_mv(br, &self.tables.mv_cb)?,
	286	decode_mv(br, &self.tables.mv_cb)?,
	287	decode_mv(br, &self.tables.mv_cb)?
	288	];
	289	binfo.set_mv(&mvec);
	290	}
	291	if self.is_pb {
21c16d5f KS	292	let mut mvec: Vec<MV> = Vec::with_capacity(bbinfo.get_num_mv());
21c16d5f KS	293	for _ in 0..bbinfo.get_num_mv() {
cf64af13 KS	294	let mv = decode_mv(br, &self.tables.mv_cb)?;
	295	mvec.push(mv);
	296	}
21c16d5f	297	binfo.set_b_mv(mvec.as_slice());
cf64af13	298	}
cf64af13 KS	299	Ok(binfo)
	300	},
	301	_ => { Err(DecoderError::InvalidData) },
	302	}
	303	}
	304
	305	#[allow(unused_variables)]
21c16d5f KS	306	fn decode_block_intra(&mut self, info: &BlockInfo, quant: u8, no: usize, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()> {
21c16d5f KS	307	self.decode_block(quant, true, coded, blk)
cf64af13 KS	308	}
	309
	310	#[allow(unused_variables)]
21c16d5f KS	311	fn decode_block_inter(&mut self, info: &BlockInfo, quant: u8, no: usize, coded: bool, blk: &mut [i16; 64]) -> DecoderResult<()> {
21c16d5f KS	312	self.decode_block(quant, false, coded, blk)
cf64af13 KS	313	}
cf64af13 KS	314
cf64af13	315	fn is_slice_end(&mut self) -> bool { self.br.peek(16) == 0 }
f2f1afb2 KS	316
	317	fn filter_row(&mut self, buf: &mut NAVideoBuffer<u8>, mb_y: usize, mb_w: usize, cbpi: &CBPInfo) {
	318	let stride = buf.get_stride(0);
	319	let mut off = buf.get_offset(0) + mb_y * 16 * stride;
	320	for mb_x in 0..mb_w {
	321	let coff = off;
	322	let coded0 = cbpi.is_coded(mb_x, 0);
	323	let coded1 = cbpi.is_coded(mb_x, 1);
	324	let q = cbpi.get_q(mb_w + mb_x);
	325	if mb_y != 0 {
	326	if coded0 && cbpi.is_coded_top(mb_x, 0) { deblock_hor(buf, 0, q, coff); }
	327	if coded1 && cbpi.is_coded_top(mb_x, 1) { deblock_hor(buf, 0, q, coff + 8); }
	328	}
	329	let coff = off + 8 * stride;
	330	if cbpi.is_coded(mb_x, 2) && coded0 { deblock_hor(buf, 0, q, coff); }
	331	if cbpi.is_coded(mb_x, 3) && coded1 { deblock_hor(buf, 0, q, coff + 8); }
	332	off += 16;
	333	}
	334	let mut leftt = false;
	335	let mut leftc = false;
	336	let mut off = buf.get_offset(0) + mb_y * 16 * stride;
	337	for mb_x in 0..mb_w {
	338	let ctop0 = cbpi.is_coded_top(mb_x, 0);
	339	let ctop1 = cbpi.is_coded_top(mb_x, 0);
	340	let ccur0 = cbpi.is_coded(mb_x, 0);
	341	let ccur1 = cbpi.is_coded(mb_x, 1);
	342	let q = cbpi.get_q(mb_w + mb_x);
	343	if mb_y != 0 {
	344	let coff = off - 8 * stride;
	345	let qtop = cbpi.get_q(mb_x);
	346	if leftt && ctop0 { deblock_ver(buf, 0, qtop, coff); }
	347	if ctop0 && ctop1 { deblock_ver(buf, 0, qtop, coff + 8); }
	348	}
	349	if leftc && ccur0 { deblock_ver(buf, 0, q, off); }
	350	if ccur0 && ccur1 { deblock_ver(buf, 0, q, off + 8); }
	351	leftt = ctop1;
	352	leftc = ccur1;
	353	off += 16;
	354	}
	355	let strideu = buf.get_stride(1);
	356	let stridev = buf.get_stride(2);
	357	let offu = buf.get_offset(1) + mb_y * 8 * strideu;
	358	let offv = buf.get_offset(2) + mb_y * 8 * stridev;
	359	if mb_y != 0 {
	360	for mb_x in 0..mb_w {
	361	let ctu = cbpi.is_coded_top(mb_x, 4);
	362	let ccu = cbpi.is_coded(mb_x, 4);
	363	let ctv = cbpi.is_coded_top(mb_x, 5);
	364	let ccv = cbpi.is_coded(mb_x, 5);
	365	let q = cbpi.get_q(mb_w + mb_x);
	366	if ctu && ccu { deblock_hor(buf, 1, q, offu + mb_x * 8); }
	367	if ctv && ccv { deblock_hor(buf, 2, q, offv + mb_x * 8); }
	368	}
	369	let mut leftu = false;
	370	let mut leftv = false;
	371	let offu = buf.get_offset(1) + (mb_y - 1) * 8 * strideu;
	372	let offv = buf.get_offset(2) + (mb_y - 1) * 8 * stridev;
	373	for mb_x in 0..mb_w {
	374	let ctu = cbpi.is_coded_top(mb_x, 4);
	375	let ctv = cbpi.is_coded_top(mb_x, 5);
	376	let qt = cbpi.get_q(mb_x);
	377	if leftu && ctu { deblock_ver(buf, 1, qt, offu + mb_x * 8); }
	378	if leftv && ctv { deblock_ver(buf, 2, qt, offv + mb_x * 8); }
	379	leftu = ctu;
380	leftv = ctv;
381	}
382	}
383	}
384	}
385
386	fn deblock_hor(buf: &mut NAVideoBuffer<u8>, comp: usize, q: u8, off: usize) {
387	let stride = buf.get_stride(comp);
388	let mut dptr = buf.get_data_mut();
389	let mut buf = dptr.as_mut_slice();
390	for x in 0..8 {
391	let a = buf[off - 2 * stride + x] as i16;
392	let b = buf[off - 1 * stride + x] as i16;
393	let c = buf[off + 0 * stride + x] as i16;
394	let d = buf[off + 1 * stride + x] as i16;
395	let diff = ((a - d) * 3 + (c - b) * 8) >> 4;
396	if (diff != 0) && (diff >= -32) && (diff < 32) {
397	let d0 = diff.abs() * 2 - (q as i16);
398	let d1 = if d0 < 0 { 0 } else { d0 };
399	let d2 = diff.abs() - d1;
400	let d3 = if d2 < 0 { 0 } else { d2 };
401
402	let delta = if diff < 0 { -d3 } else { d3 };
403
404	let b1 = b + delta;
405	if b1 < 0 { buf[off - 1 * stride + x] = 0; }
406	else if b1 > 255 { buf[off - 1 * stride + x] = 0xFF; }
407	else { buf[off - 1 * stride + x] = b1 as u8; }
408	let c1 = c - delta;
409	if c1 < 0 { buf[off + x] = 0; }
410	else if c1 > 255 { buf[off + x] = 0xFF; }
411	else { buf[off + x] = c1 as u8; }
412	}
413	}
414	}
415
416	fn deblock_ver(buf: &mut NAVideoBuffer<u8>, comp: usize, q: u8, off: usize) {
417	let stride = buf.get_stride(comp);
418	let mut dptr = buf.get_data_mut();
419	let mut buf = dptr.as_mut_slice();
420	for y in 0..8 {
421	let a = buf[off - 2 + y * stride] as i16;
422	let b = buf[off - 1 + y * stride] as i16;
423	let c = buf[off + 0 + y * stride] as i16;
424	let d = buf[off + 1 + y * stride] as i16;
425	let diff = ((a - d) * 3 + (c - b) * 8) >> 4;
426	if (diff != 0) && (diff >= -32) && (diff < 32) {
427	let d0 = diff.abs() * 2 - (q as i16);
428	let d1 = if d0 < 0 { 0 } else { d0 };
429	let d2 = diff.abs() - d1;
430	let d3 = if d2 < 0 { 0 } else { d2 };
431
432	let delta = if diff < 0 { -d3 } else { d3 };
433
434	let b1 = b + delta;
435	if b1 < 0 { buf[off - 1 + y * stride] = 0; }
436	else if b1 > 255 { buf[off - 1 + y * stride] = 0xFF; }
437	else { buf[off - 1 + y * stride] = b1 as u8; }
438	let c1 = c - delta;
439	if c1 < 0 { buf[off + y * stride] = 0; }
440	else if c1 > 255 { buf[off + y * stride] = 0xFF; }
441	else { buf[off + y * stride] = c1 as u8; }
442	}
443	}
cf64af13 KS	444	}
	445
	446	impl Intel263Decoder {
	447	fn new() -> Self {
	448	let mut coderead = H263ShortCodeReader::new(H263_INTRA_MCBPC);
	449	let intra_mcbpc_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
	450	let mut coderead = H263ShortCodeReader::new(H263_INTER_MCBPC);
	451	let inter_mcbpc_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
	452	let mut coderead = H263ShortCodeReader::new(H263_CBPY);
	453	let cbpy_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
	454	let mut coderead = H263RLCodeReader::new(H263_RL_CODES);
	455	let rl_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
	456	let mut coderead = H263RLCodeReader::new(H263_RL_CODES_AIC);
	457	let aic_rl_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
	458	let mut coderead = H263ShortCodeReader::new(H263_MV);
	459	let mv_cb = Codebook::new(&mut coderead, CodebookMode::MSB).unwrap();
	460	let tables = Tables {
	461	intra_mcbpc_cb: intra_mcbpc_cb,
	462	inter_mcbpc_cb: inter_mcbpc_cb,
	463	cbpy_cb: cbpy_cb,
	464	rl_cb: rl_cb,
	465	aic_rl_cb: aic_rl_cb,
	466	mv_cb: mv_cb,
	467	};
	468
	469	Intel263Decoder{
	470	info: Rc::new(DUMMY_CODEC_INFO),
88c58b1b	471	dec: H263BaseDecoder::new(),
cf64af13 KS	472	tables: tables,
	473	}
	474	}
	475	}
	476
	477	impl NADecoder for Intel263Decoder {
	478	fn init(&mut self, info: Rc<NACodecInfo>) -> DecoderResult<()> {
	479	if let NACodecTypeInfo::Video(vinfo) = info.get_properties() {
	480	let w = vinfo.get_width();
	481	let h = vinfo.get_height();
	482	let fmt = formats::YUV420_FORMAT;
	483	let myinfo = NACodecTypeInfo::Video(NAVideoInfo::new(w, h, false, fmt));
	484	self.info = Rc::new(NACodecInfo::new_ref(info.get_name(), myinfo, info.get_extradata()));
	485	Ok(())
	486	} else {
	487	Err(DecoderError::InvalidData)
	488	}
	489	}
	490	fn decode(&mut self, pkt: &NAPacket) -> DecoderResult<NAFrameRef> {
	491	let src = pkt.get_buffer();
	492
	493	if src.len() == 8 {
21c16d5f	494	let bret = self.dec.get_bframe();
cf64af13 KS	495	let buftype;
	496	let is_skip;
	497	if let Ok(btype) = bret {
	498	buftype = btype;
	499	is_skip = false;
	500	} else {
	501	buftype = NABufferType::None;
	502	is_skip = true;
	503	}
	504	let mut frm = NAFrame::new_from_pkt(pkt, self.info.clone(), buftype);
	505	frm.set_keyframe(false);
21c16d5f	506	frm.set_frame_type(if is_skip { FrameType::Skip } else { FrameType::B });
cf64af13 KS	507	return Ok(Rc::new(RefCell::new(frm)));
cf64af13 KS	508	}
cf64af13 KS	509	let mut ibr = Intel263BR::new(&src, &self.tables);
	510
	511	let bufinfo = self.dec.parse_frame(&mut ibr)?;
	512
	513	let mut frm = NAFrame::new_from_pkt(pkt, self.info.clone(), bufinfo);
	514	frm.set_keyframe(self.dec.is_intra());
	515	frm.set_frame_type(if self.dec.is_intra() { FrameType::I } else { FrameType::P });
	516	Ok(Rc::new(RefCell::new(frm)))
	517	}
	518	}
	519
	520
	521	pub fn get_decoder() -> Box<NADecoder> {
	522	Box::new(Intel263Decoder::new())
	523	}
	524
	525	#[cfg(test)]
	526	mod test {
379fd781	527	use test::dec_video::test_file_decoding;
cf64af13 KS	528	#[test]
cf64af13 KS	529	fn test_intel263() {
379fd781	530	test_file_decoding("avi", "assets/neal73_saber.avi", Some(16), true, false, None);
cf64af13 KS	531	}
cf64af13 KS	532	}