/*
 *  Copyright (c) 2015 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 "./vp8_rtcd.h"
#include "vp8/common/mips/msa/vp8_macros_msa.h"
#include "vp8/encoder/block.h"

static int8_t fast_quantize_b_msa(int16_t *coeff_ptr, int16_t *zbin,
                                  int16_t *round, int16_t *quant,
                                  int16_t *de_quant, int16_t *q_coeff,
                                  int16_t *dq_coeff)
{
    int32_t cnt, eob;
    v16i8 inv_zig_zag = { 0, 1, 5, 6, 2, 4, 7, 12,
                          3, 8, 11, 13, 9, 10, 14, 15 };
    v8i16 round0, round1;
    v8i16 sign_z0, sign_z1;
    v8i16 q_coeff0, q_coeff1;
    v8i16 x0, x1, de_quant0, de_quant1;
    v8i16 coeff0, coeff1, z0, z1;
    v8i16 quant0, quant1, quant2, quant3;
    v8i16 zero = { 0 };
    v8i16 inv_zig_zag0, inv_zig_zag1;
    v8i16 zigzag_mask0 = { 0, 1, 4, 8, 5, 2, 3, 6 };
    v8i16 zigzag_mask1 = { 9, 12, 13, 10, 7, 11, 14, 15 };
    v8i16 temp0_h, temp1_h, temp2_h, temp3_h;
    v4i32 temp0_w, temp1_w, temp2_w, temp3_w;

    ILVRL_B2_SH(zero, inv_zig_zag, inv_zig_zag0, inv_zig_zag1);
    eob = -1;
    LD_SH2(coeff_ptr, 8, coeff0, coeff1);
    VSHF_H2_SH(coeff0, coeff1, coeff0, coeff1, zigzag_mask0, zigzag_mask1,
               z0, z1);
    LD_SH2(round, 8, coeff0, coeff1);
    VSHF_H2_SH(coeff0, coeff1, coeff0, coeff1, zigzag_mask0, zigzag_mask1,
               round0, round1);
    LD_SH2(quant, 8, coeff0, coeff1);
    VSHF_H2_SH(coeff0, coeff1, coeff0, coeff1, zigzag_mask0, zigzag_mask1,
               quant0, quant2);
    sign_z0 = z0 >> 15;
    sign_z1 = z1 >> 15;
    x0 = __msa_add_a_h(z0, zero);
    x1 = __msa_add_a_h(z1, zero);
    ILVL_H2_SH(quant0, quant0, quant2, quant2, quant1, quant3);
    ILVR_H2_SH(quant0, quant0, quant2, quant2, quant0, quant2);
    ILVL_H2_SH(round0, x0, round1, x1, temp1_h, temp3_h);
    ILVR_H2_SH(round0, x0, round1, x1, temp0_h, temp2_h);
    DOTP_SH4_SW(temp0_h, temp1_h, temp2_h, temp3_h, quant0, quant1, quant2,
                quant3, temp0_w, temp1_w, temp2_w, temp3_w);
    SRA_4V(temp0_w, temp1_w, temp2_w, temp3_w, 16);
    PCKEV_H2_SH(temp1_w, temp0_w, temp3_w, temp2_w, x0, x1);
    x0 = x0 ^ sign_z0;
    x1 = x1 ^ sign_z1;
    SUB2(x0, sign_z0, x1, sign_z1, x0, x1);
    VSHF_H2_SH(x0, x1, x0, x1, inv_zig_zag0, inv_zig_zag1, q_coeff0, q_coeff1);
    ST_SH2(q_coeff0, q_coeff1, q_coeff, 8);
    LD_SH2(de_quant, 8, de_quant0, de_quant1);
    q_coeff0 *= de_quant0;
    q_coeff1 *= de_quant1;
    ST_SH2(q_coeff0, q_coeff1, dq_coeff, 8);

    for (cnt = 0; cnt < 16; ++cnt)
    {
        if ((cnt <= 7) && (x1[7 - cnt] != 0))
        {
            eob = (15 - cnt);
            break;
        }

        if ((cnt > 7) && (x0[7 - (cnt - 8)] != 0))
        {
            eob = (7 - (cnt - 8));
            break;
        }
    }

    return (int8_t)(eob + 1);
}

static int8_t exact_regular_quantize_b_msa(int16_t *zbin_boost,
                                           int16_t *coeff_ptr,
                                           int16_t *zbin,
                                           int16_t *round,
                                           int16_t *quant,
                                           int16_t *quant_shift,
                                           int16_t *de_quant,
                                           int16_t zbin_oq_in,
                                           int16_t *q_coeff,
                                           int16_t *dq_coeff)
{
    int32_t cnt, eob;
    int16_t *boost_temp = zbin_boost;
    v16i8 inv_zig_zag = { 0, 1, 5, 6, 2, 4, 7, 12,
                          3, 8, 11, 13, 9, 10, 14, 15 };
    v8i16 round0, round1;
    v8i16 sign_z0, sign_z1;
    v8i16 q_coeff0, q_coeff1;
    v8i16 z_bin0, z_bin1, zbin_o_q;
    v8i16 x0, x1, sign_x0, sign_x1, de_quant0, de_quant1;
    v8i16 coeff0, coeff1, z0, z1;
    v8i16 quant0, quant1, quant2, quant3;
    v8i16 zero = { 0 };
    v8i16 inv_zig_zag0, inv_zig_zag1;
    v8i16 zigzag_mask0 = { 0, 1, 4, 8, 5, 2, 3, 6 };
    v8i16 zigzag_mask1 = { 9, 12, 13, 10, 7, 11, 14, 15 };
    v8i16 temp0_h, temp1_h, temp2_h, temp3_h;
    v4i32 temp0_w, temp1_w, temp2_w, temp3_w;

    ILVRL_B2_SH(zero, inv_zig_zag, inv_zig_zag0, inv_zig_zag1);
    zbin_o_q = __msa_fill_h(zbin_oq_in);
    eob = -1;
    LD_SH2(coeff_ptr, 8, coeff0, coeff1);
    VSHF_H2_SH(coeff0, coeff1, coeff0, coeff1, zigzag_mask0, zigzag_mask1,
               z0, z1);
    LD_SH2(round, 8, coeff0, coeff1);
    VSHF_H2_SH(coeff0, coeff1, coeff0, coeff1, zigzag_mask0, zigzag_mask1,
               round0, round1);
    LD_SH2(quant, 8, coeff0, coeff1);
    VSHF_H2_SH(coeff0, coeff1, coeff0, coeff1, zigzag_mask0, zigzag_mask1,
               quant0, quant2);
    LD_SH2(zbin, 8, coeff0, coeff1);
    VSHF_H2_SH(coeff0, coeff1, coeff0, coeff1, zigzag_mask0, zigzag_mask1,
               z_bin0, z_bin1);
    sign_z0 = z0 >> 15;
    sign_z1 = z1 >> 15;
    x0 = __msa_add_a_h(z0, zero);
    x1 = __msa_add_a_h(z1, zero);
    SUB2(x0, z_bin0, x1, z_bin1, z_bin0, z_bin1);
    SUB2(z_bin0, zbin_o_q, z_bin1, zbin_o_q, z_bin0, z_bin1);
    ILVL_H2_SH(quant0, quant0, quant2, quant2, quant1, quant3);
    ILVR_H2_SH(quant0, quant0, quant2, quant2, quant0, quant2);
    ILVL_H2_SH(round0, x0, round1, x1, temp1_h, temp3_h);
    ILVR_H2_SH(round0, x0, round1, x1, temp0_h, temp2_h);
    DOTP_SH4_SW(temp0_h, temp1_h, temp2_h, temp3_h, quant0, quant1, quant2,
                quant3, temp0_w, temp1_w, temp2_w, temp3_w);
    SRA_4V(temp0_w, temp1_w, temp2_w, temp3_w, 16);
    PCKEV_H2_SH(temp1_w, temp0_w, temp3_w, temp2_w, temp0_h, temp2_h);
    LD_SH2(quant_shift, 8, coeff0, coeff1);
    VSHF_H2_SH(coeff0, coeff1, coeff0, coeff1, zigzag_mask0, zigzag_mask1,
               quant0, quant2);
    ILVL_H2_SH(quant0, quant0, quant2, quant2, quant1, quant3);
    ILVR_H2_SH(quant0, quant0, quant2, quant2, quant0, quant2);
    ADD2(x0, round0, x1, round1, x0, x1);
    ILVL_H2_SH(temp0_h, x0, temp2_h, x1, temp1_h, temp3_h);
    ILVR_H2_SH(temp0_h, x0, temp2_h, x1, temp0_h, temp2_h);
    DOTP_SH4_SW(temp0_h, temp1_h, temp2_h, temp3_h, quant0, quant1, quant2,
                quant3, temp0_w, temp1_w, temp2_w, temp3_w);
    SRA_4V(temp0_w, temp1_w, temp2_w, temp3_w, 16);
    PCKEV_H2_SH(temp1_w, temp0_w, temp3_w, temp2_w, x0, x1);
    sign_x0 = x0 ^ sign_z0;
    sign_x1 = x1 ^ sign_z1;
    SUB2(sign_x0, sign_z0, sign_x1, sign_z1, sign_x0, sign_x1);
    for (cnt = 0; cnt < 16; ++cnt)
    {
        if (cnt <= 7)
        {
            if (boost_temp[0] <= z_bin0[cnt])
            {
                if (x0[cnt])
                {
                    eob = cnt;
                    boost_temp = zbin_boost;
                }
                else
                {
                    boost_temp++;
                }
            }
            else
            {
                sign_x0[cnt] = 0;
                boost_temp++;
            }
        }
        else
        {
            if (boost_temp[0] <= z_bin1[cnt - 8])
            {
                if (x1[cnt - 8])
                {
                    eob = cnt;
                    boost_temp = zbin_boost;
                }
                else
                {
                    boost_temp++;
                }
            }
            else
            {
                sign_x1[cnt - 8] = 0;
                boost_temp++;
            }
        }
    }

    VSHF_H2_SH(sign_x0, sign_x1, sign_x0, sign_x1, inv_zig_zag0, inv_zig_zag1,
               q_coeff0, q_coeff1);
    ST_SH2(q_coeff0, q_coeff1, q_coeff, 8);
    LD_SH2(de_quant, 8, de_quant0, de_quant1);
    MUL2(de_quant0, q_coeff0, de_quant1, q_coeff1, de_quant0, de_quant1);
    ST_SH2(de_quant0, de_quant1, dq_coeff, 8);

    return (int8_t)(eob + 1);
}

void vp8_fast_quantize_b_msa(BLOCK *b, BLOCKD *d)
{
    int16_t *coeff_ptr = b->coeff;
    int16_t *zbin_ptr = b->zbin;
    int16_t *round_ptr = b->round;
    int16_t *quant_ptr = b->quant_fast;
    int16_t *qcoeff_ptr = d->qcoeff;
    int16_t *dqcoeff_ptr = d->dqcoeff;
    int16_t *dequant_ptr = d->dequant;

    *d->eob = fast_quantize_b_msa(coeff_ptr, zbin_ptr, round_ptr, quant_ptr,
                                  dequant_ptr, qcoeff_ptr, dqcoeff_ptr);
}

void vp8_regular_quantize_b_msa(BLOCK *b, BLOCKD *d)
{
    int16_t *zbin_boost_ptr = b->zrun_zbin_boost;
    int16_t *coeff_ptr = b->coeff;
    int16_t *zbin_ptr = b->zbin;
    int16_t *round_ptr = b->round;
    int16_t *quant_ptr = b->quant;
    int16_t *quant_shift_ptr = b->quant_shift;
    int16_t *qcoeff_ptr = d->qcoeff;
    int16_t *dqcoeff_ptr = d->dqcoeff;
    int16_t *dequant_ptr = d->dequant;
    int16_t zbin_oq_value = b->zbin_extra;

    *d->eob = exact_regular_quantize_b_msa(zbin_boost_ptr, coeff_ptr,
                                           zbin_ptr, round_ptr,
                                           quant_ptr, quant_shift_ptr,
                                           dequant_ptr, zbin_oq_value,
                                           qcoeff_ptr, dqcoeff_ptr);
}