mac80211-ops.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766
  1. /*-
  2. * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
  3. * Copyright (c) 2004-2005 Atheros Communications, Inc.
  4. * Copyright (c) 2006 Devicescape Software, Inc.
  5. * Copyright (c) 2007 Jiri Slaby <jirislaby@gmail.com>
  6. * Copyright (c) 2007 Luis R. Rodriguez <mcgrof@winlab.rutgers.edu>
  7. * Copyright (c) 2010 Bruno Randolf <br1@einfach.org>
  8. *
  9. * All rights reserved.
  10. *
  11. * Redistribution and use in source and binary forms, with or without
  12. * modification, are permitted provided that the following conditions
  13. * are met:
  14. * 1. Redistributions of source code must retain the above copyright
  15. * notice, this list of conditions and the following disclaimer,
  16. * without modification.
  17. * 2. Redistributions in binary form must reproduce at minimum a disclaimer
  18. * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
  19. * redistribution must be conditioned upon including a substantially
  20. * similar Disclaimer requirement for further binary redistribution.
  21. * 3. Neither the names of the above-listed copyright holders nor the names
  22. * of any contributors may be used to endorse or promote products derived
  23. * from this software without specific prior written permission.
  24. *
  25. * Alternatively, this software may be distributed under the terms of the
  26. * GNU General Public License ("GPL") version 2 as published by the Free
  27. * Software Foundation.
  28. *
  29. * NO WARRANTY
  30. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  31. * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  32. * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
  33. * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
  34. * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
  35. * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  36. * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  37. * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
  38. * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  39. * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  40. * THE POSSIBILITY OF SUCH DAMAGES.
  41. *
  42. */
  43. #include <asm/unaligned.h>
  44. #include "base.h"
  45. #include "reg.h"
  46. extern int ath5k_modparam_nohwcrypt;
  47. /********************\
  48. * Mac80211 functions *
  49. \********************/
  50. static int
  51. ath5k_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
  52. {
  53. struct ath5k_softc *sc = hw->priv;
  54. u16 qnum = skb_get_queue_mapping(skb);
  55. if (WARN_ON(qnum >= sc->ah->ah_capabilities.cap_queues.q_tx_num)) {
  56. dev_kfree_skb_any(skb);
  57. return 0;
  58. }
  59. return ath5k_tx_queue(hw, skb, &sc->txqs[qnum]);
  60. }
  61. static int
  62. ath5k_start(struct ieee80211_hw *hw)
  63. {
  64. return ath5k_init_hw(hw->priv);
  65. }
  66. static void
  67. ath5k_stop(struct ieee80211_hw *hw)
  68. {
  69. ath5k_stop_hw(hw->priv);
  70. }
  71. static int
  72. ath5k_add_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
  73. {
  74. struct ath5k_softc *sc = hw->priv;
  75. int ret;
  76. struct ath5k_vif *avf = (void *)vif->drv_priv;
  77. mutex_lock(&sc->lock);
  78. if ((vif->type == NL80211_IFTYPE_AP ||
  79. vif->type == NL80211_IFTYPE_ADHOC)
  80. && (sc->num_ap_vifs + sc->num_adhoc_vifs) >= ATH_BCBUF) {
  81. ret = -ELNRNG;
  82. goto end;
  83. }
  84. /* Don't allow other interfaces if one ad-hoc is configured.
  85. * TODO: Fix the problems with ad-hoc and multiple other interfaces.
  86. * We would need to operate the HW in ad-hoc mode to allow TSF updates
  87. * for the IBSS, but this breaks with additional AP or STA interfaces
  88. * at the moment. */
  89. if (sc->num_adhoc_vifs ||
  90. (sc->nvifs && vif->type == NL80211_IFTYPE_ADHOC)) {
  91. ATH5K_ERR(sc, "Only one single ad-hoc interface is allowed.\n");
  92. ret = -ELNRNG;
  93. goto end;
  94. }
  95. switch (vif->type) {
  96. case NL80211_IFTYPE_AP:
  97. case NL80211_IFTYPE_STATION:
  98. case NL80211_IFTYPE_ADHOC:
  99. case NL80211_IFTYPE_MESH_POINT:
  100. avf->opmode = vif->type;
  101. break;
  102. default:
  103. ret = -EOPNOTSUPP;
  104. goto end;
  105. }
  106. sc->nvifs++;
  107. ATH5K_DBG(sc, ATH5K_DEBUG_MODE, "add interface mode %d\n", avf->opmode);
  108. /* Assign the vap/adhoc to a beacon xmit slot. */
  109. if ((avf->opmode == NL80211_IFTYPE_AP) ||
  110. (avf->opmode == NL80211_IFTYPE_ADHOC) ||
  111. (avf->opmode == NL80211_IFTYPE_MESH_POINT)) {
  112. int slot;
  113. WARN_ON(list_empty(&sc->bcbuf));
  114. avf->bbuf = list_first_entry(&sc->bcbuf, struct ath5k_buf,
  115. list);
  116. list_del(&avf->bbuf->list);
  117. avf->bslot = 0;
  118. for (slot = 0; slot < ATH_BCBUF; slot++) {
  119. if (!sc->bslot[slot]) {
  120. avf->bslot = slot;
  121. break;
  122. }
  123. }
  124. BUG_ON(sc->bslot[avf->bslot] != NULL);
  125. sc->bslot[avf->bslot] = vif;
  126. if (avf->opmode == NL80211_IFTYPE_AP)
  127. sc->num_ap_vifs++;
  128. else if (avf->opmode == NL80211_IFTYPE_ADHOC)
  129. sc->num_adhoc_vifs++;
  130. }
  131. /* Any MAC address is fine, all others are included through the
  132. * filter.
  133. */
  134. memcpy(&sc->lladdr, vif->addr, ETH_ALEN);
  135. ath5k_hw_set_lladdr(sc->ah, vif->addr);
  136. memcpy(&avf->lladdr, vif->addr, ETH_ALEN);
  137. ath5k_mode_setup(sc, vif);
  138. ret = 0;
  139. end:
  140. mutex_unlock(&sc->lock);
  141. return ret;
  142. }
  143. static void
  144. ath5k_remove_interface(struct ieee80211_hw *hw,
  145. struct ieee80211_vif *vif)
  146. {
  147. struct ath5k_softc *sc = hw->priv;
  148. struct ath5k_vif *avf = (void *)vif->drv_priv;
  149. unsigned int i;
  150. mutex_lock(&sc->lock);
  151. sc->nvifs--;
  152. if (avf->bbuf) {
  153. ath5k_txbuf_free_skb(sc, avf->bbuf);
  154. list_add_tail(&avf->bbuf->list, &sc->bcbuf);
  155. for (i = 0; i < ATH_BCBUF; i++) {
  156. if (sc->bslot[i] == vif) {
  157. sc->bslot[i] = NULL;
  158. break;
  159. }
  160. }
  161. avf->bbuf = NULL;
  162. }
  163. if (avf->opmode == NL80211_IFTYPE_AP)
  164. sc->num_ap_vifs--;
  165. else if (avf->opmode == NL80211_IFTYPE_ADHOC)
  166. sc->num_adhoc_vifs--;
  167. ath5k_update_bssid_mask_and_opmode(sc, NULL);
  168. mutex_unlock(&sc->lock);
  169. }
  170. /*
  171. * TODO: Phy disable/diversity etc
  172. */
  173. static int
  174. ath5k_config(struct ieee80211_hw *hw, u32 changed)
  175. {
  176. struct ath5k_softc *sc = hw->priv;
  177. struct ath5k_hw *ah = sc->ah;
  178. struct ieee80211_conf *conf = &hw->conf;
  179. int ret = 0;
  180. int i;
  181. mutex_lock(&sc->lock);
  182. if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
  183. ret = ath5k_chan_set(sc, conf->channel);
  184. if (ret < 0)
  185. goto unlock;
  186. }
  187. if ((changed & IEEE80211_CONF_CHANGE_POWER) &&
  188. (sc->power_level != conf->power_level)) {
  189. sc->power_level = conf->power_level;
  190. /* Half dB steps */
  191. ath5k_hw_set_txpower_limit(ah, (conf->power_level * 2));
  192. }
  193. if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) {
  194. ah->ah_retry_long = conf->long_frame_max_tx_count;
  195. ah->ah_retry_short = conf->short_frame_max_tx_count;
  196. for (i = 0; i < ah->ah_capabilities.cap_queues.q_tx_num; i++)
  197. ath5k_hw_set_tx_retry_limits(ah, i);
  198. }
  199. /* TODO:
  200. * 1) Move this on config_interface and handle each case
  201. * separately eg. when we have only one STA vif, use
  202. * AR5K_ANTMODE_SINGLE_AP
  203. *
  204. * 2) Allow the user to change antenna mode eg. when only
  205. * one antenna is present
  206. *
  207. * 3) Allow the user to set default/tx antenna when possible
  208. *
  209. * 4) Default mode should handle 90% of the cases, together
  210. * with fixed a/b and single AP modes we should be able to
  211. * handle 99%. Sectored modes are extreme cases and i still
  212. * haven't found a usage for them. If we decide to support them,
  213. * then we must allow the user to set how many tx antennas we
  214. * have available
  215. */
  216. ath5k_hw_set_antenna_mode(ah, ah->ah_ant_mode);
  217. unlock:
  218. mutex_unlock(&sc->lock);
  219. return ret;
  220. }
  221. static void
  222. ath5k_bss_info_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
  223. struct ieee80211_bss_conf *bss_conf, u32 changes)
  224. {
  225. struct ath5k_vif *avf = (void *)vif->drv_priv;
  226. struct ath5k_softc *sc = hw->priv;
  227. struct ath5k_hw *ah = sc->ah;
  228. struct ath_common *common = ath5k_hw_common(ah);
  229. unsigned long flags;
  230. mutex_lock(&sc->lock);
  231. if (changes & BSS_CHANGED_BSSID) {
  232. /* Cache for later use during resets */
  233. memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
  234. common->curaid = 0;
  235. ath5k_hw_set_bssid(ah);
  236. mmiowb();
  237. }
  238. if (changes & BSS_CHANGED_BEACON_INT)
  239. sc->bintval = bss_conf->beacon_int;
  240. if (changes & BSS_CHANGED_ASSOC) {
  241. avf->assoc = bss_conf->assoc;
  242. if (bss_conf->assoc)
  243. sc->assoc = bss_conf->assoc;
  244. else
  245. sc->assoc = ath_any_vif_assoc(sc);
  246. if (sc->opmode == NL80211_IFTYPE_STATION)
  247. set_beacon_filter(hw, sc->assoc);
  248. ath5k_hw_set_ledstate(sc->ah, sc->assoc ?
  249. AR5K_LED_ASSOC : AR5K_LED_INIT);
  250. if (bss_conf->assoc) {
  251. ATH5K_DBG(sc, ATH5K_DEBUG_ANY,
  252. "Bss Info ASSOC %d, bssid: %pM\n",
  253. bss_conf->aid, common->curbssid);
  254. common->curaid = bss_conf->aid;
  255. ath5k_hw_set_bssid(ah);
  256. /* Once ANI is available you would start it here */
  257. }
  258. }
  259. if (changes & BSS_CHANGED_BEACON) {
  260. spin_lock_irqsave(&sc->block, flags);
  261. ath5k_beacon_update(hw, vif);
  262. spin_unlock_irqrestore(&sc->block, flags);
  263. }
  264. if (changes & BSS_CHANGED_BEACON_ENABLED)
  265. sc->enable_beacon = bss_conf->enable_beacon;
  266. if (changes & (BSS_CHANGED_BEACON | BSS_CHANGED_BEACON_ENABLED |
  267. BSS_CHANGED_BEACON_INT))
  268. ath5k_beacon_config(sc);
  269. mutex_unlock(&sc->lock);
  270. }
  271. static u64
  272. ath5k_prepare_multicast(struct ieee80211_hw *hw,
  273. struct netdev_hw_addr_list *mc_list)
  274. {
  275. u32 mfilt[2], val;
  276. u8 pos;
  277. struct netdev_hw_addr *ha;
  278. mfilt[0] = 0;
  279. mfilt[1] = 1;
  280. netdev_hw_addr_list_for_each(ha, mc_list) {
  281. /* calculate XOR of eight 6-bit values */
  282. val = get_unaligned_le32(ha->addr + 0);
  283. pos = (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
  284. val = get_unaligned_le32(ha->addr + 3);
  285. pos ^= (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
  286. pos &= 0x3f;
  287. mfilt[pos / 32] |= (1 << (pos % 32));
  288. /* XXX: we might be able to just do this instead,
  289. * but not sure, needs testing, if we do use this we'd
  290. * neet to inform below to not reset the mcast */
  291. /* ath5k_hw_set_mcast_filterindex(ah,
  292. * ha->addr[5]); */
  293. }
  294. return ((u64)(mfilt[1]) << 32) | mfilt[0];
  295. }
  296. /*
  297. * o always accept unicast, broadcast, and multicast traffic
  298. * o multicast traffic for all BSSIDs will be enabled if mac80211
  299. * says it should be
  300. * o maintain current state of phy ofdm or phy cck error reception.
  301. * If the hardware detects any of these type of errors then
  302. * ath5k_hw_get_rx_filter() will pass to us the respective
  303. * hardware filters to be able to receive these type of frames.
  304. * o probe request frames are accepted only when operating in
  305. * hostap, adhoc, or monitor modes
  306. * o enable promiscuous mode according to the interface state
  307. * o accept beacons:
  308. * - when operating in adhoc mode so the 802.11 layer creates
  309. * node table entries for peers,
  310. * - when operating in station mode for collecting rssi data when
  311. * the station is otherwise quiet, or
  312. * - when scanning
  313. */
  314. static void
  315. ath5k_configure_filter(struct ieee80211_hw *hw, unsigned int changed_flags,
  316. unsigned int *new_flags, u64 multicast)
  317. {
  318. #define SUPPORTED_FIF_FLAGS \
  319. (FIF_PROMISC_IN_BSS | FIF_ALLMULTI | FIF_FCSFAIL | \
  320. FIF_PLCPFAIL | FIF_CONTROL | FIF_OTHER_BSS | \
  321. FIF_BCN_PRBRESP_PROMISC)
  322. struct ath5k_softc *sc = hw->priv;
  323. struct ath5k_hw *ah = sc->ah;
  324. u32 mfilt[2], rfilt;
  325. mutex_lock(&sc->lock);
  326. mfilt[0] = multicast;
  327. mfilt[1] = multicast >> 32;
  328. /* Only deal with supported flags */
  329. changed_flags &= SUPPORTED_FIF_FLAGS;
  330. *new_flags &= SUPPORTED_FIF_FLAGS;
  331. /* If HW detects any phy or radar errors, leave those filters on.
  332. * Also, always enable Unicast, Broadcasts and Multicast
  333. * XXX: move unicast, bssid broadcasts and multicast to mac80211 */
  334. rfilt = (ath5k_hw_get_rx_filter(ah) & (AR5K_RX_FILTER_PHYERR)) |
  335. (AR5K_RX_FILTER_UCAST | AR5K_RX_FILTER_BCAST |
  336. AR5K_RX_FILTER_MCAST);
  337. if (changed_flags & (FIF_PROMISC_IN_BSS | FIF_OTHER_BSS)) {
  338. if (*new_flags & FIF_PROMISC_IN_BSS)
  339. __set_bit(ATH_STAT_PROMISC, sc->status);
  340. else
  341. __clear_bit(ATH_STAT_PROMISC, sc->status);
  342. }
  343. if (test_bit(ATH_STAT_PROMISC, sc->status))
  344. rfilt |= AR5K_RX_FILTER_PROM;
  345. /* Note, AR5K_RX_FILTER_MCAST is already enabled */
  346. if (*new_flags & FIF_ALLMULTI) {
  347. mfilt[0] = ~0;
  348. mfilt[1] = ~0;
  349. }
  350. /* This is the best we can do */
  351. if (*new_flags & (FIF_FCSFAIL | FIF_PLCPFAIL))
  352. rfilt |= AR5K_RX_FILTER_PHYERR;
  353. /* FIF_BCN_PRBRESP_PROMISC really means to enable beacons
  354. * and probes for any BSSID */
  355. if ((*new_flags & FIF_BCN_PRBRESP_PROMISC) || (sc->nvifs > 1))
  356. rfilt |= AR5K_RX_FILTER_BEACON;
  357. /* FIF_CONTROL doc says that if FIF_PROMISC_IN_BSS is not
  358. * set we should only pass on control frames for this
  359. * station. This needs testing. I believe right now this
  360. * enables *all* control frames, which is OK.. but
  361. * but we should see if we can improve on granularity */
  362. if (*new_flags & FIF_CONTROL)
  363. rfilt |= AR5K_RX_FILTER_CONTROL;
  364. /* Additional settings per mode -- this is per ath5k */
  365. /* XXX move these to mac80211, and add a beacon IFF flag to mac80211 */
  366. switch (sc->opmode) {
  367. case NL80211_IFTYPE_MESH_POINT:
  368. rfilt |= AR5K_RX_FILTER_CONTROL |
  369. AR5K_RX_FILTER_BEACON |
  370. AR5K_RX_FILTER_PROBEREQ |
  371. AR5K_RX_FILTER_PROM;
  372. break;
  373. case NL80211_IFTYPE_AP:
  374. case NL80211_IFTYPE_ADHOC:
  375. rfilt |= AR5K_RX_FILTER_PROBEREQ |
  376. AR5K_RX_FILTER_BEACON;
  377. break;
  378. case NL80211_IFTYPE_STATION:
  379. if (sc->assoc)
  380. rfilt |= AR5K_RX_FILTER_BEACON;
  381. default:
  382. break;
  383. }
  384. /* Set filters */
  385. ath5k_hw_set_rx_filter(ah, rfilt);
  386. /* Set multicast bits */
  387. ath5k_hw_set_mcast_filter(ah, mfilt[0], mfilt[1]);
  388. /* Set the cached hw filter flags, this will later actually
  389. * be set in HW */
  390. sc->filter_flags = rfilt;
  391. mutex_unlock(&sc->lock);
  392. }
  393. static int
  394. ath5k_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
  395. struct ieee80211_vif *vif, struct ieee80211_sta *sta,
  396. struct ieee80211_key_conf *key)
  397. {
  398. struct ath5k_softc *sc = hw->priv;
  399. struct ath5k_hw *ah = sc->ah;
  400. struct ath_common *common = ath5k_hw_common(ah);
  401. int ret = 0;
  402. if (ath5k_modparam_nohwcrypt)
  403. return -EOPNOTSUPP;
  404. switch (key->cipher) {
  405. case WLAN_CIPHER_SUITE_WEP40:
  406. case WLAN_CIPHER_SUITE_WEP104:
  407. case WLAN_CIPHER_SUITE_TKIP:
  408. break;
  409. case WLAN_CIPHER_SUITE_CCMP:
  410. if (common->crypt_caps & ATH_CRYPT_CAP_CIPHER_AESCCM)
  411. break;
  412. return -EOPNOTSUPP;
  413. default:
  414. WARN_ON(1);
  415. return -EINVAL;
  416. }
  417. mutex_lock(&sc->lock);
  418. switch (cmd) {
  419. case SET_KEY:
  420. ret = ath_key_config(common, vif, sta, key);
  421. if (ret >= 0) {
  422. key->hw_key_idx = ret;
  423. /* push IV and Michael MIC generation to stack */
  424. key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
  425. if (key->cipher == WLAN_CIPHER_SUITE_TKIP)
  426. key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
  427. if (key->cipher == WLAN_CIPHER_SUITE_CCMP)
  428. key->flags |= IEEE80211_KEY_FLAG_SW_MGMT;
  429. ret = 0;
  430. }
  431. break;
  432. case DISABLE_KEY:
  433. ath_key_delete(common, key);
  434. break;
  435. default:
  436. ret = -EINVAL;
  437. }
  438. mmiowb();
  439. mutex_unlock(&sc->lock);
  440. return ret;
  441. }
  442. static void
  443. ath5k_sw_scan_start(struct ieee80211_hw *hw)
  444. {
  445. struct ath5k_softc *sc = hw->priv;
  446. if (!sc->assoc)
  447. ath5k_hw_set_ledstate(sc->ah, AR5K_LED_SCAN);
  448. }
  449. static void
  450. ath5k_sw_scan_complete(struct ieee80211_hw *hw)
  451. {
  452. struct ath5k_softc *sc = hw->priv;
  453. ath5k_hw_set_ledstate(sc->ah, sc->assoc ?
  454. AR5K_LED_ASSOC : AR5K_LED_INIT);
  455. }
  456. static int
  457. ath5k_get_stats(struct ieee80211_hw *hw,
  458. struct ieee80211_low_level_stats *stats)
  459. {
  460. struct ath5k_softc *sc = hw->priv;
  461. /* Force update */
  462. ath5k_hw_update_mib_counters(sc->ah);
  463. stats->dot11ACKFailureCount = sc->stats.ack_fail;
  464. stats->dot11RTSFailureCount = sc->stats.rts_fail;
  465. stats->dot11RTSSuccessCount = sc->stats.rts_ok;
  466. stats->dot11FCSErrorCount = sc->stats.fcs_error;
  467. return 0;
  468. }
  469. static int
  470. ath5k_conf_tx(struct ieee80211_hw *hw, u16 queue,
  471. const struct ieee80211_tx_queue_params *params)
  472. {
  473. struct ath5k_softc *sc = hw->priv;
  474. struct ath5k_hw *ah = sc->ah;
  475. struct ath5k_txq_info qi;
  476. int ret = 0;
  477. if (queue >= ah->ah_capabilities.cap_queues.q_tx_num)
  478. return 0;
  479. mutex_lock(&sc->lock);
  480. ath5k_hw_get_tx_queueprops(ah, queue, &qi);
  481. qi.tqi_aifs = params->aifs;
  482. qi.tqi_cw_min = params->cw_min;
  483. qi.tqi_cw_max = params->cw_max;
  484. qi.tqi_burst_time = params->txop;
  485. ATH5K_DBG(sc, ATH5K_DEBUG_ANY,
  486. "Configure tx [queue %d], "
  487. "aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
  488. queue, params->aifs, params->cw_min,
  489. params->cw_max, params->txop);
  490. if (ath5k_hw_set_tx_queueprops(ah, queue, &qi)) {
  491. ATH5K_ERR(sc,
  492. "Unable to update hardware queue %u!\n", queue);
  493. ret = -EIO;
  494. } else
  495. ath5k_hw_reset_tx_queue(ah, queue);
  496. mutex_unlock(&sc->lock);
  497. return ret;
  498. }
  499. static u64
  500. ath5k_get_tsf(struct ieee80211_hw *hw)
  501. {
  502. struct ath5k_softc *sc = hw->priv;
  503. return ath5k_hw_get_tsf64(sc->ah);
  504. }
  505. static void
  506. ath5k_set_tsf(struct ieee80211_hw *hw, u64 tsf)
  507. {
  508. struct ath5k_softc *sc = hw->priv;
  509. ath5k_hw_set_tsf64(sc->ah, tsf);
  510. }
  511. static void
  512. ath5k_reset_tsf(struct ieee80211_hw *hw)
  513. {
  514. struct ath5k_softc *sc = hw->priv;
  515. /*
  516. * in IBSS mode we need to update the beacon timers too.
  517. * this will also reset the TSF if we call it with 0
  518. */
  519. if (sc->opmode == NL80211_IFTYPE_ADHOC)
  520. ath5k_beacon_update_timers(sc, 0);
  521. else
  522. ath5k_hw_reset_tsf(sc->ah);
  523. }
  524. static int
  525. ath5k_get_survey(struct ieee80211_hw *hw, int idx, struct survey_info *survey)
  526. {
  527. struct ath5k_softc *sc = hw->priv;
  528. struct ieee80211_conf *conf = &hw->conf;
  529. struct ath_common *common = ath5k_hw_common(sc->ah);
  530. struct ath_cycle_counters *cc = &common->cc_survey;
  531. unsigned int div = common->clockrate * 1000;
  532. if (idx != 0)
  533. return -ENOENT;
  534. spin_lock_bh(&common->cc_lock);
  535. ath_hw_cycle_counters_update(common);
  536. if (cc->cycles > 0) {
  537. sc->survey.channel_time += cc->cycles / div;
  538. sc->survey.channel_time_busy += cc->rx_busy / div;
  539. sc->survey.channel_time_rx += cc->rx_frame / div;
  540. sc->survey.channel_time_tx += cc->tx_frame / div;
  541. }
  542. memset(cc, 0, sizeof(*cc));
  543. spin_unlock_bh(&common->cc_lock);
  544. memcpy(survey, &sc->survey, sizeof(*survey));
  545. survey->channel = conf->channel;
  546. survey->noise = sc->ah->ah_noise_floor;
  547. survey->filled = SURVEY_INFO_NOISE_DBM |
  548. SURVEY_INFO_CHANNEL_TIME |
  549. SURVEY_INFO_CHANNEL_TIME_BUSY |
  550. SURVEY_INFO_CHANNEL_TIME_RX |
  551. SURVEY_INFO_CHANNEL_TIME_TX;
  552. return 0;
  553. }
  554. /**
  555. * ath5k_set_coverage_class - Set IEEE 802.11 coverage class
  556. *
  557. * @hw: struct ieee80211_hw pointer
  558. * @coverage_class: IEEE 802.11 coverage class number
  559. *
  560. * Mac80211 callback. Sets slot time, ACK timeout and CTS timeout for given
  561. * coverage class. The values are persistent, they are restored after device
  562. * reset.
  563. */
  564. static void
  565. ath5k_set_coverage_class(struct ieee80211_hw *hw, u8 coverage_class)
  566. {
  567. struct ath5k_softc *sc = hw->priv;
  568. mutex_lock(&sc->lock);
  569. ath5k_hw_set_coverage_class(sc->ah, coverage_class);
  570. mutex_unlock(&sc->lock);
  571. }
  572. static int
  573. ath5k_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant)
  574. {
  575. struct ath5k_softc *sc = hw->priv;
  576. if (tx_ant == 1 && rx_ant == 1)
  577. ath5k_hw_set_antenna_mode(sc->ah, AR5K_ANTMODE_FIXED_A);
  578. else if (tx_ant == 2 && rx_ant == 2)
  579. ath5k_hw_set_antenna_mode(sc->ah, AR5K_ANTMODE_FIXED_B);
  580. else if ((tx_ant & 3) == 3 && (rx_ant & 3) == 3)
  581. ath5k_hw_set_antenna_mode(sc->ah, AR5K_ANTMODE_DEFAULT);
  582. else
  583. return -EINVAL;
  584. return 0;
  585. }
  586. static int
  587. ath5k_get_antenna(struct ieee80211_hw *hw, u32 *tx_ant, u32 *rx_ant)
  588. {
  589. struct ath5k_softc *sc = hw->priv;
  590. switch (sc->ah->ah_ant_mode) {
  591. case AR5K_ANTMODE_FIXED_A:
  592. *tx_ant = 1; *rx_ant = 1; break;
  593. case AR5K_ANTMODE_FIXED_B:
  594. *tx_ant = 2; *rx_ant = 2; break;
  595. case AR5K_ANTMODE_DEFAULT:
  596. *tx_ant = 3; *rx_ant = 3; break;
  597. }
  598. return 0;
  599. }
  600. const struct ieee80211_ops ath5k_hw_ops = {
  601. .tx = ath5k_tx,
  602. .start = ath5k_start,
  603. .stop = ath5k_stop,
  604. .add_interface = ath5k_add_interface,
  605. /* .change_interface = not implemented */
  606. .remove_interface = ath5k_remove_interface,
  607. .config = ath5k_config,
  608. .bss_info_changed = ath5k_bss_info_changed,
  609. .prepare_multicast = ath5k_prepare_multicast,
  610. .configure_filter = ath5k_configure_filter,
  611. /* .set_tim = not implemented */
  612. .set_key = ath5k_set_key,
  613. /* .update_tkip_key = not implemented */
  614. /* .hw_scan = not implemented */
  615. .sw_scan_start = ath5k_sw_scan_start,
  616. .sw_scan_complete = ath5k_sw_scan_complete,
  617. .get_stats = ath5k_get_stats,
  618. /* .get_tkip_seq = not implemented */
  619. /* .set_frag_threshold = not implemented */
  620. /* .set_rts_threshold = not implemented */
  621. /* .sta_add = not implemented */
  622. /* .sta_remove = not implemented */
  623. /* .sta_notify = not implemented */
  624. .conf_tx = ath5k_conf_tx,
  625. .get_tsf = ath5k_get_tsf,
  626. .set_tsf = ath5k_set_tsf,
  627. .reset_tsf = ath5k_reset_tsf,
  628. /* .tx_last_beacon = not implemented */
  629. /* .ampdu_action = not needed */
  630. .get_survey = ath5k_get_survey,
  631. .set_coverage_class = ath5k_set_coverage_class,
  632. /* .rfkill_poll = not implemented */
  633. /* .flush = not implemented */
  634. /* .channel_switch = not implemented */
  635. /* .napi_poll = not implemented */
  636. .set_antenna = ath5k_set_antenna,
  637. .get_antenna = ath5k_get_antenna,
  638. };