drivers/staging/vt6656/baseband.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
   4  * All rights reserved.
   5  *
   6  * File: baseband.c
   7  *
   8  * Purpose: Implement functions to access baseband
   9  *
  10  * Author: Jerry Chen
  11  *
  12  * Date: Jun. 5, 2002
  13  *
  14  * Functions:
  15  *      vnt_get_frame_time      - Calculate data frame transmitting time
  16  *      vnt_get_phy_field       - Calculate PhyLength, PhyService and Phy
  17  *                                Signal parameter for baseband Tx
  18  *      vnt_vt3184_init         - VIA VT3184 baseband chip init code
  19  *
  20  * Revision History:
  21  *
  22  *
  23  */
  24
  25 #include "mac.h"
  26 #include "baseband.h"
  27 #include "rf.h"
  28 #include "usbpipe.h"
  29
  30 static u8 vnt_vt3184_agc[] = {
  31         0x00, 0x00, 0x02, 0x02, 0x04, 0x04, 0x06, 0x06,
  32         0x08, 0x08, 0x0a, 0x0a, 0x0c, 0x0c, 0x0e, 0x0e, /* 0x0f */
  33         0x10, 0x10, 0x12, 0x12, 0x14, 0x14, 0x16, 0x16,
  34         0x18, 0x18, 0x1a, 0x1a, 0x1c, 0x1c, 0x1e, 0x1e, /* 0x1f */
  35         0x20, 0x20, 0x22, 0x22, 0x24, 0x24, 0x26, 0x26,
  36         0x28, 0x28, 0x2a, 0x2a, 0x2c, 0x2c, 0x2e, 0x2e, /* 0x2f */
  37         0x30, 0x30, 0x32, 0x32, 0x34, 0x34, 0x36, 0x36,
  38         0x38, 0x38, 0x3a, 0x3a, 0x3c, 0x3c, 0x3e, 0x3e  /* 0x3f */
  39 };
  40
  41 static u8 vnt_vt3184_al2230[] = {
  42         0x31, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00,
  43         0x70, 0x45, 0x2a, 0x76, 0x00, 0x00, 0x80, 0x00, /* 0x0f */
  44         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  45         0x00, 0x00, 0x00, 0x8e, 0x0a, 0x00, 0x00, 0x00, /* 0x1f */
  46         0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x00,
  47         0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x0c, /* 0x2f */
  48         0x26, 0x5b, 0x00, 0x00, 0x00, 0x00, 0xaa, 0xaa,
  49         0xff, 0xff, 0x79, 0x00, 0x00, 0x0b, 0x48, 0x04, /* 0x3f */
  50         0x00, 0x08, 0x00, 0x08, 0x08, 0x14, 0x05, 0x09,
  51         0x00, 0x00, 0x00, 0x00, 0x09, 0x73, 0x00, 0xc5, /* 0x4f */
  52         0x00, 0x19, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  53         0x00, 0xd0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x5f */
  54         0xe4, 0x80, 0x00, 0x00, 0x00, 0x00, 0x98, 0x0a,
  55         0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x01, 0x00, /* 0x6f */
  56         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  57         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x7f */
  58         0x8c, 0x01, 0x09, 0x00, 0x00, 0x00, 0x00, 0x00,
  59         0x08, 0x00, 0x1f, 0xb7, 0x88, 0x47, 0xaa, 0x00, /* 0x8f */
  60         0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xeb,
  61         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, /* 0x9f */
  62         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00,
  63         0x18, 0x00, 0x00, 0x00, 0x00, 0x15, 0x00, 0x18, /* 0xaf */
  64         0x38, 0x30, 0x00, 0x00, 0xff, 0x0f, 0xe4, 0xe2,
  65         0x00, 0x00, 0x00, 0x03, 0x01, 0x00, 0x00, 0x00, /* 0xbf */
  66         0x18, 0x20, 0x07, 0x18, 0xff, 0xff, 0x0e, 0x0a,
  67         0x0e, 0x00, 0x82, 0xa7, 0x3c, 0x10, 0x30, 0x05, /* 0xcf */
  68         0x40, 0x12, 0x00, 0x00, 0x10, 0x28, 0x80, 0x2a,
  69         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xdf */
  70         0x00, 0xf3, 0x00, 0x00, 0x00, 0x10, 0x00, 0x12,
  71         0x00, 0xf4, 0x00, 0xff, 0x79, 0x20, 0x30, 0x05, /* 0xef */
  72         0x00, 0x3e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  73         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00  /* 0xff */
  74 };
  75
  76 /* {{RobertYu:20060515, new BB setting for VT3226D0 */
  77 static u8 vnt_vt3184_vt3226d0[] = {
  78         0x31, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00,
  79         0x70, 0x45, 0x2a, 0x76, 0x00, 0x00, 0x80, 0x00, /* 0x0f */
  80         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  81         0x00, 0x00, 0x00, 0x8e, 0x0a, 0x00, 0x00, 0x00, /* 0x1f */
  82         0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x00,
  83         0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x0c, /* 0x2f */
  84         0x26, 0x5b, 0x00, 0x00, 0x00, 0x00, 0xaa, 0xaa,
  85         0xff, 0xff, 0x79, 0x00, 0x00, 0x0b, 0x48, 0x04, /* 0x3f */
  86         0x00, 0x08, 0x00, 0x08, 0x08, 0x14, 0x05, 0x09,
  87         0x00, 0x00, 0x00, 0x00, 0x09, 0x73, 0x00, 0xc5, /* 0x4f */
  88         0x00, 0x19, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  89         0x00, 0xd0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x5f */
  90         0xe4, 0x80, 0x00, 0x00, 0x00, 0x00, 0x98, 0x0a,
  91         0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x01, 0x00, /* 0x6f */
  92         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  93         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x7f */
  94         0x8c, 0x01, 0x09, 0x00, 0x00, 0x00, 0x00, 0x00,
  95         0x08, 0x00, 0x1f, 0xb7, 0x88, 0x47, 0xaa, 0x00, /* 0x8f */
  96         0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xeb,
  97         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, /* 0x9f */
  98         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00,
  99         0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, /* 0xaf */
 100         0x38, 0x30, 0x00, 0x00, 0xff, 0x0f, 0xe4, 0xe2,
 101         0x00, 0x00, 0x00, 0x03, 0x01, 0x00, 0x00, 0x00, /* 0xbf */
 102         0x18, 0x20, 0x07, 0x18, 0xff, 0xff, 0x10, 0x0a,
 103         0x0e, 0x00, 0x84, 0xa7, 0x3c, 0x10, 0x24, 0x05, /* 0xcf */
 104         0x40, 0x12, 0x00, 0x00, 0x10, 0x28, 0x80, 0x2a,
 105         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xdf */
 106         0x00, 0xf3, 0x00, 0x00, 0x00, 0x10, 0x00, 0x10,
 107         0x00, 0xf4, 0x00, 0xff, 0x79, 0x20, 0x30, 0x08, /* 0xef */
 108         0x00, 0x3e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 109         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00  /* 0xff */
 110 };
 111
 112 static const u16 vnt_frame_time[MAX_RATE] = {
 113         10, 20, 55, 110, 24, 36, 48, 72, 96, 144, 192, 216
 114 };
 115
 116 /*
 117  * Description: Calculate data frame transmitting time
 118  *
 119  * Parameters:
 120  *  In:
 121  *      preamble_type   - Preamble Type
 122  *      pkt_type        - PK_TYPE_11A, PK_TYPE_11B, PK_TYPE_11GB, PK_TYPE_11GA
 123  *      frame_length    - Baseband Type
 124  *      tx_rate         - Tx Rate
 125  *  Out:
 126  *
 127  * Return Value: FrameTime
 128  *
 129  */
 130 unsigned int vnt_get_frame_time(u8 preamble_type, u8 pkt_type,
 131                                 unsigned int frame_length, u16 tx_rate)
 132 {
 133         unsigned int frame_time;
 134         unsigned int preamble;
 135         unsigned int tmp;
 136         unsigned int rate = 0;
 137
 138         if (tx_rate > RATE_54M)
 139                 return 0;
 140
 141         rate = (unsigned int)vnt_frame_time[tx_rate];
 142
 143         if (tx_rate <= 3) {
 144                 if (preamble_type == 1)
 145                         preamble = 96;
 146                 else
 147                         preamble = 192;
 148
 149                 frame_time = (frame_length * 80) / rate;
 150                 tmp = (frame_time * rate) / 80;
 151
 152                 if (frame_length != tmp)
 153                         frame_time++;
 154
 155                 return preamble + frame_time;
 156         }
 157         frame_time = (frame_length * 8 + 22) / rate;
 158         tmp = ((frame_time * rate) - 22) / 8;
 159
 160         if (frame_length != tmp)
 161                 frame_time++;
 162
 163         frame_time = frame_time * 4;
 164
 165         if (pkt_type != PK_TYPE_11A)
 166                 frame_time += 6;
 167         return 20 + frame_time;
 168 }
 169
 170 /*
 171  * Description: Calculate Length, Service, and Signal fields of Phy for Tx
 172  *
 173  * Parameters:
 174  *  In:
 175  *      priv         - Device Structure
 176  *      frame_length   - Tx Frame Length
 177  *      tx_rate           - Tx Rate
 178  *  Out:
 179  *      struct vnt_phy_field *phy
 180  *              - pointer to Phy Length field
 181  *              - pointer to Phy Service field
 182  *              - pointer to Phy Signal field
 183  *
 184  * Return Value: none
 185  *
 186  */
 187 void vnt_get_phy_field(struct vnt_private *priv, u32 frame_length,
 188                        u16 tx_rate, u8 pkt_type, struct vnt_phy_field *phy)
 189 {
 190         u32 bit_count;
 191         u32 count = 0;
 192         u32 tmp;
 193         int ext_bit;
 194         u8 preamble_type = priv->preamble_type;
 195
 196         bit_count = frame_length * 8;
 197         ext_bit = false;
 198
 199         switch (tx_rate) {
 200         case RATE_1M:
 201                 count = bit_count;
 202
 203                 phy->signal = 0x00;
 204
 205                 break;
 206         case RATE_2M:
 207                 count = bit_count / 2;
 208
 209                 if (preamble_type == 1)
 210                         phy->signal = 0x09;
 211                 else
 212                         phy->signal = 0x01;
 213
 214                 break;
 215         case RATE_5M:
 216                 count = (bit_count * 10) / 55;
 217                 tmp = (count * 55) / 10;
 218
 219                 if (tmp != bit_count)
 220                         count++;
 221
 222                 if (preamble_type == 1)
 223                         phy->signal = 0x0a;
 224                 else
 225                         phy->signal = 0x02;
 226
 227                 break;
 228         case RATE_11M:
 229                 count = bit_count / 11;
 230                 tmp = count * 11;
 231
 232                 if (tmp != bit_count) {
 233                         count++;
 234
 235                         if ((bit_count - tmp) <= 3)
 236                                 ext_bit = true;
 237                 }
 238
 239                 if (preamble_type == 1)
 240                         phy->signal = 0x0b;
 241                 else
 242                         phy->signal = 0x03;
 243
 244                 break;
 245         case RATE_6M:
 246                 if (pkt_type == PK_TYPE_11A)
 247                         phy->signal = 0x9b;
 248                 else
 249                         phy->signal = 0x8b;
 250
 251                 break;
 252         case RATE_9M:
 253                 if (pkt_type == PK_TYPE_11A)
 254                         phy->signal = 0x9f;
 255                 else
 256                         phy->signal = 0x8f;
 257
 258                 break;
 259         case RATE_12M:
 260                 if (pkt_type == PK_TYPE_11A)
 261                         phy->signal = 0x9a;
 262                 else
 263                         phy->signal = 0x8a;
 264
 265                 break;
 266         case RATE_18M:
 267                 if (pkt_type == PK_TYPE_11A)
 268                         phy->signal = 0x9e;
 269                 else
 270                         phy->signal = 0x8e;
 271
 272                 break;
 273         case RATE_24M:
 274                 if (pkt_type == PK_TYPE_11A)
 275                         phy->signal = 0x99;
 276                 else
 277                         phy->signal = 0x89;
 278
 279                 break;
 280         case RATE_36M:
 281                 if (pkt_type == PK_TYPE_11A)
 282                         phy->signal = 0x9d;
 283                 else
 284                         phy->signal = 0x8d;
 285
 286                 break;
 287         case RATE_48M:
 288                 if (pkt_type == PK_TYPE_11A)
 289                         phy->signal = 0x98;
 290                 else
 291                         phy->signal = 0x88;
 292
 293                 break;
 294         case RATE_54M:
 295                 if (pkt_type == PK_TYPE_11A)
 296                         phy->signal = 0x9c;
 297                 else
 298                         phy->signal = 0x8c;
 299                 break;
 300         default:
 301                 if (pkt_type == PK_TYPE_11A)
 302                         phy->signal = 0x9c;
 303                 else
 304                         phy->signal = 0x8c;
 305                 break;
 306         }
 307
 308         if (pkt_type == PK_TYPE_11B) {
 309                 phy->service = 0x00;
 310                 if (ext_bit)
 311                         phy->service |= 0x80;
 312                 phy->len = cpu_to_le16((u16)count);
 313         } else {
 314                 phy->service = 0x00;
 315                 phy->len = cpu_to_le16((u16)frame_length);
 316         }
 317 }
 318
 319 /*
 320  * Description: Set Antenna mode
 321  *
 322  * Parameters:
 323  *  In:
 324  *      priv            - Device Structure
 325  *      antenna_mode    - Antenna Mode
 326  *  Out:
 327  *      none
 328  *
 329  * Return Value: none
 330  *
 331  */
 332 int vnt_set_antenna_mode(struct vnt_private *priv, u8 antenna_mode)
 333 {
 334         switch (antenna_mode) {
 335         case ANT_TXA:
 336         case ANT_TXB:
 337                 break;
 338         case ANT_RXA:
 339                 priv->bb_rx_conf &= 0xFC;
 340                 break;
 341         case ANT_RXB:
 342                 priv->bb_rx_conf &= 0xFE;
 343                 priv->bb_rx_conf |= 0x02;
 344                 break;
 345         }
 346
 347         return vnt_control_out(priv, MESSAGE_TYPE_SET_ANTMD,
 348                                (u16)antenna_mode, 0, 0, NULL);
 349 }
 350
 351 /*
 352  * Description: Set Antenna mode
 353  *
 354  * Parameters:
 355  *  In:
 356  *      pDevice          - Device Structure
 357  *      byAntennaMode    - Antenna Mode
 358  *  Out:
 359  *      none
 360  *
 361  * Return Value: none
 362  *
 363  */
 364
 365 int vnt_vt3184_init(struct vnt_private *priv)
 366 {
 367         int ret = 0;
 368         u16 length;
 369         u8 *addr;
 370         u8 *agc;
 371         u16 length_agc;
 372         u8 array[256];
 373         u8 data;
 374
 375         ret = vnt_control_in(priv, MESSAGE_TYPE_READ, 0, MESSAGE_REQUEST_EEPROM,
 376                              EEP_MAX_CONTEXT_SIZE, priv->eeprom);
 377         if (ret)
 378                 goto end;
 379
 380         priv->rf_type = priv->eeprom[EEP_OFS_RFTYPE];
 381
 382         dev_dbg(&priv->usb->dev, "RF Type %d\n", priv->rf_type);
 383
 384         if (priv->rf_type == RF_AL2230 ||
 385             priv->rf_type == RF_AL2230S) {
 386                 priv->bb_rx_conf = vnt_vt3184_al2230[10];
 387                 length = sizeof(vnt_vt3184_al2230);
 388                 addr = vnt_vt3184_al2230;
 389                 agc = vnt_vt3184_agc;
 390                 length_agc = sizeof(vnt_vt3184_agc);
 391
 392                 priv->bb_vga[0] = 0x1C;
 393                 priv->bb_vga[1] = 0x10;
 394                 priv->bb_vga[2] = 0x0;
 395                 priv->bb_vga[3] = 0x0;
 396
 397         } else if (priv->rf_type == RF_AIROHA7230) {
 398                 priv->bb_rx_conf = vnt_vt3184_al2230[10];
 399                 length = sizeof(vnt_vt3184_al2230);
 400                 addr = vnt_vt3184_al2230;
 401                 agc = vnt_vt3184_agc;
 402                 length_agc = sizeof(vnt_vt3184_agc);
 403
 404                 addr[0xd7] = 0x06;
 405
 406                 priv->bb_vga[0] = 0x1c;
 407                 priv->bb_vga[1] = 0x10;
 408                 priv->bb_vga[2] = 0x0;
 409                 priv->bb_vga[3] = 0x0;
 410
 411         } else if ((priv->rf_type == RF_VT3226) ||
 412                         (priv->rf_type == RF_VT3226D0)) {
 413                 priv->bb_rx_conf = vnt_vt3184_vt3226d0[10];
 414                 length = sizeof(vnt_vt3184_vt3226d0);
 415                 addr = vnt_vt3184_vt3226d0;
 416                 agc = vnt_vt3184_agc;
 417                 length_agc = sizeof(vnt_vt3184_agc);
 418
 419                 priv->bb_vga[0] = 0x20;
 420                 priv->bb_vga[1] = 0x10;
 421                 priv->bb_vga[2] = 0x0;
 422                 priv->bb_vga[3] = 0x0;
 423
 424                 /* Fix VT3226 DFC system timing issue */
 425                 ret = vnt_mac_reg_bits_on(priv, MAC_REG_SOFTPWRCTL2,
 426                                           SOFTPWRCTL_RFLEOPT);
 427                 if (ret)
 428                         goto end;
 429         } else if (priv->rf_type == RF_VT3342A0) {
 430                 priv->bb_rx_conf = vnt_vt3184_vt3226d0[10];
 431                 length = sizeof(vnt_vt3184_vt3226d0);
 432                 addr = vnt_vt3184_vt3226d0;
 433                 agc = vnt_vt3184_agc;
 434                 length_agc = sizeof(vnt_vt3184_agc);
 435
 436                 priv->bb_vga[0] = 0x20;
 437                 priv->bb_vga[1] = 0x10;
 438                 priv->bb_vga[2] = 0x0;
 439                 priv->bb_vga[3] = 0x0;
 440
 441                 /* Fix VT3226 DFC system timing issue */
 442                 ret = vnt_mac_reg_bits_on(priv, MAC_REG_SOFTPWRCTL2,
 443                                           SOFTPWRCTL_RFLEOPT);
 444                 if (ret)
 445                         goto end;
 446         } else {
 447                 goto end;
 448         }
 449
 450         memcpy(array, addr, length);
 451
 452         ret = vnt_control_out_blocks(priv, VNT_REG_BLOCK_SIZE,
 453                                      MESSAGE_REQUEST_BBREG, length, array);
 454         if (ret)
 455                 goto end;
 456
 457         memcpy(array, agc, length_agc);
 458
 459         ret = vnt_control_out(priv, MESSAGE_TYPE_WRITE, 0,
 460                               MESSAGE_REQUEST_BBAGC, length_agc, array);
 461         if (ret)
 462                 goto end;
 463
 464         if (priv->rf_type == RF_VT3226 ||
 465             priv->rf_type == RF_VT3342A0) {
 466                 ret = vnt_control_out_u8(priv, MESSAGE_REQUEST_MACREG,
 467                                          MAC_REG_ITRTMSET, 0x23);
 468                 if (ret)
 469                         goto end;
 470
 471                 ret = vnt_mac_reg_bits_on(priv, MAC_REG_PAPEDELAY, 0x01);
 472                 if (ret)
 473                         goto end;
 474         } else if (priv->rf_type == RF_VT3226D0) {
 475                 ret = vnt_control_out_u8(priv, MESSAGE_REQUEST_MACREG,
 476                                          MAC_REG_ITRTMSET, 0x11);
 477                 if (ret)
 478                         goto end;
 479
 480                 ret = vnt_mac_reg_bits_on(priv, MAC_REG_PAPEDELAY, 0x01);
 481                 if (ret)
 482                         goto end;
 483         }
 484
 485         ret = vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x04, 0x7f);
 486         if (ret)
 487                 goto end;
 488
 489         ret = vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0x01);
 490         if (ret)
 491                 goto end;
 492
 493         ret = vnt_rf_table_download(priv);
 494         if (ret)
 495                 goto end;
 496
 497         /* Fix for TX USB resets from vendors driver */
 498         ret = vnt_control_in(priv, MESSAGE_TYPE_READ, USB_REG4,
 499                              MESSAGE_REQUEST_MEM, sizeof(data), &data);
 500         if (ret)
 501                 goto end;
 502
 503         data |= 0x2;
 504
 505         ret = vnt_control_out(priv, MESSAGE_TYPE_WRITE, USB_REG4,
 506                               MESSAGE_REQUEST_MEM, sizeof(data), &data);
 507
 508 end:
 509         return ret;
 510 }
 511
 512 /*
 513  * Description: Set ShortSlotTime mode
 514  *
 515  * Parameters:
 516  *  In:
 517  *      priv    - Device Structure
 518  *  Out:
 519  *      none
 520  *
 521  * Return Value: none
 522  *
 523  */
 524 int vnt_set_short_slot_time(struct vnt_private *priv)
 525 {
 526         int ret = 0;
 527         u8 bb_vga = 0;
 528
 529         if (priv->short_slot_time)
 530                 priv->bb_rx_conf &= 0xdf;
 531         else
 532                 priv->bb_rx_conf |= 0x20;
 533
 534         ret = vnt_control_in_u8(priv, MESSAGE_REQUEST_BBREG, 0xe7, &bb_vga);
 535         if (ret)
 536                 goto end;
 537
 538         if (bb_vga == priv->bb_vga[0])
 539                 priv->bb_rx_conf |= 0x20;
 540
 541         ret = vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0a,
 542                                  priv->bb_rx_conf);
 543
 544 end:
 545         return ret;
 546 }
 547
 548 void vnt_set_vga_gain_offset(struct vnt_private *priv, u8 data)
 549 {
 550         vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0xE7, data);
 551
 552         /* patch for 3253B0 Baseband with Cardbus module */
 553         if (priv->short_slot_time)
 554                 priv->bb_rx_conf &= 0xdf; /* 1101 1111 */
 555         else
 556                 priv->bb_rx_conf |= 0x20; /* 0010 0000 */
 557
 558         vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0a, priv->bb_rx_conf);
 559 }
 560
 561 /*
 562  * Description: vnt_set_deep_sleep
 563  *
 564  * Parameters:
 565  *  In:
 566  *      priv    - Device Structure
 567  *  Out:
 568  *      none
 569  *
 570  * Return Value: none
 571  *
 572  */
 573 int vnt_set_deep_sleep(struct vnt_private *priv)
 574 {
 575         int ret = 0;
 576
 577         /* CR12 */
 578         ret = vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0c, 0x17);
 579         if (ret)
 580                 return ret;
 581
 582         /* CR13 */
 583         return vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0xB9);
 584 }
 585
 586 int vnt_exit_deep_sleep(struct vnt_private *priv)
 587 {
 588         int ret = 0;
 589
 590         /* CR12 */
 591         ret = vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0c, 0x00);
 592         if (ret)
 593                 return ret;
 594
 595         /* CR13 */
 596         return vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0x01);
 597 }
 598
 599 void vnt_update_pre_ed_threshold(struct vnt_private *priv, int scanning)
 600 {
 601         u8 cr_201 = 0x0, cr_206 = 0x0;
 602         u8 ed_inx = priv->bb_pre_ed_index;
 603
 604         switch (priv->rf_type) {
 605         case RF_AL2230:
 606         case RF_AL2230S:
 607         case RF_AIROHA7230:
 608                 if (scanning) { /* Max sensitivity */
 609                         ed_inx = 0;
 610                         cr_206 = 0x30;
 611                         break;
 612                 }
 613
 614                 if (priv->bb_pre_ed_rssi <= 45) {
 615                         ed_inx = 20;
 616                         cr_201 = 0xff;
 617                 } else if (priv->bb_pre_ed_rssi <= 46) {
 618                         ed_inx = 19;
 619                         cr_201 = 0x1a;
 620                 } else if (priv->bb_pre_ed_rssi <= 47) {
 621                         ed_inx = 18;
 622                         cr_201 = 0x15;
 623                 } else if (priv->bb_pre_ed_rssi <= 49) {
 624                         ed_inx = 17;
 625                         cr_201 = 0xe;
 626                 } else if (priv->bb_pre_ed_rssi <= 51) {
 627                         ed_inx = 16;
 628                         cr_201 = 0x9;
 629                 } else if (priv->bb_pre_ed_rssi <= 53) {
 630                         ed_inx = 15;
 631                         cr_201 = 0x6;
 632                 } else if (priv->bb_pre_ed_rssi <= 55) {
 633                         ed_inx = 14;
 634                         cr_201 = 0x3;
 635                 } else if (priv->bb_pre_ed_rssi <= 56) {
 636                         ed_inx = 13;
 637                         cr_201 = 0x2;
 638                         cr_206 = 0xa0;
 639                 } else if (priv->bb_pre_ed_rssi <= 57) {
 640                         ed_inx = 12;
 641                         cr_201 = 0x2;
 642                         cr_206 = 0x20;
 643                 } else if (priv->bb_pre_ed_rssi <= 58) {
 644                         ed_inx = 11;
 645                         cr_201 = 0x1;
 646                         cr_206 = 0xa0;
 647                 } else if (priv->bb_pre_ed_rssi <= 59) {
 648                         ed_inx = 10;
 649                         cr_201 = 0x1;
 650                         cr_206 = 0x54;
 651                 } else if (priv->bb_pre_ed_rssi <= 60) {
 652                         ed_inx = 9;
 653                         cr_201 = 0x1;
 654                         cr_206 = 0x18;
 655                 } else if (priv->bb_pre_ed_rssi <= 61) {
 656                         ed_inx = 8;
 657                         cr_206 = 0xe3;
 658                 } else if (priv->bb_pre_ed_rssi <= 62) {
 659                         ed_inx = 7;
 660                         cr_206 = 0xb9;
 661                 } else if (priv->bb_pre_ed_rssi <= 63) {
 662                         ed_inx = 6;
 663                         cr_206 = 0x93;
 664                 } else if (priv->bb_pre_ed_rssi <= 64) {
 665                         ed_inx = 5;
 666                         cr_206 = 0x79;
 667                 } else if (priv->bb_pre_ed_rssi <= 65) {
 668                         ed_inx = 4;
 669                         cr_206 = 0x62;
 670                 } else if (priv->bb_pre_ed_rssi <= 66) {
 671                         ed_inx = 3;
 672                         cr_206 = 0x51;
 673                 } else if (priv->bb_pre_ed_rssi <= 67) {
 674                         ed_inx = 2;
 675                         cr_206 = 0x43;
 676                 } else if (priv->bb_pre_ed_rssi <= 68) {
 677                         ed_inx = 1;
 678                         cr_206 = 0x36;
 679                 } else {
 680                         ed_inx = 0;
 681                         cr_206 = 0x30;
 682                 }
 683                 break;
 684
 685         case RF_VT3226:
 686         case RF_VT3226D0:
 687                 if (scanning)   { /* Max sensitivity */
 688                         ed_inx = 0;
 689                         cr_206 = 0x24;
 690                         break;
 691                 }
 692
 693                 if (priv->bb_pre_ed_rssi <= 41) {
 694                         ed_inx = 22;
 695                         cr_201 = 0xff;
 696                 } else if (priv->bb_pre_ed_rssi <= 42) {
 697                         ed_inx = 21;
 698                         cr_201 = 0x36;
 699                 } else if (priv->bb_pre_ed_rssi <= 43) {
 700                         ed_inx = 20;
 701                         cr_201 = 0x26;
 702                 } else if (priv->bb_pre_ed_rssi <= 45) {
 703                         ed_inx = 19;
 704                         cr_201 = 0x18;
 705                 } else if (priv->bb_pre_ed_rssi <= 47) {
 706                         ed_inx = 18;
 707                         cr_201 = 0x11;
 708                 } else if (priv->bb_pre_ed_rssi <= 49) {
 709                         ed_inx = 17;
 710                         cr_201 = 0xa;
 711                 } else if (priv->bb_pre_ed_rssi <= 51) {
 712                         ed_inx = 16;
 713                         cr_201 = 0x7;
 714                 } else if (priv->bb_pre_ed_rssi <= 53) {
 715                         ed_inx = 15;
 716                         cr_201 = 0x4;
 717                 } else if (priv->bb_pre_ed_rssi <= 55) {
 718                         ed_inx = 14;
 719                         cr_201 = 0x2;
 720                         cr_206 = 0xc0;
 721                 } else if (priv->bb_pre_ed_rssi <= 56) {
 722                         ed_inx = 13;
 723                         cr_201 = 0x2;
 724                         cr_206 = 0x30;
 725                 } else if (priv->bb_pre_ed_rssi <= 57) {
 726                         ed_inx = 12;
 727                         cr_201 = 0x1;
 728                         cr_206 = 0xb0;
 729                 } else if (priv->bb_pre_ed_rssi <= 58) {
 730                         ed_inx = 11;
 731                         cr_201 = 0x1;
 732                         cr_206 = 0x70;
 733                 } else if (priv->bb_pre_ed_rssi <= 59) {
 734                         ed_inx = 10;
 735                         cr_201 = 0x1;
 736                         cr_206 = 0x30;
 737                 } else if (priv->bb_pre_ed_rssi <= 60) {
 738                         ed_inx = 9;
 739                         cr_206 = 0xea;
 740                 } else if (priv->bb_pre_ed_rssi <= 61) {
 741                         ed_inx = 8;
 742                         cr_206 = 0xc0;
 743                 } else if (priv->bb_pre_ed_rssi <= 62) {
 744                         ed_inx = 7;
 745                         cr_206 = 0x9c;
 746                 } else if (priv->bb_pre_ed_rssi <= 63) {
 747                         ed_inx = 6;
 748                         cr_206 = 0x80;
 749                 } else if (priv->bb_pre_ed_rssi <= 64) {
 750                         ed_inx = 5;
 751                         cr_206 = 0x68;
 752                 } else if (priv->bb_pre_ed_rssi <= 65) {
 753                         ed_inx = 4;
 754                         cr_206 = 0x52;
 755                 } else if (priv->bb_pre_ed_rssi <= 66) {
 756                         ed_inx = 3;
 757                         cr_206 = 0x43;
 758                 } else if (priv->bb_pre_ed_rssi <= 67) {
 759                         ed_inx = 2;
 760                         cr_206 = 0x36;
 761                 } else if (priv->bb_pre_ed_rssi <= 68) {
 762                         ed_inx = 1;
 763                         cr_206 = 0x2d;
 764                 } else {
 765                         ed_inx = 0;
 766                         cr_206 = 0x24;
 767                 }
 768                 break;
 769
 770         case RF_VT3342A0:
 771                 if (scanning) { /* need Max sensitivity */
 772                         ed_inx = 0;
 773                         cr_206 = 0x38;
 774                         break;
 775                 }
 776
 777                 if (priv->bb_pre_ed_rssi <= 41) {
 778                         ed_inx = 20;
 779                         cr_201 = 0xff;
 780                 } else if (priv->bb_pre_ed_rssi <= 42) {
 781                         ed_inx = 19;
 782                         cr_201 = 0x36;
 783                 } else if (priv->bb_pre_ed_rssi <= 43) {
 784                         ed_inx = 18;
 785                         cr_201 = 0x26;
 786                 } else if (priv->bb_pre_ed_rssi <= 45) {
 787                         ed_inx = 17;
 788                         cr_201 = 0x18;
 789                 } else if (priv->bb_pre_ed_rssi <= 47) {
 790                         ed_inx = 16;
 791                         cr_201 = 0x11;
 792                 } else if (priv->bb_pre_ed_rssi <= 49) {
 793                         ed_inx = 15;
 794                         cr_201 = 0xa;
 795                 } else if (priv->bb_pre_ed_rssi <= 51) {
 796                         ed_inx = 14;
 797                         cr_201 = 0x7;
 798                 } else if (priv->bb_pre_ed_rssi <= 53) {
 799                         ed_inx = 13;
 800                         cr_201 = 0x4;
 801                 } else if (priv->bb_pre_ed_rssi <= 55) {
 802                         ed_inx = 12;
 803                         cr_201 = 0x2;
 804                         cr_206 = 0xc0;
 805                 } else if (priv->bb_pre_ed_rssi <= 56) {
 806                         ed_inx = 11;
 807                         cr_201 = 0x2;
 808                         cr_206 = 0x30;
 809                 } else if (priv->bb_pre_ed_rssi <= 57) {
 810                         ed_inx = 10;
 811                         cr_201 = 0x1;
 812                         cr_206 = 0xb0;
 813                 } else if (priv->bb_pre_ed_rssi <= 58) {
 814                         ed_inx = 9;
 815                         cr_201 = 0x1;
 816                         cr_206 = 0x70;
 817                 } else if (priv->bb_pre_ed_rssi <= 59) {
 818                         ed_inx = 8;
 819                         cr_201 = 0x1;
 820                         cr_206 = 0x30;
 821                 } else if (priv->bb_pre_ed_rssi <= 60) {
 822                         ed_inx = 7;
 823                         cr_206 = 0xea;
 824                 } else if (priv->bb_pre_ed_rssi <= 61) {
 825                         ed_inx = 6;
 826                         cr_206 = 0xc0;
 827                 } else if (priv->bb_pre_ed_rssi <= 62) {
 828                         ed_inx = 5;
 829                         cr_206 = 0x9c;
 830                 } else if (priv->bb_pre_ed_rssi <= 63) {
 831                         ed_inx = 4;
 832                         cr_206 = 0x80;
 833                 } else if (priv->bb_pre_ed_rssi <= 64) {
 834                         ed_inx = 3;
 835                         cr_206 = 0x68;
 836                 } else if (priv->bb_pre_ed_rssi <= 65) {
 837                         ed_inx = 2;
 838                         cr_206 = 0x52;
 839                 } else if (priv->bb_pre_ed_rssi <= 66) {
 840                         ed_inx = 1;
 841                         cr_206 = 0x43;
 842                 } else {
 843                         ed_inx = 0;
 844                         cr_206 = 0x38;
 845                 }
 846                 break;
 847         }
 848
 849         if (ed_inx == priv->bb_pre_ed_index && !scanning)
 850                 return;
 851
 852         priv->bb_pre_ed_index = ed_inx;
 853
 854         dev_dbg(&priv->usb->dev, "%s bb_pre_ed_rssi %d\n",
 855                 __func__, priv->bb_pre_ed_rssi);
 856
 857         if (!cr_201 && !cr_206)
 858                 return;
 859
 860         vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0xc9, cr_201);
 861         vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0xce, cr_206);
 862 }
 863