Commit | Line | Data |
---|---|---|
95ea3627 | 1 | /* |
811aa9ca | 2 | Copyright (C) 2004 - 2008 rt2x00 SourceForge Project |
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, | |
34 | enum ieee80211_if_types type, | |
35 | u8 *mac, 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) { | |
43 | case IEEE80211_IF_TYPE_IBSS: | |
44 | case IEEE80211_IF_TYPE_AP: | |
6bb40dd1 | 45 | conf.sync = TSF_SYNC_BEACON; |
feb24691 ID |
46 | break; |
47 | case IEEE80211_IF_TYPE_STA: | |
6bb40dd1 | 48 | conf.sync = TSF_SYNC_INFRA; |
feb24691 ID |
49 | break; |
50 | default: | |
6bb40dd1 | 51 | conf.sync = TSF_SYNC_NONE; |
feb24691 ID |
52 | break; |
53 | } | |
54 | ||
6bb40dd1 ID |
55 | /* |
56 | * Note that when NULL is passed as address we will send | |
57 | * 00:00:00:00:00 to the device to clear the address. | |
58 | * This will prevent the device being confused when it wants | |
59 | * to ACK frames or consideres itself associated. | |
60 | */ | |
61 | memset(&conf.mac, 0, sizeof(conf.mac)); | |
62 | if (mac) | |
63 | memcpy(&conf.mac, mac, ETH_ALEN); | |
64 | ||
65 | memset(&conf.bssid, 0, sizeof(conf.bssid)); | |
66 | if (bssid) | |
67 | memcpy(&conf.bssid, bssid, ETH_ALEN); | |
68 | ||
69 | flags |= CONFIG_UPDATE_TYPE; | |
70 | if (mac || (!rt2x00dev->intf_ap_count && !rt2x00dev->intf_sta_count)) | |
71 | flags |= CONFIG_UPDATE_MAC; | |
72 | if (bssid || (!rt2x00dev->intf_ap_count && !rt2x00dev->intf_sta_count)) | |
73 | flags |= CONFIG_UPDATE_BSSID; | |
74 | ||
75 | rt2x00dev->ops->lib->config_intf(rt2x00dev, intf, &conf, flags); | |
76 | } | |
77 | ||
78 | void rt2x00lib_config_preamble(struct rt2x00_dev *rt2x00dev, | |
79 | struct rt2x00_intf *intf, | |
80 | const unsigned int short_preamble) | |
81 | { | |
82 | int retval; | |
83 | int ack_timeout; | |
84 | int ack_consume_time; | |
85 | ||
86 | ack_timeout = PLCP + get_duration(ACK_SIZE, 10); | |
87 | ack_consume_time = SIFS + PLCP + get_duration(ACK_SIZE, 10); | |
88 | ||
89 | if (rt2x00dev->hw->conf.flags & IEEE80211_CONF_SHORT_SLOT_TIME) | |
90 | ack_timeout += SHORT_DIFS; | |
91 | else | |
92 | ack_timeout += DIFS; | |
93 | ||
94 | if (short_preamble) { | |
95 | ack_timeout += SHORT_PREAMBLE; | |
96 | ack_consume_time += SHORT_PREAMBLE; | |
97 | } else { | |
98 | ack_timeout += PREAMBLE; | |
99 | ack_consume_time += PREAMBLE; | |
100 | } | |
101 | ||
102 | retval = rt2x00dev->ops->lib->config_preamble(rt2x00dev, | |
103 | short_preamble, | |
104 | ack_timeout, | |
105 | ack_consume_time); | |
106 | ||
107 | spin_lock(&intf->lock); | |
108 | ||
109 | if (retval) { | |
110 | intf->delayed_flags |= DELAYED_CONFIG_PREAMBLE; | |
111 | queue_work(rt2x00dev->hw->workqueue, &rt2x00dev->intf_work); | |
112 | } | |
113 | ||
114 | spin_unlock(&intf->lock); | |
95ea3627 ID |
115 | } |
116 | ||
69f81a2c ID |
117 | void rt2x00lib_config_antenna(struct rt2x00_dev *rt2x00dev, |
118 | enum antenna rx, enum antenna tx) | |
119 | { | |
120 | struct rt2x00lib_conf libconf; | |
121 | ||
122 | libconf.ant.rx = rx; | |
123 | libconf.ant.tx = tx; | |
124 | ||
05253c93 ID |
125 | if (rx == rt2x00dev->link.ant.active.rx && |
126 | tx == rt2x00dev->link.ant.active.tx) | |
127 | return; | |
128 | ||
e25c4bb9 ID |
129 | /* |
130 | * Antenna setup changes require the RX to be disabled, | |
131 | * else the changes will be ignored by the device. | |
132 | */ | |
133 | if (test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags)) | |
61667d8d | 134 | rt2x00lib_toggle_rx(rt2x00dev, STATE_RADIO_RX_OFF_LINK); |
e25c4bb9 | 135 | |
69f81a2c ID |
136 | /* |
137 | * Write new antenna setup to device and reset the link tuner. | |
138 | * The latter is required since we need to recalibrate the | |
139 | * noise-sensitivity ratio for the new setup. | |
140 | */ | |
6bb40dd1 | 141 | rt2x00dev->ops->lib->config(rt2x00dev, &libconf, CONFIG_UPDATE_ANTENNA); |
69f81a2c ID |
142 | rt2x00lib_reset_link_tuner(rt2x00dev); |
143 | ||
144 | rt2x00dev->link.ant.active.rx = libconf.ant.rx; | |
145 | rt2x00dev->link.ant.active.tx = libconf.ant.tx; | |
e25c4bb9 ID |
146 | |
147 | if (test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags)) | |
61667d8d | 148 | rt2x00lib_toggle_rx(rt2x00dev, STATE_RADIO_RX_ON_LINK); |
69f81a2c ID |
149 | } |
150 | ||
066cb637 ID |
151 | void rt2x00lib_config(struct rt2x00_dev *rt2x00dev, |
152 | struct ieee80211_conf *conf, const int force_config) | |
95ea3627 | 153 | { |
5c58ee51 ID |
154 | struct rt2x00lib_conf libconf; |
155 | struct ieee80211_hw_mode *mode; | |
156 | struct ieee80211_rate *rate; | |
addc81bd | 157 | struct antenna_setup *default_ant = &rt2x00dev->default_ant; |
69f81a2c | 158 | struct antenna_setup *active_ant = &rt2x00dev->link.ant.active; |
95ea3627 | 159 | int flags = 0; |
5c58ee51 | 160 | int short_slot_time; |
95ea3627 ID |
161 | |
162 | /* | |
066cb637 ID |
163 | * In some situations we want to force all configurations |
164 | * to be reloaded (When resuming for instance). | |
95ea3627 | 165 | */ |
066cb637 | 166 | if (force_config) { |
95ea3627 ID |
167 | flags = CONFIG_UPDATE_ALL; |
168 | goto config; | |
169 | } | |
170 | ||
171 | /* | |
172 | * Check which configuration options have been | |
173 | * updated and should be send to the device. | |
174 | */ | |
175 | if (rt2x00dev->rx_status.phymode != conf->phymode) | |
176 | flags |= CONFIG_UPDATE_PHYMODE; | |
177 | if (rt2x00dev->rx_status.channel != conf->channel) | |
178 | flags |= CONFIG_UPDATE_CHANNEL; | |
179 | if (rt2x00dev->tx_power != conf->power_level) | |
180 | flags |= CONFIG_UPDATE_TXPOWER; | |
addc81bd ID |
181 | |
182 | /* | |
183 | * Determining changes in the antenna setups request several checks: | |
184 | * antenna_sel_{r,t}x = 0 | |
185 | * -> Does active_{r,t}x match default_{r,t}x | |
186 | * -> Is default_{r,t}x SW_DIVERSITY | |
187 | * antenna_sel_{r,t}x = 1/2 | |
188 | * -> Does active_{r,t}x match antenna_sel_{r,t}x | |
189 | * The reason for not updating the antenna while SW diversity | |
190 | * should be used is simple: Software diversity means that | |
191 | * we should switch between the antenna's based on the | |
192 | * quality. This means that the current antenna is good enough | |
193 | * to work with untill the link tuner decides that an antenna | |
194 | * switch should be performed. | |
195 | */ | |
196 | if (!conf->antenna_sel_rx && | |
197 | default_ant->rx != ANTENNA_SW_DIVERSITY && | |
198 | default_ant->rx != active_ant->rx) | |
199 | flags |= CONFIG_UPDATE_ANTENNA; | |
200 | else if (conf->antenna_sel_rx && | |
201 | conf->antenna_sel_rx != active_ant->rx) | |
202 | flags |= CONFIG_UPDATE_ANTENNA; | |
16b1951f MN |
203 | else if (active_ant->rx == ANTENNA_SW_DIVERSITY) |
204 | flags |= CONFIG_UPDATE_ANTENNA; | |
addc81bd ID |
205 | |
206 | if (!conf->antenna_sel_tx && | |
207 | default_ant->tx != ANTENNA_SW_DIVERSITY && | |
208 | default_ant->tx != active_ant->tx) | |
209 | flags |= CONFIG_UPDATE_ANTENNA; | |
210 | else if (conf->antenna_sel_tx && | |
211 | conf->antenna_sel_tx != active_ant->tx) | |
95ea3627 | 212 | flags |= CONFIG_UPDATE_ANTENNA; |
16b1951f MN |
213 | else if (active_ant->tx == ANTENNA_SW_DIVERSITY) |
214 | flags |= CONFIG_UPDATE_ANTENNA; | |
95ea3627 ID |
215 | |
216 | /* | |
217 | * The following configuration options are never | |
218 | * stored anywhere and will always be updated. | |
219 | */ | |
220 | flags |= CONFIG_UPDATE_SLOT_TIME; | |
221 | flags |= CONFIG_UPDATE_BEACON_INT; | |
222 | ||
5c58ee51 ID |
223 | /* |
224 | * We have determined what options should be updated, | |
225 | * now precalculate device configuration values depending | |
226 | * on what configuration options need to be updated. | |
227 | */ | |
95ea3627 | 228 | config: |
5c58ee51 ID |
229 | memset(&libconf, 0, sizeof(libconf)); |
230 | ||
231 | if (flags & CONFIG_UPDATE_PHYMODE) { | |
232 | switch (conf->phymode) { | |
233 | case MODE_IEEE80211A: | |
234 | libconf.phymode = HWMODE_A; | |
235 | break; | |
236 | case MODE_IEEE80211B: | |
237 | libconf.phymode = HWMODE_B; | |
238 | break; | |
239 | case MODE_IEEE80211G: | |
240 | libconf.phymode = HWMODE_G; | |
241 | break; | |
242 | default: | |
243 | ERROR(rt2x00dev, | |
244 | "Attempt to configure unsupported mode (%d)" | |
245 | "Defaulting to 802.11b", conf->phymode); | |
246 | libconf.phymode = HWMODE_B; | |
247 | } | |
248 | ||
249 | mode = &rt2x00dev->hwmodes[libconf.phymode]; | |
250 | rate = &mode->rates[mode->num_rates - 1]; | |
251 | ||
252 | libconf.basic_rates = | |
253 | DEVICE_GET_RATE_FIELD(rate->val, RATEMASK) & DEV_BASIC_RATEMASK; | |
254 | } | |
255 | ||
256 | if (flags & CONFIG_UPDATE_CHANNEL) { | |
257 | memcpy(&libconf.rf, | |
258 | &rt2x00dev->spec.channels[conf->channel_val], | |
259 | sizeof(libconf.rf)); | |
260 | } | |
261 | ||
addc81bd ID |
262 | if (flags & CONFIG_UPDATE_ANTENNA) { |
263 | if (conf->antenna_sel_rx) | |
264 | libconf.ant.rx = conf->antenna_sel_rx; | |
265 | else if (default_ant->rx != ANTENNA_SW_DIVERSITY) | |
266 | libconf.ant.rx = default_ant->rx; | |
267 | else if (active_ant->rx == ANTENNA_SW_DIVERSITY) | |
268 | libconf.ant.rx = ANTENNA_B; | |
269 | ||
270 | if (conf->antenna_sel_tx) | |
271 | libconf.ant.tx = conf->antenna_sel_tx; | |
272 | else if (default_ant->tx != ANTENNA_SW_DIVERSITY) | |
273 | libconf.ant.tx = default_ant->tx; | |
274 | else if (active_ant->tx == ANTENNA_SW_DIVERSITY) | |
275 | libconf.ant.tx = ANTENNA_B; | |
276 | } | |
277 | ||
5c58ee51 ID |
278 | if (flags & CONFIG_UPDATE_SLOT_TIME) { |
279 | short_slot_time = conf->flags & IEEE80211_CONF_SHORT_SLOT_TIME; | |
280 | ||
281 | libconf.slot_time = | |
282 | short_slot_time ? SHORT_SLOT_TIME : SLOT_TIME; | |
283 | libconf.sifs = SIFS; | |
284 | libconf.pifs = short_slot_time ? SHORT_PIFS : PIFS; | |
285 | libconf.difs = short_slot_time ? SHORT_DIFS : DIFS; | |
286 | libconf.eifs = EIFS; | |
287 | } | |
288 | ||
289 | libconf.conf = conf; | |
290 | ||
291 | /* | |
292 | * Start configuration. | |
293 | */ | |
6bb40dd1 | 294 | rt2x00dev->ops->lib->config(rt2x00dev, &libconf, flags); |
95ea3627 ID |
295 | |
296 | /* | |
297 | * Some configuration changes affect the link quality | |
298 | * which means we need to reset the link tuner. | |
299 | */ | |
300 | if (flags & (CONFIG_UPDATE_CHANNEL | CONFIG_UPDATE_ANTENNA)) | |
301 | rt2x00lib_reset_link_tuner(rt2x00dev); | |
302 | ||
16b1951f MN |
303 | if (flags & CONFIG_UPDATE_PHYMODE) { |
304 | rt2x00dev->curr_hwmode = libconf.phymode; | |
305 | rt2x00dev->rx_status.phymode = conf->phymode; | |
306 | } | |
307 | ||
95ea3627 ID |
308 | rt2x00dev->rx_status.freq = conf->freq; |
309 | rt2x00dev->rx_status.channel = conf->channel; | |
310 | rt2x00dev->tx_power = conf->power_level; | |
16b1951f MN |
311 | |
312 | if (flags & CONFIG_UPDATE_ANTENNA) { | |
313 | rt2x00dev->link.ant.active.rx = libconf.ant.rx; | |
314 | rt2x00dev->link.ant.active.tx = libconf.ant.tx; | |
315 | } | |
95ea3627 | 316 | } |