|
@@ -231,6 +231,19 @@ static void ath_setup_rates(struct ath_softc *sc, enum ieee80211_band band)
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static struct ath9k_channel *ath_get_curchannel(struct ath_softc *sc,
|
|
|
|
+ struct ieee80211_hw *hw)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_channel *curchan = hw->conf.channel;
|
|
|
|
+ struct ath9k_channel *channel;
|
|
|
|
+ u8 chan_idx;
|
|
|
|
+
|
|
|
|
+ chan_idx = curchan->hw_value;
|
|
|
|
+ channel = &sc->sc_ah->channels[chan_idx];
|
|
|
|
+ ath9k_update_ichannel(sc, hw, channel);
|
|
|
|
+ return channel;
|
|
|
|
+}
|
|
|
|
+
|
|
/*
|
|
/*
|
|
* Set/change channels. If the channel is really being changed, it's done
|
|
* Set/change channels. If the channel is really being changed, it's done
|
|
* by reseting the chip. To accomplish this we must first cleanup any pending
|
|
* by reseting the chip. To accomplish this we must first cleanup any pending
|
|
@@ -283,7 +296,7 @@ int ath_set_channel(struct ath_softc *sc, struct ieee80211_hw *hw,
|
|
"reset status %d\n",
|
|
"reset status %d\n",
|
|
channel->center_freq, r);
|
|
channel->center_freq, r);
|
|
spin_unlock_bh(&sc->sc_resetlock);
|
|
spin_unlock_bh(&sc->sc_resetlock);
|
|
- return r;
|
|
|
|
|
|
+ goto ps_restore;
|
|
}
|
|
}
|
|
spin_unlock_bh(&sc->sc_resetlock);
|
|
spin_unlock_bh(&sc->sc_resetlock);
|
|
|
|
|
|
@@ -292,14 +305,17 @@ int ath_set_channel(struct ath_softc *sc, struct ieee80211_hw *hw,
|
|
if (ath_startrecv(sc) != 0) {
|
|
if (ath_startrecv(sc) != 0) {
|
|
DPRINTF(sc, ATH_DBG_FATAL,
|
|
DPRINTF(sc, ATH_DBG_FATAL,
|
|
"Unable to restart recv logic\n");
|
|
"Unable to restart recv logic\n");
|
|
- return -EIO;
|
|
|
|
|
|
+ r = -EIO;
|
|
|
|
+ goto ps_restore;
|
|
}
|
|
}
|
|
|
|
|
|
ath_cache_conf_rate(sc, &hw->conf);
|
|
ath_cache_conf_rate(sc, &hw->conf);
|
|
ath_update_txpow(sc);
|
|
ath_update_txpow(sc);
|
|
ath9k_hw_set_interrupts(ah, sc->imask);
|
|
ath9k_hw_set_interrupts(ah, sc->imask);
|
|
|
|
+
|
|
|
|
+ ps_restore:
|
|
ath9k_ps_restore(sc);
|
|
ath9k_ps_restore(sc);
|
|
- return 0;
|
|
|
|
|
|
+ return r;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
/*
|
|
@@ -1110,6 +1126,9 @@ void ath_radio_enable(struct ath_softc *sc)
|
|
ath9k_ps_wakeup(sc);
|
|
ath9k_ps_wakeup(sc);
|
|
ath9k_hw_configpcipowersave(ah, 0);
|
|
ath9k_hw_configpcipowersave(ah, 0);
|
|
|
|
|
|
|
|
+ if (!ah->curchan)
|
|
|
|
+ ah->curchan = ath_get_curchannel(sc, sc->hw);
|
|
|
|
+
|
|
spin_lock_bh(&sc->sc_resetlock);
|
|
spin_lock_bh(&sc->sc_resetlock);
|
|
r = ath9k_hw_reset(ah, ah->curchan, false);
|
|
r = ath9k_hw_reset(ah, ah->curchan, false);
|
|
if (r) {
|
|
if (r) {
|
|
@@ -1162,6 +1181,9 @@ void ath_radio_disable(struct ath_softc *sc)
|
|
ath_stoprecv(sc); /* turn off frame recv */
|
|
ath_stoprecv(sc); /* turn off frame recv */
|
|
ath_flushrecv(sc); /* flush recv queue */
|
|
ath_flushrecv(sc); /* flush recv queue */
|
|
|
|
|
|
|
|
+ if (!ah->curchan)
|
|
|
|
+ ah->curchan = ath_get_curchannel(sc, sc->hw);
|
|
|
|
+
|
|
spin_lock_bh(&sc->sc_resetlock);
|
|
spin_lock_bh(&sc->sc_resetlock);
|
|
r = ath9k_hw_reset(ah, ah->curchan, false);
|
|
r = ath9k_hw_reset(ah, ah->curchan, false);
|
|
if (r) {
|
|
if (r) {
|
|
@@ -1178,8 +1200,6 @@ void ath_radio_disable(struct ath_softc *sc)
|
|
ath9k_ps_restore(sc);
|
|
ath9k_ps_restore(sc);
|
|
}
|
|
}
|
|
|
|
|
|
-#if defined(CONFIG_RFKILL) || defined(CONFIG_RFKILL_MODULE)
|
|
|
|
-
|
|
|
|
/*******************/
|
|
/*******************/
|
|
/* Rfkill */
|
|
/* Rfkill */
|
|
/*******************/
|
|
/*******************/
|
|
@@ -1192,81 +1212,27 @@ static bool ath_is_rfkill_set(struct ath_softc *sc)
|
|
ah->rfkill_polarity;
|
|
ah->rfkill_polarity;
|
|
}
|
|
}
|
|
|
|
|
|
-/* s/w rfkill handlers */
|
|
|
|
-static int ath_rfkill_set_block(void *data, bool blocked)
|
|
|
|
|
|
+static void ath9k_rfkill_poll_state(struct ieee80211_hw *hw)
|
|
{
|
|
{
|
|
- struct ath_softc *sc = data;
|
|
|
|
-
|
|
|
|
- if (blocked)
|
|
|
|
- ath_radio_disable(sc);
|
|
|
|
- else
|
|
|
|
- ath_radio_enable(sc);
|
|
|
|
-
|
|
|
|
- return 0;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-static void ath_rfkill_poll_state(struct rfkill *rfkill, void *data)
|
|
|
|
-{
|
|
|
|
- struct ath_softc *sc = data;
|
|
|
|
|
|
+ struct ath_wiphy *aphy = hw->priv;
|
|
|
|
+ struct ath_softc *sc = aphy->sc;
|
|
bool blocked = !!ath_is_rfkill_set(sc);
|
|
bool blocked = !!ath_is_rfkill_set(sc);
|
|
|
|
|
|
- if (rfkill_set_hw_state(rfkill, blocked))
|
|
|
|
|
|
+ wiphy_rfkill_set_hw_state(hw->wiphy, blocked);
|
|
|
|
+
|
|
|
|
+ if (blocked)
|
|
ath_radio_disable(sc);
|
|
ath_radio_disable(sc);
|
|
else
|
|
else
|
|
ath_radio_enable(sc);
|
|
ath_radio_enable(sc);
|
|
}
|
|
}
|
|
|
|
|
|
-/* Init s/w rfkill */
|
|
|
|
-static int ath_init_sw_rfkill(struct ath_softc *sc)
|
|
|
|
-{
|
|
|
|
- sc->rf_kill.ops.set_block = ath_rfkill_set_block;
|
|
|
|
- if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
|
|
|
|
- sc->rf_kill.ops.poll = ath_rfkill_poll_state;
|
|
|
|
-
|
|
|
|
- snprintf(sc->rf_kill.rfkill_name, sizeof(sc->rf_kill.rfkill_name),
|
|
|
|
- "ath9k-%s::rfkill", wiphy_name(sc->hw->wiphy));
|
|
|
|
-
|
|
|
|
- sc->rf_kill.rfkill = rfkill_alloc(sc->rf_kill.rfkill_name,
|
|
|
|
- wiphy_dev(sc->hw->wiphy),
|
|
|
|
- RFKILL_TYPE_WLAN,
|
|
|
|
- &sc->rf_kill.ops, sc);
|
|
|
|
- if (!sc->rf_kill.rfkill) {
|
|
|
|
- DPRINTF(sc, ATH_DBG_FATAL, "Failed to allocate rfkill\n");
|
|
|
|
- return -ENOMEM;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- return 0;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-/* Deinitialize rfkill */
|
|
|
|
-static void ath_deinit_rfkill(struct ath_softc *sc)
|
|
|
|
-{
|
|
|
|
- if (sc->sc_flags & SC_OP_RFKILL_REGISTERED) {
|
|
|
|
- rfkill_unregister(sc->rf_kill.rfkill);
|
|
|
|
- rfkill_destroy(sc->rf_kill.rfkill);
|
|
|
|
- sc->sc_flags &= ~SC_OP_RFKILL_REGISTERED;
|
|
|
|
- }
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-static int ath_start_rfkill_poll(struct ath_softc *sc)
|
|
|
|
|
|
+static void ath_start_rfkill_poll(struct ath_softc *sc)
|
|
{
|
|
{
|
|
- if (!(sc->sc_flags & SC_OP_RFKILL_REGISTERED)) {
|
|
|
|
- if (rfkill_register(sc->rf_kill.rfkill)) {
|
|
|
|
- DPRINTF(sc, ATH_DBG_FATAL,
|
|
|
|
- "Unable to register rfkill\n");
|
|
|
|
- rfkill_destroy(sc->rf_kill.rfkill);
|
|
|
|
-
|
|
|
|
- /* Deinitialize the device */
|
|
|
|
- ath_cleanup(sc);
|
|
|
|
- return -EIO;
|
|
|
|
- } else {
|
|
|
|
- sc->sc_flags |= SC_OP_RFKILL_REGISTERED;
|
|
|
|
- }
|
|
|
|
- }
|
|
|
|
|
|
+ struct ath_hw *ah = sc->sc_ah;
|
|
|
|
|
|
- return 0;
|
|
|
|
|
|
+ if (ah->caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
|
|
|
|
+ wiphy_rfkill_start_polling(sc->hw->wiphy);
|
|
}
|
|
}
|
|
-#endif /* CONFIG_RFKILL */
|
|
|
|
|
|
|
|
void ath_cleanup(struct ath_softc *sc)
|
|
void ath_cleanup(struct ath_softc *sc)
|
|
{
|
|
{
|
|
@@ -1286,9 +1252,6 @@ void ath_detach(struct ath_softc *sc)
|
|
|
|
|
|
DPRINTF(sc, ATH_DBG_CONFIG, "Detach ATH hw\n");
|
|
DPRINTF(sc, ATH_DBG_CONFIG, "Detach ATH hw\n");
|
|
|
|
|
|
-#if defined(CONFIG_RFKILL) || defined(CONFIG_RFKILL_MODULE)
|
|
|
|
- ath_deinit_rfkill(sc);
|
|
|
|
-#endif
|
|
|
|
ath_deinit_leds(sc);
|
|
ath_deinit_leds(sc);
|
|
cancel_work_sync(&sc->chan_work);
|
|
cancel_work_sync(&sc->chan_work);
|
|
cancel_delayed_work_sync(&sc->wiphy_work);
|
|
cancel_delayed_work_sync(&sc->wiphy_work);
|
|
@@ -1626,13 +1589,6 @@ int ath_attach(u16 devid, struct ath_softc *sc)
|
|
if (error != 0)
|
|
if (error != 0)
|
|
goto error_attach;
|
|
goto error_attach;
|
|
|
|
|
|
-#if defined(CONFIG_RFKILL) || defined(CONFIG_RFKILL_MODULE)
|
|
|
|
- /* Initialize s/w rfkill */
|
|
|
|
- error = ath_init_sw_rfkill(sc);
|
|
|
|
- if (error)
|
|
|
|
- goto error_attach;
|
|
|
|
-#endif
|
|
|
|
-
|
|
|
|
INIT_WORK(&sc->chan_work, ath9k_wiphy_chan_work);
|
|
INIT_WORK(&sc->chan_work, ath9k_wiphy_chan_work);
|
|
INIT_DELAYED_WORK(&sc->wiphy_work, ath9k_wiphy_work);
|
|
INIT_DELAYED_WORK(&sc->wiphy_work, ath9k_wiphy_work);
|
|
sc->wiphy_scheduler_int = msecs_to_jiffies(500);
|
|
sc->wiphy_scheduler_int = msecs_to_jiffies(500);
|
|
@@ -1648,6 +1604,7 @@ int ath_attach(u16 devid, struct ath_softc *sc)
|
|
/* Initialize LED control */
|
|
/* Initialize LED control */
|
|
ath_init_leds(sc);
|
|
ath_init_leds(sc);
|
|
|
|
|
|
|
|
+ ath_start_rfkill_poll(sc);
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
@@ -1920,7 +1877,7 @@ static int ath9k_start(struct ieee80211_hw *hw)
|
|
struct ath_softc *sc = aphy->sc;
|
|
struct ath_softc *sc = aphy->sc;
|
|
struct ieee80211_channel *curchan = hw->conf.channel;
|
|
struct ieee80211_channel *curchan = hw->conf.channel;
|
|
struct ath9k_channel *init_channel;
|
|
struct ath9k_channel *init_channel;
|
|
- int r, pos;
|
|
|
|
|
|
+ int r;
|
|
|
|
|
|
DPRINTF(sc, ATH_DBG_CONFIG, "Starting driver with "
|
|
DPRINTF(sc, ATH_DBG_CONFIG, "Starting driver with "
|
|
"initial channel: %d MHz\n", curchan->center_freq);
|
|
"initial channel: %d MHz\n", curchan->center_freq);
|
|
@@ -1950,11 +1907,9 @@ static int ath9k_start(struct ieee80211_hw *hw)
|
|
|
|
|
|
/* setup initial channel */
|
|
/* setup initial channel */
|
|
|
|
|
|
- pos = curchan->hw_value;
|
|
|
|
|
|
+ sc->chan_idx = curchan->hw_value;
|
|
|
|
|
|
- sc->chan_idx = pos;
|
|
|
|
- init_channel = &sc->sc_ah->channels[pos];
|
|
|
|
- ath9k_update_ichannel(sc, hw, init_channel);
|
|
|
|
|
|
+ init_channel = ath_get_curchannel(sc, hw);
|
|
|
|
|
|
/* Reset SERDES registers */
|
|
/* Reset SERDES registers */
|
|
ath9k_hw_configpcipowersave(sc->sc_ah, 0);
|
|
ath9k_hw_configpcipowersave(sc->sc_ah, 0);
|
|
@@ -2018,10 +1973,6 @@ static int ath9k_start(struct ieee80211_hw *hw)
|
|
|
|
|
|
ieee80211_wake_queues(hw);
|
|
ieee80211_wake_queues(hw);
|
|
|
|
|
|
-#if defined(CONFIG_RFKILL) || defined(CONFIG_RFKILL_MODULE)
|
|
|
|
- r = ath_start_rfkill_poll(sc);
|
|
|
|
-#endif
|
|
|
|
-
|
|
|
|
mutex_unlock:
|
|
mutex_unlock:
|
|
mutex_unlock(&sc->mutex);
|
|
mutex_unlock(&sc->mutex);
|
|
|
|
|
|
@@ -2159,7 +2110,7 @@ static void ath9k_stop(struct ieee80211_hw *hw)
|
|
} else
|
|
} else
|
|
sc->rx.rxlink = NULL;
|
|
sc->rx.rxlink = NULL;
|
|
|
|
|
|
- rfkill_pause_polling(sc->rf_kill.rfkill);
|
|
|
|
|
|
+ wiphy_rfkill_stop_polling(sc->hw->wiphy);
|
|
|
|
|
|
/* disable HAL and put h/w to sleep */
|
|
/* disable HAL and put h/w to sleep */
|
|
ath9k_hw_disable(sc->sc_ah);
|
|
ath9k_hw_disable(sc->sc_ah);
|
|
@@ -2765,6 +2716,7 @@ struct ieee80211_ops ath9k_ops = {
|
|
.ampdu_action = ath9k_ampdu_action,
|
|
.ampdu_action = ath9k_ampdu_action,
|
|
.sw_scan_start = ath9k_sw_scan_start,
|
|
.sw_scan_start = ath9k_sw_scan_start,
|
|
.sw_scan_complete = ath9k_sw_scan_complete,
|
|
.sw_scan_complete = ath9k_sw_scan_complete,
|
|
|
|
+ .rfkill_poll = ath9k_rfkill_poll_state,
|
|
};
|
|
};
|
|
|
|
|
|
static struct {
|
|
static struct {
|