444 lines
9.2 KiB
C
444 lines
9.2 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* Purpose: rf function code
|
|
*
|
|
* Author: Jerry Chen
|
|
*
|
|
* Date: Feb. 19, 2004
|
|
*
|
|
* Functions:
|
|
* vnt_rf_write_embedded - Embedded write RF register via MAC
|
|
*
|
|
* Revision History:
|
|
* RF_VT3226: RobertYu:20051111, VT3226C0 and before
|
|
* RF_VT3226D0: RobertYu:20051228
|
|
* RF_VT3342A0: RobertYu:20060609
|
|
*
|
|
*/
|
|
|
|
#include <linux/errno.h>
|
|
#include "mac.h"
|
|
#include "rf.h"
|
|
#include "baseband.h"
|
|
#include "usbpipe.h"
|
|
|
|
#define CB_AL2230_INIT_SEQ 15
|
|
#define CB_AL7230_INIT_SEQ 16
|
|
#define CB_VT3226_INIT_SEQ 11
|
|
#define CB_VT3342_INIT_SEQ 13
|
|
|
|
static u8 al2230_init_table[CB_AL2230_INIT_SEQ][3] = {
|
|
{0x03, 0xf7, 0x90},
|
|
{0x03, 0x33, 0x31},
|
|
{0x01, 0xb8, 0x02},
|
|
{0x00, 0xff, 0xf3},
|
|
{0x00, 0x05, 0xa4},
|
|
{0x0f, 0x4d, 0xc5},
|
|
{0x08, 0x05, 0xb6},
|
|
{0x01, 0x47, 0xc7},
|
|
{0x00, 0x06, 0x88},
|
|
{0x04, 0x03, 0xb9},
|
|
{0x00, 0xdb, 0xba},
|
|
{0x00, 0x09, 0x9b},
|
|
{0x0b, 0xdf, 0xfc},
|
|
{0x00, 0x00, 0x0d},
|
|
{0x00, 0x58, 0x0f}
|
|
};
|
|
|
|
static u8 al2230_channel_table0[CB_MAX_CHANNEL_24G][3] = {
|
|
{0x03, 0xf7, 0x90},
|
|
{0x03, 0xf7, 0x90},
|
|
{0x03, 0xe7, 0x90},
|
|
{0x03, 0xe7, 0x90},
|
|
{0x03, 0xf7, 0xa0},
|
|
{0x03, 0xf7, 0xa0},
|
|
{0x03, 0xe7, 0xa0},
|
|
{0x03, 0xe7, 0xa0},
|
|
{0x03, 0xf7, 0xb0},
|
|
{0x03, 0xf7, 0xb0},
|
|
{0x03, 0xe7, 0xb0},
|
|
{0x03, 0xe7, 0xb0},
|
|
{0x03, 0xf7, 0xc0},
|
|
{0x03, 0xe7, 0xc0}
|
|
};
|
|
|
|
static u8 al2230_channel_table1[CB_MAX_CHANNEL_24G][3] = {
|
|
{0x03, 0x33, 0x31},
|
|
{0x0b, 0x33, 0x31},
|
|
{0x03, 0x33, 0x31},
|
|
{0x0b, 0x33, 0x31},
|
|
{0x03, 0x33, 0x31},
|
|
{0x0b, 0x33, 0x31},
|
|
{0x03, 0x33, 0x31},
|
|
{0x0b, 0x33, 0x31},
|
|
{0x03, 0x33, 0x31},
|
|
{0x0b, 0x33, 0x31},
|
|
{0x03, 0x33, 0x31},
|
|
{0x0b, 0x33, 0x31},
|
|
{0x03, 0x33, 0x31},
|
|
{0x06, 0x66, 0x61}
|
|
};
|
|
|
|
static u8 vt3226_init_table[CB_VT3226_INIT_SEQ][3] = {
|
|
{0x03, 0xff, 0x80},
|
|
{0x02, 0x82, 0xa1},
|
|
{0x03, 0xc6, 0xa2},
|
|
{0x01, 0x97, 0x93},
|
|
{0x03, 0x66, 0x64},
|
|
{0x00, 0x61, 0xa5},
|
|
{0x01, 0x7b, 0xd6},
|
|
{0x00, 0x80, 0x17},
|
|
{0x03, 0xf8, 0x08},
|
|
{0x00, 0x02, 0x39},
|
|
{0x02, 0x00, 0x2a}
|
|
};
|
|
|
|
static u8 vt3226d0_init_table[CB_VT3226_INIT_SEQ][3] = {
|
|
{0x03, 0xff, 0x80},
|
|
{0x03, 0x02, 0x21},
|
|
{0x03, 0xc6, 0xa2},
|
|
{0x01, 0x97, 0x93},
|
|
{0x03, 0x66, 0x64},
|
|
{0x00, 0x71, 0xa5},
|
|
{0x01, 0x15, 0xc6},
|
|
{0x01, 0x2e, 0x07},
|
|
{0x00, 0x58, 0x08},
|
|
{0x00, 0x02, 0x79},
|
|
{0x02, 0x01, 0xaa}
|
|
};
|
|
|
|
static u8 vt3226_channel_table0[CB_MAX_CHANNEL_24G][3] = {
|
|
{0x01, 0x97, 0x83},
|
|
{0x01, 0x97, 0x83},
|
|
{0x01, 0x97, 0x93},
|
|
{0x01, 0x97, 0x93},
|
|
{0x01, 0x97, 0x93},
|
|
{0x01, 0x97, 0x93},
|
|
{0x01, 0x97, 0xa3},
|
|
{0x01, 0x97, 0xa3},
|
|
{0x01, 0x97, 0xa3},
|
|
{0x01, 0x97, 0xa3},
|
|
{0x01, 0x97, 0xb3},
|
|
{0x01, 0x97, 0xb3},
|
|
{0x01, 0x97, 0xb3},
|
|
{0x03, 0x37, 0xc3}
|
|
};
|
|
|
|
static u8 vt3226_channel_table1[CB_MAX_CHANNEL_24G][3] = {
|
|
{0x02, 0x66, 0x64},
|
|
{0x03, 0x66, 0x64},
|
|
{0x00, 0x66, 0x64},
|
|
{0x01, 0x66, 0x64},
|
|
{0x02, 0x66, 0x64},
|
|
{0x03, 0x66, 0x64},
|
|
{0x00, 0x66, 0x64},
|
|
{0x01, 0x66, 0x64},
|
|
{0x02, 0x66, 0x64},
|
|
{0x03, 0x66, 0x64},
|
|
{0x00, 0x66, 0x64},
|
|
{0x01, 0x66, 0x64},
|
|
{0x02, 0x66, 0x64},
|
|
{0x00, 0xcc, 0xc4}
|
|
};
|
|
|
|
static const u32 vt3226d0_lo_current_table[CB_MAX_CHANNEL_24G] = {
|
|
0x0135c600,
|
|
0x0135c600,
|
|
0x0235c600,
|
|
0x0235c600,
|
|
0x0235c600,
|
|
0x0335c600,
|
|
0x0335c600,
|
|
0x0335c600,
|
|
0x0335c600,
|
|
0x0335c600,
|
|
0x0335c600,
|
|
0x0335c600,
|
|
0x0335c600,
|
|
0x0135c600
|
|
};
|
|
|
|
enum {
|
|
VNT_TABLE_INIT = 0,
|
|
VNT_TABLE_INIT_2 = 0,
|
|
VNT_TABLE_0 = 1,
|
|
VNT_TABLE_1 = 2,
|
|
VNT_TABLE_2 = 1
|
|
};
|
|
|
|
struct vnt_table_info {
|
|
u8 *addr;
|
|
int length;
|
|
};
|
|
|
|
static const struct vnt_table_info vnt_table_seq[][3] = {
|
|
{ /* RF_AL2230, RF_AL2230S init table, channel table 0 and 1 */
|
|
{&al2230_init_table[0][0], CB_AL2230_INIT_SEQ * 3},
|
|
{&al2230_channel_table0[0][0], CB_MAX_CHANNEL_24G * 3},
|
|
{&al2230_channel_table1[0][0], CB_MAX_CHANNEL_24G * 3}
|
|
}, { /* RF_VT3226 init table, channel table 0 and 1 */
|
|
{&vt3226_init_table[0][0], CB_VT3226_INIT_SEQ * 3},
|
|
{&vt3226_channel_table0[0][0], CB_MAX_CHANNEL_24G * 3},
|
|
{&vt3226_channel_table1[0][0], CB_MAX_CHANNEL_24G * 3}
|
|
}, { /* RF_VT3226D0 init table, channel table 0 and 1 */
|
|
{&vt3226d0_init_table[0][0], CB_VT3226_INIT_SEQ * 3},
|
|
{&vt3226_channel_table0[0][0], CB_MAX_CHANNEL_24G * 3},
|
|
{&vt3226_channel_table1[0][0], CB_MAX_CHANNEL_24G * 3}
|
|
}
|
|
};
|
|
|
|
/*
|
|
* Description: Write to IF/RF, by embedded programming
|
|
*/
|
|
int vnt_rf_write_embedded(struct vnt_private *priv, u32 data)
|
|
{
|
|
u8 reg_data[4];
|
|
|
|
data |= (VNT_RF_REG_LEN << 3) | IFREGCTL_REGW;
|
|
|
|
reg_data[0] = (u8)data;
|
|
reg_data[1] = (u8)(data >> 8);
|
|
reg_data[2] = (u8)(data >> 16);
|
|
reg_data[3] = (u8)(data >> 24);
|
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_IFRF, 0, 0,
|
|
ARRAY_SIZE(reg_data), reg_data);
|
|
}
|
|
|
|
static u8 vnt_rf_addpower(struct vnt_private *priv)
|
|
{
|
|
int base;
|
|
s32 rssi = -priv->current_rssi;
|
|
|
|
if (!rssi)
|
|
return 7;
|
|
|
|
if (priv->rf_type == RF_VT3226D0)
|
|
base = -60;
|
|
else
|
|
base = -70;
|
|
|
|
if (rssi < base)
|
|
return ((rssi - base + 1) / -5) * 2 + 5;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Set Tx power by power level and rate */
|
|
static int vnt_rf_set_txpower(struct vnt_private *priv, u8 power,
|
|
struct ieee80211_channel *ch)
|
|
{
|
|
u32 power_setting = 0;
|
|
int ret = 0;
|
|
|
|
power += vnt_rf_addpower(priv);
|
|
if (power > VNT_RF_MAX_POWER)
|
|
power = VNT_RF_MAX_POWER;
|
|
|
|
if (priv->power == power)
|
|
return 0;
|
|
|
|
priv->power = power;
|
|
|
|
switch (priv->rf_type) {
|
|
case RF_AL2230:
|
|
power_setting = 0x0404090 | (power << 12);
|
|
|
|
ret = vnt_rf_write_embedded(priv, power_setting);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (ch->flags & IEEE80211_CHAN_NO_OFDM)
|
|
ret = vnt_rf_write_embedded(priv, 0x0001b400);
|
|
else
|
|
ret = vnt_rf_write_embedded(priv, 0x0005a400);
|
|
|
|
break;
|
|
case RF_AL2230S:
|
|
power_setting = 0x0404090 | (power << 12);
|
|
|
|
ret = vnt_rf_write_embedded(priv, power_setting);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (ch->flags & IEEE80211_CHAN_NO_OFDM) {
|
|
ret = vnt_rf_write_embedded(priv, 0x040c1400);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = vnt_rf_write_embedded(priv, 0x00299b00);
|
|
} else {
|
|
ret = vnt_rf_write_embedded(priv, 0x0005a400);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = vnt_rf_write_embedded(priv, 0x00099b00);
|
|
}
|
|
|
|
break;
|
|
|
|
case RF_VT3226:
|
|
power_setting = ((0x3f - power) << 20) | (0x17 << 8);
|
|
|
|
ret = vnt_rf_write_embedded(priv, power_setting);
|
|
break;
|
|
case RF_VT3226D0:
|
|
if (ch->flags & IEEE80211_CHAN_NO_OFDM) {
|
|
u16 hw_value = ch->hw_value;
|
|
|
|
power_setting = ((0x3f - power) << 20) | (0xe07 << 8);
|
|
|
|
ret = vnt_rf_write_embedded(priv, power_setting);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = vnt_rf_write_embedded(priv, 0x03c6a200);
|
|
if (ret)
|
|
return ret;
|
|
|
|
dev_dbg(&priv->usb->dev,
|
|
"%s 11b channel [%d]\n", __func__, hw_value);
|
|
|
|
hw_value--;
|
|
|
|
if (hw_value < ARRAY_SIZE(vt3226d0_lo_current_table)) {
|
|
ret = vnt_rf_write_embedded(priv,
|
|
vt3226d0_lo_current_table[hw_value]);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
ret = vnt_rf_write_embedded(priv, 0x015C0800);
|
|
} else {
|
|
dev_dbg(&priv->usb->dev,
|
|
"@@@@ %s> 11G mode\n", __func__);
|
|
|
|
power_setting = ((0x3f - power) << 20) | (0x7 << 8);
|
|
|
|
ret = vnt_rf_write_embedded(priv, power_setting);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = vnt_rf_write_embedded(priv, 0x00C6A200);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = vnt_rf_write_embedded(priv, 0x016BC600);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = vnt_rf_write_embedded(priv, 0x00900800);
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/* Set Tx power by channel number type */
|
|
int vnt_rf_setpower(struct vnt_private *priv,
|
|
struct ieee80211_channel *ch)
|
|
{
|
|
u16 channel;
|
|
u8 power = priv->cck_pwr;
|
|
|
|
if (!ch)
|
|
return -EINVAL;
|
|
|
|
/* set channel number to array number */
|
|
channel = ch->hw_value - 1;
|
|
|
|
if (ch->flags & IEEE80211_CHAN_NO_OFDM) {
|
|
if (channel < ARRAY_SIZE(priv->cck_pwr_tbl))
|
|
power = priv->cck_pwr_tbl[channel];
|
|
} else if (ch->band == NL80211_BAND_5GHZ) {
|
|
/* remove 14 channels to array size */
|
|
channel -= 14;
|
|
|
|
if (channel < ARRAY_SIZE(priv->ofdm_a_pwr_tbl))
|
|
power = priv->ofdm_a_pwr_tbl[channel];
|
|
} else {
|
|
if (channel < ARRAY_SIZE(priv->ofdm_pwr_tbl))
|
|
power = priv->ofdm_pwr_tbl[channel];
|
|
}
|
|
|
|
return vnt_rf_set_txpower(priv, power, ch);
|
|
}
|
|
|
|
/* Convert rssi to dbm */
|
|
void vnt_rf_rssi_to_dbm(struct vnt_private *priv, u8 rssi, long *dbm)
|
|
{
|
|
u8 idx = ((rssi & 0xc0) >> 6) & 0x03;
|
|
long b = rssi & 0x3f;
|
|
long a = 0;
|
|
u8 airoharf[4] = {0, 18, 0, 40};
|
|
|
|
switch (priv->rf_type) {
|
|
case RF_AL2230:
|
|
case RF_AL2230S:
|
|
case RF_VT3226:
|
|
case RF_VT3226D0:
|
|
a = airoharf[idx];
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
*dbm = -1 * (a + b * 2);
|
|
}
|
|
|
|
int vnt_rf_table_download(struct vnt_private *priv)
|
|
{
|
|
int ret;
|
|
int idx = -1;
|
|
const struct vnt_table_info *table_seq;
|
|
|
|
switch (priv->rf_type) {
|
|
case RF_AL2230:
|
|
case RF_AL2230S:
|
|
idx = 0;
|
|
break;
|
|
case RF_VT3226:
|
|
idx = 1;
|
|
break;
|
|
case RF_VT3226D0:
|
|
idx = 2;
|
|
break;
|
|
}
|
|
|
|
if (idx < 0)
|
|
return 0;
|
|
|
|
table_seq = &vnt_table_seq[idx][0];
|
|
|
|
/* Init Table */
|
|
ret = vnt_control_out(priv, MESSAGE_TYPE_WRITE, 0,
|
|
MESSAGE_REQUEST_RF_INIT,
|
|
table_seq[VNT_TABLE_INIT].length,
|
|
table_seq[VNT_TABLE_INIT].addr);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* Channel Table 0 */
|
|
ret = vnt_control_out_blocks(priv, VNT_REG_BLOCK_SIZE,
|
|
MESSAGE_REQUEST_RF_CH0,
|
|
table_seq[VNT_TABLE_0].length,
|
|
table_seq[VNT_TABLE_0].addr);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* Channel Table 1 */
|
|
ret = vnt_control_out_blocks(priv, VNT_REG_BLOCK_SIZE,
|
|
MESSAGE_REQUEST_RF_CH1,
|
|
table_seq[VNT_TABLE_1].length,
|
|
table_seq[VNT_TABLE_1].addr);
|
|
|
|
return ret;
|
|
}
|