/* * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc. * All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. * * * File: baseband.c * * Purpose: Implement functions to access baseband * * Author: Jerry Chen * * Date: Jun. 5, 2002 * * Functions: * BBuGetFrameTime - Calculate data frame transmitting time * BBvCalculateParameter - Calculate PhyLength, PhyService and Phy Signal parameter for baseband Tx * BBbVT3184Init - VIA VT3184 baseband chip init code * * Revision History: * * */ #include "tmacro.h" #include "tether.h" #include "mac.h" #include "baseband.h" #include "rf.h" #include "control.h" #include "datarate.h" static int msglevel =MSG_LEVEL_INFO; //static int msglevel =MSG_LEVEL_DEBUG; static u8 abyVT3184_AGC[] = { 0x00, //0 0x00, //1 0x02, //2 0x02, //3 //RobertYu:20060505, 0x04, //3 0x04, //4 0x04, //5 //RobertYu:20060505, 0x06, //5 0x06, //6 0x06, //7 0x08, //8 0x08, //9 0x0A, //A 0x0A, //B 0x0C, //C 0x0C, //D 0x0E, //E 0x0E, //F 0x10, //10 0x10, //11 0x12, //12 0x12, //13 0x14, //14 0x14, //15 0x16, //16 0x16, //17 0x18, //18 0x18, //19 0x1A, //1A 0x1A, //1B 0x1C, //1C 0x1C, //1D 0x1E, //1E 0x1E, //1F 0x20, //20 0x20, //21 0x22, //22 0x22, //23 0x24, //24 0x24, //25 0x26, //26 0x26, //27 0x28, //28 0x28, //29 0x2A, //2A 0x2A, //2B 0x2C, //2C 0x2C, //2D 0x2E, //2E 0x2E, //2F 0x30, //30 0x30, //31 0x32, //32 0x32, //33 0x34, //34 0x34, //35 0x36, //36 0x36, //37 0x38, //38 0x38, //39 0x3A, //3A 0x3A, //3B 0x3C, //3C 0x3C, //3D 0x3E, //3E 0x3E //3F }; static u8 abyVT3184_AL2230[] = { 0x31,//00 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, 0x70, 0x45,//tx //0x64 for FPGA 0x2A, 0x76, 0x00, 0x00, 0x80, 0x00, 0x00,//10 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x8e, //RobertYu:20060522, //0x8d, 0x0a, //RobertYu:20060515, //0x09, 0x00, 0x00, 0x00, 0x00,//20 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x0c, //RobertYu:20060522, //0x10, 0x26,//30 0x5b, 0x00, 0x00, 0x00, 0x00, 0xaa, 0xaa, 0xff, 0xff, 0x79, 0x00, 0x00, 0x0b, 0x48, 0x04, 0x00,//40 0x08, 0x00, 0x08, 0x08, 0x14, 0x05, 0x09, 0x00, 0x00, 0x00, 0x00, 0x09, 0x73, 0x00, 0xc5, 0x00,//50 //RobertYu:20060505, //0x15,//50 0x19, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xd0, //RobertYu:20060505, //0xb0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe4,//60 0x80, 0x00, 0x00, 0x00, 0x00, 0x98, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, //0x80 for FPGA 0x03, 0x01, 0x00, 0x00,//70 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x8c,//80 0x01, 0x09, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 0x1f, //RobertYu:20060516, //0x0f, 0xb7, 0x88, 0x47, 0xaa, 0x00, //RobertYu:20060505, //0x02, 0x20,//90 //RobertYu:20060505, //0x22,//90 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xeb, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00,//a0 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x15, //RobertYu:20060516, //0x00, 0x00, 0x18, 0x38,//b0 0x30, 0x00, 0x00, 0xff, 0x0f, 0xe4, 0xe2, 0x00, 0x00, 0x00, 0x03, 0x01, 0x00, 0x00, 0x00, 0x18,//c0 0x20, 0x07, 0x18, 0xff, 0xff, //RobertYu:20060509, //0x2c, 0x0e, //RobertYu:20060530, //0x0c, 0x0a, 0x0e, 0x00, //RobertYu:20060505, //0x01, 0x82, //RobertYu:20060516, //0x8f, 0xa7, 0x3c, 0x10, 0x30, //RobertYu:20060627, //0x0b, 0x05, //RobertYu:20060516, //0x25, 0x40,//d0 0x12, 0x00, 0x00, 0x10, 0x28, 0x80, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,//e0 0xf3, //RobertYu:20060516, //0xd3, 0x00, 0x00, 0x00, 0x10, 0x00, 0x12, //RobertYu:20060627, //0x10, 0x00, 0xf4, 0x00, 0xff, 0x79, 0x20, 0x30, 0x05, //RobertYu:20060516, //0x0c, 0x00,//f0 0x3e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; //{{RobertYu:20060515, new BB setting for VT3226D0 static u8 abyVT3184_VT3226D0[] = { 0x31,//00 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, 0x70, 0x45,//tx //0x64 for FPGA 0x2A, 0x76, 0x00, 0x00, 0x80, 0x00, 0x00,//10 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x8e, //RobertYu:20060525, //0x8d, 0x0a, //RobertYu:20060515, //0x09, 0x00, 0x00, 0x00, 0x00,//20 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x0c, //RobertYu:20060525, //0x10, 0x26,//30 0x5b, 0x00, 0x00, 0x00, 0x00, 0xaa, 0xaa, 0xff, 0xff, 0x79, 0x00, 0x00, 0x0b, 0x48, 0x04, 0x00,//40 0x08, 0x00, 0x08, 0x08, 0x14, 0x05, 0x09, 0x00, 0x00, 0x00, 0x00, 0x09, 0x73, 0x00, 0xc5, 0x00,//50 //RobertYu:20060505, //0x15,//50 0x19, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xd0, //RobertYu:20060505, //0xb0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe4,//60 0x80, 0x00, 0x00, 0x00, 0x00, 0x98, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, //0x80 for FPGA 0x03, 0x01, 0x00, 0x00,//70 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x8c,//80 0x01, 0x09, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 0x1f, //RobertYu:20060515, //0x0f, 0xb7, 0x88, 0x47, 0xaa, 0x00, //RobertYu:20060505, //0x02, 0x20,//90 //RobertYu:20060505, //0x22,//90 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xeb, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00,//a0 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x38,//b0 0x30, 0x00, 0x00, 0xff, 0x0f, 0xe4, 0xe2, 0x00, 0x00, 0x00, 0x03, 0x01, 0x00, 0x00, 0x00, 0x18,//c0 0x20, 0x07, 0x18, 0xff, 0xff, //RobertYu:20060509, //0x2c, 0x10, //RobertYu:20060525, //0x0c, 0x0a, 0x0e, 0x00, //RobertYu:20060505, //0x01, 0x84, //RobertYu:20060525, //0x8f, 0xa7, 0x3c, 0x10, 0x24, //RobertYu:20060627, //0x18, 0x05, //RobertYu:20060515, //0x25, 0x40,//d0 0x12, 0x00, 0x00, 0x10, 0x28, 0x80, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,//e0 0xf3, //RobertYu:20060515, //0xd3, 0x00, 0x00, 0x00, 0x10, 0x00, 0x10, //RobertYu:20060627, //0x0e, 0x00, 0xf4, 0x00, 0xff, 0x79, 0x20, 0x30, 0x08, //RobertYu:20060515, //0x0c, 0x00,//f0 0x3e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, }; static const u16 awcFrameTime[MAX_RATE] = {10, 20, 55, 110, 24, 36, 48, 72, 96, 144, 192, 216}; /* static unsigned long s_ulGetLowSQ3(PSDevice pDevice); static unsigned long s_ulGetRatio(PSDevice pDevice); static void s_vClearSQ3Value(PSDevice pDevice); */ /* * Description: Calculate data frame transmitting time * * Parameters: * In: * preamble_type - Preamble Type * pkt_type - PK_TYPE_11A, PK_TYPE_11B, PK_TYPE_11GB, PK_TYPE_11GA * frame_length - Baseband Type * tx_rate - Tx Rate * Out: * * Return Value: FrameTime * */ unsigned int BBuGetFrameTime(u8 preamble_type, u8 pkt_type, unsigned int frame_length, u16 tx_rate) { unsigned int frame_time; unsigned int preamble; unsigned int tmp; unsigned int rate = 0; if (tx_rate > RATE_54M) return 0; rate = (unsigned int)awcFrameTime[tx_rate]; if (tx_rate <= 3) { if (preamble_type == 1) preamble = 96; else preamble = 192; frame_time = (frame_length * 80) / rate; tmp = (frame_time * rate) / 80; if (frame_length != tmp) frame_time++; return preamble + frame_time; } else { frame_time = (frame_length * 8 + 22) / rate; tmp = ((frame_time * rate) - 22) / 8; if (frame_length != tmp) frame_time++; frame_time = frame_time * 4; if (pkt_type != PK_TYPE_11A) frame_time += 6; return 20 + frame_time; } } /* * Description: Calculate Length, Service, and Signal fields of Phy for Tx * * Parameters: * In: * priv - Device Structure * frame_length - Tx Frame Length * tx_rate - Tx Rate * Out: * struct vnt_phy_field *phy * - pointer to Phy Length field * - pointer to Phy Service field * - pointer to Phy Signal field * * Return Value: none * */ void BBvCalculateParameter(struct vnt_private *priv, u32 frame_length, u16 tx_rate, u8 pkt_type, struct vnt_phy_field *phy) { u32 bit_count; u32 count = 0; u32 tmp; int ext_bit; u8 preamble_type = priv->byPreambleType; bit_count = frame_length * 8; ext_bit = false; switch (tx_rate) { case RATE_1M: count = bit_count; phy->signal = 0x00; break; case RATE_2M: count = bit_count / 2; if (preamble_type == 1) phy->signal = 0x09; else phy->signal = 0x01; break; case RATE_5M: count = (bit_count * 10) / 55; tmp = (count * 55) / 10; if (tmp != bit_count) count++; if (preamble_type == 1) phy->signal = 0x0a; else phy->signal = 0x02; break; case RATE_11M: count = bit_count / 11; tmp = count * 11; if (tmp != bit_count) { count++; if ((bit_count - tmp) <= 3) ext_bit = true; } if (preamble_type == 1) phy->signal = 0x0b; else phy->signal = 0x03; break; case RATE_6M: if (pkt_type == PK_TYPE_11A) phy->signal = 0x9b; else phy->signal = 0x8b; break; case RATE_9M: if (pkt_type == PK_TYPE_11A) phy->signal = 0x9f; else phy->signal = 0x8f; break; case RATE_12M: if (pkt_type == PK_TYPE_11A) phy->signal = 0x9a; else phy->signal = 0x8a; break; case RATE_18M: if (pkt_type == PK_TYPE_11A) phy->signal = 0x9e; else phy->signal = 0x8e; break; case RATE_24M: if (pkt_type == PK_TYPE_11A) phy->signal = 0x99; else phy->signal = 0x89; break; case RATE_36M: if (pkt_type == PK_TYPE_11A) phy->signal = 0x9d; else phy->signal = 0x8d; break; case RATE_48M: if (pkt_type == PK_TYPE_11A) phy->signal = 0x98; else phy->signal = 0x88; break; case RATE_54M: if (pkt_type == PK_TYPE_11A) phy->signal = 0x9c; else phy->signal = 0x8c; break; default: if (pkt_type == PK_TYPE_11A) phy->signal = 0x9c; else phy->signal = 0x8c; break; } if (pkt_type == PK_TYPE_11B) { phy->service = 0x00; if (ext_bit) phy->service |= 0x80; phy->len = cpu_to_le16((u16)count); } else { phy->service = 0x00; phy->len = cpu_to_le16((u16)frame_length); } } /* * Description: Set Antenna mode * * Parameters: * In: * priv - Device Structure * antenna_mode - Antenna Mode * Out: * none * * Return Value: none * */ void BBvSetAntennaMode(struct vnt_private *priv, u8 antenna_mode) { switch (antenna_mode) { case ANT_TXA: case ANT_TXB: break; case ANT_RXA: priv->byBBRxConf &= 0xFC; break; case ANT_RXB: priv->byBBRxConf &= 0xFE; priv->byBBRxConf |= 0x02; break; } CONTROLnsRequestOut(priv, MESSAGE_TYPE_SET_ANTMD, (u16)antenna_mode, 0, 0, NULL); } /* * Description: Set Antenna mode * * Parameters: * In: * pDevice - Device Structure * byAntennaMode - Antenna Mode * Out: * none * * Return Value: none * */ int BBbVT3184Init(struct vnt_private *priv) { int status; u16 lenght; u8 *addr; u8 *agc; u16 lenght_agc; u8 array[256]; u8 data; status = CONTROLnsRequestIn(priv, MESSAGE_TYPE_READ, 0, MESSAGE_REQUEST_EEPROM, EEP_MAX_CONTEXT_SIZE, priv->abyEEPROM); if (status != STATUS_SUCCESS) return false; /* zonetype initial */ priv->byOriginalZonetype = priv->abyEEPROM[EEP_OFS_ZONETYPE]; if (priv->config_file.ZoneType >= 0) { if ((priv->config_file.ZoneType == 0) && (priv->abyEEPROM[EEP_OFS_ZONETYPE] != 0x00)) { priv->abyEEPROM[EEP_OFS_ZONETYPE] = 0; priv->abyEEPROM[EEP_OFS_MAXCHANNEL] = 0x0B; DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Init Zone Type :USA\n"); } else if ((priv->config_file.ZoneType == 1) && (priv->abyEEPROM[EEP_OFS_ZONETYPE] != 0x01)) { priv->abyEEPROM[EEP_OFS_ZONETYPE] = 0x01; priv->abyEEPROM[EEP_OFS_MAXCHANNEL] = 0x0D; DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Init Zone Type :Japan\n"); } else if ((priv->config_file.ZoneType == 2) && (priv->abyEEPROM[EEP_OFS_ZONETYPE] != 0x02)) { priv->abyEEPROM[EEP_OFS_ZONETYPE] = 0x02; priv->abyEEPROM[EEP_OFS_MAXCHANNEL] = 0x0D; DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Init Zone Type :Europe\n"); } else { if (priv->config_file.ZoneType != priv->abyEEPROM[EEP_OFS_ZONETYPE]) printk("zonetype in file[%02x]\ mismatch with in EEPROM[%02x]\n", priv->config_file.ZoneType, priv->abyEEPROM[EEP_OFS_ZONETYPE]); else printk("Read Zonetype file success,\ use default zonetype setting[%02x]\n", priv->config_file.ZoneType); } } if (!priv->bZoneRegExist) priv->byZoneType = priv->abyEEPROM[EEP_OFS_ZONETYPE]; priv->byRFType = priv->abyEEPROM[EEP_OFS_RFTYPE]; DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Zone Type %x\n", priv->byZoneType); DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"RF Type %d\n", priv->byRFType); if ((priv->byRFType == RF_AL2230) || (priv->byRFType == RF_AL2230S)) { priv->byBBRxConf = abyVT3184_AL2230[10]; lenght = sizeof(abyVT3184_AL2230); addr = abyVT3184_AL2230; agc = abyVT3184_AGC; lenght_agc = sizeof(abyVT3184_AGC); priv->abyBBVGA[0] = 0x1C; priv->abyBBVGA[1] = 0x10; priv->abyBBVGA[2] = 0x0; priv->abyBBVGA[3] = 0x0; priv->ldBmThreshold[0] = -70; priv->ldBmThreshold[1] = -48; priv->ldBmThreshold[2] = 0; priv->ldBmThreshold[3] = 0; } else if (priv->byRFType == RF_AIROHA7230) { priv->byBBRxConf = abyVT3184_AL2230[10]; lenght = sizeof(abyVT3184_AL2230); addr = abyVT3184_AL2230; agc = abyVT3184_AGC; lenght_agc = sizeof(abyVT3184_AGC); addr[0xd7] = 0x06; priv->abyBBVGA[0] = 0x1c; priv->abyBBVGA[1] = 0x10; priv->abyBBVGA[2] = 0x0; priv->abyBBVGA[3] = 0x0; priv->ldBmThreshold[0] = -70; priv->ldBmThreshold[1] = -48; priv->ldBmThreshold[2] = 0; priv->ldBmThreshold[3] = 0; } else if ((priv->byRFType == RF_VT3226) || (priv->byRFType == RF_VT3226D0)) { priv->byBBRxConf = abyVT3184_VT3226D0[10]; lenght = sizeof(abyVT3184_VT3226D0); addr = abyVT3184_VT3226D0; agc = abyVT3184_AGC; lenght_agc = sizeof(abyVT3184_AGC); priv->abyBBVGA[0] = 0x20; priv->abyBBVGA[1] = 0x10; priv->abyBBVGA[2] = 0x0; priv->abyBBVGA[3] = 0x0; priv->ldBmThreshold[0] = -70; priv->ldBmThreshold[1] = -48; priv->ldBmThreshold[2] = 0; priv->ldBmThreshold[3] = 0; /* Fix VT3226 DFC system timing issue */ MACvRegBitsOn(priv, MAC_REG_SOFTPWRCTL2, SOFTPWRCTL_RFLEOPT); } else if ((priv->byRFType == RF_VT3342A0)) { priv->byBBRxConf = abyVT3184_VT3226D0[10]; lenght = sizeof(abyVT3184_VT3226D0); addr = abyVT3184_VT3226D0; agc = abyVT3184_AGC; lenght_agc = sizeof(abyVT3184_AGC); priv->abyBBVGA[0] = 0x20; priv->abyBBVGA[1] = 0x10; priv->abyBBVGA[2] = 0x0; priv->abyBBVGA[3] = 0x0; priv->ldBmThreshold[0] = -70; priv->ldBmThreshold[1] = -48; priv->ldBmThreshold[2] = 0; priv->ldBmThreshold[3] = 0; /* Fix VT3226 DFC system timing issue */ MACvRegBitsOn(priv, MAC_REG_SOFTPWRCTL2, SOFTPWRCTL_RFLEOPT); } else { return true; } memcpy(array, addr, lenght); CONTROLnsRequestOut(priv, MESSAGE_TYPE_WRITE, 0, MESSAGE_REQUEST_BBREG, lenght, array); memcpy(array, agc, lenght_agc); CONTROLnsRequestOut(priv, MESSAGE_TYPE_WRITE, 0, MESSAGE_REQUEST_BBAGC, lenght_agc, array); if ((priv->byRFType == RF_VT3226) || (priv->byRFType == RF_VT3342A0)) { ControlvWriteByte(priv, MESSAGE_REQUEST_MACREG, MAC_REG_ITRTMSET, 0x23); MACvRegBitsOn(priv, MAC_REG_PAPEDELAY, 0x01); } else if (priv->byRFType == RF_VT3226D0) { ControlvWriteByte(priv, MESSAGE_REQUEST_MACREG, MAC_REG_ITRTMSET, 0x11); MACvRegBitsOn(priv, MAC_REG_PAPEDELAY, 0x01); } ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0x04, 0x7f); ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0x01); RFbRFTableDownload(priv); /* Fix for TX USB resets from vendors driver */ CONTROLnsRequestIn(priv, MESSAGE_TYPE_READ, USB_REG4, MESSAGE_REQUEST_MEM, sizeof(data), &data); data |= 0x2; CONTROLnsRequestOut(priv, MESSAGE_TYPE_WRITE, USB_REG4, MESSAGE_REQUEST_MEM, sizeof(data), &data); return true; } /* * Description: Set ShortSlotTime mode * * Parameters: * In: * priv - Device Structure * Out: * none * * Return Value: none * */ void BBvSetShortSlotTime(struct vnt_private *priv) { u8 bb_vga = 0; if (priv->bShortSlotTime) priv->byBBRxConf &= 0xdf; else priv->byBBRxConf |= 0x20; ControlvReadByte(priv, MESSAGE_REQUEST_BBREG, 0xe7, &bb_vga); if (bb_vga == priv->abyBBVGA[0]) priv->byBBRxConf |= 0x20; ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0x0a, priv->byBBRxConf); } void BBvSetVGAGainOffset(struct vnt_private *priv, u8 data) { ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0xE7, data); /* patch for 3253B0 Baseband with Cardbus module */ if (priv->bShortSlotTime) priv->byBBRxConf &= 0xdf; /* 1101 1111 */ else priv->byBBRxConf |= 0x20; /* 0010 0000 */ ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0x0a, priv->byBBRxConf); } /* * Description: BBvSetDeepSleep * * Parameters: * In: * priv - Device Structure * Out: * none * * Return Value: none * */ void BBvSetDeepSleep(struct vnt_private *priv) { ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0x0c, 0x17);/* CR12 */ ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0xB9);/* CR13 */ } void BBvExitDeepSleep(struct vnt_private *priv) { ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0x0c, 0x00);/* CR12 */ ControlvWriteByte(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0x01);/* CR13 */ } static unsigned long s_ulGetLowSQ3(struct vnt_private *pDevice) { int ii; unsigned long ulSQ3 = 0; unsigned long ulMaxPacket; ulMaxPacket = pDevice->aulPktNum[RATE_54M]; if (pDevice->aulPktNum[RATE_54M] != 0) ulSQ3 = pDevice->aulSQ3Val[RATE_54M] / pDevice->aulPktNum[RATE_54M]; for (ii = RATE_48M; ii >= RATE_6M; ii--) if (pDevice->aulPktNum[ii] > ulMaxPacket) { ulMaxPacket = pDevice->aulPktNum[ii]; ulSQ3 = pDevice->aulSQ3Val[ii] / pDevice->aulPktNum[ii]; } return ulSQ3; } static unsigned long s_ulGetRatio(struct vnt_private *pDevice) { int ii, jj; unsigned long ulRatio = 0; unsigned long ulMaxPacket; unsigned long ulPacketNum; //This is a thousand-ratio ulMaxPacket = pDevice->aulPktNum[RATE_54M]; if ( pDevice->aulPktNum[RATE_54M] != 0 ) { ulPacketNum = pDevice->aulPktNum[RATE_54M]; ulRatio = (ulPacketNum * 1000 / pDevice->uDiversityCnt); ulRatio += TOP_RATE_54M; } for (ii = RATE_48M; ii >= RATE_1M; ii--) if ( pDevice->aulPktNum[ii] > ulMaxPacket ) { ulPacketNum = 0; for ( jj=RATE_54M;jj>=ii;jj--) ulPacketNum += pDevice->aulPktNum[jj]; ulRatio = (ulPacketNum * 1000 / pDevice->uDiversityCnt); ulRatio += TOP_RATE_48M; ulMaxPacket = pDevice->aulPktNum[ii]; } return ulRatio; } static void s_vClearSQ3Value(struct vnt_private *pDevice) { int ii; pDevice->uDiversityCnt = 0; for ( ii=RATE_1M;iiaulPktNum[ii] = 0; pDevice->aulSQ3Val[ii] = 0; } } /* * Description: Antenna Diversity * * Parameters: * In: * pDevice - Device Structure * byRSR - RSR from received packet * bySQ3 - SQ3 value from received packet * Out: * none * * Return Value: none * */ void BBvAntennaDiversity(struct vnt_private *pDevice, u8 byRxRate, u8 bySQ3) { pDevice->uDiversityCnt++; DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pDevice->uDiversityCnt = %d\n", (int)pDevice->uDiversityCnt); if (byRxRate == 2) { pDevice->aulPktNum[RATE_1M]++; } else if (byRxRate==4) { pDevice->aulPktNum[RATE_2M]++; } else if (byRxRate==11) { pDevice->aulPktNum[RATE_5M]++; } else if (byRxRate==22) { pDevice->aulPktNum[RATE_11M]++; } else if(byRxRate==12){ pDevice->aulPktNum[RATE_6M]++; pDevice->aulSQ3Val[RATE_6M] += bySQ3; } else if(byRxRate==18){ pDevice->aulPktNum[RATE_9M]++; pDevice->aulSQ3Val[RATE_9M] += bySQ3; } else if(byRxRate==24){ pDevice->aulPktNum[RATE_12M]++; pDevice->aulSQ3Val[RATE_12M] += bySQ3; } else if(byRxRate==36){ pDevice->aulPktNum[RATE_18M]++; pDevice->aulSQ3Val[RATE_18M] += bySQ3; } else if(byRxRate==48){ pDevice->aulPktNum[RATE_24M]++; pDevice->aulSQ3Val[RATE_24M] += bySQ3; } else if(byRxRate==72){ pDevice->aulPktNum[RATE_36M]++; pDevice->aulSQ3Val[RATE_36M] += bySQ3; } else if(byRxRate==96){ pDevice->aulPktNum[RATE_48M]++; pDevice->aulSQ3Val[RATE_48M] += bySQ3; } else if(byRxRate==108){ pDevice->aulPktNum[RATE_54M]++; pDevice->aulSQ3Val[RATE_54M] += bySQ3; } if (pDevice->byAntennaState == 0) { if (pDevice->uDiversityCnt > pDevice->ulDiversityNValue) { DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ulDiversityNValue=[%d],54M-[%d]\n",(int)pDevice->ulDiversityNValue, (int)pDevice->aulPktNum[RATE_54M]); pDevice->ulSQ3_State0 = s_ulGetLowSQ3(pDevice); pDevice->ulRatio_State0 = s_ulGetRatio(pDevice); DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"SQ3_State0, SQ3= [%08x] rate = [%08x]\n",(int)pDevice->ulSQ3_State0,(int)pDevice->ulRatio_State0); if ( ((pDevice->aulPktNum[RATE_54M] < pDevice->ulDiversityNValue/2) && (pDevice->ulSQ3_State0 > pDevice->ulSQ3TH) ) || (pDevice->ulSQ3_State0 == 0 ) ) { if ( pDevice->byTMax == 0 ) return; bScheduleCommand((void *) pDevice, WLAN_CMD_CHANGE_ANTENNA, NULL); pDevice->byAntennaState = 1; del_timer(&pDevice->TimerSQ3Tmax3); del_timer(&pDevice->TimerSQ3Tmax2); pDevice->TimerSQ3Tmax1.expires = RUN_AT(pDevice->byTMax * HZ); add_timer(&pDevice->TimerSQ3Tmax1); } else { pDevice->TimerSQ3Tmax3.expires = RUN_AT(pDevice->byTMax3 * HZ); add_timer(&pDevice->TimerSQ3Tmax3); } s_vClearSQ3Value(pDevice); } } else { //byAntennaState == 1 if (pDevice->uDiversityCnt > pDevice->ulDiversityMValue) { del_timer(&pDevice->TimerSQ3Tmax1); pDevice->ulSQ3_State1 = s_ulGetLowSQ3(pDevice); pDevice->ulRatio_State1 = s_ulGetRatio(pDevice); DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"SQ3_State1, rate0 = %08x,rate1 = %08x\n",(int)pDevice->ulRatio_State0,(int)pDevice->ulRatio_State1); if ( ((pDevice->ulSQ3_State1 == 0) && (pDevice->ulSQ3_State0 != 0)) || ((pDevice->ulSQ3_State1 == 0) && (pDevice->ulSQ3_State0 == 0) && (pDevice->ulRatio_State1 < pDevice->ulRatio_State0)) || ((pDevice->ulSQ3_State1 != 0) && (pDevice->ulSQ3_State0 != 0) && (pDevice->ulSQ3_State0 < pDevice->ulSQ3_State1)) ) { bScheduleCommand((void *) pDevice, WLAN_CMD_CHANGE_ANTENNA, NULL); pDevice->TimerSQ3Tmax3.expires = RUN_AT(pDevice->byTMax3 * HZ); pDevice->TimerSQ3Tmax2.expires = RUN_AT(pDevice->byTMax2 * HZ); add_timer(&pDevice->TimerSQ3Tmax3); add_timer(&pDevice->TimerSQ3Tmax2); } pDevice->byAntennaState = 0; s_vClearSQ3Value(pDevice); } } //byAntennaState } /*+ * * Description: * Timer for SQ3 antenna diversity * * Parameters: * In: * pvSysSpec1 * hDeviceContext - Pointer to the adapter * pvSysSpec2 * pvSysSpec3 * Out: * none * * Return Value: none * -*/ void TimerSQ3CallBack(struct vnt_private *pDevice) { DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"TimerSQ3CallBack..."); spin_lock_irq(&pDevice->lock); bScheduleCommand((void *) pDevice, WLAN_CMD_CHANGE_ANTENNA, NULL); pDevice->byAntennaState = 0; s_vClearSQ3Value(pDevice); pDevice->TimerSQ3Tmax3.expires = RUN_AT(pDevice->byTMax3 * HZ); pDevice->TimerSQ3Tmax2.expires = RUN_AT(pDevice->byTMax2 * HZ); add_timer(&pDevice->TimerSQ3Tmax3); add_timer(&pDevice->TimerSQ3Tmax2); spin_unlock_irq(&pDevice->lock); } /*+ * * Description: * Timer for SQ3 antenna diversity * * Parameters: * In: * pvSysSpec1 * hDeviceContext - Pointer to the adapter * pvSysSpec2 * pvSysSpec3 * Out: * none * * Return Value: none * -*/ void TimerSQ3Tmax3CallBack(struct vnt_private *pDevice) { DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"TimerSQ3Tmax3CallBack..."); spin_lock_irq(&pDevice->lock); pDevice->ulRatio_State0 = s_ulGetRatio(pDevice); DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"SQ3_State0 = [%08x]\n",(int)pDevice->ulRatio_State0); s_vClearSQ3Value(pDevice); if ( pDevice->byTMax == 0 ) { pDevice->TimerSQ3Tmax3.expires = RUN_AT(pDevice->byTMax3 * HZ); add_timer(&pDevice->TimerSQ3Tmax3); spin_unlock_irq(&pDevice->lock); return; } bScheduleCommand((void *) pDevice, WLAN_CMD_CHANGE_ANTENNA, NULL); pDevice->byAntennaState = 1; del_timer(&pDevice->TimerSQ3Tmax3); del_timer(&pDevice->TimerSQ3Tmax2); pDevice->TimerSQ3Tmax1.expires = RUN_AT(pDevice->byTMax * HZ); add_timer(&pDevice->TimerSQ3Tmax1); spin_unlock_irq(&pDevice->lock); } void BBvUpdatePreEDThreshold(struct vnt_private *pDevice, int bScanning) { u8 cr_201 = 0x0, cr_206 = 0x0; switch(pDevice->byRFType) { case RF_AL2230: case RF_AL2230S: case RF_AIROHA7230: //RobertYu:20060627, update new table if( bScanning ) { // need Max sensitivity //RSSI -69, -70,.... pDevice->byBBPreEDIndex = 0; cr_206 = 0x30; break; } if(pDevice->byBBPreEDRSSI <= 45) { // RSSI 0, -1,-2,....-45 if(pDevice->byBBPreEDIndex == 20) break; pDevice->byBBPreEDIndex = 20; cr_201 = 0xff; } else if(pDevice->byBBPreEDRSSI <= 46) { //RSSI -46 if(pDevice->byBBPreEDIndex == 19) break; pDevice->byBBPreEDIndex = 19; cr_201 = 0x1a; } else if(pDevice->byBBPreEDRSSI <= 47) { //RSSI -47 if(pDevice->byBBPreEDIndex == 18) break; pDevice->byBBPreEDIndex = 18; cr_201 = 0x15; } else if(pDevice->byBBPreEDRSSI <= 49) { //RSSI -48, -49 if(pDevice->byBBPreEDIndex == 17) break; pDevice->byBBPreEDIndex = 17; cr_201 = 0xe; } else if(pDevice->byBBPreEDRSSI <= 51) { //RSSI -50, -51 if(pDevice->byBBPreEDIndex == 16) break; pDevice->byBBPreEDIndex = 16; cr_201 = 0x9; } else if(pDevice->byBBPreEDRSSI <= 53) { //RSSI -52, -53 if(pDevice->byBBPreEDIndex == 15) break; pDevice->byBBPreEDIndex = 15; cr_201 = 0x6; } else if(pDevice->byBBPreEDRSSI <= 55) { //RSSI -54, -55 if(pDevice->byBBPreEDIndex == 14) break; pDevice->byBBPreEDIndex = 14; cr_201 = 0x3; } else if(pDevice->byBBPreEDRSSI <= 56) { //RSSI -56 if(pDevice->byBBPreEDIndex == 13) break; pDevice->byBBPreEDIndex = 13; cr_201 = 0x2; cr_206 = 0xa0; } else if(pDevice->byBBPreEDRSSI <= 57) { //RSSI -57 if(pDevice->byBBPreEDIndex == 12) break; pDevice->byBBPreEDIndex = 12; cr_201 = 0x2; cr_206 = 0x20; } else if(pDevice->byBBPreEDRSSI <= 58) { //RSSI -58 if(pDevice->byBBPreEDIndex == 11) break; pDevice->byBBPreEDIndex = 11; cr_201 = 0x1; cr_206 = 0xa0; } else if(pDevice->byBBPreEDRSSI <= 59) { //RSSI -59 if(pDevice->byBBPreEDIndex == 10) break; pDevice->byBBPreEDIndex = 10; cr_201 = 0x1; cr_206 = 0x54; } else if(pDevice->byBBPreEDRSSI <= 60) { //RSSI -60 if(pDevice->byBBPreEDIndex == 9) break; pDevice->byBBPreEDIndex = 9; cr_201 = 0x1; cr_206 = 0x18; } else if(pDevice->byBBPreEDRSSI <= 61) { //RSSI -61 if(pDevice->byBBPreEDIndex == 8) break; pDevice->byBBPreEDIndex = 8; cr_206 = 0xe3; } else if(pDevice->byBBPreEDRSSI <= 62) { //RSSI -62 if(pDevice->byBBPreEDIndex == 7) break; pDevice->byBBPreEDIndex = 7; cr_206 = 0xb9; } else if(pDevice->byBBPreEDRSSI <= 63) { //RSSI -63 if(pDevice->byBBPreEDIndex == 6) break; pDevice->byBBPreEDIndex = 6; cr_206 = 0x93; } else if(pDevice->byBBPreEDRSSI <= 64) { //RSSI -64 if(pDevice->byBBPreEDIndex == 5) break; pDevice->byBBPreEDIndex = 5; cr_206 = 0x79; } else if(pDevice->byBBPreEDRSSI <= 65) { //RSSI -65 if(pDevice->byBBPreEDIndex == 4) break; pDevice->byBBPreEDIndex = 4; cr_206 = 0x62; } else if(pDevice->byBBPreEDRSSI <= 66) { //RSSI -66 if(pDevice->byBBPreEDIndex == 3) break; pDevice->byBBPreEDIndex = 3; cr_206 = 0x51; } else if(pDevice->byBBPreEDRSSI <= 67) { //RSSI -67 if(pDevice->byBBPreEDIndex == 2) break; pDevice->byBBPreEDIndex = 2; cr_206 = 0x43; } else if(pDevice->byBBPreEDRSSI <= 68) { //RSSI -68 if(pDevice->byBBPreEDIndex == 1) break; pDevice->byBBPreEDIndex = 1; cr_206 = 0x36; } else { //RSSI -69, -70,.... if(pDevice->byBBPreEDIndex == 0) break; pDevice->byBBPreEDIndex = 0; cr_206 = 0x30; } break; case RF_VT3226: case RF_VT3226D0: //RobertYu:20060627, update new table if( bScanning ) { // need Max sensitivity //RSSI -69, -70, ... pDevice->byBBPreEDIndex = 0; cr_206 = 0x24; break; } if(pDevice->byBBPreEDRSSI <= 41) { // RSSI 0, -1,-2,....-41 if(pDevice->byBBPreEDIndex == 22) break; pDevice->byBBPreEDIndex = 22; cr_201 = 0xff; } else if(pDevice->byBBPreEDRSSI <= 42) { //RSSI -42 if(pDevice->byBBPreEDIndex == 21) break; pDevice->byBBPreEDIndex = 21; cr_201 = 0x36; } else if(pDevice->byBBPreEDRSSI <= 43) { //RSSI -43 if(pDevice->byBBPreEDIndex == 20) break; pDevice->byBBPreEDIndex = 20; cr_201 = 0x26; } else if(pDevice->byBBPreEDRSSI <= 45) { //RSSI -44, -45 if(pDevice->byBBPreEDIndex == 19) break; pDevice->byBBPreEDIndex = 19; cr_201 = 0x18; } else if(pDevice->byBBPreEDRSSI <= 47) { //RSSI -46, -47 if(pDevice->byBBPreEDIndex == 18) break; pDevice->byBBPreEDIndex = 18; cr_201 = 0x11; } else if(pDevice->byBBPreEDRSSI <= 49) { //RSSI -48, -49 if(pDevice->byBBPreEDIndex == 17) break; pDevice->byBBPreEDIndex = 17; cr_201 = 0xa; } else if(pDevice->byBBPreEDRSSI <= 51) { //RSSI -50, -51 if(pDevice->byBBPreEDIndex == 16) break; pDevice->byBBPreEDIndex = 16; cr_201 = 0x7; } else if(pDevice->byBBPreEDRSSI <= 53) { //RSSI -52, -53 if(pDevice->byBBPreEDIndex == 15) break; pDevice->byBBPreEDIndex = 15; cr_201 = 0x4; } else if(pDevice->byBBPreEDRSSI <= 55) { //RSSI -54, -55 if(pDevice->byBBPreEDIndex == 14) break; pDevice->byBBPreEDIndex = 14; cr_201 = 0x2; cr_206 = 0xc0; } else if(pDevice->byBBPreEDRSSI <= 56) { //RSSI -56 if(pDevice->byBBPreEDIndex == 13) break; pDevice->byBBPreEDIndex = 13; cr_201 = 0x2; cr_206 = 0x30; } else if(pDevice->byBBPreEDRSSI <= 57) { //RSSI -57 if(pDevice->byBBPreEDIndex == 12) break; pDevice->byBBPreEDIndex = 12; cr_201 = 0x1; cr_206 = 0xb0; } else if(pDevice->byBBPreEDRSSI <= 58) { //RSSI -58 if(pDevice->byBBPreEDIndex == 11) break; pDevice->byBBPreEDIndex = 11; cr_201 = 0x1; cr_206 = 0x70; } else if(pDevice->byBBPreEDRSSI <= 59) { //RSSI -59 if(pDevice->byBBPreEDIndex == 10) break; pDevice->byBBPreEDIndex = 10; cr_201 = 0x1; cr_206 = 0x30; } else if(pDevice->byBBPreEDRSSI <= 60) { //RSSI -60 if(pDevice->byBBPreEDIndex == 9) break; pDevice->byBBPreEDIndex = 9; cr_206 = 0xea; } else if(pDevice->byBBPreEDRSSI <= 61) { //RSSI -61 if(pDevice->byBBPreEDIndex == 8) break; pDevice->byBBPreEDIndex = 8; cr_206 = 0xc0; } else if(pDevice->byBBPreEDRSSI <= 62) { //RSSI -62 if(pDevice->byBBPreEDIndex == 7) break; pDevice->byBBPreEDIndex = 7; cr_206 = 0x9c; } else if(pDevice->byBBPreEDRSSI <= 63) { //RSSI -63 if(pDevice->byBBPreEDIndex == 6) break; pDevice->byBBPreEDIndex = 6; cr_206 = 0x80; } else if(pDevice->byBBPreEDRSSI <= 64) { //RSSI -64 if(pDevice->byBBPreEDIndex == 5) break; pDevice->byBBPreEDIndex = 5; cr_206 = 0x68; } else if(pDevice->byBBPreEDRSSI <= 65) { //RSSI -65 if(pDevice->byBBPreEDIndex == 4) break; pDevice->byBBPreEDIndex = 4; cr_206 = 0x52; } else if(pDevice->byBBPreEDRSSI <= 66) { //RSSI -66 if(pDevice->byBBPreEDIndex == 3) break; pDevice->byBBPreEDIndex = 3; cr_206 = 0x43; } else if(pDevice->byBBPreEDRSSI <= 67) { //RSSI -67 if(pDevice->byBBPreEDIndex == 2) break; pDevice->byBBPreEDIndex = 2; cr_206 = 0x36; } else if(pDevice->byBBPreEDRSSI <= 68) { //RSSI -68 if(pDevice->byBBPreEDIndex == 1) break; pDevice->byBBPreEDIndex = 1; cr_206 = 0x2d; } else { //RSSI -69, -70, ... if(pDevice->byBBPreEDIndex == 0) break; pDevice->byBBPreEDIndex = 0; cr_206 = 0x24; } break; case RF_VT3342A0: //RobertYu:20060627, testing table if( bScanning ) { // need Max sensitivity //RSSI -67, -68, ... pDevice->byBBPreEDIndex = 0; cr_206 = 0x38; break; } if(pDevice->byBBPreEDRSSI <= 41) { // RSSI 0, -1,-2,....-41 if(pDevice->byBBPreEDIndex == 20) break; pDevice->byBBPreEDIndex = 20; cr_201 = 0xff; } else if(pDevice->byBBPreEDRSSI <= 42) { //RSSI -42 if(pDevice->byBBPreEDIndex == 19) break; pDevice->byBBPreEDIndex = 19; cr_201 = 0x36; } else if(pDevice->byBBPreEDRSSI <= 43) { //RSSI -43 if(pDevice->byBBPreEDIndex == 18) break; pDevice->byBBPreEDIndex = 18; cr_201 = 0x26; } else if(pDevice->byBBPreEDRSSI <= 45) { //RSSI -44, -45 if(pDevice->byBBPreEDIndex == 17) break; pDevice->byBBPreEDIndex = 17; cr_201 = 0x18; } else if(pDevice->byBBPreEDRSSI <= 47) { //RSSI -46, -47 if(pDevice->byBBPreEDIndex == 16) break; pDevice->byBBPreEDIndex = 16; cr_201 = 0x11; } else if(pDevice->byBBPreEDRSSI <= 49) { //RSSI -48, -49 if(pDevice->byBBPreEDIndex == 15) break; pDevice->byBBPreEDIndex = 15; cr_201 = 0xa; } else if(pDevice->byBBPreEDRSSI <= 51) { //RSSI -50, -51 if(pDevice->byBBPreEDIndex == 14) break; pDevice->byBBPreEDIndex = 14; cr_201 = 0x7; } else if(pDevice->byBBPreEDRSSI <= 53) { //RSSI -52, -53 if(pDevice->byBBPreEDIndex == 13) break; pDevice->byBBPreEDIndex = 13; cr_201 = 0x4; } else if(pDevice->byBBPreEDRSSI <= 55) { //RSSI -54, -55 if(pDevice->byBBPreEDIndex == 12) break; pDevice->byBBPreEDIndex = 12; cr_201 = 0x2; cr_206 = 0xc0; } else if(pDevice->byBBPreEDRSSI <= 56) { //RSSI -56 if(pDevice->byBBPreEDIndex == 11) break; pDevice->byBBPreEDIndex = 11; cr_201 = 0x2; cr_206 = 0x30; } else if(pDevice->byBBPreEDRSSI <= 57) { //RSSI -57 if(pDevice->byBBPreEDIndex == 10) break; pDevice->byBBPreEDIndex = 10; cr_201 = 0x1; cr_206 = 0xb0; } else if(pDevice->byBBPreEDRSSI <= 58) { //RSSI -58 if(pDevice->byBBPreEDIndex == 9) break; pDevice->byBBPreEDIndex = 9; cr_201 = 0x1; cr_206 = 0x70; } else if(pDevice->byBBPreEDRSSI <= 59) { //RSSI -59 if(pDevice->byBBPreEDIndex == 8) break; pDevice->byBBPreEDIndex = 8; cr_201 = 0x1; cr_206 = 0x30; } else if(pDevice->byBBPreEDRSSI <= 60) { //RSSI -60 if(pDevice->byBBPreEDIndex == 7) break; pDevice->byBBPreEDIndex = 7; cr_206 = 0xea; } else if(pDevice->byBBPreEDRSSI <= 61) { //RSSI -61 if(pDevice->byBBPreEDIndex == 6) break; pDevice->byBBPreEDIndex = 6; cr_206 = 0xc0; } else if(pDevice->byBBPreEDRSSI <= 62) { //RSSI -62 if(pDevice->byBBPreEDIndex == 5) break; pDevice->byBBPreEDIndex = 5; cr_206 = 0x9c; } else if(pDevice->byBBPreEDRSSI <= 63) { //RSSI -63 if(pDevice->byBBPreEDIndex == 4) break; pDevice->byBBPreEDIndex = 4; cr_206 = 0x80; } else if(pDevice->byBBPreEDRSSI <= 64) { //RSSI -64 if(pDevice->byBBPreEDIndex == 3) break; pDevice->byBBPreEDIndex = 3; cr_206 = 0x68; } else if(pDevice->byBBPreEDRSSI <= 65) { //RSSI -65 if(pDevice->byBBPreEDIndex == 2) break; pDevice->byBBPreEDIndex = 2; cr_206 = 0x52; } else if(pDevice->byBBPreEDRSSI <= 66) { //RSSI -66 if(pDevice->byBBPreEDIndex == 1) break; pDevice->byBBPreEDIndex = 1; cr_206 = 0x43; } else { //RSSI -67, -68, ... if(pDevice->byBBPreEDIndex == 0) break; pDevice->byBBPreEDIndex = 0; cr_206 = 0x38; } break; } dev_dbg(&pDevice->usb->dev, "%s byBBPreEDRSSI %d\n", __func__, pDevice->byBBPreEDRSSI); if (!cr_201 && !cr_206) return; ControlvWriteByte(pDevice, MESSAGE_REQUEST_BBREG, 0xc9, cr_201); ControlvWriteByte(pDevice, MESSAGE_REQUEST_BBREG, 0xce, cr_206); }