ARM: mm: Recreate kernel mappings in early_paging_init()
[linux/fpc-iii.git] / drivers / net / wireless / ath / ath9k / gpio.c
blob4b412aaf4f3699e65396598be9f7485f2af0754f
1 /*
2 * Copyright (c) 2008-2011 Atheros Communications Inc.
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.
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.
17 #include "ath9k.h"
19 /********************************/
20 /* LED functions */
21 /********************************/
23 #ifdef CONFIG_MAC80211_LEDS
24 static void ath_led_brightness(struct led_classdev *led_cdev,
25 enum led_brightness brightness)
27 struct ath_softc *sc = container_of(led_cdev, struct ath_softc, led_cdev);
28 ath9k_hw_set_gpio(sc->sc_ah, sc->sc_ah->led_pin, (brightness == LED_OFF));
31 void ath_deinit_leds(struct ath_softc *sc)
33 if (!sc->led_registered)
34 return;
36 ath_led_brightness(&sc->led_cdev, LED_OFF);
37 led_classdev_unregister(&sc->led_cdev);
40 void ath_init_leds(struct ath_softc *sc)
42 int ret;
44 if (AR_SREV_9100(sc->sc_ah))
45 return;
47 if (!led_blink)
48 sc->led_cdev.default_trigger =
49 ieee80211_get_radio_led_name(sc->hw);
51 snprintf(sc->led_name, sizeof(sc->led_name),
52 "ath9k-%s", wiphy_name(sc->hw->wiphy));
53 sc->led_cdev.name = sc->led_name;
54 sc->led_cdev.brightness_set = ath_led_brightness;
56 ret = led_classdev_register(wiphy_dev(sc->hw->wiphy), &sc->led_cdev);
57 if (ret < 0)
58 return;
60 sc->led_registered = true;
63 void ath_fill_led_pin(struct ath_softc *sc)
65 struct ath_hw *ah = sc->sc_ah;
67 if (AR_SREV_9100(ah) || (ah->led_pin >= 0))
68 return;
70 if (AR_SREV_9287(ah))
71 ah->led_pin = ATH_LED_PIN_9287;
72 else if (AR_SREV_9485(sc->sc_ah))
73 ah->led_pin = ATH_LED_PIN_9485;
74 else if (AR_SREV_9300(sc->sc_ah))
75 ah->led_pin = ATH_LED_PIN_9300;
76 else if (AR_SREV_9462(sc->sc_ah) || AR_SREV_9565(sc->sc_ah))
77 ah->led_pin = ATH_LED_PIN_9462;
78 else
79 ah->led_pin = ATH_LED_PIN_DEF;
81 /* Configure gpio 1 for output */
82 ath9k_hw_cfg_output(ah, ah->led_pin, AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
84 /* LED off, active low */
85 ath9k_hw_set_gpio(ah, ah->led_pin, 1);
87 #endif
89 /*******************/
90 /* Rfkill */
91 /*******************/
93 static bool ath_is_rfkill_set(struct ath_softc *sc)
95 struct ath_hw *ah = sc->sc_ah;
96 bool is_blocked;
98 ath9k_ps_wakeup(sc);
99 is_blocked = ath9k_hw_gpio_get(ah, ah->rfkill_gpio) ==
100 ah->rfkill_polarity;
101 ath9k_ps_restore(sc);
103 return is_blocked;
106 void ath9k_rfkill_poll_state(struct ieee80211_hw *hw)
108 struct ath_softc *sc = hw->priv;
109 bool blocked = !!ath_is_rfkill_set(sc);
111 wiphy_rfkill_set_hw_state(hw->wiphy, blocked);
114 void ath_start_rfkill_poll(struct ath_softc *sc)
116 struct ath_hw *ah = sc->sc_ah;
118 if (ah->caps.hw_caps & ATH9K_HW_CAP_RFSILENT)
119 wiphy_rfkill_start_polling(sc->hw->wiphy);
122 #ifdef CONFIG_ATH9K_BTCOEX_SUPPORT
124 /******************/
125 /* BTCOEX */
126 /******************/
129 * Detects if there is any priority bt traffic
131 static void ath_detect_bt_priority(struct ath_softc *sc)
133 struct ath_btcoex *btcoex = &sc->btcoex;
134 struct ath_hw *ah = sc->sc_ah;
136 if (ath9k_hw_gpio_get(sc->sc_ah, ah->btcoex_hw.btpriority_gpio))
137 btcoex->bt_priority_cnt++;
139 if (time_after(jiffies, btcoex->bt_priority_time +
140 msecs_to_jiffies(ATH_BT_PRIORITY_TIME_THRESHOLD))) {
141 clear_bit(BT_OP_PRIORITY_DETECTED, &btcoex->op_flags);
142 clear_bit(BT_OP_SCAN, &btcoex->op_flags);
143 /* Detect if colocated bt started scanning */
144 if (btcoex->bt_priority_cnt >= ATH_BT_CNT_SCAN_THRESHOLD) {
145 ath_dbg(ath9k_hw_common(sc->sc_ah), BTCOEX,
146 "BT scan detected\n");
147 set_bit(BT_OP_PRIORITY_DETECTED, &btcoex->op_flags);
148 set_bit(BT_OP_SCAN, &btcoex->op_flags);
149 } else if (btcoex->bt_priority_cnt >= ATH_BT_CNT_THRESHOLD) {
150 ath_dbg(ath9k_hw_common(sc->sc_ah), BTCOEX,
151 "BT priority traffic detected\n");
152 set_bit(BT_OP_PRIORITY_DETECTED, &btcoex->op_flags);
155 btcoex->bt_priority_cnt = 0;
156 btcoex->bt_priority_time = jiffies;
160 static void ath9k_gen_timer_start(struct ath_hw *ah,
161 struct ath_gen_timer *timer,
162 u32 trig_timeout,
163 u32 timer_period)
165 ath9k_hw_gen_timer_start(ah, timer, trig_timeout, timer_period);
167 if ((ah->imask & ATH9K_INT_GENTIMER) == 0) {
168 ath9k_hw_disable_interrupts(ah);
169 ah->imask |= ATH9K_INT_GENTIMER;
170 ath9k_hw_set_interrupts(ah);
171 ath9k_hw_enable_interrupts(ah);
175 static void ath9k_gen_timer_stop(struct ath_hw *ah, struct ath_gen_timer *timer)
177 struct ath_gen_timer_table *timer_table = &ah->hw_gen_timers;
179 ath9k_hw_gen_timer_stop(ah, timer);
181 /* if no timer is enabled, turn off interrupt mask */
182 if (timer_table->timer_mask.val == 0) {
183 ath9k_hw_disable_interrupts(ah);
184 ah->imask &= ~ATH9K_INT_GENTIMER;
185 ath9k_hw_set_interrupts(ah);
186 ath9k_hw_enable_interrupts(ah);
190 static void ath_mci_ftp_adjust(struct ath_softc *sc)
192 struct ath_btcoex *btcoex = &sc->btcoex;
193 struct ath_mci_profile *mci = &btcoex->mci;
194 struct ath_hw *ah = sc->sc_ah;
196 if (btcoex->bt_wait_time > ATH_BTCOEX_RX_WAIT_TIME) {
197 if (ar9003_mci_state(ah, MCI_STATE_NEED_FTP_STOMP) &&
198 (mci->num_pan || mci->num_other_acl))
199 ah->btcoex_hw.mci.stomp_ftp =
200 (sc->rx.num_pkts < ATH_BTCOEX_STOMP_FTP_THRESH);
201 else
202 ah->btcoex_hw.mci.stomp_ftp = false;
203 btcoex->bt_wait_time = 0;
204 sc->rx.num_pkts = 0;
209 * This is the master bt coex timer which runs for every
210 * 45ms, bt traffic will be given priority during 55% of this
211 * period while wlan gets remaining 45%
213 static void ath_btcoex_period_timer(unsigned long data)
215 struct ath_softc *sc = (struct ath_softc *) data;
216 struct ath_hw *ah = sc->sc_ah;
217 struct ath_btcoex *btcoex = &sc->btcoex;
218 enum ath_stomp_type stomp_type;
219 u32 timer_period;
220 unsigned long flags;
222 spin_lock_irqsave(&sc->sc_pm_lock, flags);
223 if (sc->sc_ah->power_mode == ATH9K_PM_NETWORK_SLEEP) {
224 btcoex->bt_wait_time += btcoex->btcoex_period;
225 spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
226 goto skip_hw_wakeup;
228 spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
230 ath9k_mci_update_rssi(sc);
232 ath9k_ps_wakeup(sc);
234 if (!(ah->caps.hw_caps & ATH9K_HW_CAP_MCI))
235 ath_detect_bt_priority(sc);
237 if (ah->caps.hw_caps & ATH9K_HW_CAP_MCI)
238 ath_mci_ftp_adjust(sc);
240 spin_lock_bh(&btcoex->btcoex_lock);
242 stomp_type = btcoex->bt_stomp_type;
243 timer_period = btcoex->btcoex_no_stomp;
245 if (!(ah->caps.hw_caps & ATH9K_HW_CAP_MCI)) {
246 if (test_bit(BT_OP_SCAN, &btcoex->op_flags)) {
247 stomp_type = ATH_BTCOEX_STOMP_ALL;
248 timer_period = btcoex->btscan_no_stomp;
250 } else if (btcoex->stomp_audio >= 5) {
251 stomp_type = ATH_BTCOEX_STOMP_AUDIO;
252 btcoex->stomp_audio = 0;
255 ath9k_hw_btcoex_bt_stomp(ah, stomp_type);
256 ath9k_hw_btcoex_enable(ah);
258 spin_unlock_bh(&btcoex->btcoex_lock);
261 * btcoex_period is in msec while (btocex/btscan_)no_stomp are in usec,
262 * ensure that we properly convert btcoex_period to usec
263 * for any comparision with (btcoex/btscan_)no_stomp.
265 if (btcoex->btcoex_period * 1000 != btcoex->btcoex_no_stomp) {
266 if (btcoex->hw_timer_enabled)
267 ath9k_gen_timer_stop(ah, btcoex->no_stomp_timer);
269 ath9k_gen_timer_start(ah, btcoex->no_stomp_timer, timer_period,
270 timer_period * 10);
271 btcoex->hw_timer_enabled = true;
274 ath9k_ps_restore(sc);
276 skip_hw_wakeup:
277 mod_timer(&btcoex->period_timer,
278 jiffies + msecs_to_jiffies(btcoex->btcoex_period));
282 * Generic tsf based hw timer which configures weight
283 * registers to time slice between wlan and bt traffic
285 static void ath_btcoex_no_stomp_timer(void *arg)
287 struct ath_softc *sc = (struct ath_softc *)arg;
288 struct ath_hw *ah = sc->sc_ah;
289 struct ath_btcoex *btcoex = &sc->btcoex;
290 struct ath_common *common = ath9k_hw_common(ah);
292 ath_dbg(common, BTCOEX, "no stomp timer running\n");
294 ath9k_ps_wakeup(sc);
295 spin_lock_bh(&btcoex->btcoex_lock);
297 if (btcoex->bt_stomp_type == ATH_BTCOEX_STOMP_LOW ||
298 (!(ah->caps.hw_caps & ATH9K_HW_CAP_MCI) &&
299 test_bit(BT_OP_SCAN, &btcoex->op_flags)))
300 ath9k_hw_btcoex_bt_stomp(ah, ATH_BTCOEX_STOMP_NONE);
301 else if (btcoex->bt_stomp_type == ATH_BTCOEX_STOMP_ALL)
302 ath9k_hw_btcoex_bt_stomp(ah, ATH_BTCOEX_STOMP_LOW);
304 ath9k_hw_btcoex_enable(ah);
305 spin_unlock_bh(&btcoex->btcoex_lock);
306 ath9k_ps_restore(sc);
309 static int ath_init_btcoex_timer(struct ath_softc *sc)
311 struct ath_btcoex *btcoex = &sc->btcoex;
313 btcoex->btcoex_period = ATH_BTCOEX_DEF_BT_PERIOD;
314 btcoex->btcoex_no_stomp = (100 - ATH_BTCOEX_DEF_DUTY_CYCLE) * 1000 *
315 btcoex->btcoex_period / 100;
316 btcoex->btscan_no_stomp = (100 - ATH_BTCOEX_BTSCAN_DUTY_CYCLE) * 1000 *
317 btcoex->btcoex_period / 100;
319 setup_timer(&btcoex->period_timer, ath_btcoex_period_timer,
320 (unsigned long) sc);
322 spin_lock_init(&btcoex->btcoex_lock);
324 btcoex->no_stomp_timer = ath_gen_timer_alloc(sc->sc_ah,
325 ath_btcoex_no_stomp_timer,
326 ath_btcoex_no_stomp_timer,
327 (void *) sc, AR_FIRST_NDP_TIMER);
329 if (!btcoex->no_stomp_timer)
330 return -ENOMEM;
332 return 0;
336 * (Re)start btcoex timers
338 void ath9k_btcoex_timer_resume(struct ath_softc *sc)
340 struct ath_btcoex *btcoex = &sc->btcoex;
341 struct ath_hw *ah = sc->sc_ah;
343 ath_dbg(ath9k_hw_common(ah), BTCOEX, "Starting btcoex timers\n");
345 /* make sure duty cycle timer is also stopped when resuming */
346 if (btcoex->hw_timer_enabled) {
347 ath9k_gen_timer_stop(sc->sc_ah, btcoex->no_stomp_timer);
348 btcoex->hw_timer_enabled = false;
351 btcoex->bt_priority_cnt = 0;
352 btcoex->bt_priority_time = jiffies;
353 clear_bit(BT_OP_PRIORITY_DETECTED, &btcoex->op_flags);
354 clear_bit(BT_OP_SCAN, &btcoex->op_flags);
356 mod_timer(&btcoex->period_timer, jiffies);
361 * Pause btcoex timer and bt duty cycle timer
363 void ath9k_btcoex_timer_pause(struct ath_softc *sc)
365 struct ath_btcoex *btcoex = &sc->btcoex;
366 struct ath_hw *ah = sc->sc_ah;
368 del_timer_sync(&btcoex->period_timer);
370 if (btcoex->hw_timer_enabled) {
371 ath9k_gen_timer_stop(ah, btcoex->no_stomp_timer);
372 btcoex->hw_timer_enabled = false;
376 void ath9k_btcoex_stop_gen_timer(struct ath_softc *sc)
378 struct ath_btcoex *btcoex = &sc->btcoex;
380 if (btcoex->hw_timer_enabled) {
381 ath9k_gen_timer_stop(sc->sc_ah, btcoex->no_stomp_timer);
382 btcoex->hw_timer_enabled = false;
386 u16 ath9k_btcoex_aggr_limit(struct ath_softc *sc, u32 max_4ms_framelen)
388 struct ath_btcoex *btcoex = &sc->btcoex;
389 struct ath_mci_profile *mci = &sc->btcoex.mci;
390 u16 aggr_limit = 0;
392 if ((sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_MCI) && mci->aggr_limit)
393 aggr_limit = (max_4ms_framelen * mci->aggr_limit) >> 4;
394 else if (test_bit(BT_OP_PRIORITY_DETECTED, &btcoex->op_flags))
395 aggr_limit = min((max_4ms_framelen * 3) / 8,
396 (u32)ATH_AMPDU_LIMIT_MAX);
398 return aggr_limit;
401 void ath9k_btcoex_handle_interrupt(struct ath_softc *sc, u32 status)
403 struct ath_hw *ah = sc->sc_ah;
405 if (ath9k_hw_get_btcoex_scheme(ah) == ATH_BTCOEX_CFG_3WIRE)
406 if (status & ATH9K_INT_GENTIMER)
407 ath_gen_timer_isr(sc->sc_ah);
409 if (status & ATH9K_INT_MCI)
410 ath_mci_intr(sc);
413 void ath9k_start_btcoex(struct ath_softc *sc)
415 struct ath_hw *ah = sc->sc_ah;
417 if ((ath9k_hw_get_btcoex_scheme(ah) != ATH_BTCOEX_CFG_NONE) &&
418 !ah->btcoex_hw.enabled) {
419 if (!(sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_MCI))
420 ath9k_hw_btcoex_set_weight(ah, AR_BT_COEX_WGHT,
421 AR_STOMP_LOW_WLAN_WGHT, 0);
422 else
423 ath9k_hw_btcoex_set_weight(ah, 0, 0,
424 ATH_BTCOEX_STOMP_NONE);
425 ath9k_hw_btcoex_enable(ah);
427 if (ath9k_hw_get_btcoex_scheme(ah) == ATH_BTCOEX_CFG_3WIRE)
428 ath9k_btcoex_timer_resume(sc);
432 void ath9k_stop_btcoex(struct ath_softc *sc)
434 struct ath_hw *ah = sc->sc_ah;
436 if (ah->btcoex_hw.enabled &&
437 ath9k_hw_get_btcoex_scheme(ah) != ATH_BTCOEX_CFG_NONE) {
438 if (ath9k_hw_get_btcoex_scheme(ah) == ATH_BTCOEX_CFG_3WIRE)
439 ath9k_btcoex_timer_pause(sc);
440 ath9k_hw_btcoex_disable(ah);
441 if (AR_SREV_9462(ah) || AR_SREV_9565(ah))
442 ath_mci_flush_profile(&sc->btcoex.mci);
446 void ath9k_deinit_btcoex(struct ath_softc *sc)
448 struct ath_hw *ah = sc->sc_ah;
450 if ((sc->btcoex.no_stomp_timer) &&
451 ath9k_hw_get_btcoex_scheme(sc->sc_ah) == ATH_BTCOEX_CFG_3WIRE)
452 ath_gen_timer_free(sc->sc_ah, sc->btcoex.no_stomp_timer);
454 if (ath9k_hw_mci_is_enabled(ah))
455 ath_mci_cleanup(sc);
458 int ath9k_init_btcoex(struct ath_softc *sc)
460 struct ath_txq *txq;
461 struct ath_hw *ah = sc->sc_ah;
462 int r;
464 ath9k_hw_btcoex_init_scheme(ah);
466 switch (ath9k_hw_get_btcoex_scheme(sc->sc_ah)) {
467 case ATH_BTCOEX_CFG_NONE:
468 break;
469 case ATH_BTCOEX_CFG_2WIRE:
470 ath9k_hw_btcoex_init_2wire(sc->sc_ah);
471 break;
472 case ATH_BTCOEX_CFG_3WIRE:
473 ath9k_hw_btcoex_init_3wire(sc->sc_ah);
474 r = ath_init_btcoex_timer(sc);
475 if (r)
476 return -1;
477 txq = sc->tx.txq_map[IEEE80211_AC_BE];
478 ath9k_hw_init_btcoex_hw(sc->sc_ah, txq->axq_qnum);
479 sc->btcoex.bt_stomp_type = ATH_BTCOEX_STOMP_LOW;
480 if (ath9k_hw_mci_is_enabled(ah)) {
481 sc->btcoex.duty_cycle = ATH_BTCOEX_DEF_DUTY_CYCLE;
482 INIT_LIST_HEAD(&sc->btcoex.mci.info);
484 r = ath_mci_setup(sc);
485 if (r)
486 return r;
488 ath9k_hw_btcoex_init_mci(ah);
491 break;
492 default:
493 WARN_ON(1);
494 break;
497 return 0;
500 static int ath9k_dump_mci_btcoex(struct ath_softc *sc, u8 *buf, u32 size)
502 struct ath_btcoex *btcoex = &sc->btcoex;
503 struct ath_mci_profile *mci = &btcoex->mci;
504 struct ath_hw *ah = sc->sc_ah;
505 struct ath_btcoex_hw *btcoex_hw = &ah->btcoex_hw;
506 u32 len = 0;
507 int i;
509 ATH_DUMP_BTCOEX("Total BT profiles", NUM_PROF(mci));
510 ATH_DUMP_BTCOEX("MGMT", mci->num_mgmt);
511 ATH_DUMP_BTCOEX("SCO", mci->num_sco);
512 ATH_DUMP_BTCOEX("A2DP", mci->num_a2dp);
513 ATH_DUMP_BTCOEX("HID", mci->num_hid);
514 ATH_DUMP_BTCOEX("PAN", mci->num_pan);
515 ATH_DUMP_BTCOEX("ACL", mci->num_other_acl);
516 ATH_DUMP_BTCOEX("BDR", mci->num_bdr);
517 ATH_DUMP_BTCOEX("Aggr. Limit", mci->aggr_limit);
518 ATH_DUMP_BTCOEX("Stomp Type", btcoex->bt_stomp_type);
519 ATH_DUMP_BTCOEX("BTCoex Period (msec)", btcoex->btcoex_period);
520 ATH_DUMP_BTCOEX("Duty Cycle", btcoex->duty_cycle);
521 ATH_DUMP_BTCOEX("BT Wait time", btcoex->bt_wait_time);
522 ATH_DUMP_BTCOEX("Concurrent Tx", btcoex_hw->mci.concur_tx);
523 ATH_DUMP_BTCOEX("Concurrent RSSI cnt", btcoex->rssi_count);
525 len += snprintf(buf + len, size - len, "BT Weights: ");
526 for (i = 0; i < AR9300_NUM_BT_WEIGHTS; i++)
527 len += snprintf(buf + len, size - len, "%08x ",
528 btcoex_hw->bt_weight[i]);
529 len += snprintf(buf + len, size - len, "\n");
530 len += snprintf(buf + len, size - len, "WLAN Weights: ");
531 for (i = 0; i < AR9300_NUM_BT_WEIGHTS; i++)
532 len += snprintf(buf + len, size - len, "%08x ",
533 btcoex_hw->wlan_weight[i]);
534 len += snprintf(buf + len, size - len, "\n");
535 len += snprintf(buf + len, size - len, "Tx Priorities: ");
536 for (i = 0; i < ATH_BTCOEX_STOMP_MAX; i++)
537 len += snprintf(buf + len, size - len, "%08x ",
538 btcoex_hw->tx_prio[i]);
540 len += snprintf(buf + len, size - len, "\n");
542 return len;
545 static int ath9k_dump_legacy_btcoex(struct ath_softc *sc, u8 *buf, u32 size)
548 struct ath_btcoex *btcoex = &sc->btcoex;
549 u32 len = 0;
551 ATH_DUMP_BTCOEX("Stomp Type", btcoex->bt_stomp_type);
552 ATH_DUMP_BTCOEX("BTCoex Period (msec)", btcoex->btcoex_period);
553 ATH_DUMP_BTCOEX("Duty Cycle", btcoex->duty_cycle);
554 ATH_DUMP_BTCOEX("BT Wait time", btcoex->bt_wait_time);
556 return len;
559 int ath9k_dump_btcoex(struct ath_softc *sc, u8 *buf, u32 size)
561 if (ath9k_hw_mci_is_enabled(sc->sc_ah))
562 return ath9k_dump_mci_btcoex(sc, buf, size);
563 else
564 return ath9k_dump_legacy_btcoex(sc, buf, size);
567 #endif /* CONFIG_ATH9K_BTCOEX_SUPPORT */