]>
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 { |
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<()>; |
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 | |
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, |
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 | |
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); |
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); |
500 | cbpi.set_q(mb_x, binfo.get_q()); | |
cf64af13 KS |
501 | if binfo.is_intra() { |
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() { |
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])?; |
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 | } |
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; |
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 | } |
648 | } |