LXR linux/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
  30static 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
  41static 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 */
  77static 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
 112static 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 */
 130unsigned 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 */
 187void 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 */
 332int 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
 365int 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(priv, MESSAGE_TYPE_WRITE, 0,
 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
 508end:
 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 */
 524int 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
 544end:
 545        return ret;
 546}
 547
 548void 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 */
 573int 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
 586int 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
 599void 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
 864