iwl3945: cleanup and remove duplicate code

The patch removes the following duplicate structures:

	iwl3945_is_alive
	iwl3945_is_ready
	iwl3945_is_init
	iwl3945_is_rfkill_sw
	iwl3945_is_rfkill
	iwl3945_reset_qos

Signed-off-by: Abhijeet Kolekar <abhijeet.kolekar@intel.com>
Signed-off-by: Zhu Yi <yi.zhu@intel.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>
This commit is contained in:
Kolekar, Abhijeet 2008-12-19 10:37:36 +08:00 committed by John W. Linville
parent df878d8f01
commit 775a6e27bf

View File

@ -432,51 +432,6 @@ u8 iwl3945_add_station(struct iwl_priv *priv, const u8 *addr, int is_ap, u8 flag
} }
/*************** DRIVER STATUS FUNCTIONS *****/
static inline int iwl3945_is_ready(struct iwl_priv *priv)
{
/* The adapter is 'ready' if READY and GEO_CONFIGURED bits are
* set but EXIT_PENDING is not */
return test_bit(STATUS_READY, &priv->status) &&
test_bit(STATUS_GEO_CONFIGURED, &priv->status) &&
!test_bit(STATUS_EXIT_PENDING, &priv->status);
}
static inline int iwl3945_is_alive(struct iwl_priv *priv)
{
return test_bit(STATUS_ALIVE, &priv->status);
}
static inline int iwl3945_is_init(struct iwl_priv *priv)
{
return test_bit(STATUS_INIT, &priv->status);
}
static inline int iwl3945_is_rfkill_sw(struct iwl_priv *priv)
{
return test_bit(STATUS_RF_KILL_SW, &priv->status);
}
static inline int iwl3945_is_rfkill_hw(struct iwl_priv *priv)
{
return test_bit(STATUS_RF_KILL_HW, &priv->status);
}
static inline int iwl3945_is_rfkill(struct iwl_priv *priv)
{
return iwl3945_is_rfkill_hw(priv) ||
iwl3945_is_rfkill_sw(priv);
}
static inline int iwl3945_is_ready_rf(struct iwl_priv *priv)
{
if (iwl3945_is_rfkill(priv))
return 0;
return iwl3945_is_ready(priv);
}
/*************** HOST COMMAND QUEUE FUNCTIONS *****/ /*************** HOST COMMAND QUEUE FUNCTIONS *****/
@ -514,7 +469,7 @@ static int iwl3945_enqueue_hcmd(struct iwl_priv *priv, struct iwl_host_cmd *cmd)
!(cmd->meta.flags & CMD_SIZE_HUGE)); !(cmd->meta.flags & CMD_SIZE_HUGE));
if (iwl3945_is_rfkill(priv)) { if (iwl_is_rfkill(priv)) {
IWL_DEBUG_INFO("Not sending command - RF KILL"); IWL_DEBUG_INFO("Not sending command - RF KILL");
return -EIO; return -EIO;
} }
@ -941,7 +896,7 @@ static int iwl3945_commit_rxon(struct iwl_priv *priv)
struct iwl3945_rxon_cmd *active_rxon = (void *)&priv->active39_rxon; struct iwl3945_rxon_cmd *active_rxon = (void *)&priv->active39_rxon;
int rc = 0; int rc = 0;
if (!iwl3945_is_alive(priv)) if (!iwl_is_alive(priv))
return -1; return -1;
/* always get timestamp with Rx frame */ /* always get timestamp with Rx frame */
@ -1596,97 +1551,6 @@ static int iwl3945_send_qos_params_command(struct iwl_priv *priv,
sizeof(struct iwl_qosparam_cmd), qos); sizeof(struct iwl_qosparam_cmd), qos);
} }
static void iwl3945_reset_qos(struct iwl_priv *priv)
{
u16 cw_min = 15;
u16 cw_max = 1023;
u8 aifs = 2;
u8 is_legacy = 0;
unsigned long flags;
int i;
spin_lock_irqsave(&priv->lock, flags);
priv->qos_data.qos_active = 0;
/* QoS always active in AP and ADHOC mode
* In STA mode wait for association
*/
if (priv->iw_mode == NL80211_IFTYPE_ADHOC ||
priv->iw_mode == NL80211_IFTYPE_AP)
priv->qos_data.qos_active = 1;
else
priv->qos_data.qos_active = 0;
/* check for legacy mode */
if ((priv->iw_mode == NL80211_IFTYPE_ADHOC &&
(priv->active_rate & IWL_OFDM_RATES_MASK) == 0) ||
(priv->iw_mode == NL80211_IFTYPE_STATION &&
(priv->staging39_rxon.flags & RXON_FLG_SHORT_SLOT_MSK) == 0)) {
cw_min = 31;
is_legacy = 1;
}
if (priv->qos_data.qos_active)
aifs = 3;
priv->qos_data.def_qos_parm.ac[0].cw_min = cpu_to_le16(cw_min);
priv->qos_data.def_qos_parm.ac[0].cw_max = cpu_to_le16(cw_max);
priv->qos_data.def_qos_parm.ac[0].aifsn = aifs;
priv->qos_data.def_qos_parm.ac[0].edca_txop = 0;
priv->qos_data.def_qos_parm.ac[0].reserved1 = 0;
if (priv->qos_data.qos_active) {
i = 1;
priv->qos_data.def_qos_parm.ac[i].cw_min = cpu_to_le16(cw_min);
priv->qos_data.def_qos_parm.ac[i].cw_max = cpu_to_le16(cw_max);
priv->qos_data.def_qos_parm.ac[i].aifsn = 7;
priv->qos_data.def_qos_parm.ac[i].edca_txop = 0;
priv->qos_data.def_qos_parm.ac[i].reserved1 = 0;
i = 2;
priv->qos_data.def_qos_parm.ac[i].cw_min =
cpu_to_le16((cw_min + 1) / 2 - 1);
priv->qos_data.def_qos_parm.ac[i].cw_max =
cpu_to_le16(cw_max);
priv->qos_data.def_qos_parm.ac[i].aifsn = 2;
if (is_legacy)
priv->qos_data.def_qos_parm.ac[i].edca_txop =
cpu_to_le16(6016);
else
priv->qos_data.def_qos_parm.ac[i].edca_txop =
cpu_to_le16(3008);
priv->qos_data.def_qos_parm.ac[i].reserved1 = 0;
i = 3;
priv->qos_data.def_qos_parm.ac[i].cw_min =
cpu_to_le16((cw_min + 1) / 4 - 1);
priv->qos_data.def_qos_parm.ac[i].cw_max =
cpu_to_le16((cw_max + 1) / 2 - 1);
priv->qos_data.def_qos_parm.ac[i].aifsn = 2;
priv->qos_data.def_qos_parm.ac[i].reserved1 = 0;
if (is_legacy)
priv->qos_data.def_qos_parm.ac[i].edca_txop =
cpu_to_le16(3264);
else
priv->qos_data.def_qos_parm.ac[i].edca_txop =
cpu_to_le16(1504);
} else {
for (i = 1; i < 4; i++) {
priv->qos_data.def_qos_parm.ac[i].cw_min =
cpu_to_le16(cw_min);
priv->qos_data.def_qos_parm.ac[i].cw_max =
cpu_to_le16(cw_max);
priv->qos_data.def_qos_parm.ac[i].aifsn = aifs;
priv->qos_data.def_qos_parm.ac[i].edca_txop = 0;
priv->qos_data.def_qos_parm.ac[i].reserved1 = 0;
}
}
IWL_DEBUG_QOS("set QoS to default \n");
spin_unlock_irqrestore(&priv->lock, flags);
}
static void iwl3945_activate_qos(struct iwl_priv *priv, u8 force) static void iwl3945_activate_qos(struct iwl_priv *priv, u8 force)
{ {
unsigned long flags; unsigned long flags;
@ -2018,7 +1882,7 @@ static void iwl3945_setup_rxon_timing(struct iwl_priv *priv)
static int iwl3945_scan_initiate(struct iwl_priv *priv) static int iwl3945_scan_initiate(struct iwl_priv *priv)
{ {
if (!iwl3945_is_ready_rf(priv)) { if (!iwl_is_ready_rf(priv)) {
IWL_DEBUG_SCAN("Aborting scan due to not ready.\n"); IWL_DEBUG_SCAN("Aborting scan due to not ready.\n");
return -EIO; return -EIO;
} }
@ -2179,7 +2043,7 @@ static int iwl3945_set_mode(struct iwl_priv *priv, int mode)
iwl3945_clear_stations_table(priv); iwl3945_clear_stations_table(priv);
/* don't commit rxon if rf-kill is on*/ /* don't commit rxon if rf-kill is on*/
if (!iwl3945_is_ready_rf(priv)) if (!iwl_is_ready_rf(priv))
return -EAGAIN; return -EAGAIN;
cancel_delayed_work(&priv->scan_check); cancel_delayed_work(&priv->scan_check);
@ -2394,7 +2258,7 @@ static int iwl3945_tx_skb(struct iwl_priv *priv, struct sk_buff *skb)
int rc; int rc;
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
if (iwl3945_is_rfkill(priv)) { if (iwl_is_rfkill(priv)) {
IWL_DEBUG_DROP("Dropping - RF KILL\n"); IWL_DEBUG_DROP("Dropping - RF KILL\n");
goto drop_unlock; goto drop_unlock;
} }
@ -5614,7 +5478,7 @@ static void iwl3945_alive_start(struct iwl_priv *priv)
/* Clear out the uCode error bit if it is set */ /* Clear out the uCode error bit if it is set */
clear_bit(STATUS_FW_ERROR, &priv->status); clear_bit(STATUS_FW_ERROR, &priv->status);
if (iwl3945_is_rfkill(priv)) if (iwl_is_rfkill(priv))
return; return;
ieee80211_wake_queues(priv->hw); ieee80211_wake_queues(priv->hw);
@ -5708,7 +5572,7 @@ static void __iwl3945_down(struct iwl_priv *priv)
/* If we have not previously called iwl3945_init() then /* If we have not previously called iwl3945_init() then
* clear all bits but the RF Kill and SUSPEND bits and return */ * clear all bits but the RF Kill and SUSPEND bits and return */
if (!iwl3945_is_init(priv)) { if (!iwl_is_init(priv)) {
priv->status = test_bit(STATUS_RF_KILL_HW, &priv->status) << priv->status = test_bit(STATUS_RF_KILL_HW, &priv->status) <<
STATUS_RF_KILL_HW | STATUS_RF_KILL_HW |
test_bit(STATUS_RF_KILL_SW, &priv->status) << test_bit(STATUS_RF_KILL_SW, &priv->status) <<
@ -5920,7 +5784,7 @@ static void iwl3945_bg_rf_kill(struct work_struct *work)
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
if (!iwl3945_is_rfkill(priv)) { if (!iwl_is_rfkill(priv)) {
IWL_DEBUG(IWL_DL_INFO | IWL_DL_RF_KILL, IWL_DEBUG(IWL_DL_INFO | IWL_DL_RF_KILL,
"HW and/or SW RF Kill no longer active, restarting " "HW and/or SW RF Kill no longer active, restarting "
"device\n"); "device\n");
@ -5984,7 +5848,7 @@ static void iwl3945_bg_request_scan(struct work_struct *data)
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
if (!iwl3945_is_ready(priv)) { if (!iwl_is_ready(priv)) {
IWL_WARN(priv, "request scan called when driver not ready.\n"); IWL_WARN(priv, "request scan called when driver not ready.\n");
goto done; goto done;
} }
@ -6013,7 +5877,7 @@ static void iwl3945_bg_request_scan(struct work_struct *data)
goto done; goto done;
} }
if (iwl3945_is_rfkill(priv)) { if (iwl_is_rfkill(priv)) {
IWL_DEBUG_HC("Aborting scan due to RF Kill activation\n"); IWL_DEBUG_HC("Aborting scan due to RF Kill activation\n");
goto done; goto done;
} }
@ -6293,7 +6157,7 @@ static void iwl3945_bg_abort_scan(struct work_struct *work)
{ {
struct iwl_priv *priv = container_of(work, struct iwl_priv, abort_scan); struct iwl_priv *priv = container_of(work, struct iwl_priv, abort_scan);
if (!iwl3945_is_ready(priv)) if (!iwl_is_ready(priv))
return; return;
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
@ -6429,7 +6293,7 @@ static void iwl3945_mac_stop(struct ieee80211_hw *hw)
priv->is_open = 0; priv->is_open = 0;
if (iwl3945_is_ready_rf(priv)) { if (iwl_is_ready_rf(priv)) {
/* stop mac, cancel any scan request and clear /* stop mac, cancel any scan request and clear
* RXON_FILTER_ASSOC_MSK BIT * RXON_FILTER_ASSOC_MSK BIT
*/ */
@ -6491,7 +6355,7 @@ static int iwl3945_mac_add_interface(struct ieee80211_hw *hw,
memcpy(priv->mac_addr, conf->mac_addr, ETH_ALEN); memcpy(priv->mac_addr, conf->mac_addr, ETH_ALEN);
} }
if (iwl3945_is_ready(priv)) if (iwl_is_ready(priv))
iwl3945_set_mode(priv, conf->type); iwl3945_set_mode(priv, conf->type);
mutex_unlock(&priv->mutex); mutex_unlock(&priv->mutex);
@ -6518,7 +6382,7 @@ static int iwl3945_mac_config(struct ieee80211_hw *hw, u32 changed)
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
IWL_DEBUG_MAC80211("enter to channel %d\n", conf->channel->hw_value); IWL_DEBUG_MAC80211("enter to channel %d\n", conf->channel->hw_value);
if (!iwl3945_is_ready(priv)) { if (!iwl_is_ready(priv)) {
IWL_DEBUG_MAC80211("leave - not ready\n"); IWL_DEBUG_MAC80211("leave - not ready\n");
ret = -EIO; ret = -EIO;
goto out; goto out;
@ -6570,7 +6434,7 @@ static int iwl3945_mac_config(struct ieee80211_hw *hw, u32 changed)
goto out; goto out;
} }
if (iwl3945_is_rfkill(priv)) { if (iwl_is_rfkill(priv)) {
IWL_DEBUG_MAC80211("leave - RF kill\n"); IWL_DEBUG_MAC80211("leave - RF kill\n");
ret = -EIO; ret = -EIO;
goto out; goto out;
@ -6677,7 +6541,7 @@ static int iwl3945_mac_config_interface(struct ieee80211_hw *hw,
return rc; return rc;
} }
if (!iwl3945_is_alive(priv)) if (!iwl_is_alive(priv))
return -EAGAIN; return -EAGAIN;
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
@ -6705,7 +6569,7 @@ static int iwl3945_mac_config_interface(struct ieee80211_hw *hw,
priv->ibss_beacon = ieee80211_beacon_get(hw, vif); priv->ibss_beacon = ieee80211_beacon_get(hw, vif);
} }
if (iwl3945_is_rfkill(priv)) if (iwl_is_rfkill(priv))
goto done; goto done;
if (conf->bssid && !is_zero_ether_addr(conf->bssid) && if (conf->bssid && !is_zero_ether_addr(conf->bssid) &&
@ -6804,7 +6668,7 @@ static void iwl3945_mac_remove_interface(struct ieee80211_hw *hw,
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
if (iwl3945_is_ready_rf(priv)) { if (iwl_is_ready_rf(priv)) {
iwl3945_scan_cancel_timeout(priv, 100); iwl3945_scan_cancel_timeout(priv, 100);
priv->staging39_rxon.filter_flags &= ~RXON_FILTER_ASSOC_MSK; priv->staging39_rxon.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
iwl3945_commit_rxon(priv); iwl3945_commit_rxon(priv);
@ -6885,7 +6749,7 @@ static int iwl3945_mac_hw_scan(struct ieee80211_hw *hw, u8 *ssid, size_t len)
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
if (!iwl3945_is_ready_rf(priv)) { if (!iwl_is_ready_rf(priv)) {
rc = -EIO; rc = -EIO;
IWL_DEBUG_MAC80211("leave - not ready or exit pending\n"); IWL_DEBUG_MAC80211("leave - not ready or exit pending\n");
goto out_unlock; goto out_unlock;
@ -6994,7 +6858,7 @@ static int iwl3945_mac_conf_tx(struct ieee80211_hw *hw, u16 queue,
IWL_DEBUG_MAC80211("enter\n"); IWL_DEBUG_MAC80211("enter\n");
if (!iwl3945_is_ready_rf(priv)) { if (!iwl_is_ready_rf(priv)) {
IWL_DEBUG_MAC80211("leave - RF not ready\n"); IWL_DEBUG_MAC80211("leave - RF not ready\n");
return -EIO; return -EIO;
} }
@ -7042,7 +6906,7 @@ static int iwl3945_mac_get_tx_stats(struct ieee80211_hw *hw,
IWL_DEBUG_MAC80211("enter\n"); IWL_DEBUG_MAC80211("enter\n");
if (!iwl3945_is_ready_rf(priv)) { if (!iwl_is_ready_rf(priv)) {
IWL_DEBUG_MAC80211("leave - RF not ready\n"); IWL_DEBUG_MAC80211("leave - RF not ready\n");
return -EIO; return -EIO;
} }
@ -7074,7 +6938,7 @@ static void iwl3945_mac_reset_tsf(struct ieee80211_hw *hw)
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
IWL_DEBUG_MAC80211("enter\n"); IWL_DEBUG_MAC80211("enter\n");
iwl3945_reset_qos(priv); iwl_reset_qos(priv);
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
priv->assoc_id = 0; priv->assoc_id = 0;
@ -7094,7 +6958,7 @@ static void iwl3945_mac_reset_tsf(struct ieee80211_hw *hw)
spin_unlock_irqrestore(&priv->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
if (!iwl3945_is_ready_rf(priv)) { if (!iwl_is_ready_rf(priv)) {
IWL_DEBUG_MAC80211("leave - not ready\n"); IWL_DEBUG_MAC80211("leave - not ready\n");
mutex_unlock(&priv->mutex); mutex_unlock(&priv->mutex);
return; return;
@ -7132,7 +6996,7 @@ static int iwl3945_mac_beacon_update(struct ieee80211_hw *hw, struct sk_buff *sk
IWL_DEBUG_MAC80211("enter\n"); IWL_DEBUG_MAC80211("enter\n");
if (!iwl3945_is_ready_rf(priv)) { if (!iwl_is_ready_rf(priv)) {
IWL_DEBUG_MAC80211("leave - RF not ready\n"); IWL_DEBUG_MAC80211("leave - RF not ready\n");
return -EIO; return -EIO;
} }
@ -7154,7 +7018,7 @@ static int iwl3945_mac_beacon_update(struct ieee80211_hw *hw, struct sk_buff *sk
IWL_DEBUG_MAC80211("leave\n"); IWL_DEBUG_MAC80211("leave\n");
spin_unlock_irqrestore(&priv->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
iwl3945_reset_qos(priv); iwl_reset_qos(priv);
iwl3945_post_associate(priv); iwl3945_post_associate(priv);
@ -7211,7 +7075,7 @@ static ssize_t show_temperature(struct device *d,
{ {
struct iwl_priv *priv = (struct iwl_priv *)d->driver_data; struct iwl_priv *priv = (struct iwl_priv *)d->driver_data;
if (!iwl3945_is_alive(priv)) if (!iwl_is_alive(priv))
return -EAGAIN; return -EAGAIN;
return sprintf(buf, "%d\n", iwl3945_hw_get_temperature(priv)); return sprintf(buf, "%d\n", iwl3945_hw_get_temperature(priv));
@ -7423,7 +7287,7 @@ static ssize_t store_power_level(struct device *d,
mode = simple_strtoul(buf, NULL, 0); mode = simple_strtoul(buf, NULL, 0);
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
if (!iwl3945_is_ready(priv)) { if (!iwl_is_ready(priv)) {
rc = -EAGAIN; rc = -EAGAIN;
goto out; goto out;
} }
@ -7521,7 +7385,7 @@ static ssize_t show_statistics(struct device *d,
u8 *data = (u8 *)&priv->statistics_39; u8 *data = (u8 *)&priv->statistics_39;
int rc = 0; int rc = 0;
if (!iwl3945_is_alive(priv)) if (!iwl_is_alive(priv))
return -EAGAIN; return -EAGAIN;
mutex_lock(&priv->mutex); mutex_lock(&priv->mutex);
@ -7555,7 +7419,7 @@ static ssize_t show_antenna(struct device *d,
{ {
struct iwl_priv *priv = dev_get_drvdata(d); struct iwl_priv *priv = dev_get_drvdata(d);
if (!iwl3945_is_alive(priv)) if (!iwl_is_alive(priv))
return -EAGAIN; return -EAGAIN;
return sprintf(buf, "%d\n", priv->antenna); return sprintf(buf, "%d\n", priv->antenna);
@ -7592,7 +7456,7 @@ static ssize_t show_status(struct device *d,
struct device_attribute *attr, char *buf) struct device_attribute *attr, char *buf)
{ {
struct iwl_priv *priv = (struct iwl_priv *)d->driver_data; struct iwl_priv *priv = (struct iwl_priv *)d->driver_data;
if (!iwl3945_is_alive(priv)) if (!iwl_is_alive(priv))
return -EAGAIN; return -EAGAIN;
return sprintf(buf, "0x%08x\n", (int)priv->status); return sprintf(buf, "0x%08x\n", (int)priv->status);
} }
@ -7878,7 +7742,7 @@ static int iwl3945_pci_probe(struct pci_dev *pdev, const struct pci_device_id *e
priv->iw_mode = NL80211_IFTYPE_STATION; priv->iw_mode = NL80211_IFTYPE_STATION;
iwl3945_reset_qos(priv); iwl_reset_qos(priv);
priv->qos_data.qos_active = 0; priv->qos_data.qos_active = 0;
priv->qos_data.qos_cap.val = 0; priv->qos_data.qos_cap.val = 0;
@ -8099,7 +7963,7 @@ static int iwl3945_rfkill_soft_rf_kill(void *data, enum rfkill_state state)
switch (state) { switch (state) {
case RFKILL_STATE_UNBLOCKED: case RFKILL_STATE_UNBLOCKED:
if (iwl3945_is_rfkill_hw(priv)) { if (iwl_is_rfkill_hw(priv)) {
err = -EBUSY; err = -EBUSY;
goto out_unlock; goto out_unlock;
} }
@ -8176,12 +8040,12 @@ void iwl3945_rfkill_set_hw_state(struct iwl_priv *priv)
if (!priv->rfkill) if (!priv->rfkill)
return; return;
if (iwl3945_is_rfkill_hw(priv)) { if (iwl_is_rfkill_hw(priv)) {
rfkill_force_state(priv->rfkill, RFKILL_STATE_HARD_BLOCKED); rfkill_force_state(priv->rfkill, RFKILL_STATE_HARD_BLOCKED);
return; return;
} }
if (!iwl3945_is_rfkill_sw(priv)) if (!iwl_is_rfkill_sw(priv))
rfkill_force_state(priv->rfkill, RFKILL_STATE_UNBLOCKED); rfkill_force_state(priv->rfkill, RFKILL_STATE_UNBLOCKED);
else else
rfkill_force_state(priv->rfkill, RFKILL_STATE_SOFT_BLOCKED); rfkill_force_state(priv->rfkill, RFKILL_STATE_SOFT_BLOCKED);