/*

 * Copyright (c) 2018, Alliance for Open Media. All rights reserved

 *

 * This source code is subject to the terms of the BSD 2 Clause License and

 * the Alliance for Open Media Patent License 1.0. If the BSD 2 Clause License

 * was not distributed with this source code in the LICENSE file, you can

 * obtain it at https://www.aomedia.org/license/software-license. If the Alliance for Open

 * Media Patent License 1.0 was not distributed with this source code in the

 * PATENTS file, you can obtain it at https://www.aomedia.org/license/patent-license.

 */

#include "aom_dsp_rtcd.h"

#include "hash_motion.h"

#include "pcs.h"

static const int crc_bits        = 16;

static const int block_size_bits = 3;

static void hash_table_clear_all(HashTable* p_hash_table) {

    if (p_hash_table->p_lookup_table == NULL) {

        return;

    }

    int max_addr = 1 << (crc_bits + block_size_bits);

    for (int i = 0; i < max_addr; i++) {

        if (p_hash_table->p_lookup_table[i] != NULL) {

            svt_aom_vector_destroy(p_hash_table->p_lookup_table[i]);

            EB_FREE(p_hash_table->p_lookup_table[i]);

            p_hash_table->p_lookup_table[i] = NULL;

        }

    }

}

static void get_pixels_in_1d_char_array_by_block_2x2(uint8_t* y_src, int stride, uint8_t* p_pixels_in1D) {

    uint8_t* p_pel = y_src;

    int      index = 0;

    for (int i = 0; i < 2; i++) {

        for (int j = 0; j < 2; j++) {

            p_pixels_in1D[index++] = p_pel[j];

        }

        p_pel += stride;

    }

}

static void get_pixels_in_1d_short_array_by_block_2x2(uint16_t* y_src, int stride, uint16_t* p_pixels_in1D) {

    uint16_t* p_pel = y_src;

    int       index = 0;

    for (int i = 0; i < 2; i++) {

        for (int j = 0; j < 2; j++) {

            p_pixels_in1D[index++] = p_pel[j];

        }

        p_pel += stride;

    }

}

// the hash value (hash_value1 consists two parts, the first 3 bits relate to

// the block size and the remaining 16 bits are the crc values. This fuction

// is used to get the first 3 bits.

static int hash_block_size_to_index(int block_size) {

    switch (block_size) {

    case 4:

        return 0;

    case 8:

        return 1;

    case 16:

        return 2;

    case 32:

        return 3;

    case 64:

        return 4;

    case 128:

        return 5;

    default:

        return -1;

    }

}

static uint32_t get_identity_hash_value(const uint8_t a, const uint8_t b, const uint8_t c, const uint8_t d) {

    // The four input values add up to 32 bits, which is the size of the output.

    // Just pack those values as is.

    return ((uint32_t)a << 24) + ((uint32_t)b << 16) + ((uint32_t)c << 8) + ((uint32_t)d);

}

static uint32_t get_xor_hash_value_hbd(const uint16_t a, const uint16_t b, const uint16_t c, const uint16_t d) {

    uint32_t result;

    // Pack the lower 8 bits of each input value to the 32 bit output, then xor

    // with the upper 8 bits of each input value.

    result = ((uint32_t)(a & 0x00ff) << 24) + ((uint32_t)(b & 0x00ff) << 16) + ((uint32_t)(c & 0x00ff) << 8) +

        ((uint32_t)(d & 0x00ff));

    result ^= ((uint32_t)(a & 0xff00) << 16) + ((uint32_t)(b & 0xff00) << 8) + ((uint32_t)(c & 0xff00)) +

        ((uint32_t)(d & 0xff00) >> 8);

    return result;

}

void svt_av1_hash_table_destroy(HashTable* p_hash_table) {

    hash_table_clear_all(p_hash_table);

    EB_FREE_ARRAY(p_hash_table->p_lookup_table);

    p_hash_table->p_lookup_table = NULL;

}

EbErrorType svt_aom_rtime_alloc_svt_av1_hash_table_create(HashTable* p_hash_table) {

    EbErrorType err_code = EB_ErrorNone;

    ;

    if (p_hash_table->p_lookup_table != NULL) {

        hash_table_clear_all(p_hash_table);

        return err_code;

    }

    const int max_addr = 1 << (crc_bits + block_size_bits);

    EB_CALLOC_ARRAY(p_hash_table->p_lookup_table, max_addr);

    return err_code;

}

static bool hash_table_add_to_table(HashTable* p_hash_table, uint32_t hash_value, const BlockHash* curr_block_hash,

                                    uint16_t max_cand_per_bucket) {

    if (p_hash_table->p_lookup_table[hash_value] == NULL) {

        EB_MALLOC_OBJECT_NO_CHECK(p_hash_table->p_lookup_table[hash_value]);

        if (p_hash_table->p_lookup_table[hash_value] == NULL) {

            return false;

        }

        if (svt_aom_vector_setup(p_hash_table->p_lookup_table[hash_value], 10, sizeof(*curr_block_hash)) ==

            VECTOR_ERROR) {

            return false;

        }

    }

    // Place an upper bound each hash table bucket to up to 256 intrabc

    // block candidates, and ignore subsequent ones. Considering more can

    // unnecessarily slow down encoding for virtually no efficiency gain.

    if (svt_aom_vector_byte_size(p_hash_table->p_lookup_table[hash_value]) <

        max_cand_per_bucket * sizeof(*curr_block_hash)) {

        if (svt_aom_vector_push_back(p_hash_table->p_lookup_table[hash_value], (void*)curr_block_hash) ==

            VECTOR_ERROR) {

            return false;

        }

    }

    return true;

}

int32_t svt_av1_hash_table_count(const HashTable* p_hash_table, uint32_t hash_value) {

    if (p_hash_table->p_lookup_table[hash_value] == NULL) {

        return 0;

    } else {

        return (int32_t)(p_hash_table->p_lookup_table[hash_value]->size);

    }

}

Iterator svt_av1_hash_get_first_iterator(HashTable* p_hash_table, uint32_t hash_value) {

    assert(svt_av1_hash_table_count(p_hash_table, hash_value) > 0);

    return svt_aom_vector_begin(p_hash_table->p_lookup_table[hash_value]);

}

void svt_av1_generate_block_2x2_hash_value(const Yv12BufferConfig* picture, uint32_t* pic_block_hash,

                                           PictureControlSet* pcs) {

    const int width  = 2;

    const int height = 2;

    const int x_end  = picture->y_crop_width - width + 1;

    const int y_end  = picture->y_crop_height - height + 1;

    (void)pcs;

    if (picture->flags & YV12_FLAG_HIGHBITDEPTH) {

        uint16_t p[4];

        int      pos = 0;

        for (int y_pos = 0; y_pos < y_end; y_pos++) {

            for (int x_pos = 0; x_pos < x_end; x_pos++) {

                get_pixels_in_1d_short_array_by_block_2x2(

                    CONVERT_TO_SHORTPTR(picture->y_buffer) + y_pos * picture->y_stride + x_pos, picture->y_stride, p);

                // For HBD, we either have 40 or 48 bits of input data that the xor hash

                // reduce to 32 bits. We intentionally don't want to "discard" bits to

                // avoid any kind of biasing.

                pic_block_hash[pos] = get_xor_hash_value_hbd(p[0], p[1], p[2], p[3]);

                pos++;

            }

            pos += width - 1;

        }

    } else {

        uint8_t p[4];

        int     pos = 0;

        for (int y_pos = 0; y_pos < y_end; y_pos++) {

            for (int x_pos = 0; x_pos < x_end; x_pos++) {

                get_pixels_in_1d_char_array_by_block_2x2(

                    picture->y_buffer + y_pos * picture->y_stride + x_pos, picture->y_stride, p);

                // This 2x2 hash isn't used directly as a "key" for the hash table, so

                // we can afford to just copy the 4 8-bit pixel values as a single

                // 32-bit value directly. (i.e. there are no concerns of a lack of

                // uniform distribution)

                pic_block_hash[pos] = get_identity_hash_value(p[0], p[1], p[2], p[3]);

                pos++;

            }

            pos += width - 1;

        }

    }

}

void svt_av1_generate_block_hash_value(const Yv12BufferConfig* picture, int block_size, uint32_t* src_pic_block_hash,

                                       uint32_t* dst_pic_block_hash, PictureControlSet* pcs) {

    const int pic_width = picture->y_crop_width;

    const int x_end     = picture->y_crop_width - block_size + 1;

    const int y_end     = picture->y_crop_height - block_size + 1;

    const int src_size = block_size >> 1;

    uint32_t  p[4];

    const int length = sizeof(p);

    int pos = 0;

    for (int y_pos = 0; y_pos < y_end; y_pos++) {

        for (int x_pos = 0; x_pos < x_end; x_pos++) {

            p[0]                    = src_pic_block_hash[pos];

            p[1]                    = src_pic_block_hash[pos + src_size];

            p[2]                    = src_pic_block_hash[pos + src_size * pic_width];

            p[3]                    = src_pic_block_hash[pos + src_size * pic_width + src_size];

            dst_pic_block_hash[pos] = svt_av1_get_crc32c_value(&pcs->crc_calculator, (uint8_t*)p, length);

            pos++;

        }

        pos += block_size - 1;

    }

}

bool svt_aom_rtime_alloc_svt_av1_add_to_hash_map_by_row_with_precal_data(HashTable* p_hash_table, uint32_t* pic_hash,

                                                                         int pic_width, int pic_height, int block_size,

                                                                         uint16_t max_cand_per_bucket) {

    const int x_end = pic_width - block_size + 1;

    const int y_end = pic_height - block_size + 1;

    int add_value = hash_block_size_to_index(block_size);

    assert(add_value >= 0);

    add_value <<= crc_bits;

    const int crc_mask = (1 << crc_bits) - 1;

    int       step     = block_size;

    int       x_offset = 0;

    int       y_offset = 0;

    // Explore the entire frame hierarchically to add intrabc candidate blocks to

    // the hash table, by starting with coarser steps (the block size), towards

    // finer-grained steps until every candidate block has been considered.

    // The nested for loop goes through the pic_hash array column by column.

    // Doing a hierarchical block exploration helps maximize spatial dispersion

    // of the first and foremost candidate blocks while minimizing overlap between

    // them. This is helpful because we only keep up to 256 entries of the

    // same candidate block (located in different places), so we want those

    // entries to cover the biggest area of the image to encode to maximize coding

    // efficiency.

    // This is the coordinate exploration order example for an 8x8 region, with

    // block_size = 4. The top-left corner (x, y) coordinates of each candidate

    // block are shown below. There are 5 * 5 (25) candidate blocks.

    //    x  0  1  2  3  4  5  6  7

    //  y +------------------------

    //  0 |  1 10  5 13  3

    //  1 | 16 22 18 24 20

    //  2 |  7 11  9 14  8

    //  3 | 17 23 19 25 21

    //  4 |  2 12  6 15  4--------+

    //  5 |              | 4 x 4  |

    //  6 |              | block  |

    //  7 |              +--------+

    // Please note that due to the way block exploration works, the smallest step

    // used is 2 (i.e. no two adjacent blocks will be explored consecutively).

    // Also, the exploration is designed to visit each block candidate only once.

    while (step > 1) {

        for (int x_pos = x_offset; x_pos < x_end; x_pos += step) {

            for (int y_pos = y_offset; y_pos < y_end; y_pos += step) {

                const int pos = y_pos * pic_width + x_pos;

                BlockHash curr_block_hash;

                curr_block_hash.x = x_pos;

                curr_block_hash.y = y_pos;

                const uint32_t hash_value1  = (pic_hash[pos] & crc_mask) + add_value;

                curr_block_hash.hash_value2 = pic_hash[pos];

                if (!hash_table_add_to_table(p_hash_table, hash_value1, &curr_block_hash, max_cand_per_bucket)) {

                    return false;

                }

            }

        }

        // Adjust offsets and step sizes with this state machine.

        // State 0 is needed because no blocks in pic_hash have been explored,

        // so exploration requires a way to account for blocks with both zero

        // x_offset and zero y_offset.

        // State 0 is always meant to be executed first, but the relative order of

        // states 1, 2 and 3 can be arbitrary, as long as no two adjacent blocks

        // are explored consecutively.

        if (x_offset == 0 && y_offset == 0) {

            // State 0 -> State 1: special case

            // This state transition will only execute when step == block_size

            x_offset = step / 2;

        } else if (x_offset == step / 2 && y_offset == 0) {

            // State 1 -> State 2

            x_offset = 0;

            y_offset = step / 2;

        } else if (x_offset == 0 && y_offset == step / 2) {

            // State 2 -> State 3

            x_offset = step / 2;

        } else {

            assert(x_offset == step / 2 && y_offset == step / 2);

            // State 3 -> State 1: We've fully explored all the coordinates for the

            // current step size, continue by halving the step size

            step /= 2;

            x_offset = step / 2;

            y_offset = 0;

        }

    }

    return true;

}

void svt_av1_get_block_hash_value(uint8_t* y_src, int stride, int block_size, uint32_t* hash_value1,

                                  uint32_t* hash_value2, int use_highbitdepth, struct PictureControlSet* pcs,

                                  IntraBcContext* x) {

    UNUSED(pcs);

    const int add_value = hash_block_size_to_index(block_size) << crc_bits;

    assert(add_value >= 0);

    const int crc_mask = (1 << crc_bits) - 1;

    // 2x2 subblock hash values in current CU

    int sub_block_in_width = (block_size >> 1);

    if (use_highbitdepth) {

        uint16_t  pixel_to_hash[4];

        uint16_t* y16_src = CONVERT_TO_SHORTPTR(y_src);

        for (int y_pos = 0; y_pos < block_size; y_pos += 2) {

            for (int x_pos = 0; x_pos < block_size; x_pos += 2) {

                int pos = (y_pos >> 1) * sub_block_in_width + (x_pos >> 1);

                get_pixels_in_1d_short_array_by_block_2x2(y16_src + y_pos * stride + x_pos, stride, pixel_to_hash);

                assert(pos < AOM_BUFFER_SIZE_FOR_BLOCK_HASH);

                // For HBD, we either have 40 or 48 bits of input data that the xor hash

                // reduce to 32 bits. We intentionally don't want to "discard" bits to

                // avoid any kind of biasing.

                x->hash_value_buffer[0][pos] = get_xor_hash_value_hbd(

                    pixel_to_hash[0], pixel_to_hash[1], pixel_to_hash[2], pixel_to_hash[3]);

            }

        }

    } else {

        uint8_t pixel_to_hash[4];

        for (int y_pos = 0; y_pos < block_size; y_pos += 2) {

            for (int x_pos = 0; x_pos < block_size; x_pos += 2) {

                int pos = (y_pos >> 1) * sub_block_in_width + (x_pos >> 1);

                get_pixels_in_1d_char_array_by_block_2x2(y_src + y_pos * stride + x_pos, stride, pixel_to_hash);

                assert(pos < AOM_BUFFER_SIZE_FOR_BLOCK_HASH);

                // This 2x2 hash isn't used directly as a "key" for the hash table, so

                // we can afford to just copy the 4 8-bit pixel values as a single

                // 32-bit value directly. (i.e. there are no concerns of a lack of

                // uniform distribution)

                x->hash_value_buffer[0][pos] = get_identity_hash_value(

                    pixel_to_hash[0], pixel_to_hash[1], pixel_to_hash[2], pixel_to_hash[3]);

            }

        }

    }

    int src_sub_block_in_width = sub_block_in_width;

    sub_block_in_width >>= 1;

    int src_idx = 0;

    int dst_idx = 1 - src_idx;

    // 4x4 subblock hash values to current block hash values

    uint32_t to_hash[4];

    for (int sub_width = 4; sub_width <= block_size; sub_width *= 2, src_idx = 1 - src_idx) {

        dst_idx = 1 - src_idx;

        int dst_pos = 0;

        for (int y_pos = 0; y_pos < sub_block_in_width; y_pos++) {

            for (int x_pos = 0; x_pos < sub_block_in_width; x_pos++) {

                int src_pos = (y_pos << 1) * src_sub_block_in_width + (x_pos << 1);

                assert(src_pos + 1 < AOM_BUFFER_SIZE_FOR_BLOCK_HASH);

                assert(src_pos + src_sub_block_in_width + 1 < AOM_BUFFER_SIZE_FOR_BLOCK_HASH);

                assert(dst_pos < AOM_BUFFER_SIZE_FOR_BLOCK_HASH);

                to_hash[0] = x->hash_value_buffer[src_idx][src_pos];

                to_hash[1] = x->hash_value_buffer[src_idx][src_pos + 1];

                to_hash[2] = x->hash_value_buffer[src_idx][src_pos + src_sub_block_in_width];

                to_hash[3] = x->hash_value_buffer[src_idx][src_pos + src_sub_block_in_width + 1];

                x->hash_value_buffer[dst_idx][dst_pos] = svt_av1_get_crc32c_value(

                    &x->crc_calculator, (uint8_t*)to_hash, sizeof(to_hash));

                dst_pos++;

            }

        }

        src_sub_block_in_width = sub_block_in_width;

        sub_block_in_width >>= 1;

    }

    *hash_value1 = (x->hash_value_buffer[dst_idx][0] & crc_mask) + add_value;

    *hash_value2 = x->hash_value_buffer[dst_idx][0];

}