/******************************************************************************

 *

 * 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 var_q_operator.c

*

* \brief

*    This files to be used for basic fixed Q-point functions

*

* \date

*

* \author

*    ittiam

*

******************************************************************************

*/

/*****************************************************************************/

/* File Includes                                                             */

/*****************************************************************************/

/* User include files */

#include "ia_type_def.h"

#include "defs.h"

#include "ia_basic_ops32.h"

#include "ia_basic_ops40.h"

/* #include "num_struct.h" */

#include "var_q_operator.h"

#include "sqrt_interp.h"

#include "common_rom.h"

#define NUM_BITS_MAG 32

/************************************************************************************/

/* The files to be used for basic fixed Q-point functions :                         */

/*                                                                                  */

/* audio/ia_standards/c64x/include/ia_basic_ops32.h        cvs_version : FULL_V1_16 */

/* audio/ia_standards/c64x/include/ia_basic_ops40.h     cvs_version : FULL_V1_16    */

/*                                                                                  */

/************************************************************************************/

/* Multiply */

void mult32_var_q(number_t a, number_t b, number_t *c)

{

    WORD32 Q_a;

    WORD32 Q_b;

    /* WORD32 final_Q; */

    WORD32 norm_a;

    WORD32 norm_b;

    norm_a = norm32(a.sm); /* norm32 defined in ia_basic_ops32.h */

    norm_b = norm32(b.sm);

    Q_a = norm_a + a.e;

    Q_b = norm_b + b.e;

    a.sm = shl32_sat(a.sm, norm_a);

    b.sm = shl32_sat(b.sm, norm_b);

    c->sm = mult32(a.sm, b.sm); /* mult32 defined in ia_basic_ops40.h */

    c->e = a.e + b.e + norm_a + norm_b - 32; /* mult32 decreases the Q-format by 32 */

}

/* Division */

void div32_var_q(number_t a, number_t b, number_t *c)

{

    WORD32 qoutient_q_format;

    c->sm = div32(a.sm, b.sm, &qoutient_q_format); /* div32 defined in ia_basic_ops32.h */

    c->e = (a.e - b.e) + qoutient_q_format;

}

/* Addition */

void add32_var_q(number_t a, number_t b, number_t *c)

{

    WORD32 Q_a;

    WORD32 Q_b;

    WORD32 final_Q;

    WORD32 norm_a;

    WORD32 norm_b;

    norm_a = norm32(a.sm) - 1; /* norm32 defined in ia_basic_ops32.h */

    norm_b = norm32(b.sm) - 1; /* we normalise a & b only to 30t bit

                                        instead of to 31st bit

                                        */

    Q_a = norm_a + a.e;

    Q_b = norm_b + b.e;

    if(Q_b < Q_a)

    {

        b.sm = shl32_dir_sat(b.sm, norm_b);

        a.sm = shr32_dir_sat(a.sm, ((a.e - b.e) - norm_b));

        final_Q = Q_b;

    }

    else if(Q_a < Q_b)

    {

        a.sm = shl32_dir_sat(a.sm, norm_a);

        b.sm = shr32_dir_sat(b.sm, ((b.e - a.e) - norm_a));

        final_Q = Q_a;

    }

    else

    {

        a.sm = shl32_dir_sat(a.sm, norm_a);

        b.sm = shl32_dir_sat(b.sm, norm_b);

        final_Q = Q_a;

    }

    c->sm = add32(a.sm, b.sm); /* add32_shr defined in ia_basic_ops32.h */

    c->e = final_Q; /* because add32_shr does right shift

                                            by 1 before adding */

}

/* Subtraction */

void sub32_var_q(number_t a, number_t b, number_t *c)

{

    WORD32 Q_a;

    WORD32 Q_b;

    WORD32 final_Q;

    WORD32 norm_a;

    WORD32 norm_b;

    norm_a = norm32(a.sm) - 1; /* norm32 defined in ia_basic_ops32.h */

    norm_b = norm32(b.sm) - 1; /* we normalise a & b only to 30t bit

                                        instead of to 31st bit

                                        */

    Q_a = norm_a + a.e;

    Q_b = norm_b + b.e;

    if(Q_b < Q_a)

    {

        b.sm = shl32_dir_sat(b.sm, norm_b);

        a.sm = shr32_dir_sat(a.sm, ((a.e - b.e) - norm_b));

        final_Q = Q_b;

    }

    else if(Q_a < Q_b)

    {

        a.sm = shl32_dir_sat(a.sm, norm_a);

        b.sm = shr32_dir_sat(b.sm, ((b.e - a.e) - norm_a));

        final_Q = Q_a;

    }

    else

    {

        a.sm = shl32_dir_sat(a.sm, norm_a);

        b.sm = shl32_dir_sat(b.sm, norm_b);

        final_Q = Q_a;

    }

    c->sm = sub32(a.sm, b.sm); /* add32_shr defined in ia_basic_ops32.h */

    c->e = final_Q; /* because add32_shr does right shift

                                            by 1 before adding */

}

/* square root */

void sqrt32_var_q(number_t a, number_t *c)

{

    WORD32 q_temp;

    q_temp = a.e;

    c->sm = sqrtFix_interpolate(a.sm, &q_temp, gi4_sqrt_tab);

    /* c->sm = sqrtFix(a.sm, &q_temp, gi4_sqrt_tab); */

    c->e = q_temp;

}

void number_t_to_word32(number_t num_a, WORD32 *a)

{

    *a = shr32_dir_sat(num_a.sm, num_a.e);

}

/*

convert_float_to_fix(float a_f,

                     number_t *a)

{

            double log_a_f;

            log_a_f = log(ABS(a_f))/log(2);

            a->e = 30 - (WORD32)ceil(log_a_f);

            a->sm = (WORD32) (a_f * pow(2, a->e));

}

*/

#ifdef ITT_C6678

#pragma CODE_SECTION(number_t_to_word32, "itt_varq_l1pram");

#pragma CODE_SECTION(sqrt32_var_q, "itt_varq_l1pram");

#pragma CODE_SECTION(sub32_var_q, "itt_varq_l1pram");

#pragma CODE_SECTION(add32_var_q, "itt_varq_l1pram");

#pragma CODE_SECTION(div32_var_q, "itt_varq_l1pram");

#pragma CODE_SECTION(mult32_var_q, "itt_varq_l1pram");

#endif