blob: a7656a3ea1b098d661eafd7f304b5440937bca00 [file] [log] [blame]
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001/*
2 * Copyright (c) 2008 Atheros Communications Inc.
3 *
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
7 *
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 */
16
17/* mac80211 and PCI callbacks */
18
19#include <linux/nl80211.h>
20#include "core.h"
21
22#define ATH_PCI_VERSION "0.1"
23
24#define IEEE80211_HTCAP_MAXRXAMPDU_FACTOR 13
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070025
26static char *dev_info = "ath9k";
27
28MODULE_AUTHOR("Atheros Communications");
29MODULE_DESCRIPTION("Support for Atheros 802.11n wireless LAN cards.");
30MODULE_SUPPORTED_DEVICE("Atheros 802.11n WLAN cards");
31MODULE_LICENSE("Dual BSD/GPL");
32
33static struct pci_device_id ath_pci_id_table[] __devinitdata = {
34 { PCI_VDEVICE(ATHEROS, 0x0023) }, /* PCI */
35 { PCI_VDEVICE(ATHEROS, 0x0024) }, /* PCI-E */
36 { PCI_VDEVICE(ATHEROS, 0x0027) }, /* PCI */
37 { PCI_VDEVICE(ATHEROS, 0x0029) }, /* PCI */
38 { PCI_VDEVICE(ATHEROS, 0x002A) }, /* PCI-E */
39 { 0 }
40};
41
42static int ath_get_channel(struct ath_softc *sc,
43 struct ieee80211_channel *chan)
44{
45 int i;
46
47 for (i = 0; i < sc->sc_ah->ah_nchan; i++) {
48 if (sc->sc_ah->ah_channels[i].channel == chan->center_freq)
49 return i;
50 }
51
52 return -1;
53}
54
55static u32 ath_get_extchanmode(struct ath_softc *sc,
56 struct ieee80211_channel *chan)
57{
58 u32 chanmode = 0;
59 u8 ext_chan_offset = sc->sc_ht_info.ext_chan_offset;
60 enum ath9k_ht_macmode tx_chan_width = sc->sc_ht_info.tx_chan_width;
61
62 switch (chan->band) {
63 case IEEE80211_BAND_2GHZ:
Johannes Bergd9fe60d2008-10-09 12:13:49 +020064 if ((ext_chan_offset == IEEE80211_HT_PARAM_CHA_SEC_NONE) &&
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070065 (tx_chan_width == ATH9K_HT_MACMODE_20))
66 chanmode = CHANNEL_G_HT20;
Johannes Bergd9fe60d2008-10-09 12:13:49 +020067 if ((ext_chan_offset == IEEE80211_HT_PARAM_CHA_SEC_ABOVE) &&
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070068 (tx_chan_width == ATH9K_HT_MACMODE_2040))
69 chanmode = CHANNEL_G_HT40PLUS;
Johannes Bergd9fe60d2008-10-09 12:13:49 +020070 if ((ext_chan_offset == IEEE80211_HT_PARAM_CHA_SEC_BELOW) &&
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070071 (tx_chan_width == ATH9K_HT_MACMODE_2040))
72 chanmode = CHANNEL_G_HT40MINUS;
73 break;
74 case IEEE80211_BAND_5GHZ:
Johannes Bergd9fe60d2008-10-09 12:13:49 +020075 if ((ext_chan_offset == IEEE80211_HT_PARAM_CHA_SEC_NONE) &&
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070076 (tx_chan_width == ATH9K_HT_MACMODE_20))
77 chanmode = CHANNEL_A_HT20;
Johannes Bergd9fe60d2008-10-09 12:13:49 +020078 if ((ext_chan_offset == IEEE80211_HT_PARAM_CHA_SEC_ABOVE) &&
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070079 (tx_chan_width == ATH9K_HT_MACMODE_2040))
80 chanmode = CHANNEL_A_HT40PLUS;
Johannes Bergd9fe60d2008-10-09 12:13:49 +020081 if ((ext_chan_offset == IEEE80211_HT_PARAM_CHA_SEC_BELOW) &&
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070082 (tx_chan_width == ATH9K_HT_MACMODE_2040))
83 chanmode = CHANNEL_A_HT40MINUS;
84 break;
85 default:
86 break;
87 }
88
89 return chanmode;
90}
91
92
93static int ath_setkey_tkip(struct ath_softc *sc,
94 struct ieee80211_key_conf *key,
95 struct ath9k_keyval *hk,
96 const u8 *addr)
97{
98 u8 *key_rxmic = NULL;
99 u8 *key_txmic = NULL;
100
101 key_txmic = key->key + NL80211_TKIP_DATA_OFFSET_TX_MIC_KEY;
102 key_rxmic = key->key + NL80211_TKIP_DATA_OFFSET_RX_MIC_KEY;
103
104 if (addr == NULL) {
105 /* Group key installation */
106 memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic));
107 return ath_keyset(sc, key->keyidx, hk, addr);
108 }
109 if (!sc->sc_splitmic) {
110 /*
111 * data key goes at first index,
112 * the hal handles the MIC keys at index+64.
113 */
114 memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic));
115 memcpy(hk->kv_txmic, key_txmic, sizeof(hk->kv_txmic));
116 return ath_keyset(sc, key->keyidx, hk, addr);
117 }
118 /*
119 * TX key goes at first index, RX key at +32.
120 * The hal handles the MIC keys at index+64.
121 */
122 memcpy(hk->kv_mic, key_txmic, sizeof(hk->kv_mic));
123 if (!ath_keyset(sc, key->keyidx, hk, NULL)) {
124 /* Txmic entry failed. No need to proceed further */
125 DPRINTF(sc, ATH_DBG_KEYCACHE,
126 "%s Setting TX MIC Key Failed\n", __func__);
127 return 0;
128 }
129
130 memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic));
131 /* XXX delete tx key on failure? */
132 return ath_keyset(sc, key->keyidx+32, hk, addr);
133}
134
135static int ath_key_config(struct ath_softc *sc,
136 const u8 *addr,
137 struct ieee80211_key_conf *key)
138{
139 struct ieee80211_vif *vif;
140 struct ath9k_keyval hk;
141 const u8 *mac = NULL;
142 int ret = 0;
Johannes Berg05c914f2008-09-11 00:01:58 +0200143 enum nl80211_iftype opmode;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700144
145 memset(&hk, 0, sizeof(hk));
146
147 switch (key->alg) {
148 case ALG_WEP:
149 hk.kv_type = ATH9K_CIPHER_WEP;
150 break;
151 case ALG_TKIP:
152 hk.kv_type = ATH9K_CIPHER_TKIP;
153 break;
154 case ALG_CCMP:
155 hk.kv_type = ATH9K_CIPHER_AES_CCM;
156 break;
157 default:
158 return -EINVAL;
159 }
160
161 hk.kv_len = key->keylen;
162 memcpy(hk.kv_val, key->key, key->keylen);
163
164 if (!sc->sc_vaps[0])
165 return -EIO;
166
167 vif = sc->sc_vaps[0]->av_if_data;
168 opmode = vif->type;
169
170 /*
171 * Strategy:
172 * For _M_STA mc tx, we will not setup a key at all since we never
173 * tx mc.
174 * _M_STA mc rx, we will use the keyID.
175 * for _M_IBSS mc tx, we will use the keyID, and no macaddr.
176 * for _M_IBSS mc rx, we will alloc a slot and plumb the mac of the
177 * peer node. BUT we will plumb a cleartext key so that we can do
178 * perSta default key table lookup in software.
179 */
180 if (is_broadcast_ether_addr(addr)) {
181 switch (opmode) {
Johannes Berg05c914f2008-09-11 00:01:58 +0200182 case NL80211_IFTYPE_STATION:
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700183 /* default key: could be group WPA key
184 * or could be static WEP key */
185 mac = NULL;
186 break;
Johannes Berg05c914f2008-09-11 00:01:58 +0200187 case NL80211_IFTYPE_ADHOC:
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700188 break;
Johannes Berg05c914f2008-09-11 00:01:58 +0200189 case NL80211_IFTYPE_AP:
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700190 break;
191 default:
192 ASSERT(0);
193 break;
194 }
195 } else {
196 mac = addr;
197 }
198
199 if (key->alg == ALG_TKIP)
200 ret = ath_setkey_tkip(sc, key, &hk, mac);
201 else
202 ret = ath_keyset(sc, key->keyidx, &hk, mac);
203
204 if (!ret)
205 return -EIO;
206
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700207 return 0;
208}
209
210static void ath_key_delete(struct ath_softc *sc, struct ieee80211_key_conf *key)
211{
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700212 int freeslot;
213
Sujithff9b6622008-08-14 13:27:16 +0530214 freeslot = (key->keyidx >= 4) ? 1 : 0;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700215 ath_key_reset(sc, key->keyidx, freeslot);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700216}
217
Johannes Bergd9fe60d2008-10-09 12:13:49 +0200218static void setup_ht_cap(struct ieee80211_sta_ht_cap *ht_info)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700219{
Sujith60653672008-08-14 13:28:02 +0530220#define ATH9K_HT_CAP_MAXRXAMPDU_65536 0x3 /* 2 ^ 16 */
221#define ATH9K_HT_CAP_MPDUDENSITY_8 0x6 /* 8 usec */
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700222
Johannes Bergd9fe60d2008-10-09 12:13:49 +0200223 ht_info->ht_supported = true;
224 ht_info->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 |
225 IEEE80211_HT_CAP_SM_PS |
226 IEEE80211_HT_CAP_SGI_40 |
227 IEEE80211_HT_CAP_DSSSCCK40;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700228
Sujith60653672008-08-14 13:28:02 +0530229 ht_info->ampdu_factor = ATH9K_HT_CAP_MAXRXAMPDU_65536;
230 ht_info->ampdu_density = ATH9K_HT_CAP_MPDUDENSITY_8;
Johannes Bergd9fe60d2008-10-09 12:13:49 +0200231 /* set up supported mcs set */
232 memset(&ht_info->mcs, 0, sizeof(ht_info->mcs));
233 ht_info->mcs.rx_mask[0] = 0xff;
234 ht_info->mcs.rx_mask[1] = 0xff;
235 ht_info->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700236}
237
238static int ath_rate2idx(struct ath_softc *sc, int rate)
239{
240 int i = 0, cur_band, n_rates;
241 struct ieee80211_hw *hw = sc->hw;
242
243 cur_band = hw->conf.channel->band;
244 n_rates = sc->sbands[cur_band].n_bitrates;
245
246 for (i = 0; i < n_rates; i++) {
247 if (sc->sbands[cur_band].bitrates[i].bitrate == rate)
248 break;
249 }
250
251 /*
252 * NB:mac80211 validates rx rate index against the supported legacy rate
253 * index only (should be done against ht rates also), return the highest
254 * legacy rate index for rx rate which does not match any one of the
255 * supported basic and extended rates to make mac80211 happy.
256 * The following hack will be cleaned up once the issue with
257 * the rx rate index validation in mac80211 is fixed.
258 */
259 if (i == n_rates)
260 return n_rates - 1;
261 return i;
262}
263
264static void ath9k_rx_prepare(struct ath_softc *sc,
265 struct sk_buff *skb,
266 struct ath_recv_status *status,
267 struct ieee80211_rx_status *rx_status)
268{
269 struct ieee80211_hw *hw = sc->hw;
270 struct ieee80211_channel *curchan = hw->conf.channel;
271
272 memset(rx_status, 0, sizeof(struct ieee80211_rx_status));
273
274 rx_status->mactime = status->tsf;
275 rx_status->band = curchan->band;
276 rx_status->freq = curchan->center_freq;
Luis R. Rodriguez6f255422008-10-03 15:45:27 -0700277 rx_status->noise = sc->sc_ani.sc_noise_floor;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700278 rx_status->signal = rx_status->noise + status->rssi;
279 rx_status->rate_idx = ath_rate2idx(sc, (status->rateKbps / 100));
280 rx_status->antenna = status->antenna;
Luis R. Rodriguez6f255422008-10-03 15:45:27 -0700281
Luis R. Rodriguezc49d1542008-10-13 14:08:09 -0700282 /* at 45 you will be able to use MCS 15 reliably. A more elaborate
283 * scheme can be used here but it requires tables of SNR/throughput for
284 * each possible mode used. */
285 rx_status->qual = status->rssi * 100 / 45;
286
287 /* rssi can be more than 45 though, anything above that
288 * should be considered at 100% */
289 if (rx_status->qual > 100)
290 rx_status->qual = 100;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700291
292 if (status->flags & ATH_RX_MIC_ERROR)
293 rx_status->flag |= RX_FLAG_MMIC_ERROR;
294 if (status->flags & ATH_RX_FCS_ERROR)
295 rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
296
297 rx_status->flag |= RX_FLAG_TSFT;
298}
299
300static u8 parse_mpdudensity(u8 mpdudensity)
301{
302 /*
303 * 802.11n D2.0 defined values for "Minimum MPDU Start Spacing":
304 * 0 for no restriction
305 * 1 for 1/4 us
306 * 2 for 1/2 us
307 * 3 for 1 us
308 * 4 for 2 us
309 * 5 for 4 us
310 * 6 for 8 us
311 * 7 for 16 us
312 */
313 switch (mpdudensity) {
314 case 0:
315 return 0;
316 case 1:
317 case 2:
318 case 3:
319 /* Our lower layer calculations limit our precision to
320 1 microsecond */
321 return 1;
322 case 4:
323 return 2;
324 case 5:
325 return 4;
326 case 6:
327 return 8;
328 case 7:
329 return 16;
330 default:
331 return 0;
332 }
333}
334
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530335static void ath9k_ht_conf(struct ath_softc *sc,
336 struct ieee80211_bss_conf *bss_conf)
337{
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530338 struct ath_ht_info *ht_info = &sc->sc_ht_info;
339
Johannes Bergae5eb022008-10-14 16:58:37 +0200340 if (sc->hw->conf.ht.enabled) {
341 ht_info->ext_chan_offset = bss_conf->ht.secondary_channel_offset;
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530342
Johannes Bergae5eb022008-10-14 16:58:37 +0200343 if (bss_conf->ht.width_40_ok)
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530344 ht_info->tx_chan_width = ATH9K_HT_MACMODE_2040;
345 else
346 ht_info->tx_chan_width = ATH9K_HT_MACMODE_20;
347
348 ath9k_hw_set11nmac2040(sc->sc_ah, ht_info->tx_chan_width);
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530349 }
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530350}
351
352static void ath9k_bss_assoc_info(struct ath_softc *sc,
353 struct ieee80211_bss_conf *bss_conf)
354{
355 struct ieee80211_hw *hw = sc->hw;
356 struct ieee80211_channel *curchan = hw->conf.channel;
357 struct ath_vap *avp;
358 int pos;
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530359
360 if (bss_conf->assoc) {
361 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Bss Info ASSOC %d\n",
362 __func__,
363 bss_conf->aid);
364
365 avp = sc->sc_vaps[0];
366 if (avp == NULL) {
367 DPRINTF(sc, ATH_DBG_FATAL, "%s: Invalid interface\n",
368 __func__);
369 return;
370 }
371
372 /* New association, store aid */
373 if (avp->av_opmode == ATH9K_M_STA) {
374 sc->sc_curaid = bss_conf->aid;
375 ath9k_hw_write_associd(sc->sc_ah, sc->sc_curbssid,
376 sc->sc_curaid);
377 }
378
379 /* Configure the beacon */
380 ath_beacon_config(sc, 0);
381 sc->sc_flags |= SC_OP_BEACONS;
382
383 /* Reset rssi stats */
384 sc->sc_halstats.ns_avgbrssi = ATH_RSSI_DUMMY_MARKER;
385 sc->sc_halstats.ns_avgrssi = ATH_RSSI_DUMMY_MARKER;
386 sc->sc_halstats.ns_avgtxrssi = ATH_RSSI_DUMMY_MARKER;
387 sc->sc_halstats.ns_avgtxrate = ATH_RATE_DUMMY_MARKER;
388
389 /* Update chainmask */
Johannes Bergae5eb022008-10-14 16:58:37 +0200390 ath_update_chainmask(sc, hw->conf.ht.enabled);
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530391
392 DPRINTF(sc, ATH_DBG_CONFIG,
Johannes Berge1749612008-10-27 15:59:26 -0700393 "%s: bssid %pM aid 0x%x\n",
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530394 __func__,
Johannes Berge1749612008-10-27 15:59:26 -0700395 sc->sc_curbssid, sc->sc_curaid);
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530396
397 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Set channel: %d MHz\n",
398 __func__,
399 curchan->center_freq);
400
401 pos = ath_get_channel(sc, curchan);
402 if (pos == -1) {
403 DPRINTF(sc, ATH_DBG_FATAL,
404 "%s: Invalid channel\n", __func__);
405 return;
406 }
407
Johannes Bergae5eb022008-10-14 16:58:37 +0200408 if (hw->conf.ht.enabled)
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530409 sc->sc_ah->ah_channels[pos].chanmode =
410 ath_get_extchanmode(sc, curchan);
411 else
412 sc->sc_ah->ah_channels[pos].chanmode =
413 (curchan->band == IEEE80211_BAND_2GHZ) ?
414 CHANNEL_G : CHANNEL_A;
415
416 /* set h/w channel */
417 if (ath_set_channel(sc, &sc->sc_ah->ah_channels[pos]) < 0)
418 DPRINTF(sc, ATH_DBG_FATAL,
419 "%s: Unable to set channel\n",
420 __func__);
421
422 ath_rate_newstate(sc, avp);
423 /* Update ratectrl about the new state */
424 ath_rc_node_update(hw, avp->rc_node);
Luis R. Rodriguez6f255422008-10-03 15:45:27 -0700425
426 /* Start ANI */
427 mod_timer(&sc->sc_ani.timer,
428 jiffies + msecs_to_jiffies(ATH_ANI_POLLINTERVAL));
429
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530430 } else {
431 DPRINTF(sc, ATH_DBG_CONFIG,
432 "%s: Bss Info DISSOC\n", __func__);
433 sc->sc_curaid = 0;
434 }
435}
436
437void ath_get_beaconconfig(struct ath_softc *sc,
438 int if_id,
439 struct ath_beacon_config *conf)
440{
441 struct ieee80211_hw *hw = sc->hw;
442
443 /* fill in beacon config data */
444
445 conf->beacon_interval = hw->conf.beacon_int;
446 conf->listen_interval = 100;
447 conf->dtim_count = 1;
448 conf->bmiss_timeout = ATH_DEFAULT_BMISS_LIMIT * conf->listen_interval;
449}
450
451void ath_tx_complete(struct ath_softc *sc, struct sk_buff *skb,
452 struct ath_xmit_status *tx_status, struct ath_node *an)
453{
454 struct ieee80211_hw *hw = sc->hw;
455 struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
456
457 DPRINTF(sc, ATH_DBG_XMIT,
458 "%s: TX complete: skb: %p\n", __func__, skb);
459
Johannes Berge6a98542008-10-21 12:40:02 +0200460 ieee80211_tx_info_clear_status(tx_info);
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530461 if (tx_info->flags & IEEE80211_TX_CTL_NO_ACK ||
462 tx_info->flags & IEEE80211_TX_STAT_TX_FILTERED) {
Johannes Berge6a98542008-10-21 12:40:02 +0200463 /* free driver's private data area of tx_info, XXX: HACK! */
464 if (tx_info->control.vif != NULL)
465 kfree(tx_info->control.vif);
466 tx_info->control.vif = NULL;
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530467 }
468
469 if (tx_status->flags & ATH_TX_BAR) {
470 tx_info->flags |= IEEE80211_TX_STAT_AMPDU_NO_BACK;
471 tx_status->flags &= ~ATH_TX_BAR;
472 }
473
Johannes Berge6a98542008-10-21 12:40:02 +0200474 if (!(tx_status->flags & (ATH_TX_ERROR | ATH_TX_XRETRY))) {
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530475 /* Frame was ACKed */
476 tx_info->flags |= IEEE80211_TX_STAT_ACK;
477 }
478
Johannes Berge6a98542008-10-21 12:40:02 +0200479 tx_info->status.rates[0].count = tx_status->retries + 1;
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530480
481 ieee80211_tx_status(hw, skb);
482 if (an)
483 ath_node_put(sc, an, ATH9K_BH_STATUS_CHANGE);
484}
485
486int _ath_rx_indicate(struct ath_softc *sc,
487 struct sk_buff *skb,
488 struct ath_recv_status *status,
489 u16 keyix)
490{
491 struct ieee80211_hw *hw = sc->hw;
492 struct ath_node *an = NULL;
493 struct ieee80211_rx_status rx_status;
494 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
495 int hdrlen = ieee80211_get_hdrlen_from_skb(skb);
496 int padsize;
497 enum ATH_RX_TYPE st;
498
499 /* see if any padding is done by the hw and remove it */
500 if (hdrlen & 3) {
501 padsize = hdrlen % 4;
502 memmove(skb->data + padsize, skb->data, hdrlen);
503 skb_pull(skb, padsize);
504 }
505
506 /* Prepare rx status */
507 ath9k_rx_prepare(sc, skb, status, &rx_status);
508
509 if (!(keyix == ATH9K_RXKEYIX_INVALID) &&
510 !(status->flags & ATH_RX_DECRYPT_ERROR)) {
511 rx_status.flag |= RX_FLAG_DECRYPTED;
512 } else if ((le16_to_cpu(hdr->frame_control) & IEEE80211_FCTL_PROTECTED)
513 && !(status->flags & ATH_RX_DECRYPT_ERROR)
514 && skb->len >= hdrlen + 4) {
515 keyix = skb->data[hdrlen + 3] >> 6;
516
517 if (test_bit(keyix, sc->sc_keymap))
518 rx_status.flag |= RX_FLAG_DECRYPTED;
519 }
520
521 spin_lock_bh(&sc->node_lock);
522 an = ath_node_find(sc, hdr->addr2);
523 spin_unlock_bh(&sc->node_lock);
524
525 if (an) {
526 ath_rx_input(sc, an,
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530527 skb, status, &st);
528 }
529 if (!an || (st != ATH_RX_CONSUMED))
530 __ieee80211_rx(hw, skb, &rx_status);
531
532 return 0;
533}
534
535int ath_rx_subframe(struct ath_node *an,
536 struct sk_buff *skb,
537 struct ath_recv_status *status)
538{
539 struct ath_softc *sc = an->an_sc;
540 struct ieee80211_hw *hw = sc->hw;
541 struct ieee80211_rx_status rx_status;
542
543 /* Prepare rx status */
544 ath9k_rx_prepare(sc, skb, status, &rx_status);
545 if (!(status->flags & ATH_RX_DECRYPT_ERROR))
546 rx_status.flag |= RX_FLAG_DECRYPTED;
547
548 __ieee80211_rx(hw, skb, &rx_status);
549
550 return 0;
551}
552
553/********************************/
554/* LED functions */
555/********************************/
556
557static void ath_led_brightness(struct led_classdev *led_cdev,
558 enum led_brightness brightness)
559{
560 struct ath_led *led = container_of(led_cdev, struct ath_led, led_cdev);
561 struct ath_softc *sc = led->sc;
562
563 switch (brightness) {
564 case LED_OFF:
565 if (led->led_type == ATH_LED_ASSOC ||
566 led->led_type == ATH_LED_RADIO)
567 sc->sc_flags &= ~SC_OP_LED_ASSOCIATED;
568 ath9k_hw_set_gpio(sc->sc_ah, ATH_LED_PIN,
569 (led->led_type == ATH_LED_RADIO) ? 1 :
570 !!(sc->sc_flags & SC_OP_LED_ASSOCIATED));
571 break;
572 case LED_FULL:
573 if (led->led_type == ATH_LED_ASSOC)
574 sc->sc_flags |= SC_OP_LED_ASSOCIATED;
575 ath9k_hw_set_gpio(sc->sc_ah, ATH_LED_PIN, 0);
576 break;
577 default:
578 break;
579 }
580}
581
582static int ath_register_led(struct ath_softc *sc, struct ath_led *led,
583 char *trigger)
584{
585 int ret;
586
587 led->sc = sc;
588 led->led_cdev.name = led->name;
589 led->led_cdev.default_trigger = trigger;
590 led->led_cdev.brightness_set = ath_led_brightness;
591
592 ret = led_classdev_register(wiphy_dev(sc->hw->wiphy), &led->led_cdev);
593 if (ret)
594 DPRINTF(sc, ATH_DBG_FATAL,
595 "Failed to register led:%s", led->name);
596 else
597 led->registered = 1;
598 return ret;
599}
600
601static void ath_unregister_led(struct ath_led *led)
602{
603 if (led->registered) {
604 led_classdev_unregister(&led->led_cdev);
605 led->registered = 0;
606 }
607}
608
609static void ath_deinit_leds(struct ath_softc *sc)
610{
611 ath_unregister_led(&sc->assoc_led);
612 sc->sc_flags &= ~SC_OP_LED_ASSOCIATED;
613 ath_unregister_led(&sc->tx_led);
614 ath_unregister_led(&sc->rx_led);
615 ath_unregister_led(&sc->radio_led);
616 ath9k_hw_set_gpio(sc->sc_ah, ATH_LED_PIN, 1);
617}
618
619static void ath_init_leds(struct ath_softc *sc)
620{
621 char *trigger;
622 int ret;
623
624 /* Configure gpio 1 for output */
625 ath9k_hw_cfg_output(sc->sc_ah, ATH_LED_PIN,
626 AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
627 /* LED off, active low */
628 ath9k_hw_set_gpio(sc->sc_ah, ATH_LED_PIN, 1);
629
630 trigger = ieee80211_get_radio_led_name(sc->hw);
631 snprintf(sc->radio_led.name, sizeof(sc->radio_led.name),
632 "ath9k-%s:radio", wiphy_name(sc->hw->wiphy));
633 ret = ath_register_led(sc, &sc->radio_led, trigger);
634 sc->radio_led.led_type = ATH_LED_RADIO;
635 if (ret)
636 goto fail;
637
638 trigger = ieee80211_get_assoc_led_name(sc->hw);
639 snprintf(sc->assoc_led.name, sizeof(sc->assoc_led.name),
640 "ath9k-%s:assoc", wiphy_name(sc->hw->wiphy));
641 ret = ath_register_led(sc, &sc->assoc_led, trigger);
642 sc->assoc_led.led_type = ATH_LED_ASSOC;
643 if (ret)
644 goto fail;
645
646 trigger = ieee80211_get_tx_led_name(sc->hw);
647 snprintf(sc->tx_led.name, sizeof(sc->tx_led.name),
648 "ath9k-%s:tx", wiphy_name(sc->hw->wiphy));
649 ret = ath_register_led(sc, &sc->tx_led, trigger);
650 sc->tx_led.led_type = ATH_LED_TX;
651 if (ret)
652 goto fail;
653
654 trigger = ieee80211_get_rx_led_name(sc->hw);
655 snprintf(sc->rx_led.name, sizeof(sc->rx_led.name),
656 "ath9k-%s:rx", wiphy_name(sc->hw->wiphy));
657 ret = ath_register_led(sc, &sc->rx_led, trigger);
658 sc->rx_led.led_type = ATH_LED_RX;
659 if (ret)
660 goto fail;
661
662 return;
663
664fail:
665 ath_deinit_leds(sc);
666}
667
Vasanthakumar Thiagarajan500c0642008-09-10 18:50:17 +0530668#ifdef CONFIG_RFKILL
669/*******************/
670/* Rfkill */
671/*******************/
672
673static void ath_radio_enable(struct ath_softc *sc)
674{
675 struct ath_hal *ah = sc->sc_ah;
676 int status;
677
678 spin_lock_bh(&sc->sc_resetlock);
679 if (!ath9k_hw_reset(ah, ah->ah_curchan,
680 sc->sc_ht_info.tx_chan_width,
681 sc->sc_tx_chainmask,
682 sc->sc_rx_chainmask,
683 sc->sc_ht_extprotspacing,
684 false, &status)) {
685 DPRINTF(sc, ATH_DBG_FATAL,
686 "%s: unable to reset channel %u (%uMhz) "
687 "flags 0x%x hal status %u\n", __func__,
688 ath9k_hw_mhz2ieee(ah,
689 ah->ah_curchan->channel,
690 ah->ah_curchan->channelFlags),
691 ah->ah_curchan->channel,
692 ah->ah_curchan->channelFlags, status);
693 }
694 spin_unlock_bh(&sc->sc_resetlock);
695
696 ath_update_txpow(sc);
697 if (ath_startrecv(sc) != 0) {
698 DPRINTF(sc, ATH_DBG_FATAL,
699 "%s: unable to restart recv logic\n", __func__);
700 return;
701 }
702
703 if (sc->sc_flags & SC_OP_BEACONS)
704 ath_beacon_config(sc, ATH_IF_ID_ANY); /* restart beacons */
705
706 /* Re-Enable interrupts */
707 ath9k_hw_set_interrupts(ah, sc->sc_imask);
708
709 /* Enable LED */
710 ath9k_hw_cfg_output(ah, ATH_LED_PIN,
711 AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
712 ath9k_hw_set_gpio(ah, ATH_LED_PIN, 0);
713
714 ieee80211_wake_queues(sc->hw);
715}
716
717static void ath_radio_disable(struct ath_softc *sc)
718{
719 struct ath_hal *ah = sc->sc_ah;
720 int status;
721
722
723 ieee80211_stop_queues(sc->hw);
724
725 /* Disable LED */
726 ath9k_hw_set_gpio(ah, ATH_LED_PIN, 1);
727 ath9k_hw_cfg_gpio_input(ah, ATH_LED_PIN);
728
729 /* Disable interrupts */
730 ath9k_hw_set_interrupts(ah, 0);
731
732 ath_draintxq(sc, false); /* clear pending tx frames */
733 ath_stoprecv(sc); /* turn off frame recv */
734 ath_flushrecv(sc); /* flush recv queue */
735
736 spin_lock_bh(&sc->sc_resetlock);
737 if (!ath9k_hw_reset(ah, ah->ah_curchan,
738 sc->sc_ht_info.tx_chan_width,
739 sc->sc_tx_chainmask,
740 sc->sc_rx_chainmask,
741 sc->sc_ht_extprotspacing,
742 false, &status)) {
743 DPRINTF(sc, ATH_DBG_FATAL,
744 "%s: unable to reset channel %u (%uMhz) "
745 "flags 0x%x hal status %u\n", __func__,
746 ath9k_hw_mhz2ieee(ah,
747 ah->ah_curchan->channel,
748 ah->ah_curchan->channelFlags),
749 ah->ah_curchan->channel,
750 ah->ah_curchan->channelFlags, status);
751 }
752 spin_unlock_bh(&sc->sc_resetlock);
753
754 ath9k_hw_phy_disable(ah);
755 ath9k_hw_setpower(ah, ATH9K_PM_FULL_SLEEP);
756}
757
758static bool ath_is_rfkill_set(struct ath_softc *sc)
759{
760 struct ath_hal *ah = sc->sc_ah;
761
762 return ath9k_hw_gpio_get(ah, ah->ah_rfkill_gpio) ==
763 ah->ah_rfkill_polarity;
764}
765
766/* h/w rfkill poll function */
767static void ath_rfkill_poll(struct work_struct *work)
768{
769 struct ath_softc *sc = container_of(work, struct ath_softc,
770 rf_kill.rfkill_poll.work);
771 bool radio_on;
772
773 if (sc->sc_flags & SC_OP_INVALID)
774 return;
775
776 radio_on = !ath_is_rfkill_set(sc);
777
778 /*
779 * enable/disable radio only when there is a
780 * state change in RF switch
781 */
782 if (radio_on == !!(sc->sc_flags & SC_OP_RFKILL_HW_BLOCKED)) {
783 enum rfkill_state state;
784
785 if (sc->sc_flags & SC_OP_RFKILL_SW_BLOCKED) {
786 state = radio_on ? RFKILL_STATE_SOFT_BLOCKED
787 : RFKILL_STATE_HARD_BLOCKED;
788 } else if (radio_on) {
789 ath_radio_enable(sc);
790 state = RFKILL_STATE_UNBLOCKED;
791 } else {
792 ath_radio_disable(sc);
793 state = RFKILL_STATE_HARD_BLOCKED;
794 }
795
796 if (state == RFKILL_STATE_HARD_BLOCKED)
797 sc->sc_flags |= SC_OP_RFKILL_HW_BLOCKED;
798 else
799 sc->sc_flags &= ~SC_OP_RFKILL_HW_BLOCKED;
800
801 rfkill_force_state(sc->rf_kill.rfkill, state);
802 }
803
804 queue_delayed_work(sc->hw->workqueue, &sc->rf_kill.rfkill_poll,
805 msecs_to_jiffies(ATH_RFKILL_POLL_INTERVAL));
806}
807
808/* s/w rfkill handler */
809static int ath_sw_toggle_radio(void *data, enum rfkill_state state)
810{
811 struct ath_softc *sc = data;
812
813 switch (state) {
814 case RFKILL_STATE_SOFT_BLOCKED:
815 if (!(sc->sc_flags & (SC_OP_RFKILL_HW_BLOCKED |
816 SC_OP_RFKILL_SW_BLOCKED)))
817 ath_radio_disable(sc);
818 sc->sc_flags |= SC_OP_RFKILL_SW_BLOCKED;
819 return 0;
820 case RFKILL_STATE_UNBLOCKED:
821 if ((sc->sc_flags & SC_OP_RFKILL_SW_BLOCKED)) {
822 sc->sc_flags &= ~SC_OP_RFKILL_SW_BLOCKED;
823 if (sc->sc_flags & SC_OP_RFKILL_HW_BLOCKED) {
824 DPRINTF(sc, ATH_DBG_FATAL, "Can't turn on the"
825 "radio as it is disabled by h/w \n");
826 return -EPERM;
827 }
828 ath_radio_enable(sc);
829 }
830 return 0;
831 default:
832 return -EINVAL;
833 }
834}
835
836/* Init s/w rfkill */
837static int ath_init_sw_rfkill(struct ath_softc *sc)
838{
839 sc->rf_kill.rfkill = rfkill_allocate(wiphy_dev(sc->hw->wiphy),
840 RFKILL_TYPE_WLAN);
841 if (!sc->rf_kill.rfkill) {
842 DPRINTF(sc, ATH_DBG_FATAL, "Failed to allocate rfkill\n");
843 return -ENOMEM;
844 }
845
846 snprintf(sc->rf_kill.rfkill_name, sizeof(sc->rf_kill.rfkill_name),
847 "ath9k-%s:rfkill", wiphy_name(sc->hw->wiphy));
848 sc->rf_kill.rfkill->name = sc->rf_kill.rfkill_name;
849 sc->rf_kill.rfkill->data = sc;
850 sc->rf_kill.rfkill->toggle_radio = ath_sw_toggle_radio;
851 sc->rf_kill.rfkill->state = RFKILL_STATE_UNBLOCKED;
852 sc->rf_kill.rfkill->user_claim_unsupported = 1;
853
854 return 0;
855}
856
857/* Deinitialize rfkill */
858static void ath_deinit_rfkill(struct ath_softc *sc)
859{
860 if (sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
861 cancel_delayed_work_sync(&sc->rf_kill.rfkill_poll);
862
863 if (sc->sc_flags & SC_OP_RFKILL_REGISTERED) {
864 rfkill_unregister(sc->rf_kill.rfkill);
865 sc->sc_flags &= ~SC_OP_RFKILL_REGISTERED;
866 sc->rf_kill.rfkill = NULL;
867 }
868}
869#endif /* CONFIG_RFKILL */
870
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530871static int ath_detach(struct ath_softc *sc)
872{
873 struct ieee80211_hw *hw = sc->hw;
874
875 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Detach ATH hw\n", __func__);
876
877 /* Deinit LED control */
878 ath_deinit_leds(sc);
879
Vasanthakumar Thiagarajan500c0642008-09-10 18:50:17 +0530880#ifdef CONFIG_RFKILL
881 /* deinit rfkill */
882 ath_deinit_rfkill(sc);
883#endif
884
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530885 /* Unregister hw */
886
887 ieee80211_unregister_hw(hw);
888
889 /* unregister Rate control */
890 ath_rate_control_unregister();
891
892 /* tx/rx cleanup */
893
894 ath_rx_cleanup(sc);
895 ath_tx_cleanup(sc);
896
897 /* Deinit */
898
899 ath_deinit(sc);
900
901 return 0;
902}
903
904static int ath_attach(u16 devid,
905 struct ath_softc *sc)
906{
907 struct ieee80211_hw *hw = sc->hw;
908 int error = 0;
909
910 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Attach ATH hw\n", __func__);
911
912 error = ath_init(devid, sc);
913 if (error != 0)
914 return error;
915
916 /* Init nodes */
917
918 INIT_LIST_HEAD(&sc->node_list);
919 spin_lock_init(&sc->node_lock);
920
921 /* get mac address from hardware and set in mac80211 */
922
923 SET_IEEE80211_PERM_ADDR(hw, sc->sc_myaddr);
924
925 /* setup channels and rates */
926
927 sc->sbands[IEEE80211_BAND_2GHZ].channels =
928 sc->channels[IEEE80211_BAND_2GHZ];
929 sc->sbands[IEEE80211_BAND_2GHZ].bitrates =
930 sc->rates[IEEE80211_BAND_2GHZ];
931 sc->sbands[IEEE80211_BAND_2GHZ].band = IEEE80211_BAND_2GHZ;
932
933 if (sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_HT)
934 /* Setup HT capabilities for 2.4Ghz*/
Johannes Bergd9fe60d2008-10-09 12:13:49 +0200935 setup_ht_cap(&sc->sbands[IEEE80211_BAND_2GHZ].ht_cap);
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530936
937 hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
938 &sc->sbands[IEEE80211_BAND_2GHZ];
939
940 if (test_bit(ATH9K_MODE_11A, sc->sc_ah->ah_caps.wireless_modes)) {
941 sc->sbands[IEEE80211_BAND_5GHZ].channels =
942 sc->channels[IEEE80211_BAND_5GHZ];
943 sc->sbands[IEEE80211_BAND_5GHZ].bitrates =
944 sc->rates[IEEE80211_BAND_5GHZ];
945 sc->sbands[IEEE80211_BAND_5GHZ].band =
946 IEEE80211_BAND_5GHZ;
947
948 if (sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_HT)
949 /* Setup HT capabilities for 5Ghz*/
Johannes Bergd9fe60d2008-10-09 12:13:49 +0200950 setup_ht_cap(&sc->sbands[IEEE80211_BAND_5GHZ].ht_cap);
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530951
952 hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
953 &sc->sbands[IEEE80211_BAND_5GHZ];
954 }
955
956 /* FIXME: Have to figure out proper hw init values later */
957
958 hw->queues = 4;
959 hw->ampdu_queues = 1;
960
961 /* Register rate control */
962 hw->rate_control_algorithm = "ath9k_rate_control";
963 error = ath_rate_control_register();
964 if (error != 0) {
965 DPRINTF(sc, ATH_DBG_FATAL,
966 "%s: Unable to register rate control "
967 "algorithm:%d\n", __func__, error);
968 ath_rate_control_unregister();
969 goto bad;
970 }
971
972 error = ieee80211_register_hw(hw);
973 if (error != 0) {
974 ath_rate_control_unregister();
975 goto bad;
976 }
977
978 /* Initialize LED control */
979 ath_init_leds(sc);
980
Vasanthakumar Thiagarajan500c0642008-09-10 18:50:17 +0530981#ifdef CONFIG_RFKILL
982 /* Initialze h/w Rfkill */
983 if (sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
984 INIT_DELAYED_WORK(&sc->rf_kill.rfkill_poll, ath_rfkill_poll);
985
986 /* Initialize s/w rfkill */
987 if (ath_init_sw_rfkill(sc))
988 goto detach;
989#endif
990
Vasanthakumar Thiagarajan8feceb62008-09-10 18:49:27 +0530991 /* initialize tx/rx engine */
992
993 error = ath_tx_init(sc, ATH_TXBUF);
994 if (error != 0)
995 goto detach;
996
997 error = ath_rx_init(sc, ATH_RXBUF);
998 if (error != 0)
999 goto detach;
1000
1001 return 0;
1002detach:
1003 ath_detach(sc);
1004bad:
1005 return error;
1006}
1007
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001008static int ath9k_start(struct ieee80211_hw *hw)
1009{
1010 struct ath_softc *sc = hw->priv;
1011 struct ieee80211_channel *curchan = hw->conf.channel;
1012 int error = 0, pos;
1013
1014 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Starting driver with "
1015 "initial channel: %d MHz\n", __func__, curchan->center_freq);
1016
1017 /* setup initial channel */
1018
1019 pos = ath_get_channel(sc, curchan);
1020 if (pos == -1) {
1021 DPRINTF(sc, ATH_DBG_FATAL, "%s: Invalid channel\n", __func__);
1022 return -EINVAL;
1023 }
1024
1025 sc->sc_ah->ah_channels[pos].chanmode =
1026 (curchan->band == IEEE80211_BAND_2GHZ) ? CHANNEL_G : CHANNEL_A;
1027
1028 /* open ath_dev */
1029 error = ath_open(sc, &sc->sc_ah->ah_channels[pos]);
1030 if (error) {
1031 DPRINTF(sc, ATH_DBG_FATAL,
1032 "%s: Unable to complete ath_open\n", __func__);
1033 return error;
1034 }
1035
Vasanthakumar Thiagarajan500c0642008-09-10 18:50:17 +05301036#ifdef CONFIG_RFKILL
1037 /* Start rfkill polling */
1038 if (sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
1039 queue_delayed_work(sc->hw->workqueue,
1040 &sc->rf_kill.rfkill_poll, 0);
1041
1042 if (!(sc->sc_flags & SC_OP_RFKILL_REGISTERED)) {
1043 if (rfkill_register(sc->rf_kill.rfkill)) {
1044 DPRINTF(sc, ATH_DBG_FATAL,
1045 "Unable to register rfkill\n");
1046 rfkill_free(sc->rf_kill.rfkill);
1047
1048 /* Deinitialize the device */
1049 if (sc->pdev->irq)
1050 free_irq(sc->pdev->irq, sc);
1051 ath_detach(sc);
1052 pci_iounmap(sc->pdev, sc->mem);
1053 pci_release_region(sc->pdev, 0);
1054 pci_disable_device(sc->pdev);
1055 ieee80211_free_hw(hw);
1056 return -EIO;
1057 } else {
1058 sc->sc_flags |= SC_OP_RFKILL_REGISTERED;
1059 }
1060 }
1061#endif
1062
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001063 ieee80211_wake_queues(hw);
1064 return 0;
1065}
1066
1067static int ath9k_tx(struct ieee80211_hw *hw,
1068 struct sk_buff *skb)
1069{
1070 struct ath_softc *sc = hw->priv;
1071 int hdrlen, padsize;
Jouni Malinen147583c2008-08-11 14:01:50 +03001072 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
1073
1074 /*
1075 * As a temporary workaround, assign seq# here; this will likely need
1076 * to be cleaned up to work better with Beacon transmission and virtual
1077 * BSSes.
1078 */
1079 if (info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) {
1080 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
1081 if (info->flags & IEEE80211_TX_CTL_FIRST_FRAGMENT)
1082 sc->seq_no += 0x10;
1083 hdr->seq_ctrl &= cpu_to_le16(IEEE80211_SCTL_FRAG);
1084 hdr->seq_ctrl |= cpu_to_le16(sc->seq_no);
1085 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001086
1087 /* Add the padding after the header if this is not already done */
1088 hdrlen = ieee80211_get_hdrlen_from_skb(skb);
1089 if (hdrlen & 3) {
1090 padsize = hdrlen % 4;
1091 if (skb_headroom(skb) < padsize)
1092 return -1;
1093 skb_push(skb, padsize);
1094 memmove(skb->data, skb->data + padsize, hdrlen);
1095 }
1096
1097 DPRINTF(sc, ATH_DBG_XMIT, "%s: transmitting packet, skb: %p\n",
1098 __func__,
1099 skb);
1100
1101 if (ath_tx_start(sc, skb) != 0) {
1102 DPRINTF(sc, ATH_DBG_XMIT, "%s: TX failed\n", __func__);
1103 dev_kfree_skb_any(skb);
1104 /* FIXME: Check for proper return value from ATH_DEV */
1105 return 0;
1106 }
1107
1108 return 0;
1109}
1110
1111static void ath9k_stop(struct ieee80211_hw *hw)
1112{
1113 struct ath_softc *sc = hw->priv;
1114 int error;
1115
1116 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Driver halt\n", __func__);
1117
1118 error = ath_suspend(sc);
1119 if (error)
1120 DPRINTF(sc, ATH_DBG_CONFIG,
1121 "%s: Device is no longer present\n", __func__);
1122
1123 ieee80211_stop_queues(hw);
Vasanthakumar Thiagarajan500c0642008-09-10 18:50:17 +05301124
1125#ifdef CONFIG_RFKILL
1126 if (sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
1127 cancel_delayed_work_sync(&sc->rf_kill.rfkill_poll);
1128#endif
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001129}
1130
1131static int ath9k_add_interface(struct ieee80211_hw *hw,
1132 struct ieee80211_if_init_conf *conf)
1133{
1134 struct ath_softc *sc = hw->priv;
1135 int error, ic_opmode = 0;
1136
1137 /* Support only vap for now */
1138
1139 if (sc->sc_nvaps)
1140 return -ENOBUFS;
1141
1142 switch (conf->type) {
Johannes Berg05c914f2008-09-11 00:01:58 +02001143 case NL80211_IFTYPE_STATION:
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001144 ic_opmode = ATH9K_M_STA;
1145 break;
Johannes Berg05c914f2008-09-11 00:01:58 +02001146 case NL80211_IFTYPE_ADHOC:
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001147 ic_opmode = ATH9K_M_IBSS;
1148 break;
Johannes Berg05c914f2008-09-11 00:01:58 +02001149 case NL80211_IFTYPE_AP:
Jouni Malinen2ad67de2008-08-11 14:01:47 +03001150 ic_opmode = ATH9K_M_HOSTAP;
1151 break;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001152 default:
1153 DPRINTF(sc, ATH_DBG_FATAL,
Jouni Malinen2ad67de2008-08-11 14:01:47 +03001154 "%s: Interface type %d not yet supported\n",
1155 __func__, conf->type);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001156 return -EOPNOTSUPP;
1157 }
1158
1159 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Attach a VAP of type: %d\n",
1160 __func__,
1161 ic_opmode);
1162
1163 error = ath_vap_attach(sc, 0, conf->vif, ic_opmode);
1164 if (error) {
1165 DPRINTF(sc, ATH_DBG_FATAL,
1166 "%s: Unable to attach vap, error: %d\n",
1167 __func__, error);
1168 return error;
1169 }
1170
Luis R. Rodriguez6f255422008-10-03 15:45:27 -07001171 if (conf->type == NL80211_IFTYPE_AP) {
1172 /* TODO: is this a suitable place to start ANI for AP mode? */
1173 /* Start ANI */
1174 mod_timer(&sc->sc_ani.timer,
1175 jiffies + msecs_to_jiffies(ATH_ANI_POLLINTERVAL));
1176 }
1177
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001178 return 0;
1179}
1180
1181static void ath9k_remove_interface(struct ieee80211_hw *hw,
1182 struct ieee80211_if_init_conf *conf)
1183{
1184 struct ath_softc *sc = hw->priv;
1185 struct ath_vap *avp;
1186 int error;
1187
1188 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Detach VAP\n", __func__);
1189
1190 avp = sc->sc_vaps[0];
1191 if (avp == NULL) {
1192 DPRINTF(sc, ATH_DBG_FATAL, "%s: Invalid interface\n",
1193 __func__);
1194 return;
1195 }
1196
1197#ifdef CONFIG_SLOW_ANT_DIV
1198 ath_slow_ant_div_stop(&sc->sc_antdiv);
1199#endif
Luis R. Rodriguez6f255422008-10-03 15:45:27 -07001200 /* Stop ANI */
1201 del_timer_sync(&sc->sc_ani.timer);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001202
1203 /* Update ratectrl */
1204 ath_rate_newstate(sc, avp);
1205
1206 /* Reclaim beacon resources */
Sujithb4696c8b2008-08-11 14:04:52 +05301207 if (sc->sc_ah->ah_opmode == ATH9K_M_HOSTAP ||
1208 sc->sc_ah->ah_opmode == ATH9K_M_IBSS) {
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001209 ath9k_hw_stoptxdma(sc->sc_ah, sc->sc_bhalq);
1210 ath_beacon_return(sc, avp);
1211 }
1212
1213 /* Set interrupt mask */
1214 sc->sc_imask &= ~(ATH9K_INT_SWBA | ATH9K_INT_BMISS);
1215 ath9k_hw_set_interrupts(sc->sc_ah, sc->sc_imask & ~ATH9K_INT_GLOBAL);
Sujith672840a2008-08-11 14:05:08 +05301216 sc->sc_flags &= ~SC_OP_BEACONS;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001217
1218 error = ath_vap_detach(sc, 0);
1219 if (error)
1220 DPRINTF(sc, ATH_DBG_FATAL,
1221 "%s: Unable to detach vap, error: %d\n",
1222 __func__, error);
1223}
1224
Johannes Berge8975582008-10-09 12:18:51 +02001225static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001226{
1227 struct ath_softc *sc = hw->priv;
1228 struct ieee80211_channel *curchan = hw->conf.channel;
Johannes Berge8975582008-10-09 12:18:51 +02001229 struct ieee80211_conf *conf = &hw->conf;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001230 int pos;
1231
1232 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Set channel: %d MHz\n",
1233 __func__,
1234 curchan->center_freq);
1235
Johannes Bergae5eb022008-10-14 16:58:37 +02001236 /* Update chainmask */
1237 ath_update_chainmask(sc, conf->ht.enabled);
1238
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001239 pos = ath_get_channel(sc, curchan);
1240 if (pos == -1) {
1241 DPRINTF(sc, ATH_DBG_FATAL, "%s: Invalid channel\n", __func__);
1242 return -EINVAL;
1243 }
1244
1245 sc->sc_ah->ah_channels[pos].chanmode =
Sujith86b89ee2008-08-07 10:54:57 +05301246 (curchan->band == IEEE80211_BAND_2GHZ) ?
1247 CHANNEL_G : CHANNEL_A;
1248
Johannes Bergae5eb022008-10-14 16:58:37 +02001249 if (sc->sc_curaid && hw->conf.ht.enabled)
Sujith86b89ee2008-08-07 10:54:57 +05301250 sc->sc_ah->ah_channels[pos].chanmode =
1251 ath_get_extchanmode(sc, curchan);
1252
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001253 sc->sc_config.txpowlimit = 2 * conf->power_level;
1254
1255 /* set h/w channel */
1256 if (ath_set_channel(sc, &sc->sc_ah->ah_channels[pos]) < 0)
1257 DPRINTF(sc, ATH_DBG_FATAL, "%s: Unable to set channel\n",
1258 __func__);
1259
1260 return 0;
1261}
1262
1263static int ath9k_config_interface(struct ieee80211_hw *hw,
1264 struct ieee80211_vif *vif,
1265 struct ieee80211_if_conf *conf)
1266{
1267 struct ath_softc *sc = hw->priv;
Jouni Malinen2ad67de2008-08-11 14:01:47 +03001268 struct ath_hal *ah = sc->sc_ah;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001269 struct ath_vap *avp;
1270 u32 rfilt = 0;
1271 int error, i;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001272
1273 avp = sc->sc_vaps[0];
1274 if (avp == NULL) {
1275 DPRINTF(sc, ATH_DBG_FATAL, "%s: Invalid interface\n",
1276 __func__);
1277 return -EINVAL;
1278 }
1279
Jouni Malinen2ad67de2008-08-11 14:01:47 +03001280 /* TODO: Need to decide which hw opmode to use for multi-interface
1281 * cases */
Johannes Berg05c914f2008-09-11 00:01:58 +02001282 if (vif->type == NL80211_IFTYPE_AP &&
Jouni Malinen2ad67de2008-08-11 14:01:47 +03001283 ah->ah_opmode != ATH9K_M_HOSTAP) {
1284 ah->ah_opmode = ATH9K_M_HOSTAP;
1285 ath9k_hw_setopmode(ah);
1286 ath9k_hw_write_associd(ah, sc->sc_myaddr, 0);
1287 /* Request full reset to get hw opmode changed properly */
1288 sc->sc_flags |= SC_OP_FULL_RESET;
1289 }
1290
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001291 if ((conf->changed & IEEE80211_IFCC_BSSID) &&
1292 !is_zero_ether_addr(conf->bssid)) {
1293 switch (vif->type) {
Johannes Berg05c914f2008-09-11 00:01:58 +02001294 case NL80211_IFTYPE_STATION:
1295 case NL80211_IFTYPE_ADHOC:
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001296 /* Update ratectrl about the new state */
1297 ath_rate_newstate(sc, avp);
1298
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001299 /* Set BSSID */
1300 memcpy(sc->sc_curbssid, conf->bssid, ETH_ALEN);
1301 sc->sc_curaid = 0;
1302 ath9k_hw_write_associd(sc->sc_ah, sc->sc_curbssid,
1303 sc->sc_curaid);
1304
1305 /* Set aggregation protection mode parameters */
1306 sc->sc_config.ath_aggr_prot = 0;
1307
1308 /*
1309 * Reset our TSF so that its value is lower than the
1310 * beacon that we are trying to catch.
1311 * Only then hw will update its TSF register with the
1312 * new beacon. Reset the TSF before setting the BSSID
1313 * to avoid allowing in any frames that would update
1314 * our TSF only to have us clear it
1315 * immediately thereafter.
1316 */
1317 ath9k_hw_reset_tsf(sc->sc_ah);
1318
1319 /* Disable BMISS interrupt when we're not associated */
1320 ath9k_hw_set_interrupts(sc->sc_ah,
1321 sc->sc_imask &
1322 ~(ATH9K_INT_SWBA | ATH9K_INT_BMISS));
1323 sc->sc_imask &= ~(ATH9K_INT_SWBA | ATH9K_INT_BMISS);
1324
1325 DPRINTF(sc, ATH_DBG_CONFIG,
Johannes Berge1749612008-10-27 15:59:26 -07001326 "%s: RX filter 0x%x bssid %pM aid 0x%x\n",
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001327 __func__, rfilt,
Johannes Berge1749612008-10-27 15:59:26 -07001328 sc->sc_curbssid, sc->sc_curaid);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001329
1330 /* need to reconfigure the beacon */
Sujith672840a2008-08-11 14:05:08 +05301331 sc->sc_flags &= ~SC_OP_BEACONS ;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001332
1333 break;
1334 default:
1335 break;
1336 }
1337 }
1338
1339 if ((conf->changed & IEEE80211_IFCC_BEACON) &&
Johannes Berg05c914f2008-09-11 00:01:58 +02001340 ((vif->type == NL80211_IFTYPE_ADHOC) ||
1341 (vif->type == NL80211_IFTYPE_AP))) {
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001342 /*
1343 * Allocate and setup the beacon frame.
1344 *
1345 * Stop any previous beacon DMA. This may be
1346 * necessary, for example, when an ibss merge
1347 * causes reconfiguration; we may be called
1348 * with beacon transmission active.
1349 */
1350 ath9k_hw_stoptxdma(sc->sc_ah, sc->sc_bhalq);
1351
1352 error = ath_beacon_alloc(sc, 0);
1353 if (error != 0)
1354 return error;
1355
1356 ath_beacon_sync(sc, 0);
1357 }
1358
1359 /* Check for WLAN_CAPABILITY_PRIVACY ? */
Johannes Berg05c914f2008-09-11 00:01:58 +02001360 if ((avp->av_opmode != NL80211_IFTYPE_STATION)) {
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001361 for (i = 0; i < IEEE80211_WEP_NKID; i++)
1362 if (ath9k_hw_keyisvalid(sc->sc_ah, (u16)i))
1363 ath9k_hw_keysetmac(sc->sc_ah,
1364 (u16)i,
1365 sc->sc_curbssid);
1366 }
1367
1368 /* Only legacy IBSS for now */
Johannes Berg05c914f2008-09-11 00:01:58 +02001369 if (vif->type == NL80211_IFTYPE_ADHOC)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001370 ath_update_chainmask(sc, 0);
1371
1372 return 0;
1373}
1374
1375#define SUPPORTED_FILTERS \
1376 (FIF_PROMISC_IN_BSS | \
1377 FIF_ALLMULTI | \
1378 FIF_CONTROL | \
1379 FIF_OTHER_BSS | \
1380 FIF_BCN_PRBRESP_PROMISC | \
1381 FIF_FCSFAIL)
1382
Sujith7dcfdcd2008-08-11 14:03:13 +05301383/* FIXME: sc->sc_full_reset ? */
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001384static void ath9k_configure_filter(struct ieee80211_hw *hw,
1385 unsigned int changed_flags,
1386 unsigned int *total_flags,
1387 int mc_count,
1388 struct dev_mc_list *mclist)
1389{
1390 struct ath_softc *sc = hw->priv;
Sujith7dcfdcd2008-08-11 14:03:13 +05301391 u32 rfilt;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001392
1393 changed_flags &= SUPPORTED_FILTERS;
1394 *total_flags &= SUPPORTED_FILTERS;
1395
Sujith7dcfdcd2008-08-11 14:03:13 +05301396 sc->rx_filter = *total_flags;
1397 rfilt = ath_calcrxfilter(sc);
1398 ath9k_hw_setrxfilter(sc->sc_ah, rfilt);
1399
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001400 if (changed_flags & FIF_BCN_PRBRESP_PROMISC) {
1401 if (*total_flags & FIF_BCN_PRBRESP_PROMISC)
Sujith7dcfdcd2008-08-11 14:03:13 +05301402 ath9k_hw_write_associd(sc->sc_ah, ath_bcast_mac, 0);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001403 }
Sujith7dcfdcd2008-08-11 14:03:13 +05301404
1405 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Set HW RX filter: 0x%x\n",
1406 __func__, sc->rx_filter);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001407}
1408
1409static void ath9k_sta_notify(struct ieee80211_hw *hw,
1410 struct ieee80211_vif *vif,
1411 enum sta_notify_cmd cmd,
Johannes Berg17741cd2008-09-11 00:02:02 +02001412 struct ieee80211_sta *sta)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001413{
1414 struct ath_softc *sc = hw->priv;
1415 struct ath_node *an;
1416 unsigned long flags;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001417
1418 spin_lock_irqsave(&sc->node_lock, flags);
Johannes Berg17741cd2008-09-11 00:02:02 +02001419 an = ath_node_find(sc, sta->addr);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001420 spin_unlock_irqrestore(&sc->node_lock, flags);
1421
1422 switch (cmd) {
1423 case STA_NOTIFY_ADD:
1424 spin_lock_irqsave(&sc->node_lock, flags);
1425 if (!an) {
Johannes Berg17741cd2008-09-11 00:02:02 +02001426 ath_node_attach(sc, sta->addr, 0);
Johannes Berge1749612008-10-27 15:59:26 -07001427 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Attach a node: %pM\n",
1428 __func__, sta->addr);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001429 } else {
Johannes Berg17741cd2008-09-11 00:02:02 +02001430 ath_node_get(sc, sta->addr);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001431 }
Johannes Bergae5eb022008-10-14 16:58:37 +02001432
1433 /* XXX: Is this right? Can the capabilities change? */
1434 an = ath_node_find(sc, sta->addr);
1435 an->maxampdu = 1 << (IEEE80211_HTCAP_MAXRXAMPDU_FACTOR +
1436 sta->ht_cap.ampdu_factor);
1437 an->mpdudensity =
1438 parse_mpdudensity(sta->ht_cap.ampdu_density);
1439
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001440 spin_unlock_irqrestore(&sc->node_lock, flags);
1441 break;
1442 case STA_NOTIFY_REMOVE:
1443 if (!an)
1444 DPRINTF(sc, ATH_DBG_FATAL,
1445 "%s: Removal of a non-existent node\n",
1446 __func__);
1447 else {
1448 ath_node_put(sc, an, ATH9K_BH_STATUS_INTACT);
Johannes Berge1749612008-10-27 15:59:26 -07001449 DPRINTF(sc, ATH_DBG_CONFIG, "%s: Put a node: %pM\n",
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001450 __func__,
Johannes Berge1749612008-10-27 15:59:26 -07001451 sta->addr);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001452 }
1453 break;
1454 default:
1455 break;
1456 }
1457}
1458
1459static int ath9k_conf_tx(struct ieee80211_hw *hw,
1460 u16 queue,
1461 const struct ieee80211_tx_queue_params *params)
1462{
1463 struct ath_softc *sc = hw->priv;
Sujithea9880f2008-08-07 10:53:10 +05301464 struct ath9k_tx_queue_info qi;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001465 int ret = 0, qnum;
1466
1467 if (queue >= WME_NUM_AC)
1468 return 0;
1469
1470 qi.tqi_aifs = params->aifs;
1471 qi.tqi_cwmin = params->cw_min;
1472 qi.tqi_cwmax = params->cw_max;
1473 qi.tqi_burstTime = params->txop;
1474 qnum = ath_get_hal_qnum(queue, sc);
1475
1476 DPRINTF(sc, ATH_DBG_CONFIG,
1477 "%s: Configure tx [queue/halq] [%d/%d], "
1478 "aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
1479 __func__,
1480 queue,
1481 qnum,
1482 params->aifs,
1483 params->cw_min,
1484 params->cw_max,
1485 params->txop);
1486
1487 ret = ath_txq_update(sc, qnum, &qi);
1488 if (ret)
1489 DPRINTF(sc, ATH_DBG_FATAL,
1490 "%s: TXQ Update failed\n", __func__);
1491
1492 return ret;
1493}
1494
1495static int ath9k_set_key(struct ieee80211_hw *hw,
1496 enum set_key_cmd cmd,
1497 const u8 *local_addr,
1498 const u8 *addr,
1499 struct ieee80211_key_conf *key)
1500{
1501 struct ath_softc *sc = hw->priv;
1502 int ret = 0;
1503
1504 DPRINTF(sc, ATH_DBG_KEYCACHE, " %s: Set HW Key\n", __func__);
1505
1506 switch (cmd) {
1507 case SET_KEY:
1508 ret = ath_key_config(sc, addr, key);
1509 if (!ret) {
1510 set_bit(key->keyidx, sc->sc_keymap);
1511 key->hw_key_idx = key->keyidx;
1512 /* push IV and Michael MIC generation to stack */
1513 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
Senthil Balasubramanian1b961752008-09-01 19:45:21 +05301514 if (key->alg == ALG_TKIP)
1515 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001516 }
1517 break;
1518 case DISABLE_KEY:
1519 ath_key_delete(sc, key);
1520 clear_bit(key->keyidx, sc->sc_keymap);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001521 break;
1522 default:
1523 ret = -EINVAL;
1524 }
1525
1526 return ret;
1527}
1528
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001529static void ath9k_bss_info_changed(struct ieee80211_hw *hw,
1530 struct ieee80211_vif *vif,
1531 struct ieee80211_bss_conf *bss_conf,
1532 u32 changed)
1533{
1534 struct ath_softc *sc = hw->priv;
1535
1536 if (changed & BSS_CHANGED_ERP_PREAMBLE) {
1537 DPRINTF(sc, ATH_DBG_CONFIG, "%s: BSS Changed PREAMBLE %d\n",
1538 __func__,
1539 bss_conf->use_short_preamble);
1540 if (bss_conf->use_short_preamble)
Sujith672840a2008-08-11 14:05:08 +05301541 sc->sc_flags |= SC_OP_PREAMBLE_SHORT;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001542 else
Sujith672840a2008-08-11 14:05:08 +05301543 sc->sc_flags &= ~SC_OP_PREAMBLE_SHORT;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001544 }
1545
1546 if (changed & BSS_CHANGED_ERP_CTS_PROT) {
1547 DPRINTF(sc, ATH_DBG_CONFIG, "%s: BSS Changed CTS PROT %d\n",
1548 __func__,
1549 bss_conf->use_cts_prot);
1550 if (bss_conf->use_cts_prot &&
1551 hw->conf.channel->band != IEEE80211_BAND_5GHZ)
Sujith672840a2008-08-11 14:05:08 +05301552 sc->sc_flags |= SC_OP_PROTECT_ENABLE;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001553 else
Sujith672840a2008-08-11 14:05:08 +05301554 sc->sc_flags &= ~SC_OP_PROTECT_ENABLE;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001555 }
1556
1557 if (changed & BSS_CHANGED_HT) {
Johannes Bergae5eb022008-10-14 16:58:37 +02001558 DPRINTF(sc, ATH_DBG_CONFIG, "%s: BSS Changed HT\n",
1559 __func__);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001560 ath9k_ht_conf(sc, bss_conf);
1561 }
1562
1563 if (changed & BSS_CHANGED_ASSOC) {
1564 DPRINTF(sc, ATH_DBG_CONFIG, "%s: BSS Changed ASSOC %d\n",
1565 __func__,
1566 bss_conf->assoc);
1567 ath9k_bss_assoc_info(sc, bss_conf);
1568 }
1569}
1570
1571static u64 ath9k_get_tsf(struct ieee80211_hw *hw)
1572{
1573 u64 tsf;
1574 struct ath_softc *sc = hw->priv;
1575 struct ath_hal *ah = sc->sc_ah;
1576
1577 tsf = ath9k_hw_gettsf64(ah);
1578
1579 return tsf;
1580}
1581
1582static void ath9k_reset_tsf(struct ieee80211_hw *hw)
1583{
1584 struct ath_softc *sc = hw->priv;
1585 struct ath_hal *ah = sc->sc_ah;
1586
1587 ath9k_hw_reset_tsf(ah);
1588}
1589
1590static int ath9k_ampdu_action(struct ieee80211_hw *hw,
1591 enum ieee80211_ampdu_mlme_action action,
Johannes Berg17741cd2008-09-11 00:02:02 +02001592 struct ieee80211_sta *sta,
1593 u16 tid, u16 *ssn)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001594{
1595 struct ath_softc *sc = hw->priv;
1596 int ret = 0;
1597
1598 switch (action) {
1599 case IEEE80211_AMPDU_RX_START:
Johannes Berg17741cd2008-09-11 00:02:02 +02001600 ret = ath_rx_aggr_start(sc, sta->addr, tid, ssn);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001601 if (ret < 0)
1602 DPRINTF(sc, ATH_DBG_FATAL,
1603 "%s: Unable to start RX aggregation\n",
1604 __func__);
1605 break;
1606 case IEEE80211_AMPDU_RX_STOP:
Johannes Berg17741cd2008-09-11 00:02:02 +02001607 ret = ath_rx_aggr_stop(sc, sta->addr, tid);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001608 if (ret < 0)
1609 DPRINTF(sc, ATH_DBG_FATAL,
1610 "%s: Unable to stop RX aggregation\n",
1611 __func__);
1612 break;
1613 case IEEE80211_AMPDU_TX_START:
Johannes Berg17741cd2008-09-11 00:02:02 +02001614 ret = ath_tx_aggr_start(sc, sta->addr, tid, ssn);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001615 if (ret < 0)
1616 DPRINTF(sc, ATH_DBG_FATAL,
1617 "%s: Unable to start TX aggregation\n",
1618 __func__);
1619 else
Johannes Berg17741cd2008-09-11 00:02:02 +02001620 ieee80211_start_tx_ba_cb_irqsafe(hw, sta->addr, tid);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001621 break;
1622 case IEEE80211_AMPDU_TX_STOP:
Johannes Berg17741cd2008-09-11 00:02:02 +02001623 ret = ath_tx_aggr_stop(sc, sta->addr, tid);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001624 if (ret < 0)
1625 DPRINTF(sc, ATH_DBG_FATAL,
1626 "%s: Unable to stop TX aggregation\n",
1627 __func__);
1628
Johannes Berg17741cd2008-09-11 00:02:02 +02001629 ieee80211_stop_tx_ba_cb_irqsafe(hw, sta->addr, tid);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001630 break;
1631 default:
1632 DPRINTF(sc, ATH_DBG_FATAL,
1633 "%s: Unknown AMPDU action\n", __func__);
1634 }
1635
1636 return ret;
1637}
1638
Johannes Berg4233df62008-10-13 13:35:05 +02001639static int ath9k_no_fragmentation(struct ieee80211_hw *hw, u32 value)
1640{
1641 return -EOPNOTSUPP;
1642}
1643
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001644static struct ieee80211_ops ath9k_ops = {
1645 .tx = ath9k_tx,
1646 .start = ath9k_start,
1647 .stop = ath9k_stop,
1648 .add_interface = ath9k_add_interface,
1649 .remove_interface = ath9k_remove_interface,
1650 .config = ath9k_config,
1651 .config_interface = ath9k_config_interface,
1652 .configure_filter = ath9k_configure_filter,
1653 .get_stats = NULL,
1654 .sta_notify = ath9k_sta_notify,
1655 .conf_tx = ath9k_conf_tx,
1656 .get_tx_stats = NULL,
1657 .bss_info_changed = ath9k_bss_info_changed,
1658 .set_tim = NULL,
1659 .set_key = ath9k_set_key,
1660 .hw_scan = NULL,
1661 .get_tkip_seq = NULL,
1662 .set_rts_threshold = NULL,
1663 .set_frag_threshold = NULL,
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001664 .get_tsf = ath9k_get_tsf,
1665 .reset_tsf = ath9k_reset_tsf,
1666 .tx_last_beacon = NULL,
Johannes Berg4233df62008-10-13 13:35:05 +02001667 .ampdu_action = ath9k_ampdu_action,
1668 .set_frag_threshold = ath9k_no_fragmentation,
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001669};
1670
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001671static int ath_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
1672{
1673 void __iomem *mem;
1674 struct ath_softc *sc;
1675 struct ieee80211_hw *hw;
1676 const char *athname;
1677 u8 csz;
1678 u32 val;
1679 int ret = 0;
1680
1681 if (pci_enable_device(pdev))
1682 return -EIO;
1683
1684 /* XXX 32-bit addressing only */
1685 if (pci_set_dma_mask(pdev, 0xffffffff)) {
1686 printk(KERN_ERR "ath_pci: 32-bit DMA not available\n");
1687 ret = -ENODEV;
1688 goto bad;
1689 }
1690
1691 /*
1692 * Cache line size is used to size and align various
1693 * structures used to communicate with the hardware.
1694 */
1695 pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &csz);
1696 if (csz == 0) {
1697 /*
1698 * Linux 2.4.18 (at least) writes the cache line size
1699 * register as a 16-bit wide register which is wrong.
1700 * We must have this setup properly for rx buffer
1701 * DMA to work so force a reasonable value here if it
1702 * comes up zero.
1703 */
1704 csz = L1_CACHE_BYTES / sizeof(u32);
1705 pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE, csz);
1706 }
1707 /*
1708 * The default setting of latency timer yields poor results,
1709 * set it to the value used by other systems. It may be worth
1710 * tweaking this setting more.
1711 */
1712 pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0xa8);
1713
1714 pci_set_master(pdev);
1715
1716 /*
1717 * Disable the RETRY_TIMEOUT register (0x41) to keep
1718 * PCI Tx retries from interfering with C3 CPU state.
1719 */
1720 pci_read_config_dword(pdev, 0x40, &val);
1721 if ((val & 0x0000ff00) != 0)
1722 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
1723
1724 ret = pci_request_region(pdev, 0, "ath9k");
1725 if (ret) {
1726 dev_err(&pdev->dev, "PCI memory region reserve error\n");
1727 ret = -ENODEV;
1728 goto bad;
1729 }
1730
1731 mem = pci_iomap(pdev, 0, 0);
1732 if (!mem) {
1733 printk(KERN_ERR "PCI memory map error\n") ;
1734 ret = -EIO;
1735 goto bad1;
1736 }
1737
1738 hw = ieee80211_alloc_hw(sizeof(struct ath_softc), &ath9k_ops);
1739 if (hw == NULL) {
1740 printk(KERN_ERR "ath_pci: no memory for ieee80211_hw\n");
1741 goto bad2;
1742 }
1743
Sujith19b73c72008-08-14 13:28:20 +05301744 hw->flags = IEEE80211_HW_RX_INCLUDES_FCS |
Jouni Malinene022edb2008-08-22 17:31:33 +03001745 IEEE80211_HW_HOST_BROADCAST_PS_BUFFERING |
Sujith19b73c72008-08-14 13:28:20 +05301746 IEEE80211_HW_SIGNAL_DBM |
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001747 IEEE80211_HW_NOISE_DBM;
1748
Luis R. Rodriguezf59ac042008-08-29 16:26:43 -07001749 hw->wiphy->interface_modes =
1750 BIT(NL80211_IFTYPE_AP) |
1751 BIT(NL80211_IFTYPE_STATION) |
1752 BIT(NL80211_IFTYPE_ADHOC);
1753
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001754 SET_IEEE80211_DEV(hw, &pdev->dev);
1755 pci_set_drvdata(pdev, hw);
1756
1757 sc = hw->priv;
1758 sc->hw = hw;
1759 sc->pdev = pdev;
1760 sc->mem = mem;
1761
1762 if (ath_attach(id->device, sc) != 0) {
1763 ret = -ENODEV;
1764 goto bad3;
1765 }
1766
1767 /* setup interrupt service routine */
1768
1769 if (request_irq(pdev->irq, ath_isr, IRQF_SHARED, "ath", sc)) {
1770 printk(KERN_ERR "%s: request_irq failed\n",
1771 wiphy_name(hw->wiphy));
1772 ret = -EIO;
1773 goto bad4;
1774 }
1775
1776 athname = ath9k_hw_probe(id->vendor, id->device);
1777
1778 printk(KERN_INFO "%s: %s: mem=0x%lx, irq=%d\n",
1779 wiphy_name(hw->wiphy),
1780 athname ? athname : "Atheros ???",
1781 (unsigned long)mem, pdev->irq);
1782
1783 return 0;
1784bad4:
1785 ath_detach(sc);
1786bad3:
1787 ieee80211_free_hw(hw);
1788bad2:
1789 pci_iounmap(pdev, mem);
1790bad1:
1791 pci_release_region(pdev, 0);
1792bad:
1793 pci_disable_device(pdev);
1794 return ret;
1795}
1796
1797static void ath_pci_remove(struct pci_dev *pdev)
1798{
1799 struct ieee80211_hw *hw = pci_get_drvdata(pdev);
1800 struct ath_softc *sc = hw->priv;
Senthil Balasubramanian6115e852008-09-22 14:22:39 +05301801 enum ath9k_int status;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001802
Senthil Balasubramanian6115e852008-09-22 14:22:39 +05301803 if (pdev->irq) {
1804 ath9k_hw_set_interrupts(sc->sc_ah, 0);
1805 /* clear the ISR */
1806 ath9k_hw_getisr(sc->sc_ah, &status);
David S. Millerb262e602008-10-01 06:12:56 -07001807 sc->sc_flags |= SC_OP_INVALID;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001808 free_irq(pdev->irq, sc);
Senthil Balasubramanian6115e852008-09-22 14:22:39 +05301809 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001810 ath_detach(sc);
Senthil Balasubramanian6115e852008-09-22 14:22:39 +05301811
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001812 pci_iounmap(pdev, sc->mem);
1813 pci_release_region(pdev, 0);
1814 pci_disable_device(pdev);
1815 ieee80211_free_hw(hw);
1816}
1817
1818#ifdef CONFIG_PM
1819
1820static int ath_pci_suspend(struct pci_dev *pdev, pm_message_t state)
1821{
Vasanthakumar Thiagarajanc83be682008-08-25 20:47:29 +05301822 struct ieee80211_hw *hw = pci_get_drvdata(pdev);
1823 struct ath_softc *sc = hw->priv;
1824
1825 ath9k_hw_set_gpio(sc->sc_ah, ATH_LED_PIN, 1);
Vasanthakumar Thiagarajan500c0642008-09-10 18:50:17 +05301826
1827#ifdef CONFIG_RFKILL
1828 if (sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
1829 cancel_delayed_work_sync(&sc->rf_kill.rfkill_poll);
1830#endif
1831
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001832 pci_save_state(pdev);
1833 pci_disable_device(pdev);
1834 pci_set_power_state(pdev, 3);
1835
1836 return 0;
1837}
1838
1839static int ath_pci_resume(struct pci_dev *pdev)
1840{
Vasanthakumar Thiagarajanc83be682008-08-25 20:47:29 +05301841 struct ieee80211_hw *hw = pci_get_drvdata(pdev);
1842 struct ath_softc *sc = hw->priv;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001843 u32 val;
1844 int err;
1845
1846 err = pci_enable_device(pdev);
1847 if (err)
1848 return err;
1849 pci_restore_state(pdev);
1850 /*
1851 * Suspend/Resume resets the PCI configuration space, so we have to
1852 * re-disable the RETRY_TIMEOUT register (0x41) to keep
1853 * PCI Tx retries from interfering with C3 CPU state
1854 */
1855 pci_read_config_dword(pdev, 0x40, &val);
1856 if ((val & 0x0000ff00) != 0)
1857 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
1858
Vasanthakumar Thiagarajanc83be682008-08-25 20:47:29 +05301859 /* Enable LED */
1860 ath9k_hw_cfg_output(sc->sc_ah, ATH_LED_PIN,
1861 AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
1862 ath9k_hw_set_gpio(sc->sc_ah, ATH_LED_PIN, 1);
1863
Vasanthakumar Thiagarajan500c0642008-09-10 18:50:17 +05301864#ifdef CONFIG_RFKILL
1865 /*
1866 * check the h/w rfkill state on resume
1867 * and start the rfkill poll timer
1868 */
1869 if (sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
1870 queue_delayed_work(sc->hw->workqueue,
1871 &sc->rf_kill.rfkill_poll, 0);
1872#endif
1873
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001874 return 0;
1875}
1876
1877#endif /* CONFIG_PM */
1878
1879MODULE_DEVICE_TABLE(pci, ath_pci_id_table);
1880
1881static struct pci_driver ath_pci_driver = {
1882 .name = "ath9k",
1883 .id_table = ath_pci_id_table,
1884 .probe = ath_pci_probe,
1885 .remove = ath_pci_remove,
1886#ifdef CONFIG_PM
1887 .suspend = ath_pci_suspend,
1888 .resume = ath_pci_resume,
1889#endif /* CONFIG_PM */
1890};
1891
1892static int __init init_ath_pci(void)
1893{
1894 printk(KERN_INFO "%s: %s\n", dev_info, ATH_PCI_VERSION);
1895
1896 if (pci_register_driver(&ath_pci_driver) < 0) {
1897 printk(KERN_ERR
1898 "ath_pci: No devices found, driver not installed.\n");
1899 pci_unregister_driver(&ath_pci_driver);
1900 return -ENODEV;
1901 }
1902
1903 return 0;
1904}
1905module_init(init_ath_pci);
1906
1907static void __exit exit_ath_pci(void)
1908{
1909 pci_unregister_driver(&ath_pci_driver);
1910 printk(KERN_INFO "%s: driver unloaded\n", dev_info);
1911}
1912module_exit(exit_ath_pci);