Skip to content

L
linux
Commit 8c5e7a5f authored by Ivo van Doorn's avatar Ivo van Doorn Committed by John W. Linville
Browse files
Options

rt2x00: Gather channel information in structure 

Channel information which is read from EEPROM should
be read into an array containing per-channel information.
This removes the requirement of multiple arrays and makes
the channel handling a bit cleaner and easier to expand.
Signed-off-by: default avatarIvo van Doorn <IvDoorn@gmail.com>
Signed-off-by: default avatarJohn W. Linville <linville@tuxdriver.com>
parent 906c110f
Hide whitespace changes
Inline Side-by-side
Showing with 176 additions and 162 deletions
drivers/net/wireless/rt2x00/rt2400pci.c
View file @ 8c5e7a5f
...@@ -1404,7 +1404,7 @@ static int rt2400pci_init_eeprom(struct rt2x00_dev *rt2x00dev) ...@@ -1404,7 +1404,7 @@ static int rt2400pci_init_eeprom(struct rt2x00_dev *rt2x00dev)
* RF value list for RF2420 & RF2421 * RF value list for RF2420 & RF2421
* Supports: 2.4 GHz * Supports: 2.4 GHz
*/ */
static const struct rf_channel rf_vals_bg[] = { static const struct rf_channel rf_vals_b[] = {
{ 1, 0x00022058, 0x000c1fda, 0x00000101, 0 }, { 1, 0x00022058, 0x000c1fda, 0x00000101, 0 },
{ 2, 0x00022058, 0x000c1fee, 0x00000101, 0 }, { 2, 0x00022058, 0x000c1fee, 0x00000101, 0 },
{ 3, 0x00022058, 0x000c2002, 0x00000101, 0 }, { 3, 0x00022058, 0x000c2002, 0x00000101, 0 },
...@@ -1421,10 +1421,11 @@ static const struct rf_channel rf_vals_bg[] = { ...@@ -1421,10 +1421,11 @@ static const struct rf_channel rf_vals_bg[] = {
{ 14, 0x00022058, 0x000c20fa, 0x00000101, 0 }, { 14, 0x00022058, 0x000c20fa, 0x00000101, 0 },
}; };
static void rt2400pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev) static int rt2400pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
{ {
struct hw_mode_spec *spec = &rt2x00dev->spec; struct hw_mode_spec *spec = &rt2x00dev->spec;
u8 *txpower; struct channel_info *info;
char *tx_power;
unsigned int i; unsigned int i;
/* /*
...@@ -1439,24 +1440,29 @@ static void rt2400pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -1439,24 +1440,29 @@ static void rt2400pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
rt2x00_eeprom_addr(rt2x00dev, rt2x00_eeprom_addr(rt2x00dev,
EEPROM_MAC_ADDR_0)); EEPROM_MAC_ADDR_0));
/*
* Convert tx_power array in eeprom.
*/
txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_START);
for (i = 0; i < 14; i++)
txpower[i] = TXPOWER_FROM_DEV(txpower[i]);
/* /*
* Initialize hw_mode information. * Initialize hw_mode information.
*/ */
spec->supported_bands = SUPPORT_BAND_2GHZ; spec->supported_bands = SUPPORT_BAND_2GHZ;
spec->supported_rates = SUPPORT_RATE_CCK; spec->supported_rates = SUPPORT_RATE_CCK;
spec->tx_power_a = NULL;
spec->tx_power_bg = txpower;
spec->tx_power_default = DEFAULT_TXPOWER;
spec->num_channels = ARRAY_SIZE(rf_vals_bg); spec->num_channels = ARRAY_SIZE(rf_vals_b);
spec->channels = rf_vals_bg; spec->channels = rf_vals_b;
/*
* Create channel information array
*/
info = kzalloc(spec->num_channels * sizeof(*info), GFP_KERNEL);
if (!info)
return -ENOMEM;
spec->channels_info = info;
tx_power = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_START);
for (i = 0; i < 14; i++)
info[i].tx_power1 = TXPOWER_FROM_DEV(tx_power[i]);
return 0;
} }
static int rt2400pci_probe_hw(struct rt2x00_dev *rt2x00dev) static int rt2400pci_probe_hw(struct rt2x00_dev *rt2x00dev)
...@@ -1477,7 +1483,9 @@ static int rt2400pci_probe_hw(struct rt2x00_dev *rt2x00dev) ...@@ -1477,7 +1483,9 @@ static int rt2400pci_probe_hw(struct rt2x00_dev *rt2x00dev)
/* /*
* Initialize hw specifications. * Initialize hw specifications.
*/ */
rt2400pci_probe_hw_mode(rt2x00dev); retval = rt2400pci_probe_hw_mode(rt2x00dev);
if (retval)
return retval;
/* /*
* This device requires the atim queue and DMA-mapped skbs. * This device requires the atim queue and DMA-mapped skbs.
......
drivers/net/wireless/rt2x00/rt2400pci.h
View file @ 8c5e7a5f
...@@ -938,19 +938,13 @@ ...@@ -938,19 +938,13 @@
#define MAX_TXPOWER 62 #define MAX_TXPOWER 62
#define DEFAULT_TXPOWER 39 #define DEFAULT_TXPOWER 39
#define TXPOWER_FROM_DEV(__txpower) \ #define __CLAMP_TX(__txpower) \
({ \ clamp_t(char, (__txpower), MIN_TXPOWER, MAX_TXPOWER)
((__txpower) > MAX_TXPOWER) ? DEFAULT_TXPOWER - MIN_TXPOWER : \
((__txpower) < MIN_TXPOWER) ? DEFAULT_TXPOWER - MIN_TXPOWER : \ #define TXPOWER_FROM_DEV(__txpower) \
(((__txpower) - MAX_TXPOWER) + MIN_TXPOWER); \ ((__CLAMP_TX(__txpower) - MAX_TXPOWER) + MIN_TXPOWER)
})
#define TXPOWER_TO_DEV(__txpower) \
#define TXPOWER_TO_DEV(__txpower) \ MAX_TXPOWER - (__CLAMP_TX(__txpower) - MIN_TXPOWER)
({ \
(__txpower) += MIN_TXPOWER; \
((__txpower) <= MIN_TXPOWER) ? MAX_TXPOWER : \
(((__txpower) >= MAX_TXPOWER) ? MIN_TXPOWER : \
(MAX_TXPOWER - ((__txpower) - MIN_TXPOWER))); \
})
#endif /* RT2400PCI_H */ #endif /* RT2400PCI_H */
drivers/net/wireless/rt2x00/rt2500pci.c
View file @ 8c5e7a5f
...@@ -1721,10 +1721,11 @@ static const struct rf_channel rf_vals_5222[] = { ...@@ -1721,10 +1721,11 @@ static const struct rf_channel rf_vals_5222[] = {
{ 161, 0x00022020, 0x000090be, 0x00000101, 0x00000a07 }, { 161, 0x00022020, 0x000090be, 0x00000101, 0x00000a07 },
}; };
static void rt2500pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev) static int rt2500pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
{ {
struct hw_mode_spec *spec = &rt2x00dev->spec; struct hw_mode_spec *spec = &rt2x00dev->spec;
u8 *txpower; struct channel_info *info;
char *tx_power;
unsigned int i; unsigned int i;
/* /*
...@@ -1740,21 +1741,11 @@ static void rt2500pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -1740,21 +1741,11 @@ static void rt2500pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
rt2x00_eeprom_addr(rt2x00dev, rt2x00_eeprom_addr(rt2x00dev,
EEPROM_MAC_ADDR_0)); EEPROM_MAC_ADDR_0));
/*
* Convert tx_power array in eeprom.
*/
txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_START);
for (i = 0; i < 14; i++)
txpower[i] = TXPOWER_FROM_DEV(txpower[i]);
/* /*
* Initialize hw_mode information. * Initialize hw_mode information.
*/ */
spec->supported_bands = SUPPORT_BAND_2GHZ; spec->supported_bands = SUPPORT_BAND_2GHZ;
spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM; spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM;
spec->tx_power_a = NULL;
spec->tx_power_bg = txpower;
spec->tx_power_default = DEFAULT_TXPOWER;
if (rt2x00_rf(&rt2x00dev->chip, RF2522)) { if (rt2x00_rf(&rt2x00dev->chip, RF2522)) {
spec->num_channels = ARRAY_SIZE(rf_vals_bg_2522); spec->num_channels = ARRAY_SIZE(rf_vals_bg_2522);
...@@ -1776,6 +1767,26 @@ static void rt2500pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -1776,6 +1767,26 @@ static void rt2500pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
spec->num_channels = ARRAY_SIZE(rf_vals_5222); spec->num_channels = ARRAY_SIZE(rf_vals_5222);
spec->channels = rf_vals_5222; spec->channels = rf_vals_5222;
} }
/*
* Create channel information array
*/
info = kzalloc(spec->num_channels * sizeof(*info), GFP_KERNEL);
if (!info)
return -ENOMEM;
spec->channels_info = info;
tx_power = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_START);
for (i = 0; i < 14; i++)
info[i].tx_power1 = TXPOWER_FROM_DEV(tx_power[i]);
if (spec->num_channels > 14) {
for (i = 14; i < spec->num_channels; i++)
info[i].tx_power1 = DEFAULT_TXPOWER;
}
return 0;
} }
static int rt2500pci_probe_hw(struct rt2x00_dev *rt2x00dev) static int rt2500pci_probe_hw(struct rt2x00_dev *rt2x00dev)
...@@ -1796,7 +1807,9 @@ static int rt2500pci_probe_hw(struct rt2x00_dev *rt2x00dev) ...@@ -1796,7 +1807,9 @@ static int rt2500pci_probe_hw(struct rt2x00_dev *rt2x00dev)
/* /*
* Initialize hw specifications. * Initialize hw specifications.
*/ */
rt2500pci_probe_hw_mode(rt2x00dev); retval = rt2500pci_probe_hw_mode(rt2x00dev);
if (retval)
return retval;
/* /*
* This device requires the atim queue and DMA-mapped skbs. * This device requires the atim queue and DMA-mapped skbs.
......
drivers/net/wireless/rt2x00/rt2500pci.h
View file @ 8c5e7a5f
...@@ -1223,17 +1223,10 @@ ...@@ -1223,17 +1223,10 @@
#define MAX_TXPOWER 31 #define MAX_TXPOWER 31
#define DEFAULT_TXPOWER 24 #define DEFAULT_TXPOWER 24
#define TXPOWER_FROM_DEV(__txpower) \ #define TXPOWER_FROM_DEV(__txpower) \
({ \ (((u8)(__txpower)) > MAX_TXPOWER) ? DEFAULT_TXPOWER : (__txpower)
((__txpower) > MAX_TXPOWER) ? \
DEFAULT_TXPOWER : (__txpower); \ #define TXPOWER_TO_DEV(__txpower) \
}) clamp_t(char, __txpower, MIN_TXPOWER, MAX_TXPOWER)
#define TXPOWER_TO_DEV(__txpower) \
({ \
((__txpower) <= MIN_TXPOWER) ? MIN_TXPOWER : \
(((__txpower) >= MAX_TXPOWER) ? MAX_TXPOWER : \
(__txpower)); \
})
#endif /* RT2500PCI_H */ #endif /* RT2500PCI_H */
drivers/net/wireless/rt2x00/rt2500usb.c
View file @ 8c5e7a5f
...@@ -1665,10 +1665,11 @@ static const struct rf_channel rf_vals_5222[] = { ...@@ -1665,10 +1665,11 @@ static const struct rf_channel rf_vals_5222[] = {
{ 161, 0x00022020, 0x000090be, 0x00000101, 0x00000a07 }, { 161, 0x00022020, 0x000090be, 0x00000101, 0x00000a07 },
}; };
static void rt2500usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev) static int rt2500usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
{ {
struct hw_mode_spec *spec = &rt2x00dev->spec; struct hw_mode_spec *spec = &rt2x00dev->spec;
u8 *txpower; struct channel_info *info;
char *tx_power;
unsigned int i; unsigned int i;
/* /*
...@@ -1686,21 +1687,11 @@ static void rt2500usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -1686,21 +1687,11 @@ static void rt2500usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
rt2x00_eeprom_addr(rt2x00dev, rt2x00_eeprom_addr(rt2x00dev,
EEPROM_MAC_ADDR_0)); EEPROM_MAC_ADDR_0));
/*
* Convert tx_power array in eeprom.
*/
txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_START);
for (i = 0; i < 14; i++)
txpower[i] = TXPOWER_FROM_DEV(txpower[i]);
/* /*
* Initialize hw_mode information. * Initialize hw_mode information.
*/ */
spec->supported_bands = SUPPORT_BAND_2GHZ; spec->supported_bands = SUPPORT_BAND_2GHZ;
spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM; spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM;
spec->tx_power_a = NULL;
spec->tx_power_bg = txpower;
spec->tx_power_default = DEFAULT_TXPOWER;
if (rt2x00_rf(&rt2x00dev->chip, RF2522)) { if (rt2x00_rf(&rt2x00dev->chip, RF2522)) {
spec->num_channels = ARRAY_SIZE(rf_vals_bg_2522); spec->num_channels = ARRAY_SIZE(rf_vals_bg_2522);
...@@ -1722,6 +1713,26 @@ static void rt2500usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -1722,6 +1713,26 @@ static void rt2500usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
spec->num_channels = ARRAY_SIZE(rf_vals_5222); spec->num_channels = ARRAY_SIZE(rf_vals_5222);
spec->channels = rf_vals_5222; spec->channels = rf_vals_5222;
} }
/*
* Create channel information array
*/
info = kzalloc(spec->num_channels * sizeof(*info), GFP_KERNEL);
if (!info)
return -ENOMEM;
spec->channels_info = info;
tx_power = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_START);
for (i = 0; i < 14; i++)
info[i].tx_power1 = TXPOWER_FROM_DEV(tx_power[i]);
if (spec->num_channels > 14) {
for (i = 14; i < spec->num_channels; i++)
info[i].tx_power1 = DEFAULT_TXPOWER;
}
return 0;
} }
static int rt2500usb_probe_hw(struct rt2x00_dev *rt2x00dev) static int rt2500usb_probe_hw(struct rt2x00_dev *rt2x00dev)
...@@ -1742,7 +1753,9 @@ static int rt2500usb_probe_hw(struct rt2x00_dev *rt2x00dev) ...@@ -1742,7 +1753,9 @@ static int rt2500usb_probe_hw(struct rt2x00_dev *rt2x00dev)
/* /*
* Initialize hw specifications. * Initialize hw specifications.
*/ */
rt2500usb_probe_hw_mode(rt2x00dev); retval = rt2500usb_probe_hw_mode(rt2x00dev);
if (retval)
return retval;
/* /*
* This device requires the atim queue * This device requires the atim queue
......
drivers/net/wireless/rt2x00/rt2500usb.h
View file @ 8c5e7a5f
...@@ -825,17 +825,10 @@ ...@@ -825,17 +825,10 @@
#define MAX_TXPOWER 31 #define MAX_TXPOWER 31
#define DEFAULT_TXPOWER 24 #define DEFAULT_TXPOWER 24
#define TXPOWER_FROM_DEV(__txpower) \ #define TXPOWER_FROM_DEV(__txpower) \
({ \ (((u8)(__txpower)) > MAX_TXPOWER) ? DEFAULT_TXPOWER : (__txpower)
((__txpower) > MAX_TXPOWER) ? \
DEFAULT_TXPOWER : (__txpower); \ #define TXPOWER_TO_DEV(__txpower) \
}) clamp_t(char, __txpower, MIN_TXPOWER, MAX_TXPOWER)
#define TXPOWER_TO_DEV(__txpower) \
({ \
((__txpower) <= MIN_TXPOWER) ? MIN_TXPOWER : \
(((__txpower) >= MAX_TXPOWER) ? MAX_TXPOWER : \
(__txpower)); \
})
#endif /* RT2500USB_H */ #endif /* RT2500USB_H */
drivers/net/wireless/rt2x00/rt2x00.h
View file @ 8c5e7a5f
...@@ -143,6 +143,17 @@ struct rf_channel { ...@@ -143,6 +143,17 @@ struct rf_channel {
u32 rf4; u32 rf4;
}; };
/*
* Channel information structure
*/
struct channel_info {
unsigned int flags;
#define GEOGRAPHY_ALLOWED 0x00000001
short tx_power1;
short tx_power2;
};
/* /*
* Antenna setup values. * Antenna setup values.
*/ */
...@@ -394,10 +405,7 @@ static inline struct rt2x00_intf* vif_to_intf(struct ieee80211_vif *vif) ...@@ -394,10 +405,7 @@ static inline struct rt2x00_intf* vif_to_intf(struct ieee80211_vif *vif)
* @num_channels: Number of supported channels. This is used as array size * @num_channels: Number of supported channels. This is used as array size
* for @tx_power_a, @tx_power_bg and @channels. * for @tx_power_a, @tx_power_bg and @channels.
* @channels: Device/chipset specific channel values (See &struct rf_channel). * @channels: Device/chipset specific channel values (See &struct rf_channel).
* @tx_power_a: TX power values for all 5.2GHz channels (may be NULL). * @channels_info: Additional information for channels (See &struct channel_info).
* @tx_power_bg: TX power values for all 2.4GHz channels (may be NULL).
* @tx_power_default: Default TX power value to use when either
* @tx_power_a or @tx_power_bg is missing.
*/ */
struct hw_mode_spec { struct hw_mode_spec {
unsigned int supported_bands; unsigned int supported_bands;
...@@ -410,10 +418,7 @@ struct hw_mode_spec { ...@@ -410,10 +418,7 @@ struct hw_mode_spec {
unsigned int num_channels; unsigned int num_channels;
const struct rf_channel *channels; const struct rf_channel *channels;
const struct channel_info *channels_info;
const u8 *tx_power_a;
const u8 *tx_power_bg;
u8 tx_power_default;
}; };
/* /*
...@@ -425,7 +430,9 @@ struct hw_mode_spec { ...@@ -425,7 +430,9 @@ struct hw_mode_spec {
*/ */
struct rt2x00lib_conf { struct rt2x00lib_conf {
struct ieee80211_conf *conf; struct ieee80211_conf *conf;
struct rf_channel rf; struct rf_channel rf;
struct channel_info channel;
struct antenna_setup ant; struct antenna_setup ant;
......
drivers/net/wireless/rt2x00/rt2x00config.c
View file @ 8c5e7a5f
...@@ -245,6 +245,10 @@ void rt2x00lib_config(struct rt2x00_dev *rt2x00dev, ...@@ -245,6 +245,10 @@ void rt2x00lib_config(struct rt2x00_dev *rt2x00dev,
memcpy(&libconf.rf, memcpy(&libconf.rf,
&rt2x00dev->spec.channels[conf->channel->hw_value], &rt2x00dev->spec.channels[conf->channel->hw_value],
sizeof(libconf.rf)); sizeof(libconf.rf));
memcpy(&libconf.channel,
&rt2x00dev->spec.channels_info[conf->channel->hw_value],
sizeof(libconf.channel));
} }
if (flags & CONFIG_UPDATE_ANTENNA) { if (flags & CONFIG_UPDATE_ANTENNA) {
......
drivers/net/wireless/rt2x00/rt2x00dev.c
View file @ 8c5e7a5f
...@@ -818,7 +818,6 @@ static int rt2x00lib_probe_hw_modes(struct rt2x00_dev *rt2x00dev, ...@@ -818,7 +818,6 @@ static int rt2x00lib_probe_hw_modes(struct rt2x00_dev *rt2x00dev,
struct ieee80211_rate *rates; struct ieee80211_rate *rates;
unsigned int num_rates; unsigned int num_rates;
unsigned int i; unsigned int i;
unsigned char tx_power;
num_rates = 0; num_rates = 0;
if (spec->supported_rates & SUPPORT_RATE_CCK) if (spec->supported_rates & SUPPORT_RATE_CCK)
...@@ -844,20 +843,9 @@ static int rt2x00lib_probe_hw_modes(struct rt2x00_dev *rt2x00dev, ...@@ -844,20 +843,9 @@ static int rt2x00lib_probe_hw_modes(struct rt2x00_dev *rt2x00dev,
* Initialize Channel list. * Initialize Channel list.
*/ */
for (i = 0; i < spec->num_channels; i++) { for (i = 0; i < spec->num_channels; i++) {
if (spec->channels[i].channel <= 14) {
if (spec->tx_power_bg)
tx_power = spec->tx_power_bg[i];
else
tx_power = spec->tx_power_default;
} else {
if (spec->tx_power_a)
tx_power = spec->tx_power_a[i];
else
tx_power = spec->tx_power_default;
}
rt2x00lib_channel(&channels[i], rt2x00lib_channel(&channels[i],
spec->channels[i].channel, tx_power, i); spec->channels[i].channel,
spec->channels_info[i].tx_power1, i);
} }
/* /*
...@@ -909,6 +897,8 @@ static void rt2x00lib_remove_hw(struct rt2x00_dev *rt2x00dev) ...@@ -909,6 +897,8 @@ static void rt2x00lib_remove_hw(struct rt2x00_dev *rt2x00dev)
rt2x00dev->hw->wiphy->bands[IEEE80211_BAND_2GHZ] = NULL; rt2x00dev->hw->wiphy->bands[IEEE80211_BAND_2GHZ] = NULL;
rt2x00dev->hw->wiphy->bands[IEEE80211_BAND_5GHZ] = NULL; rt2x00dev->hw->wiphy->bands[IEEE80211_BAND_5GHZ] = NULL;
} }
kfree(rt2x00dev->spec.channels_info);
} }
static int rt2x00lib_probe_hw(struct rt2x00_dev *rt2x00dev) static int rt2x00lib_probe_hw(struct rt2x00_dev *rt2x00dev)
......
drivers/net/wireless/rt2x00/rt61pci.c
View file @ 8c5e7a5f
...@@ -2514,10 +2514,11 @@ static const struct rf_channel rf_vals_seq[] = { ...@@ -2514,10 +2514,11 @@ static const struct rf_channel rf_vals_seq[] = {
{ 46, 0x00002ccc, 0x000049a6, 0x0009be55, 0x000c0a23 }, { 46, 0x00002ccc, 0x000049a6, 0x0009be55, 0x000c0a23 },
}; };
static void rt61pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev) static int rt61pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
{ {
struct hw_mode_spec *spec = &rt2x00dev->spec; struct hw_mode_spec *spec = &rt2x00dev->spec;
u8 *txpower; struct channel_info *info;
char *tx_power;
unsigned int i; unsigned int i;
/* /*
...@@ -2533,21 +2534,11 @@ static void rt61pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -2533,21 +2534,11 @@ static void rt61pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
rt2x00_eeprom_addr(rt2x00dev, rt2x00_eeprom_addr(rt2x00dev,
EEPROM_MAC_ADDR_0)); EEPROM_MAC_ADDR_0));
/*
* Convert tx_power array in eeprom.
*/
txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_G_START);
for (i = 0; i < 14; i++)
txpower[i] = TXPOWER_FROM_DEV(txpower[i]);
/* /*
* Initialize hw_mode information. * Initialize hw_mode information.
*/ */
spec->supported_bands = SUPPORT_BAND_2GHZ; spec->supported_bands = SUPPORT_BAND_2GHZ;
spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM; spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM;
spec->tx_power_a = NULL;
spec->tx_power_bg = txpower;
spec->tx_power_default = DEFAULT_TXPOWER;
if (!test_bit(CONFIG_RF_SEQUENCE, &rt2x00dev->flags)) { if (!test_bit(CONFIG_RF_SEQUENCE, &rt2x00dev->flags)) {
spec->num_channels = 14; spec->num_channels = 14;
...@@ -2561,13 +2552,28 @@ static void rt61pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -2561,13 +2552,28 @@ static void rt61pci_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
rt2x00_rf(&rt2x00dev->chip, RF5325)) { rt2x00_rf(&rt2x00dev->chip, RF5325)) {
spec->supported_bands |= SUPPORT_BAND_5GHZ; spec->supported_bands |= SUPPORT_BAND_5GHZ;
spec->num_channels = ARRAY_SIZE(rf_vals_seq); spec->num_channels = ARRAY_SIZE(rf_vals_seq);
}
/*
* Create channel information array
*/
info = kzalloc(spec->num_channels * sizeof(*info), GFP_KERNEL);
if (!info)
return -ENOMEM;
spec->channels_info = info;
txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_A_START); tx_power = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_G_START);
for (i = 0; i < 14; i++) for (i = 0; i < 14; i++)
txpower[i] = TXPOWER_FROM_DEV(txpower[i]); info[i].tx_power1 = TXPOWER_FROM_DEV(tx_power[i]);
spec->tx_power_a = txpower; if (spec->num_channels > 14) {
tx_power = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_A_START);
for (i = 14; i < spec->num_channels; i++)
info[i].tx_power1 = TXPOWER_FROM_DEV(tx_power[i]);
} }
return 0;
} }
static int rt61pci_probe_hw(struct rt2x00_dev *rt2x00dev) static int rt61pci_probe_hw(struct rt2x00_dev *rt2x00dev)
...@@ -2588,7 +2594,9 @@ static int rt61pci_probe_hw(struct rt2x00_dev *rt2x00dev) ...@@ -2588,7 +2594,9 @@ static int rt61pci_probe_hw(struct rt2x00_dev *rt2x00dev)
/* /*
* Initialize hw specifications. * Initialize hw specifications.
*/ */
rt61pci_probe_hw_mode(rt2x00dev); retval = rt61pci_probe_hw_mode(rt2x00dev);
if (retval)
return retval;
/* /*
* This device requires firmware and DMA mapped skbs. * This device requires firmware and DMA mapped skbs.
......
drivers/net/wireless/rt2x00/rt61pci.h
View file @ 8c5e7a5f
...@@ -1482,17 +1482,10 @@ struct hw_pairwise_ta_entry { ...@@ -1482,17 +1482,10 @@ struct hw_pairwise_ta_entry {
#define MAX_TXPOWER 31 #define MAX_TXPOWER 31
#define DEFAULT_TXPOWER 24 #define DEFAULT_TXPOWER 24
#define TXPOWER_FROM_DEV(__txpower) \ #define TXPOWER_FROM_DEV(__txpower) \
({ \ (((u8)(__txpower)) > MAX_TXPOWER) ? DEFAULT_TXPOWER : (__txpower)
((__txpower) > MAX_TXPOWER) ? \
DEFAULT_TXPOWER : (__txpower); \ #define TXPOWER_TO_DEV(__txpower) \
}) clamp_t(char, __txpower, MIN_TXPOWER, MAX_TXPOWER)
#define TXPOWER_TO_DEV(__txpower) \
({ \
((__txpower) <= MIN_TXPOWER) ? MIN_TXPOWER : \
(((__txpower) >= MAX_TXPOWER) ? MAX_TXPOWER : \
(__txpower)); \
})
#endif /* RT61PCI_H */ #endif /* RT61PCI_H */
drivers/net/wireless/rt2x00/rt73usb.c
View file @ 8c5e7a5f
...@@ -2107,10 +2107,11 @@ static const struct rf_channel rf_vals_5225_2527[] = { ...@@ -2107,10 +2107,11 @@ static const struct rf_channel rf_vals_5225_2527[] = {
}; };
static void rt73usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev) static int rt73usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
{ {
struct hw_mode_spec *spec = &rt2x00dev->spec; struct hw_mode_spec *spec = &rt2x00dev->spec;
u8 *txpower; struct channel_info *info;
char *tx_power;
unsigned int i; unsigned int i;
/* /*
...@@ -2126,21 +2127,11 @@ static void rt73usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -2126,21 +2127,11 @@ static void rt73usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
rt2x00_eeprom_addr(rt2x00dev, rt2x00_eeprom_addr(rt2x00dev,
EEPROM_MAC_ADDR_0)); EEPROM_MAC_ADDR_0));
/*
* Convert tx_power array in eeprom.
*/
txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_G_START);
for (i = 0; i < 14; i++)
txpower[i] = TXPOWER_FROM_DEV(txpower[i]);
/* /*
* Initialize hw_mode information. * Initialize hw_mode information.
*/ */
spec->supported_bands = SUPPORT_BAND_2GHZ; spec->supported_bands = SUPPORT_BAND_2GHZ;
spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM; spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM;
spec->tx_power_a = NULL;
spec->tx_power_bg = txpower;
spec->tx_power_default = DEFAULT_TXPOWER;
if (rt2x00_rf(&rt2x00dev->chip, RF2528)) { if (rt2x00_rf(&rt2x00dev->chip, RF2528)) {
spec->num_channels = ARRAY_SIZE(rf_vals_bg_2528); spec->num_channels = ARRAY_SIZE(rf_vals_bg_2528);
...@@ -2158,14 +2149,26 @@ static void rt73usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev) ...@@ -2158,14 +2149,26 @@ static void rt73usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
spec->channels = rf_vals_5225_2527; spec->channels = rf_vals_5225_2527;
} }
if (rt2x00_rf(&rt2x00dev->chip, RF5225) || /*
rt2x00_rf(&rt2x00dev->chip, RF5226)) { * Create channel information array
txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_A_START); */
for (i = 0; i < 14; i++) info = kzalloc(spec->num_channels * sizeof(*info), GFP_KERNEL);
txpower[i] = TXPOWER_FROM_DEV(txpower[i]); if (!info)
return -ENOMEM;
spec->tx_power_a = txpower; spec->channels_info = info;
tx_power = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_G_START);
for (i = 0; i < 14; i++)
info[i].tx_power1 = TXPOWER_FROM_DEV(tx_power[i]);
if (spec->num_channels > 14) {
tx_power = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_A_START);
for (i = 14; i < spec->num_channels; i++)
info[i].tx_power1 = TXPOWER_FROM_DEV(tx_power[i]);
} }
return 0;
} }
static int rt73usb_probe_hw(struct rt2x00_dev *rt2x00dev) static int rt73usb_probe_hw(struct rt2x00_dev *rt2x00dev)
...@@ -2186,7 +2189,9 @@ static int rt73usb_probe_hw(struct rt2x00_dev *rt2x00dev) ...@@ -2186,7 +2189,9 @@ static int rt73usb_probe_hw(struct rt2x00_dev *rt2x00dev)
/* /*
* Initialize hw specifications. * Initialize hw specifications.
*/ */
rt73usb_probe_hw_mode(rt2x00dev); retval = rt73usb_probe_hw_mode(rt2x00dev);
if (retval)
return retval;
/* /*
* This device requires firmware. * This device requires firmware.
......
drivers/net/wireless/rt2x00/rt73usb.h
View file @ 8c5e7a5f
...@@ -1050,17 +1050,10 @@ struct hw_pairwise_ta_entry { ...@@ -1050,17 +1050,10 @@ struct hw_pairwise_ta_entry {
#define MAX_TXPOWER 31 #define MAX_TXPOWER 31
#define DEFAULT_TXPOWER 24 #define DEFAULT_TXPOWER 24
#define TXPOWER_FROM_DEV(__txpower) \ #define TXPOWER_FROM_DEV(__txpower) \
({ \ (((u8)(__txpower)) > MAX_TXPOWER) ? DEFAULT_TXPOWER : (__txpower)
((__txpower) > MAX_TXPOWER) ? \
DEFAULT_TXPOWER : (__txpower); \ #define TXPOWER_TO_DEV(__txpower) \
}) clamp_t(char, __txpower, MIN_TXPOWER, MAX_TXPOWER)
#define TXPOWER_TO_DEV(__txpower) \
({ \
((__txpower) <= MIN_TXPOWER) ? MIN_TXPOWER : \
(((__txpower) >= MAX_TXPOWER) ? MAX_TXPOWER : \
(__txpower)); \
})
#endif /* RT73USB_H */ #endif /* RT73USB_H */
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7