| /* |
| * Copyright (c) 2011 The WebM project authors. All Rights Reserved. |
| * |
| * Use of this source code is governed by a BSD-style license |
| * that can be found in the LICENSE file in the root of the source |
| * tree. An additional intellectual property rights grant can be found |
| * in the file PATENTS. All contributing project authors may |
| * be found in the AUTHORS file in the root of the source tree. |
| */ |
| |
| #include <assert.h> |
| |
| #include "error_concealment.h" |
| #include "onyxd_int.h" |
| #include "decodemv.h" |
| #include "vpx_mem/vpx_mem.h" |
| #include "vp8/common/findnearmv.h" |
| #include "vp8/common/common.h" |
| #include "vpx_dsp/vpx_dsp_common.h" |
| |
| #define FLOOR(x,q) ((x) & -(1 << (q))) |
| |
| #define NUM_NEIGHBORS 20 |
| |
| typedef struct ec_position |
| { |
| int row; |
| int col; |
| } EC_POS; |
| |
| /* |
| * Regenerate the table in Matlab with: |
| * x = meshgrid((1:4), (1:4)); |
| * y = meshgrid((1:4), (1:4))'; |
| * W = round((1./(sqrt(x.^2 + y.^2))*2^7)); |
| * W(1,1) = 0; |
| */ |
| static const int weights_q7[5][5] = { |
| { 0, 128, 64, 43, 32 }, |
| {128, 91, 57, 40, 31 }, |
| { 64, 57, 45, 36, 29 }, |
| { 43, 40, 36, 30, 26 }, |
| { 32, 31, 29, 26, 23 } |
| }; |
| |
| int vp8_alloc_overlap_lists(VP8D_COMP *pbi) |
| { |
| if (pbi->overlaps != NULL) |
| { |
| vpx_free(pbi->overlaps); |
| pbi->overlaps = NULL; |
| } |
| |
| pbi->overlaps = vpx_calloc(pbi->common.mb_rows * pbi->common.mb_cols, |
| sizeof(MB_OVERLAP)); |
| |
| if (pbi->overlaps == NULL) |
| return -1; |
| |
| return 0; |
| } |
| |
| void vp8_de_alloc_overlap_lists(VP8D_COMP *pbi) |
| { |
| vpx_free(pbi->overlaps); |
| pbi->overlaps = NULL; |
| } |
| |
| /* Inserts a new overlap area value to the list of overlaps of a block */ |
| static void assign_overlap(OVERLAP_NODE* overlaps, |
| union b_mode_info *bmi, |
| int overlap) |
| { |
| int i; |
| if (overlap <= 0) |
| return; |
| /* Find and assign to the next empty overlap node in the list of overlaps. |
| * Empty is defined as bmi == NULL */ |
| for (i = 0; i < MAX_OVERLAPS; i++) |
| { |
| if (overlaps[i].bmi == NULL) |
| { |
| overlaps[i].bmi = bmi; |
| overlaps[i].overlap = overlap; |
| break; |
| } |
| } |
| } |
| |
| /* Calculates the overlap area between two 4x4 squares, where the first |
| * square has its upper-left corner at (b1_row, b1_col) and the second |
| * square has its upper-left corner at (b2_row, b2_col). Doesn't |
| * properly handle squares which do not overlap. |
| */ |
| static int block_overlap(int b1_row, int b1_col, int b2_row, int b2_col) |
| { |
| const int int_top = VPXMAX(b1_row, b2_row); // top |
| const int int_left = VPXMAX(b1_col, b2_col); // left |
| /* Since each block is 4x4 pixels, adding 4 (Q3) to the left/top edge |
| * gives us the right/bottom edge. |
| */ |
| const int int_right = VPXMIN(b1_col + (4<<3), b2_col + (4<<3)); // right |
| const int int_bottom = VPXMIN(b1_row + (4<<3), b2_row + (4<<3)); // bottom |
| return (int_bottom - int_top) * (int_right - int_left); |
| } |
| |
| /* Calculates the overlap area for all blocks in a macroblock at position |
| * (mb_row, mb_col) in macroblocks, which are being overlapped by a given |
| * overlapping block at position (new_row, new_col) (in pixels, Q3). The |
| * first block being overlapped in the macroblock has position (first_blk_row, |
| * first_blk_col) in blocks relative the upper-left corner of the image. |
| */ |
| static void calculate_overlaps_mb(B_OVERLAP *b_overlaps, union b_mode_info *bmi, |
| int new_row, int new_col, |
| int mb_row, int mb_col, |
| int first_blk_row, int first_blk_col) |
| { |
| /* Find the blocks within this MB (defined by mb_row, mb_col) which are |
| * overlapped by bmi and calculate and assign overlap for each of those |
| * blocks. */ |
| |
| /* Block coordinates relative the upper-left block */ |
| const int rel_ol_blk_row = first_blk_row - mb_row * 4; |
| const int rel_ol_blk_col = first_blk_col - mb_col * 4; |
| /* If the block partly overlaps any previous MB, these coordinates |
| * can be < 0. We don't want to access blocks in previous MBs. |
| */ |
| const int blk_idx = VPXMAX(rel_ol_blk_row,0) * 4 + VPXMAX(rel_ol_blk_col,0); |
| /* Upper left overlapping block */ |
| B_OVERLAP *b_ol_ul = &(b_overlaps[blk_idx]); |
| |
| /* Calculate and assign overlaps for all blocks in this MB |
| * which the motion compensated block overlaps |
| */ |
| /* Avoid calculating overlaps for blocks in later MBs */ |
| int end_row = VPXMIN(4 + mb_row * 4 - first_blk_row, 2); |
| int end_col = VPXMIN(4 + mb_col * 4 - first_blk_col, 2); |
| int row, col; |
| |
| /* Check if new_row and new_col are evenly divisible by 4 (Q3), |
| * and if so we shouldn't check neighboring blocks |
| */ |
| if (new_row >= 0 && (new_row & 0x1F) == 0) |
| end_row = 1; |
| if (new_col >= 0 && (new_col & 0x1F) == 0) |
| end_col = 1; |
| |
| /* Check if the overlapping block partly overlaps a previous MB |
| * and if so, we're overlapping fewer blocks in this MB. |
| */ |
| if (new_row < (mb_row*16)<<3) |
| end_row = 1; |
| if (new_col < (mb_col*16)<<3) |
| end_col = 1; |
| |
| for (row = 0; row < end_row; ++row) |
| { |
| for (col = 0; col < end_col; ++col) |
| { |
| /* input in Q3, result in Q6 */ |
| const int overlap = block_overlap(new_row, new_col, |
| (((first_blk_row + row) * |
| 4) << 3), |
| (((first_blk_col + col) * |
| 4) << 3)); |
| assign_overlap(b_ol_ul[row * 4 + col].overlaps, bmi, overlap); |
| } |
| } |
| } |
| |
| void vp8_calculate_overlaps(MB_OVERLAP *overlap_ul, |
| int mb_rows, int mb_cols, |
| union b_mode_info *bmi, |
| int b_row, int b_col) |
| { |
| MB_OVERLAP *mb_overlap; |
| int row, col, rel_row, rel_col; |
| int new_row, new_col; |
| int end_row, end_col; |
| int overlap_b_row, overlap_b_col; |
| int overlap_mb_row, overlap_mb_col; |
| |
| /* mb subpixel position */ |
| row = (4 * b_row) << 3; /* Q3 */ |
| col = (4 * b_col) << 3; /* Q3 */ |
| |
| /* reverse compensate for motion */ |
| new_row = row - bmi->mv.as_mv.row; |
| new_col = col - bmi->mv.as_mv.col; |
| |
| if (new_row >= ((16*mb_rows) << 3) || new_col >= ((16*mb_cols) << 3)) |
| { |
| /* the new block ended up outside the frame */ |
| return; |
| } |
| |
| if (new_row <= -32 || new_col <= -32) |
| { |
| /* outside the frame */ |
| return; |
| } |
| /* overlapping block's position in blocks */ |
| overlap_b_row = FLOOR(new_row / 4, 3) >> 3; |
| overlap_b_col = FLOOR(new_col / 4, 3) >> 3; |
| |
| /* overlapping block's MB position in MBs |
| * operations are done in Q3 |
| */ |
| overlap_mb_row = FLOOR((overlap_b_row << 3) / 4, 3) >> 3; |
| overlap_mb_col = FLOOR((overlap_b_col << 3) / 4, 3) >> 3; |
| |
| end_row = VPXMIN(mb_rows - overlap_mb_row, 2); |
| end_col = VPXMIN(mb_cols - overlap_mb_col, 2); |
| |
| /* Don't calculate overlap for MBs we don't overlap */ |
| /* Check if the new block row starts at the last block row of the MB */ |
| if (abs(new_row - ((16*overlap_mb_row) << 3)) < ((3*4) << 3)) |
| end_row = 1; |
| /* Check if the new block col starts at the last block col of the MB */ |
| if (abs(new_col - ((16*overlap_mb_col) << 3)) < ((3*4) << 3)) |
| end_col = 1; |
| |
| /* find the MB(s) this block is overlapping */ |
| for (rel_row = 0; rel_row < end_row; ++rel_row) |
| { |
| for (rel_col = 0; rel_col < end_col; ++rel_col) |
| { |
| if (overlap_mb_row + rel_row < 0 || |
| overlap_mb_col + rel_col < 0) |
| continue; |
| mb_overlap = overlap_ul + (overlap_mb_row + rel_row) * mb_cols + |
| overlap_mb_col + rel_col; |
| |
| calculate_overlaps_mb(mb_overlap->overlaps, bmi, |
| new_row, new_col, |
| overlap_mb_row + rel_row, |
| overlap_mb_col + rel_col, |
| overlap_b_row + rel_row, |
| overlap_b_col + rel_col); |
| } |
| } |
| } |
| |
| /* Estimates a motion vector given the overlapping blocks' motion vectors. |
| * Filters out all overlapping blocks which do not refer to the correct |
| * reference frame type. |
| */ |
| static void estimate_mv(const OVERLAP_NODE *overlaps, union b_mode_info *bmi) |
| { |
| int i; |
| int overlap_sum = 0; |
| int row_acc = 0; |
| int col_acc = 0; |
| |
| bmi->mv.as_int = 0; |
| for (i=0; i < MAX_OVERLAPS; ++i) |
| { |
| if (overlaps[i].bmi == NULL) |
| break; |
| col_acc += overlaps[i].overlap * overlaps[i].bmi->mv.as_mv.col; |
| row_acc += overlaps[i].overlap * overlaps[i].bmi->mv.as_mv.row; |
| overlap_sum += overlaps[i].overlap; |
| } |
| if (overlap_sum > 0) |
| { |
| /* Q9 / Q6 = Q3 */ |
| bmi->mv.as_mv.col = col_acc / overlap_sum; |
| bmi->mv.as_mv.row = row_acc / overlap_sum; |
| } |
| else |
| { |
| bmi->mv.as_mv.col = 0; |
| bmi->mv.as_mv.row = 0; |
| } |
| } |
| |
| /* Estimates all motion vectors for a macroblock given the lists of |
| * overlaps for each block. Decides whether or not the MVs must be clamped. |
| */ |
| static void estimate_mb_mvs(const B_OVERLAP *block_overlaps, |
| MODE_INFO *mi, |
| int mb_to_left_edge, |
| int mb_to_right_edge, |
| int mb_to_top_edge, |
| int mb_to_bottom_edge) |
| { |
| int row, col; |
| int non_zero_count = 0; |
| MV * const filtered_mv = &(mi->mbmi.mv.as_mv); |
| union b_mode_info * const bmi = mi->bmi; |
| filtered_mv->col = 0; |
| filtered_mv->row = 0; |
| mi->mbmi.need_to_clamp_mvs = 0; |
| for (row = 0; row < 4; ++row) |
| { |
| int this_b_to_top_edge = mb_to_top_edge + ((row*4)<<3); |
| int this_b_to_bottom_edge = mb_to_bottom_edge - ((row*4)<<3); |
| for (col = 0; col < 4; ++col) |
| { |
| int i = row * 4 + col; |
| int this_b_to_left_edge = mb_to_left_edge + ((col*4)<<3); |
| int this_b_to_right_edge = mb_to_right_edge - ((col*4)<<3); |
| /* Estimate vectors for all blocks which are overlapped by this */ |
| /* type. Interpolate/extrapolate the rest of the block's MVs */ |
| estimate_mv(block_overlaps[i].overlaps, &(bmi[i])); |
| mi->mbmi.need_to_clamp_mvs |= vp8_check_mv_bounds( |
| &bmi[i].mv, |
| this_b_to_left_edge, |
| this_b_to_right_edge, |
| this_b_to_top_edge, |
| this_b_to_bottom_edge); |
| if (bmi[i].mv.as_int != 0) |
| { |
| ++non_zero_count; |
| filtered_mv->col += bmi[i].mv.as_mv.col; |
| filtered_mv->row += bmi[i].mv.as_mv.row; |
| } |
| } |
| } |
| if (non_zero_count > 0) |
| { |
| filtered_mv->col /= non_zero_count; |
| filtered_mv->row /= non_zero_count; |
| } |
| } |
| |
| static void calc_prev_mb_overlaps(MB_OVERLAP *overlaps, MODE_INFO *prev_mi, |
| int mb_row, int mb_col, |
| int mb_rows, int mb_cols) |
| { |
| int sub_row; |
| int sub_col; |
| for (sub_row = 0; sub_row < 4; ++sub_row) |
| { |
| for (sub_col = 0; sub_col < 4; ++sub_col) |
| { |
| vp8_calculate_overlaps( |
| overlaps, mb_rows, mb_cols, |
| &(prev_mi->bmi[sub_row * 4 + sub_col]), |
| 4 * mb_row + sub_row, |
| 4 * mb_col + sub_col); |
| } |
| } |
| } |
| |
| /* Estimate all missing motion vectors. This function does the same as the one |
| * above, but has different input arguments. */ |
| static void estimate_missing_mvs(MB_OVERLAP *overlaps, |
| MODE_INFO *mi, MODE_INFO *prev_mi, |
| int mb_rows, int mb_cols, |
| unsigned int first_corrupt) |
| { |
| int mb_row, mb_col; |
| memset(overlaps, 0, sizeof(MB_OVERLAP) * mb_rows * mb_cols); |
| /* First calculate the overlaps for all blocks */ |
| for (mb_row = 0; mb_row < mb_rows; ++mb_row) |
| { |
| for (mb_col = 0; mb_col < mb_cols; ++mb_col) |
| { |
| /* We're only able to use blocks referring to the last frame |
| * when extrapolating new vectors. |
| */ |
| if (prev_mi->mbmi.ref_frame == LAST_FRAME) |
| { |
| calc_prev_mb_overlaps(overlaps, prev_mi, |
| mb_row, mb_col, |
| mb_rows, mb_cols); |
| } |
| ++prev_mi; |
| } |
| ++prev_mi; |
| } |
| |
| mb_row = first_corrupt / mb_cols; |
| mb_col = first_corrupt - mb_row * mb_cols; |
| mi += mb_row*(mb_cols + 1) + mb_col; |
| /* Go through all macroblocks in the current image with missing MVs |
| * and calculate new MVs using the overlaps. |
| */ |
| for (; mb_row < mb_rows; ++mb_row) |
| { |
| int mb_to_top_edge = -((mb_row * 16)) << 3; |
| int mb_to_bottom_edge = ((mb_rows - 1 - mb_row) * 16) << 3; |
| for (; mb_col < mb_cols; ++mb_col) |
| { |
| int mb_to_left_edge = -((mb_col * 16) << 3); |
| int mb_to_right_edge = ((mb_cols - 1 - mb_col) * 16) << 3; |
| const B_OVERLAP *block_overlaps = |
| overlaps[mb_row*mb_cols + mb_col].overlaps; |
| mi->mbmi.ref_frame = LAST_FRAME; |
| mi->mbmi.mode = SPLITMV; |
| mi->mbmi.uv_mode = DC_PRED; |
| mi->mbmi.partitioning = 3; |
| mi->mbmi.segment_id = 0; |
| estimate_mb_mvs(block_overlaps, |
| mi, |
| mb_to_left_edge, |
| mb_to_right_edge, |
| mb_to_top_edge, |
| mb_to_bottom_edge); |
| ++mi; |
| } |
| mb_col = 0; |
| ++mi; |
| } |
| } |
| |
| void vp8_estimate_missing_mvs(VP8D_COMP *pbi) |
| { |
| VP8_COMMON * const pc = &pbi->common; |
| estimate_missing_mvs(pbi->overlaps, |
| pc->mi, pc->prev_mi, |
| pc->mb_rows, pc->mb_cols, |
| pbi->mvs_corrupt_from_mb); |
| } |
| |
| static void assign_neighbor(EC_BLOCK *neighbor, MODE_INFO *mi, int block_idx) |
| { |
| assert(mi->mbmi.ref_frame < MAX_REF_FRAMES); |
| neighbor->ref_frame = mi->mbmi.ref_frame; |
| neighbor->mv = mi->bmi[block_idx].mv.as_mv; |
| } |
| |
| /* Finds the neighboring blocks of a macroblocks. In the general case |
| * 20 blocks are found. If a fewer number of blocks are found due to |
| * image boundaries, those positions in the EC_BLOCK array are left "empty". |
| * The neighbors are enumerated with the upper-left neighbor as the first |
| * element, the second element refers to the neighbor to right of the previous |
| * neighbor, and so on. The last element refers to the neighbor below the first |
| * neighbor. |
| */ |
| static void find_neighboring_blocks(MODE_INFO *mi, |
| EC_BLOCK *neighbors, |
| int mb_row, int mb_col, |
| int mb_rows, int mb_cols, |
| int mi_stride) |
| { |
| int i = 0; |
| int j; |
| if (mb_row > 0) |
| { |
| /* upper left */ |
| if (mb_col > 0) |
| assign_neighbor(&neighbors[i], mi - mi_stride - 1, 15); |
| ++i; |
| /* above */ |
| for (j = 12; j < 16; ++j, ++i) |
| assign_neighbor(&neighbors[i], mi - mi_stride, j); |
| } |
| else |
| i += 5; |
| if (mb_col < mb_cols - 1) |
| { |
| /* upper right */ |
| if (mb_row > 0) |
| assign_neighbor(&neighbors[i], mi - mi_stride + 1, 12); |
| ++i; |
| /* right */ |
| for (j = 0; j <= 12; j += 4, ++i) |
| assign_neighbor(&neighbors[i], mi + 1, j); |
| } |
| else |
| i += 5; |
| if (mb_row < mb_rows - 1) |
| { |
| /* lower right */ |
| if (mb_col < mb_cols - 1) |
| assign_neighbor(&neighbors[i], mi + mi_stride + 1, 0); |
| ++i; |
| /* below */ |
| for (j = 0; j < 4; ++j, ++i) |
| assign_neighbor(&neighbors[i], mi + mi_stride, j); |
| } |
| else |
| i += 5; |
| if (mb_col > 0) |
| { |
| /* lower left */ |
| if (mb_row < mb_rows - 1) |
| assign_neighbor(&neighbors[i], mi + mi_stride - 1, 4); |
| ++i; |
| /* left */ |
| for (j = 3; j < 16; j += 4, ++i) |
| { |
| assign_neighbor(&neighbors[i], mi - 1, j); |
| } |
| } |
| else |
| i += 5; |
| assert(i == 20); |
| } |
| |
| /* Interpolates all motion vectors for a macroblock from the neighboring blocks' |
| * motion vectors. |
| */ |
| static void interpolate_mvs(MACROBLOCKD *mb, |
| EC_BLOCK *neighbors, |
| MV_REFERENCE_FRAME dom_ref_frame) |
| { |
| int row, col, i; |
| MODE_INFO * const mi = mb->mode_info_context; |
| /* Table with the position of the neighboring blocks relative the position |
| * of the upper left block of the current MB. Starting with the upper left |
| * neighbor and going to the right. |
| */ |
| const EC_POS neigh_pos[NUM_NEIGHBORS] = { |
| {-1,-1}, {-1,0}, {-1,1}, {-1,2}, {-1,3}, |
| {-1,4}, {0,4}, {1,4}, {2,4}, {3,4}, |
| {4,4}, {4,3}, {4,2}, {4,1}, {4,0}, |
| {4,-1}, {3,-1}, {2,-1}, {1,-1}, {0,-1} |
| }; |
| mi->mbmi.need_to_clamp_mvs = 0; |
| for (row = 0; row < 4; ++row) |
| { |
| int mb_to_top_edge = mb->mb_to_top_edge + ((row*4)<<3); |
| int mb_to_bottom_edge = mb->mb_to_bottom_edge - ((row*4)<<3); |
| for (col = 0; col < 4; ++col) |
| { |
| int mb_to_left_edge = mb->mb_to_left_edge + ((col*4)<<3); |
| int mb_to_right_edge = mb->mb_to_right_edge - ((col*4)<<3); |
| int w_sum = 0; |
| int mv_row_sum = 0; |
| int mv_col_sum = 0; |
| int_mv * const mv = &(mi->bmi[row*4 + col].mv); |
| mv->as_int = 0; |
| for (i = 0; i < NUM_NEIGHBORS; ++i) |
| { |
| /* Calculate the weighted sum of neighboring MVs referring |
| * to the dominant frame type. |
| */ |
| const int w = weights_q7[abs(row - neigh_pos[i].row)] |
| [abs(col - neigh_pos[i].col)]; |
| if (neighbors[i].ref_frame != dom_ref_frame) |
| continue; |
| w_sum += w; |
| /* Q7 * Q3 = Q10 */ |
| mv_row_sum += w*neighbors[i].mv.row; |
| mv_col_sum += w*neighbors[i].mv.col; |
| } |
| if (w_sum > 0) |
| { |
| /* Avoid division by zero. |
| * Normalize with the sum of the coefficients |
| * Q3 = Q10 / Q7 |
| */ |
| mv->as_mv.row = mv_row_sum / w_sum; |
| mv->as_mv.col = mv_col_sum / w_sum; |
| mi->mbmi.need_to_clamp_mvs |= vp8_check_mv_bounds( |
| mv, |
| mb_to_left_edge, |
| mb_to_right_edge, |
| mb_to_top_edge, |
| mb_to_bottom_edge); |
| } |
| } |
| } |
| } |
| |
| void vp8_interpolate_motion(MACROBLOCKD *mb, |
| int mb_row, int mb_col, |
| int mb_rows, int mb_cols, |
| int mi_stride) |
| { |
| /* Find relevant neighboring blocks */ |
| EC_BLOCK neighbors[NUM_NEIGHBORS]; |
| int i; |
| /* Initialize the array. MAX_REF_FRAMES is interpreted as "doesn't exist" */ |
| for (i = 0; i < NUM_NEIGHBORS; ++i) |
| { |
| neighbors[i].ref_frame = MAX_REF_FRAMES; |
| neighbors[i].mv.row = neighbors[i].mv.col = 0; |
| } |
| find_neighboring_blocks(mb->mode_info_context, |
| neighbors, |
| mb_row, mb_col, |
| mb_rows, mb_cols, |
| mb->mode_info_stride); |
| /* Interpolate MVs for the missing blocks from the surrounding |
| * blocks which refer to the last frame. */ |
| interpolate_mvs(mb, neighbors, LAST_FRAME); |
| |
| mb->mode_info_context->mbmi.ref_frame = LAST_FRAME; |
| mb->mode_info_context->mbmi.mode = SPLITMV; |
| mb->mode_info_context->mbmi.uv_mode = DC_PRED; |
| mb->mode_info_context->mbmi.partitioning = 3; |
| mb->mode_info_context->mbmi.segment_id = 0; |
| } |
| |
| void vp8_conceal_corrupt_mb(MACROBLOCKD *xd) |
| { |
| /* This macroblock has corrupt residual, use the motion compensated |
| image (predictor) for concealment */ |
| |
| /* The build predictor functions now output directly into the dst buffer, |
| * so the copies are no longer necessary */ |
| |
| } |