]>
Commit | Line | Data |
---|---|---|
1 | //use std::mem; | |
2 | use crate::frame::*; | |
3 | use super::super::*; | |
4 | use super::super::blockdsp; | |
5 | use super::*; | |
6 | //use super::code::*; | |
7 | use crate::formats; | |
8 | ||
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, | |
16 | mvmode: MVMode, | |
17 | } | |
18 | ||
19 | impl MVInfo { | |
20 | fn new() -> Self { MVInfo{ mv: Vec::new(), mb_w: 0, mb_stride: 0, mb_start: 0, top: true, mvmode: MVMode::Old } } | |
21 | fn reset(&mut self, mb_w: usize, mb_start: usize, mvmode: MVMode) { | |
22 | self.mb_start = mb_start; | |
23 | self.mb_w = mb_w; | |
24 | self.mb_stride = mb_w * 2; | |
25 | self.mv.resize(self.mb_stride * 3, ZERO_MV); | |
26 | self.mvmode = mvmode; | |
27 | } | |
28 | fn update_row(&mut self) { | |
29 | self.mb_start = self.mb_w + 1; | |
30 | self.top = false; | |
31 | for i in 0..self.mb_stride { | |
32 | self.mv[i] = self.mv[self.mb_stride * 2 + i]; | |
33 | } | |
34 | } | |
35 | #[allow(non_snake_case)] | |
36 | fn predict(&mut self, mb_x: usize, blk_no: usize, use4: bool, diff: MV, first_line: bool, first_mb: bool) -> MV { | |
37 | let A; | |
38 | let B; | |
39 | let C; | |
40 | let last = mb_x == self.mb_w - 1; | |
41 | match blk_no { | |
42 | 0 => { | |
43 | if mb_x != self.mb_start { | |
44 | A = if !first_mb { self.mv[self.mb_stride + mb_x * 2 - 1] } else { ZERO_MV }; | |
45 | B = if !first_line { self.mv[ mb_x * 2] } else { A }; | |
46 | C = if !first_line && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV }; | |
47 | } else { | |
48 | A = ZERO_MV; B = ZERO_MV; C = ZERO_MV; | |
49 | } | |
50 | }, | |
51 | 1 => { | |
52 | A = self.mv[self.mb_stride + mb_x * 2]; | |
53 | B = if !first_line { self.mv[mb_x * 2 + 1] } else { A }; | |
54 | C = if !first_line && !last { self.mv[mb_x * 2 + 2] } else { ZERO_MV/*A*/ }; | |
55 | }, | |
56 | 2 => { | |
57 | A = if mb_x != self.mb_start { self.mv[self.mb_stride * 2 + mb_x * 2 - 1] } else { ZERO_MV }; | |
58 | B = self.mv[self.mb_stride + mb_x * 2]; | |
59 | C = self.mv[self.mb_stride + mb_x * 2 + 1]; | |
60 | }, | |
61 | 3 => { | |
62 | A = self.mv[self.mb_stride * 2 + mb_x * 2]; | |
63 | B = self.mv[self.mb_stride * 1 + mb_x * 2 + 1]; | |
64 | C = self.mv[self.mb_stride * 1 + mb_x * 2]; | |
65 | }, | |
66 | _ => { return ZERO_MV; } | |
67 | } | |
68 | let pred_mv = MV::pred(A, B, C); | |
69 | let new_mv = MV::add_umv(pred_mv, diff, self.mvmode); | |
70 | if !use4 { | |
71 | self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv; | |
72 | self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv; | |
73 | self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv; | |
74 | self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv; | |
75 | } else { | |
76 | match blk_no { | |
77 | 0 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = new_mv; }, | |
78 | 1 => { self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = new_mv; }, | |
79 | 2 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = new_mv; }, | |
80 | 3 => { self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = new_mv; }, | |
81 | _ => {}, | |
82 | }; | |
83 | } | |
84 | ||
85 | new_mv | |
86 | } | |
87 | fn set_zero_mv(&mut self, mb_x: usize) { | |
88 | self.mv[self.mb_stride * 1 + mb_x * 2 + 0] = ZERO_MV; | |
89 | self.mv[self.mb_stride * 1 + mb_x * 2 + 1] = ZERO_MV; | |
90 | self.mv[self.mb_stride * 2 + mb_x * 2 + 0] = ZERO_MV; | |
91 | self.mv[self.mb_stride * 2 + mb_x * 2 + 1] = ZERO_MV; | |
92 | } | |
93 | fn get_mv(&self, mb_x: usize, blk_no: usize) -> MV { | |
94 | self.mv[self.mb_stride + mb_x * 2 + (blk_no & 1) + (blk_no >> 1) * self.mb_stride] | |
95 | } | |
96 | } | |
97 | ||
98 | #[allow(dead_code)] | |
99 | #[derive(Clone,Copy)] | |
100 | struct BMB { | |
101 | num_mv: usize, | |
102 | mv_f: [MV; 4], | |
103 | mv_b: [MV; 4], | |
104 | fwd: bool, | |
105 | blk: [[i16; 64]; 6], | |
106 | cbp: u8, | |
107 | } | |
108 | ||
109 | impl BMB { | |
110 | 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} } | |
111 | } | |
112 | ||
113 | #[derive(Clone,Copy)] | |
114 | struct PredCoeffs { | |
115 | hor: [[i16; 8]; 6], | |
116 | ver: [[i16; 8]; 6], | |
117 | } | |
118 | ||
119 | const ZERO_PRED_COEFFS: PredCoeffs = PredCoeffs { hor: [[0; 8]; 6], ver: [[0; 8]; 6] }; | |
120 | ||
121 | pub struct H263BaseDecoder { | |
122 | w: usize, | |
123 | h: usize, | |
124 | mb_w: usize, | |
125 | mb_h: usize, | |
126 | num_mb: usize, | |
127 | ftype: Type, | |
128 | ipbs: IPBShuffler, | |
129 | next_ts: u16, | |
130 | last_ts: u16, | |
131 | tsdiff: u16, | |
132 | has_b: bool, | |
133 | b_data: Vec<BMB>, | |
134 | pred_coeffs: Vec<PredCoeffs>, | |
135 | is_gob: bool, | |
136 | slice_reset: bool, | |
137 | may_have_b_frames: bool, | |
138 | mv_data: Vec<BlockMVInfo>, | |
139 | } | |
140 | ||
141 | #[inline] | |
142 | fn clip_dc(dc: i16) -> i16 { | |
143 | if dc < 0 { 0 } | |
144 | else if dc > 2046 { 2046 } | |
145 | else { (dc + 1) & !1 } | |
146 | } | |
147 | ||
148 | #[inline] | |
149 | fn clip_ac(ac: i16) -> i16 { | |
150 | if ac < -2048 { -2048 } | |
151 | else if ac > 2047 { 2047 } | |
152 | else { ac } | |
153 | } | |
154 | ||
155 | #[allow(dead_code)] | |
156 | impl H263BaseDecoder { | |
157 | pub fn new_with_opts(is_gob: bool, slice_reset: bool, may_have_b_frames: bool) -> Self { | |
158 | H263BaseDecoder{ | |
159 | w: 0, h: 0, mb_w: 0, mb_h: 0, num_mb: 0, | |
160 | ftype: Type::Special, | |
161 | ipbs: IPBShuffler::new(), | |
162 | last_ts: 0, next_ts: 0, tsdiff: 0, | |
163 | has_b: false, b_data: Vec::new(), | |
164 | pred_coeffs: Vec::new(), | |
165 | is_gob: is_gob, slice_reset: slice_reset, | |
166 | may_have_b_frames: may_have_b_frames, | |
167 | mv_data: Vec::new(), | |
168 | } | |
169 | } | |
170 | pub fn new(is_gob: bool) -> Self { | |
171 | Self::new_with_opts(is_gob, true, false) | |
172 | } | |
173 | pub fn new_b_frames(is_gob: bool) -> Self { | |
174 | Self::new_with_opts(is_gob, true, true) | |
175 | } | |
176 | ||
177 | pub fn is_intra(&self) -> bool { self.ftype == Type::I } | |
178 | pub fn get_frame_type(&self) -> FrameType { | |
179 | match self.ftype { | |
180 | Type::I => FrameType::I, | |
181 | Type::P => FrameType::P, | |
182 | Type::B => FrameType::B, | |
183 | Type::PB => FrameType::P, | |
184 | Type::Skip => FrameType::Skip, | |
185 | Type::Special => FrameType::Skip, | |
186 | } | |
187 | } | |
188 | pub fn get_dimensions(&self) -> (usize, usize) { (self.w, self.h) } | |
189 | ||
190 | pub fn parse_frame(&mut self, bd: &mut BlockDecoder, bdsp: &BlockDSP) -> DecoderResult<NABufferType> { | |
191 | let pinfo = bd.decode_pichdr()?; | |
192 | let mut mvi = MVInfo::new(); | |
193 | let mut mvi2 = MVInfo::new(); | |
194 | let mut cbpi = CBPInfo::new(); | |
195 | ||
196 | //todo handle res change | |
197 | self.w = pinfo.w; | |
198 | self.h = pinfo.h; | |
199 | self.mb_w = (pinfo.w + 15) >> 4; | |
200 | self.mb_h = (pinfo.h + 15) >> 4; | |
201 | self.num_mb = self.mb_w * self.mb_h; | |
202 | self.ftype = pinfo.mode; | |
203 | self.has_b = pinfo.is_pb(); | |
204 | ||
205 | if self.has_b { | |
206 | self.mv_data.truncate(0); | |
207 | } | |
208 | ||
209 | let save_b_data = pinfo.mode.is_ref() && self.may_have_b_frames; | |
210 | if save_b_data { | |
211 | self.mv_data.truncate(0); | |
212 | } | |
213 | let is_b = pinfo.mode == Type::B; | |
214 | ||
215 | let tsdiff = if pinfo.is_pb() { pinfo.ts.wrapping_sub(self.last_ts) >> 1 } | |
216 | else { self.last_ts.wrapping_sub(self.next_ts) >> 1 }; | |
217 | let bsdiff = if pinfo.is_pb() { (pinfo.get_pbinfo().get_trb() as u16) << 7 } | |
218 | else { pinfo.ts.wrapping_sub(self.next_ts) >> 1 }; | |
219 | ||
220 | let fmt = formats::YUV420_FORMAT; | |
221 | let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt); | |
222 | let bufret = alloc_video_buffer(vinfo, 4); | |
223 | if let Err(_) = bufret { return Err(DecoderError::InvalidData); } | |
224 | let mut bufinfo = bufret.unwrap(); | |
225 | let mut buf = bufinfo.get_vbuf().unwrap(); | |
226 | ||
227 | let mut slice = if self.is_gob { | |
228 | SliceInfo::get_default_slice(&pinfo) | |
229 | } else { | |
230 | bd.decode_slice_header(&pinfo)? | |
231 | }; | |
232 | mvi.reset(self.mb_w, 0, pinfo.get_mvmode()); | |
233 | if is_b || pinfo.is_pb() { | |
234 | mvi2.reset(self.mb_w, 0, pinfo.get_mvmode()); | |
235 | } | |
236 | cbpi.reset(self.mb_w); | |
237 | ||
238 | let mut blk: [[i16; 64]; 6] = [[0; 64]; 6]; | |
239 | let mut sstate = SliceState::new(pinfo.mode == Type::I); | |
240 | let mut mb_pos = 0; | |
241 | let apply_acpred = (pinfo.mode == Type::I) && pinfo.plusinfo.is_some() && pinfo.plusinfo.unwrap().aic; | |
242 | if apply_acpred { | |
243 | self.pred_coeffs.truncate(0); | |
244 | self.pred_coeffs.resize(self.mb_w * self.mb_h, ZERO_PRED_COEFFS); | |
245 | } | |
246 | sstate.quant = slice.quant; | |
247 | for mb_y in 0..self.mb_h { | |
248 | for mb_x in 0..self.mb_w { | |
249 | for i in 0..6 { for j in 0..64 { blk[i][j] = 0; } } | |
250 | ||
251 | if slice.is_at_end(mb_pos) || (slice.needs_check() && mb_pos > 0 && bd.is_slice_end()) { | |
252 | slice = bd.decode_slice_header(&pinfo)?; | |
253 | if !self.is_gob && self.slice_reset { | |
254 | mvi.reset(self.mb_w, mb_x, pinfo.get_mvmode()); | |
255 | if is_b || pinfo.is_pb() { | |
256 | mvi2.reset(self.mb_w, mb_x, pinfo.get_mvmode()); | |
257 | } | |
258 | cbpi.reset(self.mb_w); | |
259 | sstate.reset_slice(mb_x, mb_y); | |
260 | sstate.quant = slice.quant; | |
261 | } | |
262 | } | |
263 | ||
264 | let binfo = bd.decode_block_header(&pinfo, &slice, &sstate)?; | |
265 | let cbp = binfo.get_cbp(); | |
266 | cbpi.set_cbp(mb_x, cbp); | |
267 | cbpi.set_q(mb_x, binfo.get_q()); | |
268 | sstate.quant = binfo.get_q(); | |
269 | if binfo.is_intra() { | |
270 | if save_b_data { | |
271 | self.mv_data.push(BlockMVInfo::Intra); | |
272 | } | |
273 | for i in 0..6 { | |
274 | bd.decode_block_intra(&binfo, &sstate, binfo.get_q(), i, (cbp & (1 << (5 - i))) != 0, &mut blk[i])?; | |
275 | if apply_acpred && (binfo.acpred != ACPredMode::None) { | |
276 | let has_b = (i == 1) || (i == 3) || !sstate.first_mb; | |
277 | let has_a = (i == 2) || (i == 3) || !sstate.first_line; | |
278 | let (b_mb, b_blk) = if has_b { | |
279 | if (i == 1) || (i == 3) { | |
280 | (mb_pos, i - 1) | |
281 | } else if i < 4 { | |
282 | (mb_pos - 1, i + 1) | |
283 | } else { | |
284 | (mb_pos - 1, i) | |
285 | } | |
286 | } else { (0, 0) }; | |
287 | let (a_mb, a_blk) = if has_a { | |
288 | if (i == 2) || (i == 3) { | |
289 | (mb_pos, i - 2) | |
290 | } else if i < 4 { | |
291 | (mb_pos - self.mb_w, i + 2) | |
292 | } else { | |
293 | (mb_pos - self.mb_w, i) | |
294 | } | |
295 | } else { (0, 0) }; | |
296 | match binfo.acpred { | |
297 | ACPredMode::DC => { | |
298 | let dc; | |
299 | if has_a && has_b { | |
300 | dc = (self.pred_coeffs[b_mb].hor[b_blk][0] + self.pred_coeffs[a_mb].ver[a_blk][0]) / 2; | |
301 | } else if has_a { | |
302 | dc = self.pred_coeffs[a_mb].ver[a_blk][0]; | |
303 | } else if has_b { | |
304 | dc = self.pred_coeffs[b_mb].hor[b_blk][0]; | |
305 | } else { | |
306 | dc = 1024; | |
307 | } | |
308 | blk[i][0] = clip_dc(blk[i][0] + dc); | |
309 | }, | |
310 | ACPredMode::Hor => { | |
311 | if has_b { | |
312 | for k in 0..8 { | |
313 | blk[i][k * 8] += self.pred_coeffs[b_mb].hor[b_blk][k]; | |
314 | } | |
315 | for k in 1..8 { | |
316 | blk[i][k * 8] = clip_ac(blk[i][k * 8]); | |
317 | } | |
318 | } else { | |
319 | blk[i][0] += 1024; | |
320 | } | |
321 | blk[i][0] = clip_dc(blk[i][0]); | |
322 | }, | |
323 | ACPredMode::Ver => { | |
324 | if has_a { | |
325 | for k in 0..8 { | |
326 | blk[i][k] += self.pred_coeffs[a_mb].ver[a_blk][k]; | |
327 | } | |
328 | for k in 1..8 { | |
329 | blk[i][k] = clip_ac(blk[i][k]); | |
330 | } | |
331 | } else { | |
332 | blk[i][0] += 1024; | |
333 | } | |
334 | blk[i][0] = clip_dc(blk[i][0]); | |
335 | }, | |
336 | ACPredMode::None => {}, | |
337 | }; | |
338 | for t in 0..8 { self.pred_coeffs[mb_pos].hor[i][t] = blk[i][t * 8]; } | |
339 | for t in 0..8 { self.pred_coeffs[mb_pos].ver[i][t] = blk[i][t]; } | |
340 | } | |
341 | bdsp.idct(&mut blk[i]); | |
342 | } | |
343 | blockdsp::put_blocks(&mut buf, mb_x, mb_y, &blk); | |
344 | mvi.set_zero_mv(mb_x); | |
345 | if is_b { | |
346 | mvi2.set_zero_mv(mb_x); | |
347 | } else if pinfo.is_pb() { | |
348 | mvi2.predict(mb_x, 0, false, binfo.get_mv2(0), sstate.first_line, sstate.first_mb); | |
349 | } | |
350 | } else if (binfo.mode != Type::B) && !binfo.is_skipped() { | |
351 | if binfo.get_num_mvs() == 1 { | |
352 | let mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb); | |
353 | if save_b_data { | |
354 | self.mv_data.push(BlockMVInfo::Inter_1MV(mv)); | |
355 | } | |
356 | if let Some(ref srcbuf) = self.ipbs.get_lastref() { | |
357 | bdsp.copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, mv); | |
358 | } | |
359 | if pinfo.is_pb() { | |
360 | mvi2.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb); | |
361 | } | |
362 | } else { | |
363 | let mut mv: [MV; 4] = [ZERO_MV, ZERO_MV, ZERO_MV, ZERO_MV]; | |
364 | for blk_no in 0..4 { | |
365 | mv[blk_no] = mvi.predict(mb_x, blk_no, true, binfo.get_mv(blk_no), sstate.first_line, sstate.first_mb); | |
366 | if let Some(ref srcbuf) = self.ipbs.get_lastref() { | |
367 | bdsp.copy_blocks(&mut buf, srcbuf, | |
368 | mb_x * 16 + (blk_no & 1) * 8, | |
369 | mb_y * 16 + (blk_no & 2) * 4, 8, 8, mv[blk_no]); | |
370 | } | |
371 | } | |
372 | if pinfo.is_pb() { | |
373 | for blk_no in 0..4 { | |
374 | mvi2.predict(mb_x, blk_no, true, binfo.get_mv(blk_no), sstate.first_line, sstate.first_mb); | |
375 | } | |
376 | } | |
377 | if save_b_data { | |
378 | self.mv_data.push(BlockMVInfo::Inter_4MV(mv)); | |
379 | } | |
380 | } | |
381 | for i in 0..6 { | |
382 | bd.decode_block_inter(&binfo, &sstate, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?; | |
383 | bdsp.idct(&mut blk[i]); | |
384 | } | |
385 | blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk); | |
386 | if is_b && !pinfo.is_pb() { | |
387 | mvi2.set_zero_mv(mb_x); | |
388 | } | |
389 | } else if binfo.mode != Type::B { | |
390 | self.mv_data.push(BlockMVInfo::Inter_1MV(ZERO_MV)); | |
391 | mvi.set_zero_mv(mb_x); | |
392 | if is_b || pinfo.is_pb() { | |
393 | mvi2.set_zero_mv(mb_x); | |
394 | } | |
395 | if let Some(ref srcbuf) = self.ipbs.get_lastref() { | |
396 | bdsp.copy_blocks(&mut buf, srcbuf, mb_x * 16, mb_y * 16, 16, 16, ZERO_MV); | |
397 | } | |
398 | } else { | |
399 | let ref_mv_info = self.mv_data[mb_pos]; | |
400 | let has_fwd = binfo.get_num_mvs() > 0; | |
401 | let has_bwd = binfo.get_num_mvs2() > 0; | |
402 | //todo refactor | |
403 | if has_fwd || has_bwd { | |
404 | let fwd_mv; | |
405 | if has_fwd { | |
406 | fwd_mv = mvi.predict(mb_x, 0, false, binfo.get_mv(0), sstate.first_line, sstate.first_mb); | |
407 | } else { | |
408 | fwd_mv = ZERO_MV; | |
409 | mvi.set_zero_mv(mb_x); | |
410 | } | |
411 | let bwd_mv; | |
412 | if has_bwd { | |
413 | bwd_mv = mvi2.predict(mb_x, 0, false, binfo.get_mv2(0), sstate.first_line, sstate.first_mb); | |
414 | } else { | |
415 | bwd_mv = ZERO_MV; | |
416 | mvi2.set_zero_mv(mb_x); | |
417 | } | |
418 | if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) { | |
419 | if has_fwd && has_bwd { | |
420 | bdsp.copy_blocks(&mut buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, fwd_mv); | |
421 | bdsp.avg_blocks (&mut buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, bwd_mv); | |
422 | } else if has_fwd { | |
423 | bdsp.copy_blocks(&mut buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, fwd_mv); | |
424 | } else { | |
425 | bdsp.copy_blocks(&mut buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, bwd_mv); | |
426 | } | |
427 | } | |
428 | } else { | |
429 | if let BlockMVInfo::Inter_4MV(mvs) = ref_mv_info { | |
430 | for blk_no in 0..4 { | |
431 | let ref_mv = mvs[blk_no]; | |
432 | let ref_mv_fwd = ref_mv.scale(bsdiff, tsdiff); | |
433 | let ref_mv_bwd = ref_mv - ref_mv_fwd; | |
434 | let xoff = mb_x * 16 + (blk_no & 1) * 8; | |
435 | let yoff = mb_y * 16 + (blk_no & 2) * 4; | |
436 | if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) { | |
437 | bdsp.copy_blocks(&mut buf, fwd_buf, xoff, yoff, 8, 8, ref_mv_fwd); | |
438 | bdsp.avg_blocks (&mut buf, bck_buf, xoff, yoff, 8, 8, ref_mv_bwd); | |
439 | } | |
440 | } | |
441 | } else { | |
442 | let ref_mv = if let BlockMVInfo::Inter_1MV(mv_) = ref_mv_info { mv_ } else { ZERO_MV }; | |
443 | let ref_mv_fwd = ref_mv.scale(bsdiff, tsdiff); | |
444 | let ref_mv_bwd = MV::b_sub(ref_mv, ref_mv_fwd, ZERO_MV, bsdiff, tsdiff); | |
445 | ||
446 | if let (Some(ref fwd_buf), Some(ref bck_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) { | |
447 | bdsp.copy_blocks(&mut buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, ref_mv_fwd); | |
448 | bdsp.avg_blocks (&mut buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, ref_mv_bwd); | |
449 | } | |
450 | } | |
451 | mvi.set_zero_mv(mb_x); | |
452 | mvi2.set_zero_mv(mb_x); | |
453 | } | |
454 | if cbp != 0 { | |
455 | for i in 0..6 { | |
456 | bd.decode_block_inter(&binfo, &sstate, binfo.get_q(), i, ((cbp >> (5 - i)) & 1) != 0, &mut blk[i])?; | |
457 | bdsp.idct(&mut blk[i]); | |
458 | } | |
459 | blockdsp::add_blocks(&mut buf, mb_x, mb_y, &blk); | |
460 | } | |
461 | } | |
462 | if pinfo.is_pb() { | |
463 | let mut b_mb = BMB::new(); | |
464 | let cbp = binfo.get_cbp_b(); | |
465 | let bq = (((pinfo.get_pbinfo().get_dbquant() + 5) as u16) * (binfo.get_q() as u16)) >> 2; | |
466 | let bquant; | |
467 | if bq < 1 { bquant = 1; } | |
468 | else if bq > 31 { bquant = 31; } | |
469 | else { bquant = bq as u8; } | |
470 | ||
471 | b_mb.cbp = cbp; | |
472 | for i in 0..6 { | |
473 | bd.decode_block_inter(&binfo, &sstate, bquant, i, (cbp & (1 << (5 - i))) != 0, &mut b_mb.blk[i])?; | |
474 | bdsp.idct(&mut b_mb.blk[i]); | |
475 | } | |
476 | ||
477 | let is_fwd = binfo.is_b_fwd(); | |
478 | b_mb.fwd = is_fwd; | |
479 | if binfo.get_num_mvs() != 4 { | |
480 | let ref_mv = mvi2.get_mv(mb_x, 0); | |
481 | let b_mv = if binfo.is_intra() { binfo.get_mv2(1) } else { binfo.get_mv2(0) }; | |
482 | let src_mv = if is_fwd { ZERO_MV } else { ref_mv.scale(bsdiff, tsdiff) }; | |
483 | let mv_f = MV::add_umv(src_mv, b_mv, pinfo.get_mvmode()); | |
484 | let mv_b = MV::b_sub(ref_mv, mv_f, b_mv, bsdiff, tsdiff); | |
485 | b_mb.mv_f[0] = mv_f; | |
486 | b_mb.mv_b[0] = mv_b; | |
487 | b_mb.num_mv = 1; | |
488 | } else { | |
489 | for blk_no in 0..4 { | |
490 | let src_mv = if is_fwd { ZERO_MV } else { mvi2.get_mv(mb_x, blk_no).scale(bsdiff, tsdiff) }; | |
491 | let mv_f = MV::add_umv(src_mv, binfo.get_mv2(0), pinfo.get_mvmode()); | |
492 | let mv_b = MV::b_sub(mvi2.get_mv(mb_x, blk_no), mv_f, binfo.get_mv2(0), bsdiff, tsdiff); | |
493 | b_mb.mv_f[blk_no] = mv_f; | |
494 | b_mb.mv_b[blk_no] = mv_b; | |
495 | } | |
496 | b_mb.num_mv = 4; | |
497 | } | |
498 | self.b_data.push(b_mb); | |
499 | } | |
500 | sstate.next_mb(); | |
501 | mb_pos += 1; | |
502 | } | |
503 | if let Some(plusinfo) = pinfo.plusinfo { | |
504 | if plusinfo.deblock { | |
505 | bdsp.filter_row(&mut buf, mb_y, self.mb_w, &cbpi); | |
506 | } | |
507 | } | |
508 | mvi.update_row(); | |
509 | if is_b || pinfo.is_pb() { | |
510 | mvi2.update_row(); | |
511 | } | |
512 | cbpi.update_row(); | |
513 | sstate.new_row(); | |
514 | } | |
515 | ||
516 | if pinfo.mode.is_ref() { | |
517 | self.ipbs.add_frame(buf); | |
518 | self.next_ts = self.last_ts; | |
519 | self.last_ts = pinfo.ts; | |
520 | self.tsdiff = tsdiff; | |
521 | } | |
522 | ||
523 | Ok(bufinfo) | |
524 | } | |
525 | ||
526 | pub fn get_bframe(&mut self, bdsp: &BlockDSP) -> DecoderResult<NABufferType> { | |
527 | if !self.has_b || !self.ipbs.get_lastref().is_some() || !self.ipbs.get_nextref().is_some() { | |
528 | return Err(DecoderError::MissingReference); | |
529 | } | |
530 | self.has_b = false; | |
531 | ||
532 | let fmt = formats::YUV420_FORMAT; | |
533 | let vinfo = NAVideoInfo::new(self.w, self.h, false, fmt); | |
534 | let bufret = alloc_video_buffer(vinfo, 4); | |
535 | if let Err(_) = bufret { return Err(DecoderError::InvalidData); } | |
536 | let mut bufinfo = bufret.unwrap(); | |
537 | let mut b_buf = bufinfo.get_vbuf().unwrap(); | |
538 | ||
539 | if let (Some(ref bck_buf), Some(ref fwd_buf)) = (self.ipbs.get_nextref(), self.ipbs.get_lastref()) { | |
540 | recon_b_frame(&mut b_buf, fwd_buf, bck_buf, self.mb_w, self.mb_h, &self.b_data, bdsp); | |
541 | } | |
542 | ||
543 | self.b_data.truncate(0); | |
544 | Ok(bufinfo) | |
545 | } | |
546 | } | |
547 | ||
548 | fn recon_b_frame(b_buf: &mut NAVideoBuffer<u8>, bck_buf: &NAVideoBuffer<u8>, fwd_buf: &NAVideoBuffer<u8>, | |
549 | mb_w: usize, mb_h: usize, b_data: &Vec<BMB>, bdsp: &BlockDSP) { | |
550 | let mut cbpi = CBPInfo::new(); | |
551 | let mut cur_mb = 0; | |
552 | cbpi.reset(mb_w); | |
553 | for mb_y in 0..mb_h { | |
554 | for mb_x in 0..mb_w { | |
555 | let num_mv = b_data[cur_mb].num_mv; | |
556 | let is_fwd = b_data[cur_mb].fwd; | |
557 | let cbp = b_data[cur_mb].cbp; | |
558 | cbpi.set_cbp(mb_x, cbp); | |
559 | if num_mv == 1 { | |
560 | bdsp.copy_blocks(b_buf, fwd_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_b[0]); | |
561 | if !is_fwd { | |
562 | bdsp.avg_blocks(b_buf, bck_buf, mb_x * 16, mb_y * 16, 16, 16, b_data[cur_mb].mv_f[0]); | |
563 | } | |
564 | } else { | |
565 | for blk_no in 0..4 { | |
566 | let xpos = mb_x * 16 + (blk_no & 1) * 8; | |
567 | let ypos = mb_y * 16 + (blk_no & 2) * 4; | |
568 | bdsp.copy_blocks(b_buf, fwd_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_b[blk_no]); | |
569 | if !is_fwd { | |
570 | bdsp.avg_blocks(b_buf, bck_buf, xpos, ypos, 8, 8, b_data[cur_mb].mv_f[blk_no]); | |
571 | } | |
572 | } | |
573 | } | |
574 | if cbp != 0 { | |
575 | blockdsp::add_blocks(b_buf, mb_x, mb_y, &b_data[cur_mb].blk); | |
576 | } | |
577 | cur_mb += 1; | |
578 | } | |
579 | cbpi.update_row(); | |
580 | } | |
581 | } |