// SPDX-License-Identifier: GPL-2.0
/******************************************************************************
 *
 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
 *
 ******************************************************************************/

#include <linux/kernel.h>
#include "odm_precomp.h"

static bool CheckPositive(struct dm_odm_t *pDM_Odm, const u32 Condition1, const u32 Condition2)
{
        u8 _BoardType =
                ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA */
                ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA */
                ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA */
                ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */
                ((pDM_Odm->BoardType & BIT2) >> 2) << 4;  /* _BT */

        u32   cond1   = Condition1, cond2 = Condition2;
        u32    driver1 =
                pDM_Odm->CutVersion       << 24 |
                pDM_Odm->SupportPlatform  << 16 |
                pDM_Odm->PackageType      << 12 |
                pDM_Odm->SupportInterface << 8  |
                _BoardType;

        u32 driver2 =
                pDM_Odm->TypeGLNA <<  0 |
                pDM_Odm->TypeGPA  <<  8 |
                pDM_Odm->TypeALNA << 16 |
                pDM_Odm->TypeAPA  << 24;

        /* Value Defined Check =============== */
        /* QFN Type [15:12] and Cut Version [27:24] need to do value check */

        if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000)))
                return false;
        if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000)))
                return false;

        /* Bit Defined Check ================ */
        /* We don't care [31:28] and [23:20] */
        /* */
        cond1   &= 0x000F0FFF;
        driver1 &= 0x000F0FFF;

        if ((cond1 & driver1) == cond1) {
                u32 bitMask = 0;

                if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE */
                        return true;

                if ((cond1 & BIT0) != 0) /* GLNA */
                        bitMask |= 0x000000FF;
                if ((cond1 & BIT1) != 0) /* GPA */
                        bitMask |= 0x0000FF00;
                if ((cond1 & BIT2) != 0) /* ALNA */
                        bitMask |= 0x00FF0000;
                if ((cond1 & BIT3) != 0) /* APA */
                        bitMask |= 0xFF000000;

                /* BoardType of each RF path is matched */
                if ((cond2 & bitMask) == (driver2 & bitMask))
                        return true;
        }
        return false;
}

/******************************************************************************
 *                           MAC_REG.TXT
 ******************************************************************************/

static u32 Array_MP_8723B_MAC_REG[] = {
                0x02F, 0x00000030,
                0x035, 0x00000000,
                0x039, 0x00000008,
                0x04E, 0x000000E0,
                0x064, 0x00000000,
                0x067, 0x00000020,
                0x428, 0x0000000A,
                0x429, 0x00000010,
                0x430, 0x00000000,
                0x431, 0x00000000,
                0x432, 0x00000000,
                0x433, 0x00000001,
                0x434, 0x00000004,
                0x435, 0x00000005,
                0x436, 0x00000007,
                0x437, 0x00000008,
                0x43C, 0x00000004,
                0x43D, 0x00000005,
                0x43E, 0x00000007,
                0x43F, 0x00000008,
                0x440, 0x0000005D,
                0x441, 0x00000001,
                0x442, 0x00000000,
                0x444, 0x00000010,
                0x445, 0x00000000,
                0x446, 0x00000000,
                0x447, 0x00000000,
                0x448, 0x00000000,
                0x449, 0x000000F0,
                0x44A, 0x0000000F,
                0x44B, 0x0000003E,
                0x44C, 0x00000010,
                0x44D, 0x00000000,
                0x44E, 0x00000000,
                0x44F, 0x00000000,
                0x450, 0x00000000,
                0x451, 0x000000F0,
                0x452, 0x0000000F,
                0x453, 0x00000000,
                0x456, 0x0000005E,
                0x460, 0x00000066,
                0x461, 0x00000066,
                0x4C8, 0x000000FF,
                0x4C9, 0x00000008,
                0x4CC, 0x000000FF,
                0x4CD, 0x000000FF,
                0x4CE, 0x00000001,
                0x500, 0x00000026,
                0x501, 0x000000A2,
                0x502, 0x0000002F,
                0x503, 0x00000000,
                0x504, 0x00000028,
                0x505, 0x000000A3,
                0x506, 0x0000005E,
                0x507, 0x00000000,
                0x508, 0x0000002B,
                0x509, 0x000000A4,
                0x50A, 0x0000005E,
                0x50B, 0x00000000,
                0x50C, 0x0000004F,
                0x50D, 0x000000A4,
                0x50E, 0x00000000,
                0x50F, 0x00000000,
                0x512, 0x0000001C,
                0x514, 0x0000000A,
                0x516, 0x0000000A,
                0x525, 0x0000004F,
                0x550, 0x00000010,
                0x551, 0x00000010,
                0x559, 0x00000002,
                0x55C, 0x00000050,
                0x55D, 0x000000FF,
                0x605, 0x00000030,
                0x608, 0x0000000E,
                0x609, 0x0000002A,
                0x620, 0x000000FF,
                0x621, 0x000000FF,
                0x622, 0x000000FF,
                0x623, 0x000000FF,
                0x624, 0x000000FF,
                0x625, 0x000000FF,
                0x626, 0x000000FF,
                0x627, 0x000000FF,
                0x638, 0x00000050,
                0x63C, 0x0000000A,
                0x63D, 0x0000000A,
                0x63E, 0x0000000E,
                0x63F, 0x0000000E,
                0x640, 0x00000040,
                0x642, 0x00000040,
                0x643, 0x00000000,
                0x652, 0x000000C8,
                0x66E, 0x00000005,
                0x700, 0x00000021,
                0x701, 0x00000043,
                0x702, 0x00000065,
                0x703, 0x00000087,
                0x708, 0x00000021,
                0x709, 0x00000043,
                0x70A, 0x00000065,
                0x70B, 0x00000087,
                0x765, 0x00000018,
                0x76E, 0x00000004,

};

void ODM_ReadAndConfig_MP_8723B_MAC_REG(struct dm_odm_t *pDM_Odm)
{
        u32 i = 0;
        u32 ArrayLen = ARRAY_SIZE(Array_MP_8723B_MAC_REG);
        u32 *Array = Array_MP_8723B_MAC_REG;

        for (i = 0; i < ArrayLen; i += 2) {
                u32 v1 = Array[i];
                u32 v2 = Array[i + 1];

                /* This (offset, data) pair doesn't care the condition. */
                if (v1 < 0x40000000) {
                        odm_ConfigMAC_8723B(pDM_Odm, v1, (u8)v2);
                        continue;
                } else {
                        /* This line is the beginning of branch. */
                        bool bMatched = true;
                        u8  cCond  = (u8)((v1 & (BIT29 | BIT28)) >> 28);

                        if (cCond == COND_ELSE) { /* ELSE, ENDIF */
                                bMatched = true;
                                READ_NEXT_PAIR(v1, v2, i);
                        } else if (!CheckPositive(pDM_Odm, v1, v2)) {
                                bMatched = false;
                                READ_NEXT_PAIR(v1, v2, i);
                                READ_NEXT_PAIR(v1, v2, i);
                        } else {
                                READ_NEXT_PAIR(v1, v2, i);
                                bMatched = true;
                                READ_NEXT_PAIR(v1, v2, i);
                        }

                        if (!bMatched) {
                                /*
                                 * Condition isn't matched.
                                 * Discard the following (offset, data) pairs.
                                 */
                                while (v1 < 0x40000000 && i < ArrayLen - 2)
                                        READ_NEXT_PAIR(v1, v2, i);

                                i -= 2; /* prevent from for-loop += 2 */
                        } else { /* Configure matched pairs and skip to end of if-else. */
                                while (v1 < 0x40000000 && i < ArrayLen - 2) {
                                        odm_ConfigMAC_8723B(pDM_Odm, v1, (u8)v2);
                                        READ_NEXT_PAIR(v1, v2, i);
                                }

                                /* Keeps reading until ENDIF. */
                                cCond = (u8)((v1 & (BIT29 | BIT28)) >> 28);
                                while (cCond != COND_ENDIF && i < ArrayLen - 2) {
                                        READ_NEXT_PAIR(v1, v2, i);
                                        cCond = (u8)((v1 & (BIT29 | BIT28)) >> 28);
                                }
                        }
                }
        }
}