drivers/staging/rtl8188eu/hal/bb_cfg.c

   1 /******************************************************************************
   2 *
   3 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
   4 *
   5 * This program is free software; you can redistribute it and/or modify it
   6 * under the terms of version 2 of the GNU General Public License as
   7 * published by the Free Software Foundation.
   8 *
   9 * This program is distributed in the hope that it will be useful, but WITHOUT
  10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12 * more details.
  13 *
  14 * You should have received a copy of the GNU General Public License along with
  15 * this program; if not, write to the Free Software Foundation, Inc.,
  16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17 *
  18 *
  19 ******************************************************************************/
  20
  21 #include "odm_precomp.h"
  22
  23 #include <phy.h>
  24
  25 /* AGC_TAB_1T.TXT */
  26
  27 static u32 array_agc_tab_1t_8188e[] = {
  28                 0xC78, 0xFB000001,
  29                 0xC78, 0xFB010001,
  30                 0xC78, 0xFB020001,
  31                 0xC78, 0xFB030001,
  32                 0xC78, 0xFB040001,
  33                 0xC78, 0xFB050001,
  34                 0xC78, 0xFA060001,
  35                 0xC78, 0xF9070001,
  36                 0xC78, 0xF8080001,
  37                 0xC78, 0xF7090001,
  38                 0xC78, 0xF60A0001,
  39                 0xC78, 0xF50B0001,
  40                 0xC78, 0xF40C0001,
  41                 0xC78, 0xF30D0001,
  42                 0xC78, 0xF20E0001,
  43                 0xC78, 0xF10F0001,
  44                 0xC78, 0xF0100001,
  45                 0xC78, 0xEF110001,
  46                 0xC78, 0xEE120001,
  47                 0xC78, 0xED130001,
  48                 0xC78, 0xEC140001,
  49                 0xC78, 0xEB150001,
  50                 0xC78, 0xEA160001,
  51                 0xC78, 0xE9170001,
  52                 0xC78, 0xE8180001,
  53                 0xC78, 0xE7190001,
  54                 0xC78, 0xE61A0001,
  55                 0xC78, 0xE51B0001,
  56                 0xC78, 0xE41C0001,
  57                 0xC78, 0xE31D0001,
  58                 0xC78, 0xE21E0001,
  59                 0xC78, 0xE11F0001,
  60                 0xC78, 0x8A200001,
  61                 0xC78, 0x89210001,
  62                 0xC78, 0x88220001,
  63                 0xC78, 0x87230001,
  64                 0xC78, 0x86240001,
  65                 0xC78, 0x85250001,
  66                 0xC78, 0x84260001,
  67                 0xC78, 0x83270001,
  68                 0xC78, 0x82280001,
  69                 0xC78, 0x6B290001,
  70                 0xC78, 0x6A2A0001,
  71                 0xC78, 0x692B0001,
  72                 0xC78, 0x682C0001,
  73                 0xC78, 0x672D0001,
  74                 0xC78, 0x662E0001,
  75                 0xC78, 0x652F0001,
  76                 0xC78, 0x64300001,
  77                 0xC78, 0x63310001,
  78                 0xC78, 0x62320001,
  79                 0xC78, 0x61330001,
  80                 0xC78, 0x46340001,
  81                 0xC78, 0x45350001,
  82                 0xC78, 0x44360001,
  83                 0xC78, 0x43370001,
  84                 0xC78, 0x42380001,
  85                 0xC78, 0x41390001,
  86                 0xC78, 0x403A0001,
  87                 0xC78, 0x403B0001,
  88                 0xC78, 0x403C0001,
  89                 0xC78, 0x403D0001,
  90                 0xC78, 0x403E0001,
  91                 0xC78, 0x403F0001,
  92                 0xC78, 0xFB400001,
  93                 0xC78, 0xFB410001,
  94                 0xC78, 0xFB420001,
  95                 0xC78, 0xFB430001,
  96                 0xC78, 0xFB440001,
  97                 0xC78, 0xFB450001,
  98                 0xC78, 0xFB460001,
  99                 0xC78, 0xFB470001,
 100                 0xC78, 0xFB480001,
 101                 0xC78, 0xFA490001,
 102                 0xC78, 0xF94A0001,
 103                 0xC78, 0xF84B0001,
 104                 0xC78, 0xF74C0001,
 105                 0xC78, 0xF64D0001,
 106                 0xC78, 0xF54E0001,
 107                 0xC78, 0xF44F0001,
 108                 0xC78, 0xF3500001,
 109                 0xC78, 0xF2510001,
 110                 0xC78, 0xF1520001,
 111                 0xC78, 0xF0530001,
 112                 0xC78, 0xEF540001,
 113                 0xC78, 0xEE550001,
 114                 0xC78, 0xED560001,
 115                 0xC78, 0xEC570001,
 116                 0xC78, 0xEB580001,
 117                 0xC78, 0xEA590001,
 118                 0xC78, 0xE95A0001,
 119                 0xC78, 0xE85B0001,
 120                 0xC78, 0xE75C0001,
 121                 0xC78, 0xE65D0001,
 122                 0xC78, 0xE55E0001,
 123                 0xC78, 0xE45F0001,
 124                 0xC78, 0xE3600001,
 125                 0xC78, 0xE2610001,
 126                 0xC78, 0xC3620001,
 127                 0xC78, 0xC2630001,
 128                 0xC78, 0xC1640001,
 129                 0xC78, 0x8B650001,
 130                 0xC78, 0x8A660001,
 131                 0xC78, 0x89670001,
 132                 0xC78, 0x88680001,
 133                 0xC78, 0x87690001,
 134                 0xC78, 0x866A0001,
 135                 0xC78, 0x856B0001,
 136                 0xC78, 0x846C0001,
 137                 0xC78, 0x676D0001,
 138                 0xC78, 0x666E0001,
 139                 0xC78, 0x656F0001,
 140                 0xC78, 0x64700001,
 141                 0xC78, 0x63710001,
 142                 0xC78, 0x62720001,
 143                 0xC78, 0x61730001,
 144                 0xC78, 0x60740001,
 145                 0xC78, 0x46750001,
 146                 0xC78, 0x45760001,
 147                 0xC78, 0x44770001,
 148                 0xC78, 0x43780001,
 149                 0xC78, 0x42790001,
 150                 0xC78, 0x417A0001,
 151                 0xC78, 0x407B0001,
 152                 0xC78, 0x407C0001,
 153                 0xC78, 0x407D0001,
 154                 0xC78, 0x407E0001,
 155                 0xC78, 0x407F0001,
 156 };
 157
 158 static bool set_baseband_agc_config(struct adapter *adapt)
 159 {
 160         u32 i;
 161         const u32 arraylen = ARRAY_SIZE(array_agc_tab_1t_8188e);
 162         u32 *array = array_agc_tab_1t_8188e;
 163
 164         for (i = 0; i < arraylen; i += 2) {
 165                 u32 v1 = array[i];
 166                 u32 v2 = array[i+1];
 167
 168                 if (v1 < 0xCDCDCDCD) {
 169                         phy_set_bb_reg(adapt, v1, bMaskDWord, v2);
 170                         udelay(1);
 171                 }
 172         }
 173         return true;
 174 }
 175
 176 /*  PHY_REG_1T.TXT  */
 177
 178 static u32 array_phy_reg_1t_8188e[] = {
 179                 0x800, 0x80040000,
 180                 0x804, 0x00000003,
 181                 0x808, 0x0000FC00,
 182                 0x80C, 0x0000000A,
 183                 0x810, 0x10001331,
 184                 0x814, 0x020C3D10,
 185                 0x818, 0x02200385,
 186                 0x81C, 0x00000000,
 187                 0x820, 0x01000100,
 188                 0x824, 0x00390204,
 189                 0x828, 0x00000000,
 190                 0x82C, 0x00000000,
 191                 0x830, 0x00000000,
 192                 0x834, 0x00000000,
 193                 0x838, 0x00000000,
 194                 0x83C, 0x00000000,
 195                 0x840, 0x00010000,
 196                 0x844, 0x00000000,
 197                 0x848, 0x00000000,
 198                 0x84C, 0x00000000,
 199                 0x850, 0x00000000,
 200                 0x854, 0x00000000,
 201                 0x858, 0x569A11A9,
 202                 0x85C, 0x01000014,
 203                 0x860, 0x66F60110,
 204                 0x864, 0x061F0649,
 205                 0x868, 0x00000000,
 206                 0x86C, 0x27272700,
 207                 0x870, 0x07000760,
 208                 0x874, 0x25004000,
 209                 0x878, 0x00000808,
 210                 0x87C, 0x00000000,
 211                 0x880, 0xB0000C1C,
 212                 0x884, 0x00000001,
 213                 0x888, 0x00000000,
 214                 0x88C, 0xCCC000C0,
 215                 0x890, 0x00000800,
 216                 0x894, 0xFFFFFFFE,
 217                 0x898, 0x40302010,
 218                 0x89C, 0x00706050,
 219                 0x900, 0x00000000,
 220                 0x904, 0x00000023,
 221                 0x908, 0x00000000,
 222                 0x90C, 0x81121111,
 223                 0x910, 0x00000002,
 224                 0x914, 0x00000201,
 225                 0xA00, 0x00D047C8,
 226                 0xA04, 0x80FF000C,
 227                 0xA08, 0x8C838300,
 228                 0xA0C, 0x2E7F120F,
 229                 0xA10, 0x9500BB78,
 230                 0xA14, 0x1114D028,
 231                 0xA18, 0x00881117,
 232                 0xA1C, 0x89140F00,
 233                 0xA20, 0x1A1B0000,
 234                 0xA24, 0x090E1317,
 235                 0xA28, 0x00000204,
 236                 0xA2C, 0x00D30000,
 237                 0xA70, 0x101FBF00,
 238                 0xA74, 0x00000007,
 239                 0xA78, 0x00000900,
 240                 0xA7C, 0x225B0606,
 241                 0xA80, 0x218075B1,
 242                 0xB2C, 0x80000000,
 243                 0xC00, 0x48071D40,
 244                 0xC04, 0x03A05611,
 245                 0xC08, 0x000000E4,
 246                 0xC0C, 0x6C6C6C6C,
 247                 0xC10, 0x08800000,
 248                 0xC14, 0x40000100,
 249                 0xC18, 0x08800000,
 250                 0xC1C, 0x40000100,
 251                 0xC20, 0x00000000,
 252                 0xC24, 0x00000000,
 253                 0xC28, 0x00000000,
 254                 0xC2C, 0x00000000,
 255                 0xC30, 0x69E9AC47,
 256                 0xC34, 0x469652AF,
 257                 0xC38, 0x49795994,
 258                 0xC3C, 0x0A97971C,
 259                 0xC40, 0x1F7C403F,
 260                 0xC44, 0x000100B7,
 261                 0xC48, 0xEC020107,
 262                 0xC4C, 0x007F037F,
 263                 0xC50, 0x69553420,
 264                 0xC54, 0x43BC0094,
 265                 0xC58, 0x00013169,
 266                 0xC5C, 0x00250492,
 267                 0xC60, 0x00000000,
 268                 0xC64, 0x7112848B,
 269                 0xC68, 0x47C00BFF,
 270                 0xC6C, 0x00000036,
 271                 0xC70, 0x2C7F000D,
 272                 0xC74, 0x020610DB,
 273                 0xC78, 0x0000001F,
 274                 0xC7C, 0x00B91612,
 275                 0xC80, 0x390000E4,
 276                 0xC84, 0x20F60000,
 277                 0xC88, 0x40000100,
 278                 0xC8C, 0x20200000,
 279                 0xC90, 0x00091521,
 280                 0xC94, 0x00000000,
 281                 0xC98, 0x00121820,
 282                 0xC9C, 0x00007F7F,
 283                 0xCA0, 0x00000000,
 284                 0xCA4, 0x000300A0,
 285                 0xCA8, 0x00000000,
 286                 0xCAC, 0x00000000,
 287                 0xCB0, 0x00000000,
 288                 0xCB4, 0x00000000,
 289                 0xCB8, 0x00000000,
 290                 0xCBC, 0x28000000,
 291                 0xCC0, 0x00000000,
 292                 0xCC4, 0x00000000,
 293                 0xCC8, 0x00000000,
 294                 0xCCC, 0x00000000,
 295                 0xCD0, 0x00000000,
 296                 0xCD4, 0x00000000,
 297                 0xCD8, 0x64B22427,
 298                 0xCDC, 0x00766932,
 299                 0xCE0, 0x00222222,
 300                 0xCE4, 0x00000000,
 301                 0xCE8, 0x37644302,
 302                 0xCEC, 0x2F97D40C,
 303                 0xD00, 0x00000740,
 304                 0xD04, 0x00020401,
 305                 0xD08, 0x0000907F,
 306                 0xD0C, 0x20010201,
 307                 0xD10, 0xA0633333,
 308                 0xD14, 0x3333BC43,
 309                 0xD18, 0x7A8F5B6F,
 310                 0xD2C, 0xCC979975,
 311                 0xD30, 0x00000000,
 312                 0xD34, 0x80608000,
 313                 0xD38, 0x00000000,
 314                 0xD3C, 0x00127353,
 315                 0xD40, 0x00000000,
 316                 0xD44, 0x00000000,
 317                 0xD48, 0x00000000,
 318                 0xD4C, 0x00000000,
 319                 0xD50, 0x6437140A,
 320                 0xD54, 0x00000000,
 321                 0xD58, 0x00000282,
 322                 0xD5C, 0x30032064,
 323                 0xD60, 0x4653DE68,
 324                 0xD64, 0x04518A3C,
 325                 0xD68, 0x00002101,
 326                 0xD6C, 0x2A201C16,
 327                 0xD70, 0x1812362E,
 328                 0xD74, 0x322C2220,
 329                 0xD78, 0x000E3C24,
 330                 0xE00, 0x2D2D2D2D,
 331                 0xE04, 0x2D2D2D2D,
 332                 0xE08, 0x0390272D,
 333                 0xE10, 0x2D2D2D2D,
 334                 0xE14, 0x2D2D2D2D,
 335                 0xE18, 0x2D2D2D2D,
 336                 0xE1C, 0x2D2D2D2D,
 337                 0xE28, 0x00000000,
 338                 0xE30, 0x1000DC1F,
 339                 0xE34, 0x10008C1F,
 340                 0xE38, 0x02140102,
 341                 0xE3C, 0x681604C2,
 342                 0xE40, 0x01007C00,
 343                 0xE44, 0x01004800,
 344                 0xE48, 0xFB000000,
 345                 0xE4C, 0x000028D1,
 346                 0xE50, 0x1000DC1F,
 347                 0xE54, 0x10008C1F,
 348                 0xE58, 0x02140102,
 349                 0xE5C, 0x28160D05,
 350                 0xE60, 0x00000008,
 351                 0xE68, 0x001B25A4,
 352                 0xE6C, 0x00C00014,
 353                 0xE70, 0x00C00014,
 354                 0xE74, 0x01000014,
 355                 0xE78, 0x01000014,
 356                 0xE7C, 0x01000014,
 357                 0xE80, 0x01000014,
 358                 0xE84, 0x00C00014,
 359                 0xE88, 0x01000014,
 360                 0xE8C, 0x00C00014,
 361                 0xED0, 0x00C00014,
 362                 0xED4, 0x00C00014,
 363                 0xED8, 0x00C00014,
 364                 0xEDC, 0x00000014,
 365                 0xEE0, 0x00000014,
 366                 0xEEC, 0x01C00014,
 367                 0xF14, 0x00000003,
 368                 0xF4C, 0x00000000,
 369                 0xF00, 0x00000300,
 370 };
 371
 372 static void rtl_bb_delay(struct adapter *adapt, u32 addr, u32 data)
 373 {
 374         if (addr == 0xfe) {
 375                 msleep(50);
 376         } else if (addr == 0xfd) {
 377                 mdelay(5);
 378         } else if (addr == 0xfc) {
 379                 mdelay(1);
 380         } else if (addr == 0xfb) {
 381                 udelay(50);
 382         } else if (addr == 0xfa) {
 383                 udelay(5);
 384         } else if (addr == 0xf9) {
 385                 udelay(1);
 386         } else {
 387                 phy_set_bb_reg(adapt, addr, bMaskDWord, data);
 388                 /*  Add 1us delay between BB/RF register setting. */
 389                 udelay(1);
 390         }
 391 }
 392
 393 static bool set_baseband_phy_config(struct adapter *adapt)
 394 {
 395         u32 i;
 396         const u32 arraylen = ARRAY_SIZE(array_phy_reg_1t_8188e);
 397         u32 *array = array_phy_reg_1t_8188e;
 398
 399         for (i = 0; i < arraylen; i += 2) {
 400                 u32 v1 = array[i];
 401                 u32 v2 = array[i+1];
 402
 403                 if (v1 < 0xCDCDCDCD)
 404                         rtl_bb_delay(adapt, v1, v2);
 405         }
 406         return true;
 407 }
 408
 409 /*  PHY_REG_PG.TXT  */
 410
 411 static u32 array_phy_reg_pg_8188e[] = {
 412                 0xE00, 0xFFFFFFFF, 0x06070809,
 413                 0xE04, 0xFFFFFFFF, 0x02020405,
 414                 0xE08, 0x0000FF00, 0x00000006,
 415                 0x86C, 0xFFFFFF00, 0x00020400,
 416                 0xE10, 0xFFFFFFFF, 0x08090A0B,
 417                 0xE14, 0xFFFFFFFF, 0x01030607,
 418                 0xE18, 0xFFFFFFFF, 0x08090A0B,
 419                 0xE1C, 0xFFFFFFFF, 0x01030607,
 420                 0xE00, 0xFFFFFFFF, 0x00000000,
 421                 0xE04, 0xFFFFFFFF, 0x00000000,
 422                 0xE08, 0x0000FF00, 0x00000000,
 423                 0x86C, 0xFFFFFF00, 0x00000000,
 424                 0xE10, 0xFFFFFFFF, 0x00000000,
 425                 0xE14, 0xFFFFFFFF, 0x00000000,
 426                 0xE18, 0xFFFFFFFF, 0x00000000,
 427                 0xE1C, 0xFFFFFFFF, 0x00000000,
 428                 0xE00, 0xFFFFFFFF, 0x02020202,
 429                 0xE04, 0xFFFFFFFF, 0x00020202,
 430                 0xE08, 0x0000FF00, 0x00000000,
 431                 0x86C, 0xFFFFFF00, 0x00000000,
 432                 0xE10, 0xFFFFFFFF, 0x04040404,
 433                 0xE14, 0xFFFFFFFF, 0x00020404,
 434                 0xE18, 0xFFFFFFFF, 0x00000000,
 435                 0xE1C, 0xFFFFFFFF, 0x00000000,
 436                 0xE00, 0xFFFFFFFF, 0x02020202,
 437                 0xE04, 0xFFFFFFFF, 0x00020202,
 438                 0xE08, 0x0000FF00, 0x00000000,
 439                 0x86C, 0xFFFFFF00, 0x00000000,
 440                 0xE10, 0xFFFFFFFF, 0x04040404,
 441                 0xE14, 0xFFFFFFFF, 0x00020404,
 442                 0xE18, 0xFFFFFFFF, 0x00000000,
 443                 0xE1C, 0xFFFFFFFF, 0x00000000,
 444                 0xE00, 0xFFFFFFFF, 0x00000000,
 445                 0xE04, 0xFFFFFFFF, 0x00000000,
 446                 0xE08, 0x0000FF00, 0x00000000,
 447                 0x86C, 0xFFFFFF00, 0x00000000,
 448                 0xE10, 0xFFFFFFFF, 0x00000000,
 449                 0xE14, 0xFFFFFFFF, 0x00000000,
 450                 0xE18, 0xFFFFFFFF, 0x00000000,
 451                 0xE1C, 0xFFFFFFFF, 0x00000000,
 452                 0xE00, 0xFFFFFFFF, 0x02020202,
 453                 0xE04, 0xFFFFFFFF, 0x00020202,
 454                 0xE08, 0x0000FF00, 0x00000000,
 455                 0x86C, 0xFFFFFF00, 0x00000000,
 456                 0xE10, 0xFFFFFFFF, 0x04040404,
 457                 0xE14, 0xFFFFFFFF, 0x00020404,
 458                 0xE18, 0xFFFFFFFF, 0x00000000,
 459                 0xE1C, 0xFFFFFFFF, 0x00000000,
 460                 0xE00, 0xFFFFFFFF, 0x00000000,
 461                 0xE04, 0xFFFFFFFF, 0x00000000,
 462                 0xE08, 0x0000FF00, 0x00000000,
 463                 0x86C, 0xFFFFFF00, 0x00000000,
 464                 0xE10, 0xFFFFFFFF, 0x00000000,
 465                 0xE14, 0xFFFFFFFF, 0x00000000,
 466                 0xE18, 0xFFFFFFFF, 0x00000000,
 467                 0xE1C, 0xFFFFFFFF, 0x00000000,
 468                 0xE00, 0xFFFFFFFF, 0x00000000,
 469                 0xE04, 0xFFFFFFFF, 0x00000000,
 470                 0xE08, 0x0000FF00, 0x00000000,
 471                 0x86C, 0xFFFFFF00, 0x00000000,
 472                 0xE10, 0xFFFFFFFF, 0x00000000,
 473                 0xE14, 0xFFFFFFFF, 0x00000000,
 474                 0xE18, 0xFFFFFFFF, 0x00000000,
 475                 0xE1C, 0xFFFFFFFF, 0x00000000,
 476                 0xE00, 0xFFFFFFFF, 0x00000000,
 477                 0xE04, 0xFFFFFFFF, 0x00000000,
 478                 0xE08, 0x0000FF00, 0x00000000,
 479                 0x86C, 0xFFFFFF00, 0x00000000,
 480                 0xE10, 0xFFFFFFFF, 0x00000000,
 481                 0xE14, 0xFFFFFFFF, 0x00000000,
 482                 0xE18, 0xFFFFFFFF, 0x00000000,
 483                 0xE1C, 0xFFFFFFFF, 0x00000000,
 484                 0xE00, 0xFFFFFFFF, 0x00000000,
 485                 0xE04, 0xFFFFFFFF, 0x00000000,
 486                 0xE08, 0x0000FF00, 0x00000000,
 487                 0x86C, 0xFFFFFF00, 0x00000000,
 488                 0xE10, 0xFFFFFFFF, 0x00000000,
 489                 0xE14, 0xFFFFFFFF, 0x00000000,
 490                 0xE18, 0xFFFFFFFF, 0x00000000,
 491                 0xE1C, 0xFFFFFFFF, 0x00000000,
 492                 0xE00, 0xFFFFFFFF, 0x00000000,
 493                 0xE04, 0xFFFFFFFF, 0x00000000,
 494                 0xE08, 0x0000FF00, 0x00000000,
 495                 0x86C, 0xFFFFFF00, 0x00000000,
 496                 0xE10, 0xFFFFFFFF, 0x00000000,
 497                 0xE14, 0xFFFFFFFF, 0x00000000,
 498                 0xE18, 0xFFFFFFFF, 0x00000000,
 499                 0xE1C, 0xFFFFFFFF, 0x00000000,
 500
 501 };
 502
 503 static void store_pwrindex_offset(struct adapter *Adapter, u32 regaddr, u32 bitmask, u32 data)
 504 {
 505         struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
 506          u8 pwrGrpCnt = hal_data->pwrGroupCnt;
 507
 508         if (regaddr == rTxAGC_A_Rate18_06)
 509                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][0] = data;
 510         if (regaddr == rTxAGC_A_Rate54_24)
 511                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][1] = data;
 512         if (regaddr == rTxAGC_A_CCK1_Mcs32)
 513                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][6] = data;
 514         if (regaddr == rTxAGC_B_CCK11_A_CCK2_11 && bitmask == 0xffffff00)
 515                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][7] = data;
 516         if (regaddr == rTxAGC_A_Mcs03_Mcs00)
 517                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][2] = data;
 518         if (regaddr == rTxAGC_A_Mcs07_Mcs04)
 519                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][3] = data;
 520         if (regaddr == rTxAGC_A_Mcs11_Mcs08)
 521                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][4] = data;
 522         if (regaddr == rTxAGC_A_Mcs15_Mcs12) {
 523                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][5] = data;
 524                 if (hal_data->rf_type == RF_1T1R)
 525                         hal_data->pwrGroupCnt++;
 526         }
 527         if (regaddr == rTxAGC_B_Rate18_06)
 528                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][8] = data;
 529         if (regaddr == rTxAGC_B_Rate54_24)
 530                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][9] = data;
 531         if (regaddr == rTxAGC_B_CCK1_55_Mcs32)
 532                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][14] = data;
 533         if (regaddr == rTxAGC_B_CCK11_A_CCK2_11 && bitmask == 0x000000ff)
 534                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][15] = data;
 535         if (regaddr == rTxAGC_B_Mcs03_Mcs00)
 536                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][10] = data;
 537         if (regaddr == rTxAGC_B_Mcs07_Mcs04)
 538                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][11] = data;
 539         if (regaddr == rTxAGC_B_Mcs11_Mcs08)
 540                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][12] = data;
 541         if (regaddr == rTxAGC_B_Mcs15_Mcs12) {
 542                 hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt][13] = data;
 543                 if (hal_data->rf_type != RF_1T1R)
 544                         hal_data->pwrGroupCnt++;
 545         }
 546 }
 547
 548 static void rtl_addr_delay(struct adapter *adapt,
 549                         u32 addr, u32 bit_mask, u32 data)
 550 {
 551         switch (addr) {
 552         case 0xfe:
 553                 msleep(50);
 554                 break;
 555         case 0xfd:
 556                 mdelay(5);
 557                 break;
 558         case 0xfc:
 559                 mdelay(1);
 560                 break;
 561         case 0xfb:
 562                 udelay(50);
 563                 break;
 564         case 0xfa:
 565                 udelay(5);
 566                 break;
 567         case 0xf9:
 568                 udelay(1);
 569                 break;
 570         default:
 571                 store_pwrindex_offset(adapt, addr, bit_mask, data);
 572         }
 573 }
 574
 575 static bool config_bb_with_pgheader(struct adapter *adapt)
 576 {
 577         u32 i;
 578         const u32 arraylen = ARRAY_SIZE(array_phy_reg_pg_8188e);
 579         u32 *array = array_phy_reg_pg_8188e;
 580
 581         for (i = 0; i < arraylen; i += 3) {
 582                 u32 v1 = array[i];
 583                 u32 v2 = array[i+1];
 584                 u32 v3 = array[i+2];
 585
 586                 if (v1 < 0xCDCDCDCD)
 587                         rtl_addr_delay(adapt, v1, v2, v3);
 588         }
 589         return true;
 590 }
 591
 592 static void rtl88e_phy_init_bb_rf_register_definition(struct adapter *Adapter)
 593 {
 594         struct hal_data_8188e           *hal_data = GET_HAL_DATA(Adapter);
 595         struct bb_reg_def               *reg[4];
 596
 597         reg[RF_PATH_A] = &(hal_data->PHYRegDef[RF_PATH_A]);
 598         reg[RF_PATH_B] = &(hal_data->PHYRegDef[RF_PATH_B]);
 599         reg[RF_PATH_C] = &(hal_data->PHYRegDef[RF_PATH_C]);
 600         reg[RF_PATH_D] = &(hal_data->PHYRegDef[RF_PATH_D]);
 601
 602         reg[RF_PATH_A]->rfintfs = rFPGA0_XAB_RFInterfaceSW;
 603         reg[RF_PATH_B]->rfintfs = rFPGA0_XAB_RFInterfaceSW;
 604         reg[RF_PATH_C]->rfintfs = rFPGA0_XCD_RFInterfaceSW;
 605         reg[RF_PATH_D]->rfintfs = rFPGA0_XCD_RFInterfaceSW;
 606
 607         reg[RF_PATH_A]->rfintfi = rFPGA0_XAB_RFInterfaceRB;
 608         reg[RF_PATH_B]->rfintfi = rFPGA0_XAB_RFInterfaceRB;
 609         reg[RF_PATH_C]->rfintfi = rFPGA0_XCD_RFInterfaceRB;
 610         reg[RF_PATH_D]->rfintfi = rFPGA0_XCD_RFInterfaceRB;
 611
 612         reg[RF_PATH_A]->rfintfo = rFPGA0_XA_RFInterfaceOE;
 613         reg[RF_PATH_B]->rfintfo = rFPGA0_XB_RFInterfaceOE;
 614
 615         reg[RF_PATH_A]->rfintfe = rFPGA0_XA_RFInterfaceOE;
 616         reg[RF_PATH_B]->rfintfe = rFPGA0_XB_RFInterfaceOE;
 617
 618         reg[RF_PATH_A]->rf3wireOffset = rFPGA0_XA_LSSIParameter;
 619         reg[RF_PATH_B]->rf3wireOffset = rFPGA0_XB_LSSIParameter;
 620
 621         reg[RF_PATH_A]->rfLSSI_Select = rFPGA0_XAB_RFParameter;
 622         reg[RF_PATH_B]->rfLSSI_Select = rFPGA0_XAB_RFParameter;
 623         reg[RF_PATH_C]->rfLSSI_Select = rFPGA0_XCD_RFParameter;
 624         reg[RF_PATH_D]->rfLSSI_Select = rFPGA0_XCD_RFParameter;
 625
 626         reg[RF_PATH_A]->rfTxGainStage = rFPGA0_TxGainStage;
 627         reg[RF_PATH_B]->rfTxGainStage = rFPGA0_TxGainStage;
 628         reg[RF_PATH_C]->rfTxGainStage = rFPGA0_TxGainStage;
 629         reg[RF_PATH_D]->rfTxGainStage = rFPGA0_TxGainStage;
 630
 631         reg[RF_PATH_A]->rfHSSIPara1 = rFPGA0_XA_HSSIParameter1;
 632         reg[RF_PATH_B]->rfHSSIPara1 = rFPGA0_XB_HSSIParameter1;
 633
 634         reg[RF_PATH_A]->rfHSSIPara2 = rFPGA0_XA_HSSIParameter2;
 635         reg[RF_PATH_B]->rfHSSIPara2 = rFPGA0_XB_HSSIParameter2;
 636
 637         reg[RF_PATH_A]->rfSwitchControl = rFPGA0_XAB_SwitchControl;
 638         reg[RF_PATH_B]->rfSwitchControl = rFPGA0_XAB_SwitchControl;
 639         reg[RF_PATH_C]->rfSwitchControl = rFPGA0_XCD_SwitchControl;
 640         reg[RF_PATH_D]->rfSwitchControl = rFPGA0_XCD_SwitchControl;
 641
 642         reg[RF_PATH_A]->rfAGCControl1 = rOFDM0_XAAGCCore1;
 643         reg[RF_PATH_B]->rfAGCControl1 = rOFDM0_XBAGCCore1;
 644         reg[RF_PATH_C]->rfAGCControl1 = rOFDM0_XCAGCCore1;
 645         reg[RF_PATH_D]->rfAGCControl1 = rOFDM0_XDAGCCore1;
 646
 647         reg[RF_PATH_A]->rfAGCControl2 = rOFDM0_XAAGCCore2;
 648         reg[RF_PATH_B]->rfAGCControl2 = rOFDM0_XBAGCCore2;
 649         reg[RF_PATH_C]->rfAGCControl2 = rOFDM0_XCAGCCore2;
 650         reg[RF_PATH_D]->rfAGCControl2 = rOFDM0_XDAGCCore2;
 651
 652         reg[RF_PATH_A]->rfRxIQImbalance = rOFDM0_XARxIQImbalance;
 653         reg[RF_PATH_B]->rfRxIQImbalance = rOFDM0_XBRxIQImbalance;
 654         reg[RF_PATH_C]->rfRxIQImbalance = rOFDM0_XCRxIQImbalance;
 655         reg[RF_PATH_D]->rfRxIQImbalance = rOFDM0_XDRxIQImbalance;
 656
 657         reg[RF_PATH_A]->rfRxAFE = rOFDM0_XARxAFE;
 658         reg[RF_PATH_B]->rfRxAFE = rOFDM0_XBRxAFE;
 659         reg[RF_PATH_C]->rfRxAFE = rOFDM0_XCRxAFE;
 660         reg[RF_PATH_D]->rfRxAFE = rOFDM0_XDRxAFE;
 661
 662         reg[RF_PATH_A]->rfTxIQImbalance = rOFDM0_XATxIQImbalance;
 663         reg[RF_PATH_B]->rfTxIQImbalance = rOFDM0_XBTxIQImbalance;
 664         reg[RF_PATH_C]->rfTxIQImbalance = rOFDM0_XCTxIQImbalance;
 665         reg[RF_PATH_D]->rfTxIQImbalance = rOFDM0_XDTxIQImbalance;
 666
 667         reg[RF_PATH_A]->rfTxAFE = rOFDM0_XATxAFE;
 668         reg[RF_PATH_B]->rfTxAFE = rOFDM0_XBTxAFE;
 669         reg[RF_PATH_C]->rfTxAFE = rOFDM0_XCTxAFE;
 670         reg[RF_PATH_D]->rfTxAFE = rOFDM0_XDTxAFE;
 671
 672         reg[RF_PATH_A]->rfLSSIReadBack = rFPGA0_XA_LSSIReadBack;
 673         reg[RF_PATH_B]->rfLSSIReadBack = rFPGA0_XB_LSSIReadBack;
 674         reg[RF_PATH_C]->rfLSSIReadBack = rFPGA0_XC_LSSIReadBack;
 675         reg[RF_PATH_D]->rfLSSIReadBack = rFPGA0_XD_LSSIReadBack;
 676
 677         reg[RF_PATH_A]->rfLSSIReadBackPi = TransceiverA_HSPI_Readback;
 678         reg[RF_PATH_B]->rfLSSIReadBackPi = TransceiverB_HSPI_Readback;
 679 }
 680
 681 static bool config_parafile(struct adapter *adapt)
 682 {
 683         struct eeprom_priv *pEEPROM = GET_EEPROM_EFUSE_PRIV(adapt);
 684         struct hal_data_8188e *hal_data = GET_HAL_DATA(adapt);
 685
 686         set_baseband_phy_config(adapt);
 687
 688         /* If EEPROM or EFUSE autoload OK, We must config by PHY_REG_PG.txt */
 689         if (!pEEPROM->bautoload_fail_flag) {
 690                 hal_data->pwrGroupCnt = 0;
 691                 config_bb_with_pgheader(adapt);
 692         }
 693         set_baseband_agc_config(adapt);
 694         return true;
 695 }
 696
 697 bool rtl88eu_phy_bb_config(struct adapter *adapt)
 698 {
 699         int rtstatus = true;
 700         struct hal_data_8188e   *hal_data = GET_HAL_DATA(adapt);
 701         u32 regval;
 702         u8 crystal_cap;
 703
 704         rtl88e_phy_init_bb_rf_register_definition(adapt);
 705
 706         /*  Enable BB and RF */
 707         regval = usb_read16(adapt, REG_SYS_FUNC_EN);
 708         usb_write16(adapt, REG_SYS_FUNC_EN, (u16)(regval|BIT13|BIT0|BIT1));
 709
 710         usb_write8(adapt, REG_RF_CTRL, RF_EN|RF_RSTB|RF_SDMRSTB);
 711
 712         usb_write8(adapt, REG_SYS_FUNC_EN, FEN_USBA | FEN_USBD | FEN_BB_GLB_RSTn | FEN_BBRSTB);
 713
 714         /*  Config BB and AGC */
 715         rtstatus = config_parafile(adapt);
 716
 717         /*  write 0x24[16:11] = 0x24[22:17] = crystal_cap */
 718         crystal_cap = hal_data->CrystalCap & 0x3F;
 719         phy_set_bb_reg(adapt, REG_AFE_XTAL_CTRL, 0x7ff800, (crystal_cap | (crystal_cap << 6)));
 720
 721         return rtstatus;
 722 }