1 use nihav_core::codecs::*;
2 use nihav_core::codecs::blockdsp::*;
4 pub const VP_YUVA420_FORMAT: NAPixelFormaton = NAPixelFormaton{
5 model: ColorModel::YUV(YUVSubmodel::YUVJ),
8 Some(NAPixelChromaton{ h_ss: 0, v_ss: 0, packed: false, depth: 8, shift: 0, comp_offs: 0, next_elem: 1}),
9 Some(NAPixelChromaton{ h_ss: 1, v_ss: 1, packed: false, depth: 8, shift: 0, comp_offs: 1, next_elem: 1}),
10 Some(NAPixelChromaton{ h_ss: 1, v_ss: 1, packed: false, depth: 8, shift: 0, comp_offs: 2, next_elem: 1}),
11 Some(NAPixelChromaton{ h_ss: 0, v_ss: 0, packed: false, depth: 8, shift: 0, comp_offs: 3, next_elem: 1}),
19 #[derive(Clone,Copy,Debug,PartialEq)]
34 pub const VP_REF_INTER: u8 = 1;
35 pub const VP_REF_GOLDEN: u8 = 2;
39 pub fn is_intra(self) -> bool { self == VPMBType::Intra }
40 pub fn get_ref_id(self) -> u8 {
45 VPMBType::InterNearest |
47 VPMBType::InterFourMV => VP_REF_INTER,
53 impl Default for VPMBType {
54 fn default() -> Self { VPMBType::Intra }
58 pub struct VPShuffler {
59 lastframe: Option<NAVideoBufferRef<u8>>,
60 goldframe: Option<NAVideoBufferRef<u8>>,
64 pub fn new() -> Self { VPShuffler { lastframe: None, goldframe: None } }
65 pub fn clear(&mut self) { self.lastframe = None; self.goldframe = None; }
66 pub fn add_frame(&mut self, buf: NAVideoBufferRef<u8>) {
67 self.lastframe = Some(buf);
69 pub fn add_golden_frame(&mut self, buf: NAVideoBufferRef<u8>) {
70 self.goldframe = Some(buf);
72 pub fn get_last(&mut self) -> Option<NAVideoBufferRef<u8>> {
73 if let Some(ref frm) = self.lastframe {
79 pub fn get_golden(&mut self) -> Option<NAVideoBufferRef<u8>> {
80 if let Some(ref frm) = self.goldframe {
86 pub fn has_refs(&self) -> bool {
87 self.lastframe.is_some()
91 pub const VP56_COEF_BASE: [i16; 6] = [ 5, 7, 11, 19, 35, 67 ];
92 pub const VP56_COEF_ADD_PROBS: [[u8; 12]; 6] = [
93 [ 159, 128, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 ],
94 [ 165, 145, 128, 0, 0, 0, 0, 0, 0, 0, 0, 0 ],
95 [ 173, 148, 140, 128, 0, 0, 0, 0, 0, 0, 0, 0 ],
96 [ 176, 155, 140, 135, 128, 0, 0, 0, 0, 0, 0, 0 ],
97 [ 180, 157, 141, 134, 130, 128, 0, 0, 0, 0, 0, 0 ],
98 [ 254, 254, 243, 230, 196, 177, 153, 140, 133, 130, 129, 128 ],
102 pub struct BoolCoder<'a> {
111 impl<'a> BoolCoder<'a> {
112 pub fn new(src: &'a [u8]) -> DecoderResult<Self> {
113 if src.len() < 3 { return Err(DecoderError::ShortData); }
114 let value = ((src[0] as u32) << 24) | ((src[1] as u32) << 16) | ((src[2] as u32) << 8) | (src[3] as u32);
115 Ok(Self { src, pos: 4, value, range: 255, bits: 8 })
117 pub fn read_bool(&mut self) -> bool {
120 pub fn read_prob(&mut self, prob: u8) -> bool {
122 let split = 1 + (((self.range - 1) * (prob as u32)) >> 8);
124 if self.value < (split << 24) {
129 self.value -= split << 24;
134 pub fn read_bits(&mut self, bits: u8) -> u32 {
137 val = (val << 1) | (self.read_prob(128) as u32);
141 pub fn read_byte(&mut self) -> u8 {
144 val = (val << 1) | (self.read_prob(128) as u8);
148 pub fn read_sbits(&mut self, bits: u8) -> i32 {
149 let mut val = if self.read_prob(128) { -1i32 } else { 0i32 };
151 val = (val << 1) | (self.read_prob(128) as i32);
155 pub fn read_probability(&mut self) -> u8 {
156 let val = self.read_bits(7) as u8;
163 fn renorm(&mut self) {
164 let shift = self.range.leading_zeros() & 7;
165 self.range <<= shift;
166 self.value <<= shift;
167 self.bits -= shift as i32;
168 if (self.bits <= 0) && (self.pos < self.src.len()) {
169 self.value |= (self.src[self.pos] as u32) << (-self.bits as u8);
173 /* while self.range < 0x80 {
177 if (self.bits <= 0) && (self.pos < self.src.len()) {
178 self.value |= self.src[self.pos] as u32;
184 pub fn skip_bytes(&mut self, nbytes: usize) {
187 if self.pos < self.src.len() {
188 self.value |= self.src[self.pos] as u32;
196 pub fn rescale_prob(prob: u8, weights: &[i16; 2], maxval: i32) -> u8 {
197 ((((prob as i32) * (weights[0] as i32) + 128) >> 8) + (weights[1] as i32)).min(maxval).max(1) as u8
201 macro_rules! vp_tree {
202 ($bc: expr, $prob: expr, $node1: expr, $node2: expr) => {
203 if !$bc.read_prob($prob) {
209 ($leaf: expr) => { $leaf }
212 const C1S7: i32 = 64277;
213 const C2S6: i32 = 60547;
214 const C3S5: i32 = 54491;
215 const C4S4: i32 = 46341;
216 const C5S3: i32 = 36410;
217 const C6S2: i32 = 25080;
218 const C7S1: i32 = 12785;
220 fn mul16(a: i32, b: i32) -> i32 {
224 macro_rules! idct_step {
225 ($s0:expr, $s1:expr, $s2:expr, $s3:expr, $s4:expr, $s5:expr, $s6:expr, $s7:expr,
226 $d0:expr, $d1:expr, $d2:expr, $d3:expr, $d4:expr, $d5:expr, $d6:expr, $d7:expr,
227 $bias:expr, $shift:expr, $otype:ty) => {
228 let t_a = mul16(C1S7, i32::from($s1)) + mul16(C7S1, i32::from($s7));
229 let t_b = mul16(C7S1, i32::from($s1)) - mul16(C1S7, i32::from($s7));
230 let t_c = mul16(C3S5, i32::from($s3)) + mul16(C5S3, i32::from($s5));
231 let t_d = mul16(C3S5, i32::from($s5)) - mul16(C5S3, i32::from($s3));
232 let t_a1 = mul16(C4S4, t_a - t_c);
233 let t_b1 = mul16(C4S4, t_b - t_d);
236 let t_e = mul16(C4S4, i32::from($s0 + $s4)) + $bias;
237 let t_f = mul16(C4S4, i32::from($s0 - $s4)) + $bias;
238 let t_g = mul16(C2S6, i32::from($s2)) + mul16(C6S2, i32::from($s6));
239 let t_h = mul16(C6S2, i32::from($s2)) - mul16(C2S6, i32::from($s6));
240 let t_e1 = t_e - t_g;
242 let t_a = t_f + t_a1;
243 let t_f = t_f - t_a1;
244 let t_b = t_b1 - t_h;
245 let t_h = t_b1 + t_h;
247 $d0 = ((t_g + t_c) >> $shift) as $otype;
248 $d7 = ((t_g - t_c) >> $shift) as $otype;
249 $d1 = ((t_a + t_h) >> $shift) as $otype;
250 $d2 = ((t_a - t_h) >> $shift) as $otype;
251 $d3 = ((t_e1 + t_d) >> $shift) as $otype;
252 $d4 = ((t_e1 - t_d) >> $shift) as $otype;
253 $d5 = ((t_f + t_b) >> $shift) as $otype;
254 $d6 = ((t_f - t_b) >> $shift) as $otype;
258 pub fn vp_idct(coeffs: &mut [i16; 64]) {
259 let mut tmp = [0i32; 64];
260 for (src, dst) in coeffs.chunks(8).zip(tmp.chunks_mut(8)) {
261 idct_step!(src[0], src[1], src[2], src[3], src[4], src[5], src[6], src[7],
262 dst[0], dst[1], dst[2], dst[3], dst[4], dst[5], dst[6], dst[7], 0, 0, i32);
267 idct_step!(src[0 * 8 + i], src[1 * 8 + i], src[2 * 8 + i], src[3 * 8 + i],
268 src[4 * 8 + i], src[5 * 8 + i], src[6 * 8 + i], src[7 * 8 + i],
269 dst[0 * 8 + i], dst[1 * 8 + i], dst[2 * 8 + i], dst[3 * 8 + i],
270 dst[4 * 8 + i], dst[5 * 8 + i], dst[6 * 8 + i], dst[7 * 8 + i], 8, 4, i16);
274 pub fn vp_idct_dc(coeffs: &mut [i16; 64]) {
275 let dc = ((mul16(C4S4, mul16(C4S4, i32::from(coeffs[0]))) + 8) >> 4) as i16;
281 pub fn unquant(coeffs: &mut [i16; 64], qmat: &[i16; 64]) {
283 coeffs[i] = coeffs[i].wrapping_mul(qmat[i]);
287 pub fn vp_put_block(coeffs: &mut [i16; 64], bx: usize, by: usize, plane: usize, frm: &mut NASimpleVideoFrame<u8>) {
289 let mut off = frm.offset[plane] + bx * 8 + by * 8 * frm.stride[plane];
292 frm.data[off + x] = (coeffs[x + y * 8] + 128).min(255).max(0) as u8;
294 off += frm.stride[plane];
298 pub fn vp_put_block_ilace(coeffs: &mut [i16; 64], bx: usize, by: usize, plane: usize, frm: &mut NASimpleVideoFrame<u8>) {
300 let mut off = frm.offset[plane] + bx * 8 + ((by & !1) * 8 + (by & 1)) * frm.stride[plane];
303 frm.data[off + x] = (coeffs[x + y * 8] + 128).min(255).max(0) as u8;
305 off += frm.stride[plane] * 2;
309 pub fn vp_put_block_dc(coeffs: &mut [i16; 64], bx: usize, by: usize, plane: usize, frm: &mut NASimpleVideoFrame<u8>) {
311 let dc = (coeffs[0] + 128).min(255).max(0) as u8;
312 let mut off = frm.offset[plane] + bx * 8 + by * 8 * frm.stride[plane];
315 frm.data[off + x] = dc;
317 off += frm.stride[plane];
321 pub fn vp_add_block(coeffs: &mut [i16; 64], bx: usize, by: usize, plane: usize, frm: &mut NASimpleVideoFrame<u8>) {
323 let mut off = frm.offset[plane] + bx * 8 + by * 8 * frm.stride[plane];
326 frm.data[off + x] = (coeffs[x + y * 8] + (frm.data[off + x] as i16)).min(255).max(0) as u8;
328 off += frm.stride[plane];
332 pub fn vp_add_block_ilace(coeffs: &mut [i16; 64], bx: usize, by: usize, plane: usize, frm: &mut NASimpleVideoFrame<u8>) {
334 let mut off = frm.offset[plane] + bx * 8 + ((by & !1) * 8 + (by & 1)) * frm.stride[plane];
337 frm.data[off + x] = (coeffs[x + y * 8] + (frm.data[off + x] as i16)).min(255).max(0) as u8;
339 off += frm.stride[plane] * 2;
343 pub fn vp_add_block_dc(coeffs: &mut [i16; 64], bx: usize, by: usize, plane: usize, frm: &mut NASimpleVideoFrame<u8>) {
346 let mut off = frm.offset[plane] + bx * 8 + by * 8 * frm.stride[plane];
349 frm.data[off + x] = (dc + (frm.data[off + x] as i16)).min(255).max(0) as u8;
351 off += frm.stride[plane];
355 pub fn vp31_loop_filter(data: &mut [u8], mut off: usize, step: usize, stride: usize,
356 len: usize, loop_str: i16) {
358 let a = data[off - step * 2] as i16;
359 let b = data[off - step] as i16;
360 let c = data[off] as i16;
361 let d = data[off + step] as i16;
362 let mut diff = ((a - d) + 3 * (c - b) + 4) >> 3;
363 if diff.abs() >= 2 * loop_str {
365 } else if diff.abs() >= loop_str {
367 diff = -diff - 2 * loop_str;
369 diff = -diff + 2 * loop_str;
373 data[off - step] = (b + diff).max(0).min(255) as u8;
374 data[off] = (c - diff).max(0).min(255) as u8;
381 pub fn vp_copy_block(dst: &mut NASimpleVideoFrame<u8>, src: NAVideoBufferRef<u8>, comp: usize,
382 dx: usize, dy: usize, mv_x: i16, mv_y: i16,
383 preborder: usize, postborder: usize, loop_str: i16,
384 mode: usize, interp: &[BlkInterpFunc], mut mc_buf: NAVideoBufferRef<u8>)
386 let sx = (dx as isize) + (mv_x as isize);
387 let sy = (dy as isize) + (mv_y as isize);
388 if ((sx | sy) & 7) == 0 {
389 copy_block(dst, src, comp, dx, dy, mv_x, mv_y, 8, 8, preborder, postborder, mode, interp);
392 let pre = preborder.max(2);
393 let post = postborder.max(1);
394 let bsize = 8 + pre + post;
395 let src_x = sx - (pre as isize);
396 let src_y = sy - (pre as isize);
398 let tmp_buf = NASimpleVideoFrame::from_video_buf(&mut mc_buf).unwrap();
399 edge_emu(src.as_ref(), src_x, src_y, bsize, bsize, &mut tmp_buf.data[tmp_buf.offset[comp]..], tmp_buf.stride[comp], comp);
400 // copy_block(&mut tmp_buf, src, comp, 0, 0, src_x as i16, src_y as i16,
401 // bsize, bsize, 0, 0, 0, interp);
403 let foff = (8 - (sx & 7)) as usize;
404 let off = pre + foff + tmp_buf.offset[comp];
405 vp31_loop_filter(tmp_buf.data, off, 1, tmp_buf.stride[comp], bsize, loop_str);
408 let foff = (8 - (sy & 7)) as usize;
409 let off = (pre + foff) * tmp_buf.stride[comp] + tmp_buf.offset[comp];
410 vp31_loop_filter(tmp_buf.data, off, tmp_buf.stride[comp], 1, bsize, loop_str);
413 let dxoff = (pre as i16) - (dx as i16);
414 let dyoff = (pre as i16) - (dy as i16);
415 copy_block(dst, mc_buf, comp, dx, dy, dxoff, dyoff, 8, 8, preborder, postborder, mode, interp);
418 fn vp3_interp00(dst: &mut [u8], dstride: usize, src: &[u8], sstride: usize, bw: usize, bh: usize)
423 for x in 0..bw { dst[didx + x] = src[sidx + x]; }
429 fn vp3_interp01(dst: &mut [u8], dstride: usize, src: &[u8], sstride: usize, bw: usize, bh: usize)
434 for x in 0..bw { dst[didx + x] = (((src[sidx + x] as u16) + (src[sidx + x + 1] as u16)) >> 1) as u8; }
440 fn vp3_interp10(dst: &mut [u8], dstride: usize, src: &[u8], sstride: usize, bw: usize, bh: usize)
445 for x in 0..bw { dst[didx + x] = (((src[sidx + x] as u16) + (src[sidx + x + sstride] as u16)) >> 1) as u8; }
451 fn vp3_interp1x(dst: &mut [u8], dstride: usize, src: &[u8], sstride: usize, bw: usize, bh: usize)
457 dst[didx + x] = (((src[sidx + x] as u16) +
458 (src[sidx + x + sstride + 1] as u16)) >> 1) as u8;
465 fn vp3_interp1y(dst: &mut [u8], dstride: usize, src: &[u8], sstride: usize, bw: usize, bh: usize)
471 dst[didx + x] = (((src[sidx + x + 1] as u16) +
472 (src[sidx + x + sstride] as u16)) >> 1) as u8;
479 pub const VP3_INTERP_FUNCS: &[blockdsp::BlkInterpFunc] = &[ vp3_interp00, vp3_interp01, vp3_interp10, vp3_interp1x, vp3_interp1y ];