Commit | Line | Data |
---|---|---|
95ea3627 | 1 | /* |
9c9a0d14 | 2 | Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com> |
95ea3627 ID |
3 | <http://rt2x00.serialmonkey.com> |
4 | ||
5 | This program is free software; you can redistribute it and/or modify | |
6 | it under the terms of the GNU General Public License as published by | |
7 | the Free Software Foundation; either version 2 of the License, or | |
8 | (at your option) any later version. | |
9 | ||
10 | This program is distributed in the hope that it will be useful, | |
11 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | GNU General Public License for more details. | |
14 | ||
15 | You should have received a copy of the GNU General Public License | |
16 | along with this program; if not, write to the | |
17 | Free Software Foundation, Inc., | |
18 | 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
19 | */ | |
20 | ||
21 | /* | |
22 | Module: rt2x00lib | |
23 | Abstract: rt2x00 generic configuration routines. | |
24 | */ | |
25 | ||
95ea3627 ID |
26 | #include <linux/kernel.h> |
27 | #include <linux/module.h> | |
28 | ||
29 | #include "rt2x00.h" | |
30 | #include "rt2x00lib.h" | |
31 | ||
6bb40dd1 ID |
32 | void rt2x00lib_config_intf(struct rt2x00_dev *rt2x00dev, |
33 | struct rt2x00_intf *intf, | |
05c914fe | 34 | enum nl80211_iftype type, |
5f936f11 | 35 | const u8 *mac, const u8 *bssid) |
95ea3627 | 36 | { |
6bb40dd1 ID |
37 | struct rt2x00intf_conf conf; |
38 | unsigned int flags = 0; | |
95ea3627 | 39 | |
6bb40dd1 | 40 | conf.type = type; |
feb24691 ID |
41 | |
42 | switch (type) { | |
05c914fe | 43 | case NL80211_IFTYPE_ADHOC: |
ab8966dd HS |
44 | conf.sync = TSF_SYNC_ADHOC; |
45 | break; | |
05c914fe | 46 | case NL80211_IFTYPE_AP: |
a07dbea2 | 47 | case NL80211_IFTYPE_MESH_POINT: |
ce292a64 | 48 | case NL80211_IFTYPE_WDS: |
ab8966dd | 49 | conf.sync = TSF_SYNC_AP_NONE; |
feb24691 | 50 | break; |
05c914fe | 51 | case NL80211_IFTYPE_STATION: |
6bb40dd1 | 52 | conf.sync = TSF_SYNC_INFRA; |
feb24691 ID |
53 | break; |
54 | default: | |
6bb40dd1 | 55 | conf.sync = TSF_SYNC_NONE; |
feb24691 ID |
56 | break; |
57 | } | |
58 | ||
6bb40dd1 ID |
59 | /* |
60 | * Note that when NULL is passed as address we will send | |
61 | * 00:00:00:00:00 to the device to clear the address. | |
62 | * This will prevent the device being confused when it wants | |
25985edc | 63 | * to ACK frames or considers itself associated. |
6bb40dd1 | 64 | */ |
736e3aca | 65 | memset(conf.mac, 0, sizeof(conf.mac)); |
6bb40dd1 | 66 | if (mac) |
736e3aca | 67 | memcpy(conf.mac, mac, ETH_ALEN); |
6bb40dd1 | 68 | |
736e3aca | 69 | memset(conf.bssid, 0, sizeof(conf.bssid)); |
6bb40dd1 | 70 | if (bssid) |
736e3aca | 71 | memcpy(conf.bssid, bssid, ETH_ALEN); |
6bb40dd1 ID |
72 | |
73 | flags |= CONFIG_UPDATE_TYPE; | |
74 | if (mac || (!rt2x00dev->intf_ap_count && !rt2x00dev->intf_sta_count)) | |
75 | flags |= CONFIG_UPDATE_MAC; | |
76 | if (bssid || (!rt2x00dev->intf_ap_count && !rt2x00dev->intf_sta_count)) | |
77 | flags |= CONFIG_UPDATE_BSSID; | |
78 | ||
79 | rt2x00dev->ops->lib->config_intf(rt2x00dev, intf, &conf, flags); | |
80 | } | |
81 | ||
72810379 ID |
82 | void rt2x00lib_config_erp(struct rt2x00_dev *rt2x00dev, |
83 | struct rt2x00_intf *intf, | |
02044643 HS |
84 | struct ieee80211_bss_conf *bss_conf, |
85 | u32 changed) | |
6bb40dd1 | 86 | { |
72810379 | 87 | struct rt2x00lib_erp erp; |
6bb40dd1 | 88 | |
72810379 ID |
89 | memset(&erp, 0, sizeof(erp)); |
90 | ||
91 | erp.short_preamble = bss_conf->use_short_preamble; | |
e360c4cb ID |
92 | erp.cts_protection = bss_conf->use_cts_prot; |
93 | ||
e4ea1c40 ID |
94 | erp.slot_time = bss_conf->use_short_slot ? SHORT_SLOT_TIME : SLOT_TIME; |
95 | erp.sifs = SIFS; | |
96 | erp.pifs = bss_conf->use_short_slot ? SHORT_PIFS : PIFS; | |
97 | erp.difs = bss_conf->use_short_slot ? SHORT_DIFS : DIFS; | |
98 | erp.eifs = bss_conf->use_short_slot ? SHORT_EIFS : EIFS; | |
6bb40dd1 | 99 | |
e4ea1c40 | 100 | erp.basic_rates = bss_conf->basic_rates; |
8a566afe | 101 | erp.beacon_int = bss_conf->beacon_int; |
e4ea1c40 | 102 | |
1c0bcf89 ID |
103 | /* Update the AID, this is needed for dynamic PS support */ |
104 | rt2x00dev->aid = bss_conf->assoc ? bss_conf->aid : 0; | |
8c358bcd | 105 | rt2x00dev->last_beacon = bss_conf->sync_tsf; |
1c0bcf89 | 106 | |
6b347bff ID |
107 | /* Update global beacon interval time, this is needed for PS support */ |
108 | rt2x00dev->beacon_int = bss_conf->beacon_int; | |
109 | ||
87c1915d HS |
110 | if (changed & BSS_CHANGED_HT) |
111 | erp.ht_opmode = bss_conf->ht_operation_mode; | |
112 | ||
02044643 | 113 | rt2x00dev->ops->lib->config_erp(rt2x00dev, &erp, changed); |
95ea3627 ID |
114 | } |
115 | ||
69f81a2c | 116 | void rt2x00lib_config_antenna(struct rt2x00_dev *rt2x00dev, |
bdfa500b | 117 | struct antenna_setup config) |
69f81a2c | 118 | { |
bdfa500b | 119 | struct link_ant *ant = &rt2x00dev->link.ant; |
0b927a07 ID |
120 | struct antenna_setup *def = &rt2x00dev->default_ant; |
121 | struct antenna_setup *active = &rt2x00dev->link.ant.active; | |
122 | ||
6d64360a | 123 | /* |
0ed7b3c0 ID |
124 | * When the caller tries to send the SW diversity, |
125 | * we must update the ANTENNA_RX_DIVERSITY flag to | |
126 | * enable the antenna diversity in the link tuner. | |
127 | * | |
128 | * Secondly, we must guarentee we never send the | |
129 | * software antenna diversity command to the driver. | |
6d64360a | 130 | */ |
0ed7b3c0 ID |
131 | if (!(ant->flags & ANTENNA_RX_DIVERSITY)) { |
132 | if (config.rx == ANTENNA_SW_DIVERSITY) { | |
133 | ant->flags |= ANTENNA_RX_DIVERSITY; | |
134 | ||
135 | if (def->rx == ANTENNA_SW_DIVERSITY) | |
136 | config.rx = ANTENNA_B; | |
137 | else | |
138 | config.rx = def->rx; | |
139 | } | |
140 | } else if (config.rx == ANTENNA_SW_DIVERSITY) | |
bdfa500b | 141 | config.rx = active->rx; |
69f81a2c | 142 | |
0ed7b3c0 ID |
143 | if (!(ant->flags & ANTENNA_TX_DIVERSITY)) { |
144 | if (config.tx == ANTENNA_SW_DIVERSITY) { | |
145 | ant->flags |= ANTENNA_TX_DIVERSITY; | |
146 | ||
147 | if (def->tx == ANTENNA_SW_DIVERSITY) | |
148 | config.tx = ANTENNA_B; | |
149 | else | |
150 | config.tx = def->tx; | |
151 | } | |
152 | } else if (config.tx == ANTENNA_SW_DIVERSITY) | |
bdfa500b ID |
153 | config.tx = active->tx; |
154 | ||
e25c4bb9 ID |
155 | /* |
156 | * Antenna setup changes require the RX to be disabled, | |
157 | * else the changes will be ignored by the device. | |
158 | */ | |
0262ab0d | 159 | if (test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags)) |
0b7fde54 | 160 | rt2x00queue_stop_queue(rt2x00dev->rx); |
e25c4bb9 | 161 | |
69f81a2c ID |
162 | /* |
163 | * Write new antenna setup to device and reset the link tuner. | |
164 | * The latter is required since we need to recalibrate the | |
165 | * noise-sensitivity ratio for the new setup. | |
166 | */ | |
bdfa500b | 167 | rt2x00dev->ops->lib->config_ant(rt2x00dev, &config); |
e4ea1c40 | 168 | |
84e3196f | 169 | rt2x00link_reset_tuner(rt2x00dev, true); |
69f81a2c | 170 | |
bdfa500b | 171 | memcpy(active, &config, sizeof(config)); |
e25c4bb9 | 172 | |
0262ab0d | 173 | if (test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags)) |
0b7fde54 | 174 | rt2x00queue_start_queue(rt2x00dev->rx); |
69f81a2c ID |
175 | } |
176 | ||
46a01ec0 GW |
177 | static u16 rt2x00ht_center_channel(struct rt2x00_dev *rt2x00dev, |
178 | struct ieee80211_conf *conf) | |
179 | { | |
180 | struct hw_mode_spec *spec = &rt2x00dev->spec; | |
181 | int center_channel; | |
182 | u16 i; | |
183 | ||
184 | /* | |
185 | * Initialize center channel to current channel. | |
186 | */ | |
675a0b04 | 187 | center_channel = spec->channels[conf->chandef.chan->hw_value].channel; |
46a01ec0 GW |
188 | |
189 | /* | |
190 | * Adjust center channel to HT40+ and HT40- operation. | |
191 | */ | |
192 | if (conf_is_ht40_plus(conf)) | |
193 | center_channel += 2; | |
194 | else if (conf_is_ht40_minus(conf)) | |
195 | center_channel -= (center_channel == 14) ? 1 : 2; | |
196 | ||
197 | for (i = 0; i < spec->num_channels; i++) | |
198 | if (spec->channels[i].channel == center_channel) | |
199 | return i; | |
200 | ||
201 | WARN_ON(1); | |
675a0b04 | 202 | return conf->chandef.chan->hw_value; |
46a01ec0 GW |
203 | } |
204 | ||
066cb637 | 205 | void rt2x00lib_config(struct rt2x00_dev *rt2x00dev, |
e4ea1c40 ID |
206 | struct ieee80211_conf *conf, |
207 | unsigned int ieee80211_flags) | |
95ea3627 | 208 | { |
5c58ee51 | 209 | struct rt2x00lib_conf libconf; |
06443e46 | 210 | u16 hw_value; |
1c0bcf89 ID |
211 | u16 autowake_timeout; |
212 | u16 beacon_int; | |
213 | u16 beacon_diff; | |
95ea3627 | 214 | |
5c58ee51 ID |
215 | memset(&libconf, 0, sizeof(libconf)); |
216 | ||
e4ea1c40 | 217 | libconf.conf = conf; |
5c58ee51 | 218 | |
e4ea1c40 | 219 | if (ieee80211_flags & IEEE80211_CONF_CHANGE_CHANNEL) { |
da40f407 SG |
220 | if (!conf_is_ht(conf)) |
221 | set_bit(CONFIG_HT_DISABLED, &rt2x00dev->flags); | |
222 | else | |
223 | clear_bit(CONFIG_HT_DISABLED, &rt2x00dev->flags); | |
224 | ||
06443e46 | 225 | if (conf_is_ht40(conf)) { |
7dab73b3 | 226 | set_bit(CONFIG_CHANNEL_HT40, &rt2x00dev->flags); |
06443e46 GW |
227 | hw_value = rt2x00ht_center_channel(rt2x00dev, conf); |
228 | } else { | |
7dab73b3 | 229 | clear_bit(CONFIG_CHANNEL_HT40, &rt2x00dev->flags); |
675a0b04 | 230 | hw_value = conf->chandef.chan->hw_value; |
06443e46 | 231 | } |
35f00cfc | 232 | |
5c58ee51 | 233 | memcpy(&libconf.rf, |
06443e46 | 234 | &rt2x00dev->spec.channels[hw_value], |
5c58ee51 | 235 | sizeof(libconf.rf)); |
8c5e7a5f ID |
236 | |
237 | memcpy(&libconf.channel, | |
06443e46 | 238 | &rt2x00dev->spec.channels_info[hw_value], |
8c5e7a5f | 239 | sizeof(libconf.channel)); |
2e9c43dd JL |
240 | |
241 | /* Used for VCO periodic calibration */ | |
242 | rt2x00dev->rf_channel = libconf.rf.channel; | |
5c58ee51 ID |
243 | } |
244 | ||
1c0bcf89 ID |
245 | if (test_bit(REQUIRE_PS_AUTOWAKE, &rt2x00dev->cap_flags) && |
246 | (ieee80211_flags & IEEE80211_CONF_CHANGE_PS)) | |
247 | cancel_delayed_work_sync(&rt2x00dev->autowakeup_work); | |
248 | ||
5c58ee51 ID |
249 | /* |
250 | * Start configuration. | |
251 | */ | |
e4ea1c40 | 252 | rt2x00dev->ops->lib->config(rt2x00dev, &libconf, ieee80211_flags); |
95ea3627 ID |
253 | |
254 | /* | |
255 | * Some configuration changes affect the link quality | |
256 | * which means we need to reset the link tuner. | |
257 | */ | |
e4ea1c40 | 258 | if (ieee80211_flags & IEEE80211_CONF_CHANGE_CHANNEL) |
84e3196f | 259 | rt2x00link_reset_tuner(rt2x00dev, false); |
95ea3627 | 260 | |
3bb42a64 SG |
261 | if (test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags) && |
262 | test_bit(REQUIRE_PS_AUTOWAKE, &rt2x00dev->cap_flags) && | |
1c0bcf89 ID |
263 | (ieee80211_flags & IEEE80211_CONF_CHANGE_PS) && |
264 | (conf->flags & IEEE80211_CONF_PS)) { | |
265 | beacon_diff = (long)jiffies - (long)rt2x00dev->last_beacon; | |
266 | beacon_int = msecs_to_jiffies(rt2x00dev->beacon_int); | |
267 | ||
268 | if (beacon_diff > beacon_int) | |
269 | beacon_diff = 0; | |
270 | ||
271 | autowake_timeout = (conf->max_sleep_period * beacon_int) - beacon_diff; | |
272 | queue_delayed_work(rt2x00dev->workqueue, | |
273 | &rt2x00dev->autowakeup_work, | |
274 | autowake_timeout - 15); | |
275 | } | |
276 | ||
277 | if (conf->flags & IEEE80211_CONF_PS) | |
278 | set_bit(CONFIG_POWERSAVING, &rt2x00dev->flags); | |
279 | else | |
280 | clear_bit(CONFIG_POWERSAVING, &rt2x00dev->flags); | |
281 | ||
675a0b04 KB |
282 | rt2x00dev->curr_band = conf->chandef.chan->band; |
283 | rt2x00dev->curr_freq = conf->chandef.chan->center_freq; | |
95ea3627 | 284 | rt2x00dev->tx_power = conf->power_level; |
42c82857 ID |
285 | rt2x00dev->short_retry = conf->short_frame_max_tx_count; |
286 | rt2x00dev->long_retry = conf->long_frame_max_tx_count; | |
95ea3627 | 287 | } |