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