/******************************************************************************
 *
 * Copyright (C) 2018 The Android Open Source Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at:
 *
 * http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
 *****************************************************************************
 * Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore
*/

/**
******************************************************************************
* @file hme_subpel.c
*
* @brief
*    Fullpel search and refinement
*
* @author
*    Ittiam
*
******************************************************************************
*/

/*****************************************************************************/
/* File Includes                                                             */
/*****************************************************************************/
/* System include files */
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <assert.h>
#include <stdarg.h>
#include <math.h>
#include <limits.h>

/* User include files */
#include "ihevc_typedefs.h"
#include "itt_video_api.h"
#include "ihevce_api.h"

#include "rc_cntrl_param.h"
#include "rc_frame_info_collector.h"
#include "rc_look_ahead_params.h"

#include "ihevc_defs.h"
#include "ihevc_structs.h"
#include "ihevc_platform_macros.h"
#include "ihevc_deblk.h"
#include "ihevc_itrans_recon.h"
#include "ihevc_chroma_itrans_recon.h"
#include "ihevc_chroma_intra_pred.h"
#include "ihevc_intra_pred.h"
#include "ihevc_inter_pred.h"
#include "ihevc_mem_fns.h"
#include "ihevc_padding.h"
#include "ihevc_weighted_pred.h"
#include "ihevc_sao.h"
#include "ihevc_resi_trans.h"
#include "ihevc_quant_iquant_ssd.h"
#include "ihevc_cabac_tables.h"

#include "ihevce_defs.h"
#include "ihevce_lap_enc_structs.h"
#include "ihevce_multi_thrd_structs.h"
#include "ihevce_multi_thrd_funcs.h"
#include "ihevce_me_common_defs.h"
#include "ihevce_had_satd.h"
#include "ihevce_error_codes.h"
#include "ihevce_bitstream.h"
#include "ihevce_cabac.h"
#include "ihevce_rdoq_macros.h"
#include "ihevce_function_selector.h"
#include "ihevce_enc_structs.h"
#include "ihevce_entropy_structs.h"
#include "ihevce_cmn_utils_instr_set_router.h"
#include "ihevce_enc_loop_structs.h"
#include "ihevce_bs_compute_ctb.h"
#include "ihevce_global_tables.h"
#include "ihevce_dep_mngr_interface.h"
#include "hme_datatype.h"
#include "hme_interface.h"
#include "hme_common_defs.h"
#include "hme_defs.h"
#include "ihevce_me_instr_set_router.h"
#include "hme_globals.h"
#include "hme_utils.h"
#include "hme_coarse.h"
#include "hme_refine.h"
#include "hme_err_compute.h"
#include "hme_common_utils.h"
#include "hme_search_algo.h"
#include "ihevce_stasino_helpers.h"

/**
********************************************************************************
*  @fn     hme_fullpel_cand_sifter
*
*  @brief  Given a list of search candidates and valid partition types,
*          this function finds the two best candidates for each partition type.
*
*  @return None
********************************************************************************
*/
void hme_fullpel_cand_sifter(
    hme_search_prms_t *ps_search_prms,
    layer_ctxt_t *ps_layer_ctxt,
    wgt_pred_ctxt_t *ps_wt_inp_prms,
    S32 i4_alpha_stim_multiplier,
    U08 u1_is_cu_noisy,
    ihevce_me_optimised_function_list_t *ps_me_optimised_function_list)
{
    S32 i4_i;
    S16 i2_temp_tot_cost, i2_temp_stim_injected_cost, i2_temp_mv_cost, i2_temp_mv_x, i2_temp_mv_y,
        i2_temp_ref_idx;

    fullpel_refine_ctxt_t *ps_fullpel_refine_ctxt = ps_search_prms->ps_fullpel_refine_ctxt;
    S32 i4_temp_part_mask;

    ps_search_prms->i4_alpha_stim_multiplier = i4_alpha_stim_multiplier;
    ps_search_prms->u1_is_cu_noisy = u1_is_cu_noisy;

    if(u1_is_cu_noisy)
    {
        i4_temp_part_mask = ps_search_prms->i4_part_mask;
        ps_search_prms->i4_part_mask &= ((ENABLE_2Nx2N) | (ENABLE_NxN));

        ps_fullpel_refine_ctxt->i4_num_valid_parts = hme_create_valid_part_ids(
            (ps_search_prms->i4_part_mask) & ((ENABLE_2Nx2N) | (ENABLE_NxN)),
            &ps_fullpel_refine_ctxt->ai4_part_id[0]);
    }

    ps_search_prms->u1_is_cu_noisy = u1_is_cu_noisy;

    hme_pred_search(
        ps_search_prms, ps_layer_ctxt, ps_wt_inp_prms, 0, ps_me_optimised_function_list);

    if(u1_is_cu_noisy)
    {
        if(ps_search_prms->ps_search_results->u1_num_results_per_part == 2)
        {
            for(i4_i = 0; i4_i < ps_fullpel_refine_ctxt->i4_num_valid_parts; i4_i++)
            {
                if(ps_fullpel_refine_ctxt->i2_tot_cost[0][i4_i] >
                   ps_fullpel_refine_ctxt->i2_tot_cost[1][i4_i])
                {
                    i2_temp_tot_cost = ps_fullpel_refine_ctxt->i2_tot_cost[0][i4_i];
                    i2_temp_stim_injected_cost =
                        ps_fullpel_refine_ctxt->i2_stim_injected_cost[0][i4_i];
                    i2_temp_mv_cost = ps_fullpel_refine_ctxt->i2_mv_cost[0][i4_i];
                    i2_temp_mv_x = ps_fullpel_refine_ctxt->i2_mv_x[0][i4_i];
                    i2_temp_mv_y = ps_fullpel_refine_ctxt->i2_mv_y[0][i4_i];
                    i2_temp_ref_idx = ps_fullpel_refine_ctxt->i2_ref_idx[0][i4_i];

                    ps_fullpel_refine_ctxt->i2_tot_cost[0][i4_i] =
                        ps_fullpel_refine_ctxt->i2_tot_cost[1][i4_i];
                    ps_fullpel_refine_ctxt->i2_stim_injected_cost[0][i4_i] =
                        ps_fullpel_refine_ctxt->i2_stim_injected_cost[1][i4_i];
                    ps_fullpel_refine_ctxt->i2_mv_cost[0][i4_i] =
                        ps_fullpel_refine_ctxt->i2_mv_cost[1][i4_i];
                    ps_fullpel_refine_ctxt->i2_mv_x[0][i4_i] =
                        ps_fullpel_refine_ctxt->i2_mv_x[1][i4_i];
                    ps_fullpel_refine_ctxt->i2_mv_y[0][i4_i] =
                        ps_fullpel_refine_ctxt->i2_mv_y[1][i4_i];
                    ps_fullpel_refine_ctxt->i2_ref_idx[0][i4_i] =
                        ps_fullpel_refine_ctxt->i2_ref_idx[1][i4_i];

                    ps_fullpel_refine_ctxt->i2_tot_cost[1][i4_i] = i2_temp_tot_cost;
                    ps_fullpel_refine_ctxt->i2_stim_injected_cost[1][i4_i] =
                        i2_temp_stim_injected_cost;
                    ps_fullpel_refine_ctxt->i2_mv_cost[1][i4_i] = i2_temp_mv_cost;
                    ps_fullpel_refine_ctxt->i2_mv_x[1][i4_i] = i2_temp_mv_x;
                    ps_fullpel_refine_ctxt->i2_mv_y[1][i4_i] = i2_temp_mv_y;
                    ps_fullpel_refine_ctxt->i2_ref_idx[1][i4_i] = i2_temp_ref_idx;
                }
            }
        }

        ps_search_prms->i4_part_mask = i4_temp_part_mask;

        ps_fullpel_refine_ctxt->i4_num_valid_parts = hme_create_valid_part_ids(
            ps_search_prms->i4_part_mask, &ps_fullpel_refine_ctxt->ai4_part_id[0]);
    }
}

static void hme_add_fpel_refine_candidates_to_search_cand_array(
    search_node_t *ps_unique_search_nodes,
    fullpel_refine_ctxt_t *ps_fullpel_refine_ctxt,
    S32 *pi4_num_unique_nodes,
    U32 *pu4_unique_node_map,
    S32 i4_fpel_search_result_id,
    S32 i4_fpel_search_result_array_index,
    S32 i4_unique_node_map_center_x,
    S32 i4_unique_node_map_center_y,
    S08 i1_unique_node_map_ref_idx,
    U08 u1_add_refine_grid_center_to_search_cand_array,
    U08 u1_do_not_check_for_duplicates)
{
    search_node_t s_refine_grid_center;

    U08 u1_use_hashing, i;

    S32 i2_mvx =
        ps_fullpel_refine_ctxt->i2_mv_x[i4_fpel_search_result_id][i4_fpel_search_result_array_index];
    S32 i2_mvy =
        ps_fullpel_refine_ctxt->i2_mv_y[i4_fpel_search_result_id][i4_fpel_search_result_array_index];
    S08 i1_ref_idx = ps_fullpel_refine_ctxt
                         ->i2_ref_idx[i4_fpel_search_result_id][i4_fpel_search_result_array_index];

    if(!u1_do_not_check_for_duplicates)
    {
        s_refine_grid_center.s_mv.i2_mvx = i2_mvx;
        s_refine_grid_center.s_mv.i2_mvy = i2_mvy;
        s_refine_grid_center.i1_ref_idx = i1_ref_idx;

        u1_use_hashing = (s_refine_grid_center.i1_ref_idx == i1_unique_node_map_ref_idx);

        for(i = 0; i < NUM_POINTS_IN_RECTANGULAR_GRID; i++)
        {
            S08 i1_offset_x = gai1_mv_offsets_from_center_in_rect_grid[i][0];
            S08 i1_offset_y = gai1_mv_offsets_from_center_in_rect_grid[i][1];

            if(i1_offset_x || i1_offset_y)
            {
                s_refine_grid_center.s_mv.i2_mvx = i2_mvx + i1_offset_x;
                s_refine_grid_center.s_mv.i2_mvy = i2_mvy + i1_offset_y;

                INSERT_NEW_NODE(
                    ps_unique_search_nodes,
                    pi4_num_unique_nodes[0],
                    s_refine_grid_center,
                    1,
                    pu4_unique_node_map,
                    i4_unique_node_map_center_x,
                    i4_unique_node_map_center_y,
                    u1_use_hashing);
            }
            else if(u1_add_refine_grid_center_to_search_cand_array)
            {
                s_refine_grid_center.s_mv.i2_mvx = i2_mvx;
                s_refine_grid_center.s_mv.i2_mvy = i2_mvy;

                INSERT_NEW_NODE(
                    ps_unique_search_nodes,
                    pi4_num_unique_nodes[0],
                    s_refine_grid_center,
                    1,
                    pu4_unique_node_map,
                    i4_unique_node_map_center_x,
                    i4_unique_node_map_center_y,
                    0);
            }
        }
    }
    else
    {
        for(i = 0; i < NUM_POINTS_IN_RECTANGULAR_GRID; i++)
        {
            S08 i1_offset_x = gai1_mv_offsets_from_center_in_rect_grid[i][0];
            S08 i1_offset_y = gai1_mv_offsets_from_center_in_rect_grid[i][1];

            if(i1_offset_x || i1_offset_y)
            {
                ps_unique_search_nodes[pi4_num_unique_nodes[0]].s_mv.i2_mvx = i2_mvx + i1_offset_x;
                ps_unique_search_nodes[pi4_num_unique_nodes[0]].s_mv.i2_mvy = i2_mvy + i1_offset_y;
                ps_unique_search_nodes[pi4_num_unique_nodes[0]++].i1_ref_idx = i1_ref_idx;
            }
            else if(u1_add_refine_grid_center_to_search_cand_array)
            {
                ps_unique_search_nodes[pi4_num_unique_nodes[0]].s_mv.i2_mvx = i2_mvx;
                ps_unique_search_nodes[pi4_num_unique_nodes[0]].s_mv.i2_mvy = i2_mvy;
                ps_unique_search_nodes[pi4_num_unique_nodes[0]++].i1_ref_idx = i1_ref_idx;
            }
        }
    }
}

void hme_fullpel_refine(
    refine_prms_t *ps_refine_prms,
    hme_search_prms_t *ps_search_prms,
    layer_ctxt_t *ps_layer_ctxt,
    wgt_pred_ctxt_t *ps_wt_inp_prms,
    U32 *pu4_unique_node_map,
    U08 u1_num_init_search_cands,
    U08 u1_8x8_blk_mask,
    S32 i4_unique_node_map_center_x,
    S32 i4_unique_node_map_center_y,
    S08 i1_unique_node_map_ref_idx,
    ME_QUALITY_PRESETS_T e_quality_preset,
    ihevce_me_optimised_function_list_t *ps_me_optimised_function_list)
{
    S32 i, j;
    S32 i4_num_results;
    U08 u1_num_complete_grids = 0;
    U08 u1_num_grids = 0;

    fullpel_refine_ctxt_t *ps_fullpel_refine_ctxt = ps_search_prms->ps_fullpel_refine_ctxt;

    S32 i4_num_unique_nodes = 0;

    search_node_t *ps_unique_search_nodes = ps_search_prms->ps_search_nodes;

    if(u1_num_init_search_cands >= 2)
    {
        S32 i4_max_num_results = (15 == u1_8x8_blk_mask)
                                     ? ps_refine_prms->u1_max_num_fpel_refine_centers
                                     : ((ME_XTREME_SPEED_25 == e_quality_preset)
                                            ? MAX_NUM_CANDS_FOR_FPEL_REFINE_IN_XS25
                                            : INT_MAX);

        for(i = 0; i < ps_fullpel_refine_ctxt->i4_num_valid_parts; i++)
        {
            S32 i4_part_id;
            S32 i4_index;

            i4_part_id = ps_fullpel_refine_ctxt->ai4_part_id[i];
            i4_index = (ps_fullpel_refine_ctxt->i4_num_valid_parts > 8) ? i4_part_id : i;
            i4_num_results = (15 == u1_8x8_blk_mask)
                                 ? MIN(ps_search_prms->ps_search_results->u1_num_results_per_part,
                                       ps_refine_prms->pu1_num_best_results[i4_part_id])
                                 : ps_search_prms->ps_search_results->u1_num_results_per_part;

            ASSERT(i4_num_results <= 2);

            for(j = 0; j < i4_num_results; j++)
            {
                if((ps_fullpel_refine_ctxt->i2_ref_idx[j][i4_index] >= 0) &&
                   (ps_fullpel_refine_ctxt->i2_mv_x[j][i4_index] != INTRA_MV))
                {
                    S32 i4_num_nodes_added = i4_num_unique_nodes;

                    hme_add_fpel_refine_candidates_to_search_cand_array(
                        ps_unique_search_nodes,
                        ps_fullpel_refine_ctxt,
                        &i4_num_unique_nodes,
                        pu4_unique_node_map,
                        j,
                        i4_index,
                        i4_unique_node_map_center_x,
                        i4_unique_node_map_center_y,
                        i1_unique_node_map_ref_idx,
                        0,
                        0);

                    i4_num_nodes_added = i4_num_unique_nodes - i4_num_nodes_added;

                    u1_num_complete_grids +=
                        (i4_num_nodes_added >= (NUM_POINTS_IN_RECTANGULAR_GRID - 1));
                    u1_num_grids += (!!i4_num_nodes_added);

                    i4_max_num_results--;
                }

                if(i4_max_num_results <= 0)
                {
                    break;
                }
            }

            if(i4_max_num_results <= 0)
            {
                break;
            }
        }
    }
    else if((1 == u1_num_init_search_cands) && (ps_refine_prms->u1_max_num_fpel_refine_centers >= 1))
    {
        ps_fullpel_refine_ctxt->i2_mv_x[0][0] = ps_unique_search_nodes[0].s_mv.i2_mvx;
        ps_fullpel_refine_ctxt->i2_mv_y[0][0] = ps_unique_search_nodes[0].s_mv.i2_mvy;
        ps_fullpel_refine_ctxt->i2_ref_idx[0][0] = ps_unique_search_nodes[0].i1_ref_idx;

        if((ps_fullpel_refine_ctxt->i2_ref_idx[0][0] >= 0) &&
           (ps_fullpel_refine_ctxt->i2_mv_x[0][0] != INTRA_MV))
        {
            hme_add_fpel_refine_candidates_to_search_cand_array(
                ps_unique_search_nodes,
                ps_fullpel_refine_ctxt,
                &i4_num_unique_nodes,
                pu4_unique_node_map,
                0,
                0,
                i4_unique_node_map_center_x,
                i4_unique_node_map_center_y,
                i1_unique_node_map_ref_idx,
                1,
                1);

            u1_num_complete_grids++;
        }
    }

    if(i4_num_unique_nodes > 0)
    {
        ps_search_prms->i4_num_search_nodes = i4_num_unique_nodes;
        ps_search_prms->u1_is_cu_noisy = 0;

        hme_pred_search(
            ps_search_prms,
            ps_layer_ctxt,
            ps_wt_inp_prms,
            (1 == u1_num_complete_grids) && (u1_num_grids == u1_num_complete_grids),
            ps_me_optimised_function_list

        );
    }
}

/**
********************************************************************************
*  @fn     hme_remove_duplicate_fpel_search_candidates
*
*  @brief  Function name is self-explanatory
*
*  @return Number of unique candidates
********************************************************************************
*/
S32 hme_remove_duplicate_fpel_search_candidates(
    search_node_t *ps_unique_search_nodes,
    search_candt_t *ps_search_candts,
    U32 *pu4_unique_node_map,
    S08 *pi1_pred_dir_to_ref_idx,
    S32 i4_num_srch_cands,
    S32 i4_num_init_candts,
    S32 i4_refine_iter_ctr,
    S32 i4_num_refinement_iterations,
    S32 i4_num_act_ref_l0,
    S08 i1_unique_node_map_ref_idx,
    S32 i4_unique_node_map_center_x,
    S32 i4_unique_node_map_center_y,
    U08 u1_is_bidir_enabled,
    ME_QUALITY_PRESETS_T e_quality_preset)
{
    S32 i;

    S32 i4_max_num_cands = ((!u1_is_bidir_enabled) && (i4_num_act_ref_l0 > 1))
                               ? (i4_num_init_candts >> 1)
                               : i4_num_init_candts;
    S32 i4_num_unique_nodes = 0;

    for(i = 0; (i < i4_num_srch_cands) && (i4_num_unique_nodes < i4_max_num_cands); i++)
    {
        search_node_t *ps_cur_cand = ps_search_candts[i].ps_search_node;

        U08 u1_use_hashing = (ps_cur_cand->i1_ref_idx == i1_unique_node_map_ref_idx);

        if(i4_num_refinement_iterations > 1)
        {
#if !ENABLE_EXPLICIT_SEARCH_IN_P_IN_L0
            /* Ref0 evaluated during the first iteration */
            /* All other Ref's evaluated during the second iteration */
            if((ps_cur_cand->i1_ref_idx != pi1_pred_dir_to_ref_idx[0]) && (i4_refine_iter_ctr == 0))
            {
                continue;
            }
#else
            if(e_quality_preset == ME_HIGH_QUALITY)
            {
                if((ps_cur_cand->i1_ref_idx != pi1_pred_dir_to_ref_idx[0]) &&
                   (i4_refine_iter_ctr == 0))
                {
                    continue;
                }
            }
            else
            {
                if(ps_cur_cand->i1_ref_idx != pi1_pred_dir_to_ref_idx[i4_refine_iter_ctr])
                {
                    continue;
                }
            }
#endif
        }

        INSERT_UNIQUE_NODE(
            ps_unique_search_nodes,
            i4_num_unique_nodes,
            ps_cur_cand[0],
            pu4_unique_node_map,
            i4_unique_node_map_center_x,
            i4_unique_node_map_center_y,
            u1_use_hashing);
    }

    return i4_num_unique_nodes;
}