gpio: rcar: Fix runtime PM imbalance on error
[linux/fpc-iii.git] / drivers / net / wireless / ath / ath9k / common-beacon.c
blob01d6d3205a654292397557990ea485b074313341
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 "common.h"
19 #define FUDGE 2
21 static u32 ath9k_get_next_tbtt(struct ath_hw *ah, u64 tsf,
22 unsigned int interval)
24 unsigned int offset, divisor;
26 tsf += TU_TO_USEC(FUDGE + ah->config.sw_beacon_response_time);
27 divisor = TU_TO_USEC(interval);
28 div_u64_rem(tsf, divisor, &offset);
30 return (u32) tsf + divisor - offset;
34 * This sets up the beacon timers according to the timestamp of the last
35 * received beacon and the current TSF, configures PCF and DTIM
36 * handling, programs the sleep registers so the hardware will wakeup in
37 * time to receive beacons, and configures the beacon miss handling so
38 * we'll receive a BMISS interrupt when we stop seeing beacons from the AP
39 * we've associated with.
41 int ath9k_cmn_beacon_config_sta(struct ath_hw *ah,
42 struct ath_beacon_config *conf,
43 struct ath9k_beacon_state *bs)
45 struct ath_common *common = ath9k_hw_common(ah);
46 int dtim_intval;
47 u64 tsf;
49 /* No need to configure beacon if we are not associated */
50 if (!test_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags)) {
51 ath_dbg(common, BEACON,
52 "STA is not yet associated..skipping beacon config\n");
53 return -EPERM;
56 memset(bs, 0, sizeof(*bs));
57 conf->intval = conf->beacon_interval;
60 * Setup dtim parameters according to
61 * last beacon we received (which may be none).
63 dtim_intval = conf->intval * conf->dtim_period;
66 * Pull nexttbtt forward to reflect the current
67 * TSF and calculate dtim state for the result.
69 tsf = ath9k_hw_gettsf64(ah);
70 conf->nexttbtt = ath9k_get_next_tbtt(ah, tsf, conf->intval);
72 bs->bs_intval = TU_TO_USEC(conf->intval);
73 bs->bs_dtimperiod = conf->dtim_period * bs->bs_intval;
74 bs->bs_nexttbtt = conf->nexttbtt;
75 bs->bs_nextdtim = conf->nexttbtt;
76 if (conf->dtim_period > 1)
77 bs->bs_nextdtim = ath9k_get_next_tbtt(ah, tsf, dtim_intval);
80 * Calculate the number of consecutive beacons to miss* before taking
81 * a BMISS interrupt. The configuration is specified in TU so we only
82 * need calculate based on the beacon interval. Note that we clamp the
83 * result to at most 15 beacons.
85 bs->bs_bmissthreshold = DIV_ROUND_UP(conf->bmiss_timeout, conf->intval);
86 if (bs->bs_bmissthreshold > 15)
87 bs->bs_bmissthreshold = 15;
88 else if (bs->bs_bmissthreshold <= 0)
89 bs->bs_bmissthreshold = 1;
92 * Calculate sleep duration. The configuration is given in ms.
93 * We ensure a multiple of the beacon period is used. Also, if the sleep
94 * duration is greater than the DTIM period then it makes senses
95 * to make it a multiple of that.
97 * XXX fixed at 100ms
100 bs->bs_sleepduration = TU_TO_USEC(roundup(IEEE80211_MS_TO_TU(100),
101 conf->intval));
102 if (bs->bs_sleepduration > bs->bs_dtimperiod)
103 bs->bs_sleepduration = bs->bs_dtimperiod;
105 /* TSF out of range threshold fixed at 1 second */
106 bs->bs_tsfoor_threshold = ATH9K_TSFOOR_THRESHOLD;
108 ath_dbg(common, BEACON, "bmiss: %u sleep: %u\n",
109 bs->bs_bmissthreshold, bs->bs_sleepduration);
110 return 0;
112 EXPORT_SYMBOL(ath9k_cmn_beacon_config_sta);
114 void ath9k_cmn_beacon_config_adhoc(struct ath_hw *ah,
115 struct ath_beacon_config *conf)
117 struct ath_common *common = ath9k_hw_common(ah);
119 conf->intval = TU_TO_USEC(conf->beacon_interval);
121 if (conf->ibss_creator)
122 conf->nexttbtt = conf->intval;
123 else
124 conf->nexttbtt = ath9k_get_next_tbtt(ah, ath9k_hw_gettsf64(ah),
125 conf->beacon_interval);
127 if (conf->enable_beacon)
128 ah->imask |= ATH9K_INT_SWBA;
129 else
130 ah->imask &= ~ATH9K_INT_SWBA;
132 ath_dbg(common, BEACON,
133 "IBSS (%s) nexttbtt: %u intval: %u conf_intval: %u\n",
134 (conf->enable_beacon) ? "Enable" : "Disable",
135 conf->nexttbtt, conf->intval, conf->beacon_interval);
137 EXPORT_SYMBOL(ath9k_cmn_beacon_config_adhoc);
140 * For multi-bss ap support beacons are either staggered evenly over N slots or
141 * burst together. For the former arrange for the SWBA to be delivered for each
142 * slot. Slots that are not occupied will generate nothing.
144 void ath9k_cmn_beacon_config_ap(struct ath_hw *ah,
145 struct ath_beacon_config *conf,
146 unsigned int bc_buf)
148 struct ath_common *common = ath9k_hw_common(ah);
150 /* NB: the beacon interval is kept internally in TU's */
151 conf->intval = TU_TO_USEC(conf->beacon_interval);
152 conf->intval /= bc_buf;
153 conf->nexttbtt = ath9k_get_next_tbtt(ah, ath9k_hw_gettsf64(ah),
154 conf->beacon_interval);
156 if (conf->enable_beacon)
157 ah->imask |= ATH9K_INT_SWBA;
158 else
159 ah->imask &= ~ATH9K_INT_SWBA;
161 ath_dbg(common, BEACON,
162 "AP (%s) nexttbtt: %u intval: %u conf_intval: %u\n",
163 (conf->enable_beacon) ? "Enable" : "Disable",
164 conf->nexttbtt, conf->intval, conf->beacon_interval);
166 EXPORT_SYMBOL(ath9k_cmn_beacon_config_ap);