projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
wl12xx: rearrange some ELP wake_up/sleep calls
[deliverable/linux.git] / drivers / net / wireless / wl12xx / main.c
CommitLineData
f5fc0f86
LC		 1/*
2 * This file is part of wl1271
3 *
8bf29b0e 4 * Copyright (C) 2008-2010 Nokia Corporation
f5fc0f86
LC		 5 *
6 * Contact: Luciano Coelho <luciano.coelho@nokia.com>
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * version 2 as published by the Free Software Foundation.
11 *
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
20 * 02110-1301 USA
21 *
22 */
23
24#include <linux/module.h>
f5fc0f86
LC		 25#include <linux/firmware.h>
26#include <linux/delay.h>
f5fc0f86
LC		 27#include <linux/spi/spi.h>
28#include <linux/crc32.h>
29#include <linux/etherdevice.h>
1fba4974 30#include <linux/vmalloc.h>
a1dd8187 31#include <linux/platform_device.h>
5a0e3ad6 32#include <linux/slab.h>
f5fc0f86 33
00d20100 34#include "wl12xx.h"
f5fc0f86 35#include "wl12xx_80211.h"
00d20100
SL		 36#include "reg.h"
37#include "io.h"
38#include "event.h"
39#include "tx.h"
40#include "rx.h"
41#include "ps.h"
42#include "init.h"
43#include "debugfs.h"
44#include "cmd.h"
45#include "boot.h"
46#include "testmode.h"
47#include "scan.h"
f5fc0f86 48
9ccd9217
JO		 49#define WL1271_BOOT_RETRIES 3
50
8a08048a
JO		 51static struct conf_drv_settings default_conf = {
52 .sg = {
1b00f546
JO		 53 .params = {
54 [CONF_SG_BT_PER_THRESHOLD] = 7500,
55 [CONF_SG_HV3_MAX_OVERRIDE] = 0,
56 [CONF_SG_BT_NFS_SAMPLE_INTERVAL] = 400,
d9482e2b 57 [CONF_SG_BT_LOAD_RATIO] = 200,
8d2ef7bd 58 [CONF_SG_AUTO_PS_MODE] = 1,
1b00f546
JO		 59 [CONF_SG_AUTO_SCAN_PROBE_REQ] = 170,
60 [CONF_SG_ACTIVE_SCAN_DURATION_FACTOR_HV3] = 50,
61 [CONF_SG_ANTENNA_CONFIGURATION] = 0,
62 [CONF_SG_BEACON_MISS_PERCENT] = 60,
63 [CONF_SG_RATE_ADAPT_THRESH] = 12,
64 [CONF_SG_RATE_ADAPT_SNR] = 0,
65 [CONF_SG_WLAN_PS_BT_ACL_MASTER_MIN_BR] = 10,
66 [CONF_SG_WLAN_PS_BT_ACL_MASTER_MAX_BR] = 30,
67 [CONF_SG_WLAN_PS_MAX_BT_ACL_MASTER_BR] = 8,
68 [CONF_SG_WLAN_PS_BT_ACL_SLAVE_MIN_BR] = 20,
69 [CONF_SG_WLAN_PS_BT_ACL_SLAVE_MAX_BR] = 50,
70 /* Note: with UPSD, this should be 4 */
71 [CONF_SG_WLAN_PS_MAX_BT_ACL_SLAVE_BR] = 8,
72 [CONF_SG_WLAN_PS_BT_ACL_MASTER_MIN_EDR] = 7,
73 [CONF_SG_WLAN_PS_BT_ACL_MASTER_MAX_EDR] = 25,
74 [CONF_SG_WLAN_PS_MAX_BT_ACL_MASTER_EDR] = 20,
75 /* Note: with UPDS, this should be 15 */
76 [CONF_SG_WLAN_PS_BT_ACL_SLAVE_MIN_EDR] = 8,
77 /* Note: with UPDS, this should be 50 */
78 [CONF_SG_WLAN_PS_BT_ACL_SLAVE_MAX_EDR] = 40,
79 /* Note: with UPDS, this should be 10 */
80 [CONF_SG_WLAN_PS_MAX_BT_ACL_SLAVE_EDR] = 20,
81 [CONF_SG_RXT] = 1200,
82 [CONF_SG_TXT] = 1000,
83 [CONF_SG_ADAPTIVE_RXT_TXT] = 1,
84 [CONF_SG_PS_POLL_TIMEOUT] = 10,
85 [CONF_SG_UPSD_TIMEOUT] = 10,
86 [CONF_SG_WLAN_ACTIVE_BT_ACL_MASTER_MIN_EDR] = 7,
87 [CONF_SG_WLAN_ACTIVE_BT_ACL_MASTER_MAX_EDR] = 15,
88 [CONF_SG_WLAN_ACTIVE_MAX_BT_ACL_MASTER_EDR] = 15,
89 [CONF_SG_WLAN_ACTIVE_BT_ACL_SLAVE_MIN_EDR] = 8,
90 [CONF_SG_WLAN_ACTIVE_BT_ACL_SLAVE_MAX_EDR] = 20,
91 [CONF_SG_WLAN_ACTIVE_MAX_BT_ACL_SLAVE_EDR] = 15,
92 [CONF_SG_WLAN_ACTIVE_BT_ACL_MIN_BR] = 20,
93 [CONF_SG_WLAN_ACTIVE_BT_ACL_MAX_BR] = 50,
94 [CONF_SG_WLAN_ACTIVE_MAX_BT_ACL_BR] = 10,
95 [CONF_SG_PASSIVE_SCAN_DURATION_FACTOR_HV3] = 200,
96 [CONF_SG_PASSIVE_SCAN_DURATION_FACTOR_A2DP] = 800,
97 [CONF_SG_PASSIVE_SCAN_A2DP_BT_TIME] = 75,
98 [CONF_SG_PASSIVE_SCAN_A2DP_WLAN_TIME] = 15,
99 [CONF_SG_HV3_MAX_SERVED] = 6,
100 [CONF_SG_DHCP_TIME] = 5000,
101 [CONF_SG_ACTIVE_SCAN_DURATION_FACTOR_A2DP] = 100,
102 },
103 .state = CONF_SG_PROTECTIVE,
8a08048a
JO		 104 },
105 .rx = {
106 .rx_msdu_life_time = 512000,
107 .packet_detection_threshold = 0,
108 .ps_poll_timeout = 15,
109 .upsd_timeout = 15,
110 .rts_threshold = 2347,
3ed8f2c6
LC		 111 .rx_cca_threshold = 0,
112 .irq_blk_threshold = 0xFFFF,
113 .irq_pkt_threshold = 0,
114 .irq_timeout = 600,
8a08048a
JO		 115 .queue_type = CONF_RX_QUEUE_TYPE_LOW_PRIORITY,
116 },
117 .tx = {
118 .tx_energy_detection = 0,
1e05a818 119 .sta_rc_conf = {
ebba60c6 120 .enabled_rates = 0,
8a08048a
JO		 121 .short_retry_limit = 10,
122 .long_retry_limit = 10,
1e05a818 123 .aflags = 0,
45b531a8 124 },
8a08048a
JO		 125 .ac_conf_count = 4,
126 .ac_conf = {
9987a9da 127 [CONF_TX_AC_BE] = {
8a08048a
JO		 128 .ac = CONF_TX_AC_BE,
129 .cw_min = 15,
130 .cw_max = 63,
131 .aifsn = 3,
132 .tx_op_limit = 0,
45b531a8 133 },
9987a9da 134 [CONF_TX_AC_BK] = {
8a08048a
JO		 135 .ac = CONF_TX_AC_BK,
136 .cw_min = 15,
137 .cw_max = 63,
138 .aifsn = 7,
139 .tx_op_limit = 0,
45b531a8 140 },
9987a9da 141 [CONF_TX_AC_VI] = {
8a08048a
JO		 142 .ac = CONF_TX_AC_VI,
143 .cw_min = 15,
144 .cw_max = 63,
145 .aifsn = CONF_TX_AIFS_PIFS,
146 .tx_op_limit = 3008,
147 },
9987a9da 148 [CONF_TX_AC_VO] = {
8a08048a
JO		 149 .ac = CONF_TX_AC_VO,
150 .cw_min = 15,
151 .cw_max = 63,
152 .aifsn = CONF_TX_AIFS_PIFS,
153 .tx_op_limit = 1504,
45b531a8 154 },
51f2be24 155 },
1e05a818
AN		 156 .ap_rc_conf = {
157 [0] = {
158 .enabled_rates = CONF_TX_AP_ENABLED_RATES,
159 .short_retry_limit = 10,
160 .long_retry_limit = 10,
161 .aflags = 0,
162 },
163 [1] = {
164 .enabled_rates = CONF_TX_AP_ENABLED_RATES,
165 .short_retry_limit = 10,
166 .long_retry_limit = 10,
167 .aflags = 0,
168 },
169 [2] = {
170 .enabled_rates = CONF_TX_AP_ENABLED_RATES,
171 .short_retry_limit = 10,
172 .long_retry_limit = 10,
173 .aflags = 0,
174 },
175 [3] = {
176 .enabled_rates = CONF_TX_AP_ENABLED_RATES,
177 .short_retry_limit = 10,
178 .long_retry_limit = 10,
179 .aflags = 0,
180 },
181 },
182 .ap_mgmt_conf = {
183 .enabled_rates = CONF_TX_AP_DEFAULT_MGMT_RATES,
184 .short_retry_limit = 10,
185 .long_retry_limit = 10,
186 .aflags = 0,
187 },
188 .ap_bcst_conf = {
189 .enabled_rates = CONF_HW_BIT_RATE_1MBPS,
190 .short_retry_limit = 10,
191 .long_retry_limit = 10,
192 .aflags = 0,
193 },
79b223f4 194 .ap_max_tx_retries = 100,
9987a9da 195 .tid_conf_count = 4,
8a08048a 196 .tid_conf = {
9987a9da
JO		 197 [CONF_TX_AC_BE] = {
198 .queue_id = CONF_TX_AC_BE,
199 .channel_type = CONF_CHANNEL_TYPE_EDCF,
8a08048a
JO		 200 .tsid = CONF_TX_AC_BE,
201 .ps_scheme = CONF_PS_SCHEME_LEGACY,
202 .ack_policy = CONF_ACK_POLICY_LEGACY,
203 .apsd_conf = {0, 0},
51f2be24 204 },
9987a9da
JO		 205 [CONF_TX_AC_BK] = {
206 .queue_id = CONF_TX_AC_BK,
207 .channel_type = CONF_CHANNEL_TYPE_EDCF,
208 .tsid = CONF_TX_AC_BK,
8a08048a
JO		 209 .ps_scheme = CONF_PS_SCHEME_LEGACY,
210 .ack_policy = CONF_ACK_POLICY_LEGACY,
211 .apsd_conf = {0, 0},
212 },
9987a9da
JO		 213 [CONF_TX_AC_VI] = {
214 .queue_id = CONF_TX_AC_VI,
215 .channel_type = CONF_CHANNEL_TYPE_EDCF,
216 .tsid = CONF_TX_AC_VI,
8a08048a
JO		 217 .ps_scheme = CONF_PS_SCHEME_LEGACY,
218 .ack_policy = CONF_ACK_POLICY_LEGACY,
219 .apsd_conf = {0, 0},
220 },
9987a9da
JO		 221 [CONF_TX_AC_VO] = {
222 .queue_id = CONF_TX_AC_VO,
223 .channel_type = CONF_CHANNEL_TYPE_EDCF,
224 .tsid = CONF_TX_AC_VO,
8a08048a
JO		 225 .ps_scheme = CONF_PS_SCHEME_LEGACY,
226 .ack_policy = CONF_ACK_POLICY_LEGACY,
227 .apsd_conf = {0, 0},
228 },
8a08048a
JO		 229 },
230 .frag_threshold = IEEE80211_MAX_FRAG_THRESHOLD,
3ed8f2c6 231 .tx_compl_timeout = 700,
ebba60c6
JO		 232 .tx_compl_threshold = 4,
233 .basic_rate = CONF_HW_BIT_RATE_1MBPS,
234 .basic_rate_5 = CONF_HW_BIT_RATE_6MBPS,
1e05a818
AN		 235 .tmpl_short_retry_limit = 10,
236 .tmpl_long_retry_limit = 10,
8a08048a
JO		 237 },
238 .conn = {
239 .wake_up_event = CONF_WAKE_UP_EVENT_DTIM,
50c500ad 240 .listen_interval = 1,
8a08048a
JO		 241 .bcn_filt_mode = CONF_BCN_FILT_MODE_ENABLED,
242 .bcn_filt_ie_count = 1,
243 .bcn_filt_ie = {
244 [0] = {
245 .ie = WLAN_EID_CHANNEL_SWITCH,
246 .rule = CONF_BCN_RULE_PASS_ON_APPEARANCE,
51f2be24 247 }
47fab7d5 248 },
3ed8f2c6 249 .synch_fail_thold = 10,
8a08048a
JO		 250 .bss_lose_timeout = 100,
251 .beacon_rx_timeout = 10000,
252 .broadcast_timeout = 20000,
253 .rx_broadcast_in_ps = 1,
90494a90
JO		 254 .ps_poll_threshold = 10,
255 .ps_poll_recovery_period = 700,
11f70f97 256 .bet_enable = CONF_BET_MODE_ENABLE,
958b20e0 257 .bet_max_consecutive = 50,
8eab7b47 258 .psm_entry_retries = 5,
ee60833a 259 .psm_exit_retries = 255,
8eab7b47
JO		 260 .psm_entry_nullfunc_retries = 3,
261 .psm_entry_hangover_period = 1,
50c500ad
JO		 262 .keep_alive_interval = 55000,
263 .max_listen_interval = 20,
8a08048a 264 },
6e92b416
LC		 265 .itrim = {
266 .enable = false,
267 .timeout = 50000,
38ad2d87
JO		 268 },
269 .pm_config = {
270 .host_clk_settling_time = 5000,
271 .host_fast_wakeup_support = false
00236aed
JO		 272 },
273 .roam_trigger = {
00236aed
JO		 274 .trigger_pacing = 1,
275 .avg_weight_rssi_beacon = 20,
276 .avg_weight_rssi_data = 10,
277 .avg_weight_snr_beacon = 20,
4b7fac77 278 .avg_weight_snr_data = 10,
bea39d6a
JO		 279 },
280 .scan = {
281 .min_dwell_time_active = 7500,
282 .max_dwell_time_active = 30000,
ea45b2cb
JO		 283 .min_dwell_time_passive = 100000,
284 .max_dwell_time_passive = 100000,
bea39d6a
JO		 285 .num_probe_reqs = 2,
286 },
644a4860
JO		 287 .rf = {
288 .tx_per_channel_power_compensation_2 = {
289 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
290 },
291 .tx_per_channel_power_compensation_5 = {
292 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
293 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
294 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
295 },
296 },
4b7fac77
LS		 297 .ht = {
298 .tx_ba_win_size = 64,
299 .inactivity_timeout = 10000,
300 },
13b107dd 301 .mem_wl127x = {
fe5ef090
EP		 302 .num_stations = 1,
303 .ssid_profiles = 1,
304 .rx_block_num = 70,
305 .tx_min_block_num = 40,
c8bde243 306 .dynamic_memory = 0,
b16d4b68 307 .min_req_tx_blocks = 100,
c8bde243
EP		 308 .min_req_rx_blocks = 22,
309 .tx_min = 27,
13b107dd
SL		 310 },
311 .mem_wl128x = {
312 .num_stations = 1,
313 .ssid_profiles = 1,
314 .rx_block_num = 40,
315 .tx_min_block_num = 40,
316 .dynamic_memory = 1,
317 .min_req_tx_blocks = 45,
318 .min_req_rx_blocks = 22,
319 .tx_min = 27,
320 },
8a08048a
JO		 321};
322
52b0e7a6 323static void __wl1271_op_remove_interface(struct wl1271 *wl);
7f179b46 324static void wl1271_free_ap_keys(struct wl1271 *wl);
52b0e7a6
JO		 325
326
a1dd8187
JO		 327static void wl1271_device_release(struct device *dev)
328{
329
330}
331
332static struct platform_device wl1271_device = {
333 .name = "wl1271",
334 .id = -1,
335
336 /* device model insists to have a release function */
337 .dev = {
338 .release = wl1271_device_release,
339 },
340};
341
f9f774c1 342static DEFINE_MUTEX(wl_list_mutex);
01c09162
JO		 343static LIST_HEAD(wl_list);
344
c2c192ac
JO		 345static int wl1271_dev_notify(struct notifier_block *me, unsigned long what,
346 void *arg)
347{
348 struct net_device *dev = arg;
349 struct wireless_dev *wdev;
350 struct wiphy *wiphy;
351 struct ieee80211_hw *hw;
352 struct wl1271 *wl;
353 struct wl1271 *wl_temp;
354 int ret = 0;
355
356 /* Check that this notification is for us. */
357 if (what != NETDEV_CHANGE)
358 return NOTIFY_DONE;
359
360 wdev = dev->ieee80211_ptr;
361 if (wdev == NULL)
362 return NOTIFY_DONE;
363
364 wiphy = wdev->wiphy;
365 if (wiphy == NULL)
366 return NOTIFY_DONE;
367
368 hw = wiphy_priv(wiphy);
369 if (hw == NULL)
370 return NOTIFY_DONE;
371
372 wl_temp = hw->priv;
f9f774c1 373 mutex_lock(&wl_list_mutex);
c2c192ac
JO		 374 list_for_each_entry(wl, &wl_list, list) {
375 if (wl == wl_temp)
376 break;
377 }
f9f774c1 378 mutex_unlock(&wl_list_mutex);
c2c192ac
JO		 379 if (wl != wl_temp)
380 return NOTIFY_DONE;
381
382 mutex_lock(&wl->mutex);
383
384 if (wl->state == WL1271_STATE_OFF)
385 goto out;
386
387 if (!test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
388 goto out;
389
a620865e 390 ret = wl1271_ps_elp_wakeup(wl);
c2c192ac
JO		 391 if (ret < 0)
392 goto out;
393
394 if ((dev->operstate == IF_OPER_UP) &&
395 !test_and_set_bit(WL1271_FLAG_STA_STATE_SENT, &wl->flags)) {
396 wl1271_cmd_set_sta_state(wl);
397 wl1271_info("Association completed.");
398 }
399
400 wl1271_ps_elp_sleep(wl);
401
402out:
403 mutex_unlock(&wl->mutex);
404
405 return NOTIFY_OK;
406}
407
b7417d93 408static int wl1271_reg_notify(struct wiphy *wiphy,
573c67cf
LC		 409 struct regulatory_request *request)
410{
b7417d93
JO		 411 struct ieee80211_supported_band *band;
412 struct ieee80211_channel *ch;
413 int i;
414
415 band = wiphy->bands[IEEE80211_BAND_5GHZ];
416 for (i = 0; i < band->n_channels; i++) {
417 ch = &band->channels[i];
418 if (ch->flags & IEEE80211_CHAN_DISABLED)
419 continue;
420
421 if (ch->flags & IEEE80211_CHAN_RADAR)
422 ch->flags |= IEEE80211_CHAN_NO_IBSS |
423 IEEE80211_CHAN_PASSIVE_SCAN;
424
425 }
426
427 return 0;
428}
429
8a08048a
JO		 430static void wl1271_conf_init(struct wl1271 *wl)
431{
2b60100b
JO		 432
433 /*
434 * This function applies the default configuration to the driver. This
435 * function is invoked upon driver load (spi probe.)
436 *
437 * The configuration is stored in a run-time structure in order to
438 * facilitate for run-time adjustment of any of the parameters. Making
439 * changes to the configuration structure will apply the new values on
440 * the next interface up (wl1271_op_start.)
441 */
442
443 /* apply driver default configuration */
8a08048a 444 memcpy(&wl->conf, &default_conf, sizeof(default_conf));
2b60100b
JO		 445}
446
447
f5fc0f86
LC		 448static int wl1271_plt_init(struct wl1271 *wl)
449{
12419cce
LC		 450 struct conf_tx_ac_category *conf_ac;
451 struct conf_tx_tid *conf_tid;
452 int ret, i;
f5fc0f86 453
49d750ca
SL		 454 if (wl->chip.id == CHIP_ID_1283_PG20)
455 ret = wl128x_cmd_general_parms(wl);
456 else
457 ret = wl1271_cmd_general_parms(wl);
4a90406b 458 if (ret < 0)
cc7defa3
LC		 459 return ret;
460
49d750ca
SL		 461 if (wl->chip.id == CHIP_ID_1283_PG20)
462 ret = wl128x_cmd_radio_parms(wl);
463 else
464 ret = wl1271_cmd_radio_parms(wl);
4a90406b 465 if (ret < 0)
cc7defa3
LC		 466 return ret;
467
49d750ca
SL		 468 if (wl->chip.id != CHIP_ID_1283_PG20) {
469 ret = wl1271_cmd_ext_radio_parms(wl);
470 if (ret < 0)
471 return ret;
472 }
644a4860
JO		 473 if (ret < 0)
474 return ret;
475
48a61477
SL		 476 /* Chip-specific initializations */
477 ret = wl1271_chip_specific_init(wl);
478 if (ret < 0)
479 return ret;
480
e0fe371b 481 ret = wl1271_sta_init_templates_config(wl);
12419cce
LC		 482 if (ret < 0)
483 return ret;
484
f5fc0f86
LC		 485 ret = wl1271_acx_init_mem_config(wl);
486 if (ret < 0)
487 return ret;
488
12419cce
LC		 489 /* PHY layer config */
490 ret = wl1271_init_phy_config(wl);
491 if (ret < 0)
492 goto out_free_memmap;
493
494 ret = wl1271_acx_dco_itrim_params(wl);
495 if (ret < 0)
496 goto out_free_memmap;
497
498 /* Initialize connection monitoring thresholds */
6ccbb92e 499 ret = wl1271_acx_conn_monit_params(wl, false);
12419cce
LC		 500 if (ret < 0)
501 goto out_free_memmap;
502
503 /* Bluetooth WLAN coexistence */
504 ret = wl1271_init_pta(wl);
505 if (ret < 0)
506 goto out_free_memmap;
507
508 /* Energy detection */
509 ret = wl1271_init_energy_detection(wl);
510 if (ret < 0)
511 goto out_free_memmap;
512
1ec610eb
GK		 513 ret = wl1271_acx_sta_mem_cfg(wl);
514 if (ret < 0)
515 goto out_free_memmap;
516
12419cce 517 /* Default fragmentation threshold */
68d069c4 518 ret = wl1271_acx_frag_threshold(wl, wl->conf.tx.frag_threshold);
12419cce
LC		 519 if (ret < 0)
520 goto out_free_memmap;
521
9987a9da
JO		 522 /* Default TID/AC configuration */
523 BUG_ON(wl->conf.tx.tid_conf_count != wl->conf.tx.ac_conf_count);
12419cce 524 for (i = 0; i < wl->conf.tx.tid_conf_count; i++) {
9987a9da
JO		 525 conf_ac = &wl->conf.tx.ac_conf[i];
526 ret = wl1271_acx_ac_cfg(wl, conf_ac->ac, conf_ac->cw_min,
527 conf_ac->cw_max, conf_ac->aifsn,
528 conf_ac->tx_op_limit);
529 if (ret < 0)
530 goto out_free_memmap;
531
12419cce
LC		 532 conf_tid = &wl->conf.tx.tid_conf[i];
533 ret = wl1271_acx_tid_cfg(wl, conf_tid->queue_id,
534 conf_tid->channel_type,
535 conf_tid->tsid,
536 conf_tid->ps_scheme,
537 conf_tid->ack_policy,
538 conf_tid->apsd_conf[0],
539 conf_tid->apsd_conf[1]);
540 if (ret < 0)
541 goto out_free_memmap;
542 }
543
12419cce 544 /* Enable data path */
94210897 545 ret = wl1271_cmd_data_path(wl, 1);
f5fc0f86 546 if (ret < 0)
12419cce
LC		 547 goto out_free_memmap;
548
549 /* Configure for CAM power saving (ie. always active) */
550 ret = wl1271_acx_sleep_auth(wl, WL1271_PSM_CAM);
551 if (ret < 0)
552 goto out_free_memmap;
553
554 /* configure PM */
555 ret = wl1271_acx_pm_config(wl);
556 if (ret < 0)
557 goto out_free_memmap;
f5fc0f86
LC		 558
559 return 0;
12419cce
LC		 560
561 out_free_memmap:
562 kfree(wl->target_mem_map);
563 wl->target_mem_map = NULL;
564
565 return ret;
f5fc0f86
LC		 566}
567
b622d992
AN		 568static void wl1271_irq_ps_regulate_link(struct wl1271 *wl, u8 hlid, u8 tx_blks)
569{
570 bool fw_ps;
571
572 /* only regulate station links */
573 if (hlid < WL1271_AP_STA_HLID_START)
574 return;
575
576 fw_ps = test_bit(hlid, (unsigned long *)&wl->ap_fw_ps_map);
577
578 /*
579 * Wake up from high level PS if the STA is asleep with too little
580 * blocks in FW or if the STA is awake.
581 */
582 if (!fw_ps || tx_blks < WL1271_PS_STA_MAX_BLOCKS)
583 wl1271_ps_link_end(wl, hlid);
584
585 /* Start high-level PS if the STA is asleep with enough blocks in FW */
586 else if (fw_ps && tx_blks >= WL1271_PS_STA_MAX_BLOCKS)
587 wl1271_ps_link_start(wl, hlid, true);
588}
589
590static void wl1271_irq_update_links_status(struct wl1271 *wl,
591 struct wl1271_fw_ap_status *status)
592{
593 u32 cur_fw_ps_map;
594 u8 hlid;
595
596 cur_fw_ps_map = le32_to_cpu(status->link_ps_bitmap);
597 if (wl->ap_fw_ps_map != cur_fw_ps_map) {
598 wl1271_debug(DEBUG_PSM,
599 "link ps prev 0x%x cur 0x%x changed 0x%x",
600 wl->ap_fw_ps_map, cur_fw_ps_map,
601 wl->ap_fw_ps_map ^ cur_fw_ps_map);
602
603 wl->ap_fw_ps_map = cur_fw_ps_map;
604 }
605
606 for (hlid = WL1271_AP_STA_HLID_START; hlid < AP_MAX_LINKS; hlid++) {
607 u8 cnt = status->tx_lnk_free_blks[hlid] -
608 wl->links[hlid].prev_freed_blks;
609
610 wl->links[hlid].prev_freed_blks =
611 status->tx_lnk_free_blks[hlid];
612 wl->links[hlid].allocated_blks -= cnt;
613
614 wl1271_irq_ps_regulate_link(wl, hlid,
615 wl->links[hlid].allocated_blks);
616 }
617}
618
c15f63bf 619static void wl1271_fw_status(struct wl1271 *wl,
c8bde243 620 struct wl1271_fw_full_status *full_status)
f5fc0f86 621{
c8bde243 622 struct wl1271_fw_common_status *status = &full_status->common;
ac5e1e39 623 struct timespec ts;
13b107dd 624 u32 old_tx_blk_count = wl->tx_blocks_available;
f5fc0f86
LC		 625 u32 total = 0;
626 int i;
627
13b107dd 628 if (wl->bss_type == BSS_TYPE_AP_BSS) {
c8bde243
EP		 629 wl1271_raw_read(wl, FW_STATUS_ADDR, status,
630 sizeof(struct wl1271_fw_ap_status), false);
13b107dd 631 } else {
c8bde243
EP		 632 wl1271_raw_read(wl, FW_STATUS_ADDR, status,
633 sizeof(struct wl1271_fw_sta_status), false);
f5fc0f86 634
13b107dd
SL		 635 /* Update tx total blocks change */
636 wl->tx_total_diff +=
637 ((struct wl1271_fw_sta_status *)status)->tx_total -
638 wl->tx_new_total;
639
640 /* Update total tx blocks */
641 wl->tx_new_total =
642 ((struct wl1271_fw_sta_status *)status)->tx_total;
643 }
644
f5fc0f86
LC		 645 wl1271_debug(DEBUG_IRQ, "intr: 0x%x (fw_rx_counter = %d, "
646 "drv_rx_counter = %d, tx_results_counter = %d)",
647 status->intr,
648 status->fw_rx_counter,
649 status->drv_rx_counter,
650 status->tx_results_counter);
651
652 /* update number of available TX blocks */
653 for (i = 0; i < NUM_TX_QUEUES; i++) {
13b107dd 654 total += le32_to_cpu(status->tx_released_blks[i]) -
d0f63b20
LC		 655 wl->tx_blocks_freed[i];
656
657 wl->tx_blocks_freed[i] =
658 le32_to_cpu(status->tx_released_blks[i]);
13b107dd
SL		 659
660 }
661
662 /*
663 * By adding the freed blocks to tx_total_diff we are actually
664 * moving them to the RX pool.
665 */
666 wl->tx_total_diff += total;
667
668 /* if we have positive difference, add the blocks to the TX pool */
669 if (wl->tx_total_diff >= 0) {
670 wl->tx_blocks_available += wl->tx_total_diff;
671 wl->tx_total_diff = 0;
f5fc0f86
LC		 672 }
673
a522550a 674 /* if more blocks are available now, tx work can be scheduled */
13b107dd 675 if (wl->tx_blocks_available > old_tx_blk_count)
a522550a 676 clear_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags);
f5fc0f86 677
b622d992
AN		 678 /* for AP update num of allocated TX blocks per link and ps status */
679 if (wl->bss_type == BSS_TYPE_AP_BSS)
680 wl1271_irq_update_links_status(wl, &full_status->ap);
09039f42 681
f5fc0f86 682 /* update the host-chipset time offset */
ac5e1e39
JO		 683 getnstimeofday(&ts);
684 wl->time_offset = (timespec_to_ns(&ts) >> 10) -
685 (s64)le32_to_cpu(status->fw_localtime);
f5fc0f86
LC		 686}
687
a620865e
IY		 688static void wl1271_flush_deferred_work(struct wl1271 *wl)
689{
690 struct sk_buff *skb;
691
692 /* Pass all received frames to the network stack */
693 while ((skb = skb_dequeue(&wl->deferred_rx_queue)))
694 ieee80211_rx_ni(wl->hw, skb);
695
696 /* Return sent skbs to the network stack */
697 while ((skb = skb_dequeue(&wl->deferred_tx_queue)))
698 ieee80211_tx_status(wl->hw, skb);
699}
700
701static void wl1271_netstack_work(struct work_struct *work)
702{
703 struct wl1271 *wl =
704 container_of(work, struct wl1271, netstack_work);
705
706 do {
707 wl1271_flush_deferred_work(wl);
708 } while (skb_queue_len(&wl->deferred_rx_queue));
709}
1e73eb62 710
a620865e
IY		 711#define WL1271_IRQ_MAX_LOOPS 256
712
713irqreturn_t wl1271_irq(int irq, void *cookie)
f5fc0f86 714{
f5fc0f86 715 int ret;
c15f63bf 716 u32 intr;
1e73eb62 717 int loopcount = WL1271_IRQ_MAX_LOOPS;
a620865e
IY		 718 struct wl1271 *wl = (struct wl1271 *)cookie;
719 bool done = false;
720 unsigned int defer_count;
b07d4037
IY		 721 unsigned long flags;
722
723 /* TX might be handled here, avoid redundant work */
724 set_bit(WL1271_FLAG_TX_PENDING, &wl->flags);
725 cancel_work_sync(&wl->tx_work);
f5fc0f86
LC		 726
727 mutex_lock(&wl->mutex);
728
729 wl1271_debug(DEBUG_IRQ, "IRQ work");
730
1e73eb62 731 if (unlikely(wl->state == WL1271_STATE_OFF))
f5fc0f86
LC		 732 goto out;
733
a620865e 734 ret = wl1271_ps_elp_wakeup(wl);
f5fc0f86
LC		 735 if (ret < 0)
736 goto out;
737
a620865e
IY		 738 while (!done && loopcount--) {
739 /*
740 * In order to avoid a race with the hardirq, clear the flag
741 * before acknowledging the chip. Since the mutex is held,
742 * wl1271_ps_elp_wakeup cannot be called concurrently.
743 */
744 clear_bit(WL1271_FLAG_IRQ_RUNNING, &wl->flags);
745 smp_mb__after_clear_bit();
1e73eb62
JO		 746
747 wl1271_fw_status(wl, wl->fw_status);
c8bde243 748 intr = le32_to_cpu(wl->fw_status->common.intr);
a620865e 749 intr &= WL1271_INTR_MASK;
1e73eb62 750 if (!intr) {
a620865e 751 done = true;
1e73eb62
JO		 752 continue;
753 }
f5fc0f86 754
ccc83b04
EP		 755 if (unlikely(intr & WL1271_ACX_INTR_WATCHDOG)) {
756 wl1271_error("watchdog interrupt received! "
757 "starting recovery.");
758 ieee80211_queue_work(wl->hw, &wl->recovery_work);
759
760 /* restarting the chip. ignore any other interrupt. */
761 goto out;
762 }
763
a620865e 764 if (likely(intr & WL1271_ACX_INTR_DATA)) {
1e73eb62 765 wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_DATA");
1fd2794f 766
8aad2464 767 wl1271_rx(wl, &wl->fw_status->common);
f5fc0f86 768
a522550a 769 /* Check if any tx blocks were freed */
b07d4037 770 spin_lock_irqsave(&wl->wl_lock, flags);
a522550a 771 if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
6742f554 772 wl->tx_queue_count) {
b07d4037 773 spin_unlock_irqrestore(&wl->wl_lock, flags);
a522550a
IY		 774 /*
775 * In order to avoid starvation of the TX path,
776 * call the work function directly.
777 */
778 wl1271_tx_work_locked(wl);
b07d4037
IY		 779 } else {
780 spin_unlock_irqrestore(&wl->wl_lock, flags);
a522550a
IY		 781 }
782
8aad2464
IY		 783 /* check for tx results */
784 if (wl->fw_status->common.tx_results_counter !=
785 (wl->tx_results_count & 0xff))
786 wl1271_tx_complete(wl);
a620865e
IY		 787
788 /* Make sure the deferred queues don't get too long */
789 defer_count = skb_queue_len(&wl->deferred_tx_queue) +
790 skb_queue_len(&wl->deferred_rx_queue);
791 if (defer_count > WL1271_DEFERRED_QUEUE_LIMIT)
792 wl1271_flush_deferred_work(wl);
1e73eb62 793 }
f5fc0f86 794
1e73eb62
JO		 795 if (intr & WL1271_ACX_INTR_EVENT_A) {
796 wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_EVENT_A");
797 wl1271_event_handle(wl, 0);
798 }
f5fc0f86 799
1e73eb62
JO		 800 if (intr & WL1271_ACX_INTR_EVENT_B) {
801 wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_EVENT_B");
802 wl1271_event_handle(wl, 1);
803 }
f5fc0f86 804
1e73eb62
JO		 805 if (intr & WL1271_ACX_INTR_INIT_COMPLETE)
806 wl1271_debug(DEBUG_IRQ,
807 "WL1271_ACX_INTR_INIT_COMPLETE");
f5fc0f86 808
1e73eb62
JO		 809 if (intr & WL1271_ACX_INTR_HW_AVAILABLE)
810 wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_HW_AVAILABLE");
c15f63bf 811 }
f5fc0f86 812
f5fc0f86
LC		 813 wl1271_ps_elp_sleep(wl);
814
815out:
b07d4037
IY		 816 spin_lock_irqsave(&wl->wl_lock, flags);
817 /* In case TX was not handled here, queue TX work */
818 clear_bit(WL1271_FLAG_TX_PENDING, &wl->flags);
819 if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
820 wl->tx_queue_count)
821 ieee80211_queue_work(wl->hw, &wl->tx_work);
822 spin_unlock_irqrestore(&wl->wl_lock, flags);
823
f5fc0f86 824 mutex_unlock(&wl->mutex);
a620865e
IY		 825
826 return IRQ_HANDLED;
f5fc0f86 827}
a620865e 828EXPORT_SYMBOL_GPL(wl1271_irq);
f5fc0f86 829
f5fc0f86
LC		 830static int wl1271_fetch_firmware(struct wl1271 *wl)
831{
832 const struct firmware *fw;
166d504e 833 const char *fw_name;
f5fc0f86
LC		 834 int ret;
835
166d504e
AN		 836 switch (wl->bss_type) {
837 case BSS_TYPE_AP_BSS:
1aed55fd
AN		 838 if (wl->chip.id == CHIP_ID_1283_PG20)
839 fw_name = WL128X_AP_FW_NAME;
840 else
841 fw_name = WL127X_AP_FW_NAME;
166d504e
AN		 842 break;
843 case BSS_TYPE_IBSS:
844 case BSS_TYPE_STA_BSS:
bc765bf3
SL		 845 if (wl->chip.id == CHIP_ID_1283_PG20)
846 fw_name = WL128X_FW_NAME;
847 else
848 fw_name = WL1271_FW_NAME;
166d504e
AN		 849 break;
850 default:
851 wl1271_error("no compatible firmware for bss_type %d",
852 wl->bss_type);
853 return -EINVAL;
854 }
855
856 wl1271_debug(DEBUG_BOOT, "booting firmware %s", fw_name);
857
858 ret = request_firmware(&fw, fw_name, wl1271_wl_to_dev(wl));
f5fc0f86
LC		 859
860 if (ret < 0) {
861 wl1271_error("could not get firmware: %d", ret);
862 return ret;
863 }
864
865 if (fw->size % 4) {
866 wl1271_error("firmware size is not multiple of 32 bits: %zu",
867 fw->size);
868 ret = -EILSEQ;
869 goto out;
870 }
871
166d504e 872 vfree(wl->fw);
f5fc0f86 873 wl->fw_len = fw->size;
1fba4974 874 wl->fw = vmalloc(wl->fw_len);
f5fc0f86
LC		 875
876 if (!wl->fw) {
877 wl1271_error("could not allocate memory for the firmware");
878 ret = -ENOMEM;
879 goto out;
880 }
881
882 memcpy(wl->fw, fw->data, wl->fw_len);
166d504e 883 wl->fw_bss_type = wl->bss_type;
f5fc0f86
LC		 884 ret = 0;
885
886out:
887 release_firmware(fw);
888
889 return ret;
890}
891
892static int wl1271_fetch_nvs(struct wl1271 *wl)
893{
894 const struct firmware *fw;
895 int ret;
896
5aa42346 897 ret = request_firmware(&fw, WL12XX_NVS_NAME, wl1271_wl_to_dev(wl));
f5fc0f86
LC		 898
899 if (ret < 0) {
900 wl1271_error("could not get nvs file: %d", ret);
901 return ret;
902 }
903
bc765bf3 904 wl->nvs = kmemdup(fw->data, fw->size, GFP_KERNEL);
f5fc0f86
LC		 905
906 if (!wl->nvs) {
907 wl1271_error("could not allocate memory for the nvs file");
908 ret = -ENOMEM;
909 goto out;
910 }
911
02fabb0e
JO		 912 wl->nvs_len = fw->size;
913
f5fc0f86
LC		 914out:
915 release_firmware(fw);
916
917 return ret;
918}
919
52b0e7a6
JO		 920static void wl1271_recovery_work(struct work_struct *work)
921{
922 struct wl1271 *wl =
923 container_of(work, struct wl1271, recovery_work);
924
925 mutex_lock(&wl->mutex);
926
927 if (wl->state != WL1271_STATE_ON)
928 goto out;
929
930 wl1271_info("Hardware recovery in progress.");
931
d25611da
JO		 932 if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
933 ieee80211_connection_loss(wl->vif);
934
52b0e7a6
JO		 935 /* reboot the chipset */
936 __wl1271_op_remove_interface(wl);
937 ieee80211_restart_hw(wl->hw);
938
939out:
940 mutex_unlock(&wl->mutex);
941}
942
f5fc0f86
LC		 943static void wl1271_fw_wakeup(struct wl1271 *wl)
944{
945 u32 elp_reg;
946
947 elp_reg = ELPCTRL_WAKE_UP;
74621417 948 wl1271_raw_write32(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, elp_reg);
f5fc0f86
LC		 949}
950
951static int wl1271_setup(struct wl1271 *wl)
952{
953 wl->fw_status = kmalloc(sizeof(*wl->fw_status), GFP_KERNEL);
954 if (!wl->fw_status)
955 return -ENOMEM;
956
957 wl->tx_res_if = kmalloc(sizeof(*wl->tx_res_if), GFP_KERNEL);
958 if (!wl->tx_res_if) {
959 kfree(wl->fw_status);
960 return -ENOMEM;
961 }
962
f5fc0f86
LC		 963 return 0;
964}
965
966static int wl1271_chip_wakeup(struct wl1271 *wl)
967{
451de97a 968 struct wl1271_partition_set partition;
f5fc0f86
LC		 969 int ret = 0;
970
01ac17ec 971 msleep(WL1271_PRE_POWER_ON_SLEEP);
2cc78ff7
OBC		 972 ret = wl1271_power_on(wl);
973 if (ret < 0)
974 goto out;
f5fc0f86 975 msleep(WL1271_POWER_ON_SLEEP);
9b280722
TP		 976 wl1271_io_reset(wl);
977 wl1271_io_init(wl);
f5fc0f86
LC		 978
979 /* We don't need a real memory partition here, because we only want
980 * to use the registers at this point. */
451de97a
JO		 981 memset(&partition, 0, sizeof(partition));
982 partition.reg.start = REGISTERS_BASE;
983 partition.reg.size = REGISTERS_DOWN_SIZE;
984 wl1271_set_partition(wl, &partition);
f5fc0f86
LC		 985
986 /* ELP module wake up */
987 wl1271_fw_wakeup(wl);
988
989 /* whal_FwCtrl_BootSm() */
990
991 /* 0. read chip id from CHIP_ID */
7b048c52 992 wl->chip.id = wl1271_read32(wl, CHIP_ID_B);
f5fc0f86
LC		 993
994 /* 1. check if chip id is valid */
995
996 switch (wl->chip.id) {
997 case CHIP_ID_1271_PG10:
998 wl1271_warning("chip id 0x%x (1271 PG10) support is obsolete",
999 wl->chip.id);
1000
1001 ret = wl1271_setup(wl);
1002 if (ret < 0)
9ccd9217 1003 goto out;
f5fc0f86
LC		 1004 break;
1005 case CHIP_ID_1271_PG20:
1006 wl1271_debug(DEBUG_BOOT, "chip id 0x%x (1271 PG20)",
1007 wl->chip.id);
1008
1009 ret = wl1271_setup(wl);
1010 if (ret < 0)
9ccd9217 1011 goto out;
f5fc0f86 1012 break;
0830ceed
SL		 1013 case CHIP_ID_1283_PG20:
1014 wl1271_debug(DEBUG_BOOT, "chip id 0x%x (1283 PG20)",
1015 wl->chip.id);
1016
1017 ret = wl1271_setup(wl);
1018 if (ret < 0)
1019 goto out;
1020 break;
1021 case CHIP_ID_1283_PG10:
f5fc0f86 1022 default:
9ccd9217 1023 wl1271_warning("unsupported chip id: 0x%x", wl->chip.id);
f5fc0f86 1024 ret = -ENODEV;
9ccd9217 1025 goto out;
f5fc0f86
LC		 1026 }
1027
166d504e
AN		 1028 /* Make sure the firmware type matches the BSS type */
1029 if (wl->fw == NULL || wl->fw_bss_type != wl->bss_type) {
f5fc0f86
LC		 1030 ret = wl1271_fetch_firmware(wl);
1031 if (ret < 0)
9ccd9217 1032 goto out;
f5fc0f86
LC		 1033 }
1034
1035 /* No NVS from netlink, try to get it from the filesystem */
1036 if (wl->nvs == NULL) {
1037 ret = wl1271_fetch_nvs(wl);
1038 if (ret < 0)
9ccd9217 1039 goto out;
f5fc0f86
LC		 1040 }
1041
1042out:
1043 return ret;
1044}
1045
e7ddf549
LC		 1046static unsigned int wl1271_get_fw_ver_quirks(struct wl1271 *wl)
1047{
1048 unsigned int quirks = 0;
1049 unsigned int *fw_ver = wl->chip.fw_ver;
1050
1051 /* Only for wl127x */
1052 if ((fw_ver[FW_VER_CHIP] == FW_VER_CHIP_WL127X) &&
1053 /* Check STA version */
1054 (((fw_ver[FW_VER_IF_TYPE] == FW_VER_IF_TYPE_STA) &&
1055 (fw_ver[FW_VER_MINOR] < FW_VER_MINOR_1_SPARE_STA_MIN)) ||
1056 /* Check AP version */
1057 ((fw_ver[FW_VER_IF_TYPE] == FW_VER_IF_TYPE_AP) &&
1058 (fw_ver[FW_VER_MINOR] < FW_VER_MINOR_1_SPARE_AP_MIN))))
1059 quirks |= WL12XX_QUIRK_USE_2_SPARE_BLOCKS;
1060
1061 return quirks;
1062}
1063
f5fc0f86
LC		 1064int wl1271_plt_start(struct wl1271 *wl)
1065{
9ccd9217 1066 int retries = WL1271_BOOT_RETRIES;
f5fc0f86
LC		 1067 int ret;
1068
1069 mutex_lock(&wl->mutex);
1070
1071 wl1271_notice("power up");
1072
1073 if (wl->state != WL1271_STATE_OFF) {
1074 wl1271_error("cannot go into PLT state because not "
1075 "in off state: %d", wl->state);
1076 ret = -EBUSY;
1077 goto out;
1078 }
1079
166d504e
AN		 1080 wl->bss_type = BSS_TYPE_STA_BSS;
1081
9ccd9217
JO		 1082 while (retries) {
1083 retries--;
1084 ret = wl1271_chip_wakeup(wl);
1085 if (ret < 0)
1086 goto power_off;
f5fc0f86 1087
9ccd9217
JO		 1088 ret = wl1271_boot(wl);
1089 if (ret < 0)
1090 goto power_off;
eb5b28d0 1091
9ccd9217
JO		 1092 ret = wl1271_plt_init(wl);
1093 if (ret < 0)
1094 goto irq_disable;
bd5ea18f 1095
9ccd9217
JO		 1096 wl->state = WL1271_STATE_PLT;
1097 wl1271_notice("firmware booted in PLT mode (%s)",
4b7fac77 1098 wl->chip.fw_ver_str);
e7ddf549
LC		 1099
1100 /* Check if any quirks are needed with older fw versions */
1101 wl->quirks |= wl1271_get_fw_ver_quirks(wl);
9ccd9217 1102 goto out;
eb5b28d0 1103
9ccd9217 1104irq_disable:
9ccd9217
JO		 1105 mutex_unlock(&wl->mutex);
1106 /* Unlocking the mutex in the middle of handling is
1107 inherently unsafe. In this case we deem it safe to do,
1108 because we need to let any possibly pending IRQ out of
1109 the system (and while we are WL1271_STATE_OFF the IRQ
1110 work function will not do anything.) Also, any other
1111 possible concurrent operations will fail due to the
1112 current state, hence the wl1271 struct should be safe. */
a620865e
IY		 1113 wl1271_disable_interrupts(wl);
1114 wl1271_flush_deferred_work(wl);
1115 cancel_work_sync(&wl->netstack_work);
9ccd9217
JO		 1116 mutex_lock(&wl->mutex);
1117power_off:
1118 wl1271_power_off(wl);
1119 }
f5fc0f86 1120
9ccd9217
JO		 1121 wl1271_error("firmware boot in PLT mode failed despite %d retries",
1122 WL1271_BOOT_RETRIES);
f5fc0f86
LC		 1123out:
1124 mutex_unlock(&wl->mutex);
1125
1126 return ret;
1127}
1128
4623ec7d 1129static int __wl1271_plt_stop(struct wl1271 *wl)
f5fc0f86
LC		 1130{
1131 int ret = 0;
1132
f5fc0f86
LC		 1133 wl1271_notice("power down");
1134
1135 if (wl->state != WL1271_STATE_PLT) {
1136 wl1271_error("cannot power down because not in PLT "
1137 "state: %d", wl->state);
1138 ret = -EBUSY;
1139 goto out;
1140 }
1141
f5fc0f86
LC		 1142 wl1271_power_off(wl);
1143
1144 wl->state = WL1271_STATE_OFF;
bd5ea18f 1145 wl->rx_counter = 0;
f5fc0f86 1146
f5fc0f86 1147 mutex_unlock(&wl->mutex);
a620865e
IY		 1148 wl1271_disable_interrupts(wl);
1149 wl1271_flush_deferred_work(wl);
1150 cancel_work_sync(&wl->netstack_work);
52b0e7a6 1151 cancel_work_sync(&wl->recovery_work);
4ae3fa87
JO		 1152 mutex_lock(&wl->mutex);
1153out:
1154 return ret;
1155}
1156
1157int wl1271_plt_stop(struct wl1271 *wl)
1158{
1159 int ret;
8c7f4f31 1160
4ae3fa87
JO		 1161 mutex_lock(&wl->mutex);
1162 ret = __wl1271_plt_stop(wl);
1163 mutex_unlock(&wl->mutex);
f5fc0f86
LC		 1164 return ret;
1165}
1166
7bb45683 1167static void wl1271_op_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
f5fc0f86
LC		 1168{
1169 struct wl1271 *wl = hw->priv;
830fb67b 1170 unsigned long flags;
6742f554 1171 int q;
a8c0ddb5 1172 u8 hlid = 0;
f5fc0f86 1173
b07d4037
IY		 1174 q = wl1271_tx_get_queue(skb_get_queue_mapping(skb));
1175
1176 if (wl->bss_type == BSS_TYPE_AP_BSS)
1177 hlid = wl1271_tx_get_hlid(skb);
1178
830fb67b 1179 spin_lock_irqsave(&wl->wl_lock, flags);
b07d4037 1180
6742f554 1181 wl->tx_queue_count++;
f4d08ddd
AN		 1182
1183 /*
1184 * The workqueue is slow to process the tx_queue and we need stop
1185 * the queue here, otherwise the queue will get too long.
1186 */
1187 if (wl->tx_queue_count >= WL1271_TX_QUEUE_HIGH_WATERMARK) {
1188 wl1271_debug(DEBUG_TX, "op_tx: stopping queues");
1189 ieee80211_stop_queues(wl->hw);
1190 set_bit(WL1271_FLAG_TX_QUEUE_STOPPED, &wl->flags);
1191 }
1192
830fb67b 1193 /* queue the packet */
a8c0ddb5 1194 if (wl->bss_type == BSS_TYPE_AP_BSS) {
a8c0ddb5
AN		 1195 wl1271_debug(DEBUG_TX, "queue skb hlid %d q %d", hlid, q);
1196 skb_queue_tail(&wl->links[hlid].tx_queue[q], skb);
1197 } else {
1198 skb_queue_tail(&wl->tx_queue[q], skb);
1199 }
f5fc0f86
LC		 1200
1201 /*
1202 * The chip specific setup must run before the first TX packet -
1203 * before that, the tx_work will not be initialized!
1204 */
1205
b07d4037
IY		 1206 if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
1207 !test_bit(WL1271_FLAG_TX_PENDING, &wl->flags))
a522550a 1208 ieee80211_queue_work(wl->hw, &wl->tx_work);
b07d4037
IY		 1209
1210 spin_unlock_irqrestore(&wl->wl_lock, flags);
f5fc0f86
LC		 1211}
1212
ae47c45f
SL		 1213#define TX_DUMMY_PACKET_SIZE 1400
1214int wl1271_tx_dummy_packet(struct wl1271 *wl)
1215{
1216 struct sk_buff *skb = NULL;
1217 struct ieee80211_hdr_3addr *hdr;
1218 int ret = 0;
1219
1220 skb = dev_alloc_skb(
1221 sizeof(struct wl1271_tx_hw_descr) + sizeof(*hdr) +
1222 TX_DUMMY_PACKET_SIZE);
1223 if (!skb) {
1224 wl1271_warning("failed to allocate buffer for dummy packet");
1225 ret = -ENOMEM;
1226 goto out;
1227 }
1228
1229 skb_reserve(skb, sizeof(struct wl1271_tx_hw_descr));
1230
1231 hdr = (struct ieee80211_hdr_3addr *) skb_put(skb, sizeof(*hdr));
1232 memset(hdr, 0, sizeof(*hdr));
1233 hdr->frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA |
1234 IEEE80211_FCTL_TODS |
1235 IEEE80211_STYPE_NULLFUNC);
1236
1237 memcpy(hdr->addr1, wl->bssid, ETH_ALEN);
1238 memcpy(hdr->addr2, wl->mac_addr, ETH_ALEN);
1239 memcpy(hdr->addr3, wl->bssid, ETH_ALEN);
1240
1241 skb_put(skb, TX_DUMMY_PACKET_SIZE);
1242
1243 memset(skb->data, 0, TX_DUMMY_PACKET_SIZE);
1244
1245 skb->pkt_type = TX_PKT_TYPE_DUMMY_REQ;
18b92ffa
LC		 1246 /* Dummy packets require the TID to be management */
1247 skb->priority = WL1271_TID_MGMT;
ae47c45f
SL		 1248 /* CONF_TX_AC_VO */
1249 skb->queue_mapping = 0;
1250
1251 wl1271_op_tx(wl->hw, skb);
1252
1253out:
1254 return ret;
1255}
1256
c2c192ac
JO		 1257static struct notifier_block wl1271_dev_notifier = {
1258 .notifier_call = wl1271_dev_notify,
1259};
1260
f5fc0f86 1261static int wl1271_op_start(struct ieee80211_hw *hw)
1b72aecd
JO		 1262{
1263 wl1271_debug(DEBUG_MAC80211, "mac80211 start");
1264
1265 /*
1266 * We have to delay the booting of the hardware because
1267 * we need to know the local MAC address before downloading and
1268 * initializing the firmware. The MAC address cannot be changed
1269 * after boot, and without the proper MAC address, the firmware
1270 * will not function properly.
1271 *
1272 * The MAC address is first known when the corresponding interface
1273 * is added. That is where we will initialize the hardware.
166d504e
AN		 1274 *
1275 * In addition, we currently have different firmwares for AP and managed
1276 * operation. We will know which to boot according to interface type.
1b72aecd
JO		 1277 */
1278
1279 return 0;
1280}
1281
1282static void wl1271_op_stop(struct ieee80211_hw *hw)
1283{
1284 wl1271_debug(DEBUG_MAC80211, "mac80211 stop");
1285}
1286
1287static int wl1271_op_add_interface(struct ieee80211_hw *hw,
1288 struct ieee80211_vif *vif)
f5fc0f86
LC		 1289{
1290 struct wl1271 *wl = hw->priv;
ac01e948 1291 struct wiphy *wiphy = hw->wiphy;
9ccd9217 1292 int retries = WL1271_BOOT_RETRIES;
f5fc0f86 1293 int ret = 0;
71125abd 1294 bool booted = false;
f5fc0f86 1295
1b72aecd
JO		 1296 wl1271_debug(DEBUG_MAC80211, "mac80211 add interface type %d mac %pM",
1297 vif->type, vif->addr);
f5fc0f86
LC		 1298
1299 mutex_lock(&wl->mutex);
1b72aecd 1300 if (wl->vif) {
71125abd
EP		 1301 wl1271_debug(DEBUG_MAC80211,
1302 "multiple vifs are not supported yet");
1b72aecd
JO		 1303 ret = -EBUSY;
1304 goto out;
1305 }
1306
1b72aecd
JO		 1307 switch (vif->type) {
1308 case NL80211_IFTYPE_STATION:
1309 wl->bss_type = BSS_TYPE_STA_BSS;
5da11dcd 1310 wl->set_bss_type = BSS_TYPE_STA_BSS;
1b72aecd
JO		 1311 break;
1312 case NL80211_IFTYPE_ADHOC:
1313 wl->bss_type = BSS_TYPE_IBSS;
5da11dcd 1314 wl->set_bss_type = BSS_TYPE_STA_BSS;
1b72aecd 1315 break;
038d925b
AN		 1316 case NL80211_IFTYPE_AP:
1317 wl->bss_type = BSS_TYPE_AP_BSS;
1318 break;
1b72aecd
JO		 1319 default:
1320 ret = -EOPNOTSUPP;
1321 goto out;
1322 }
1323
1324 memcpy(wl->mac_addr, vif->addr, ETH_ALEN);
f5fc0f86
LC		 1325
1326 if (wl->state != WL1271_STATE_OFF) {
1327 wl1271_error("cannot start because not in off state: %d",
1328 wl->state);
1329 ret = -EBUSY;
1330 goto out;
1331 }
1332
9ccd9217
JO		 1333 while (retries) {
1334 retries--;
1335 ret = wl1271_chip_wakeup(wl);
1336 if (ret < 0)
1337 goto power_off;
f5fc0f86 1338
9ccd9217
JO		 1339 ret = wl1271_boot(wl);
1340 if (ret < 0)
1341 goto power_off;
f5fc0f86 1342
9ccd9217
JO		 1343 ret = wl1271_hw_init(wl);
1344 if (ret < 0)
1345 goto irq_disable;
f5fc0f86 1346
71125abd
EP		 1347 booted = true;
1348 break;
eb5b28d0 1349
9ccd9217 1350irq_disable:
9ccd9217
JO		 1351 mutex_unlock(&wl->mutex);
1352 /* Unlocking the mutex in the middle of handling is
1353 inherently unsafe. In this case we deem it safe to do,
1354 because we need to let any possibly pending IRQ out of
1355 the system (and while we are WL1271_STATE_OFF the IRQ
1356 work function will not do anything.) Also, any other
1357 possible concurrent operations will fail due to the
1358 current state, hence the wl1271 struct should be safe. */
a620865e
IY		 1359 wl1271_disable_interrupts(wl);
1360 wl1271_flush_deferred_work(wl);
1361 cancel_work_sync(&wl->netstack_work);
9ccd9217
JO		 1362 mutex_lock(&wl->mutex);
1363power_off:
1364 wl1271_power_off(wl);
1365 }
eb5b28d0 1366
71125abd
EP		 1367 if (!booted) {
1368 wl1271_error("firmware boot failed despite %d retries",
1369 WL1271_BOOT_RETRIES);
1370 goto out;
1371 }
1372
1373 wl->vif = vif;
1374 wl->state = WL1271_STATE_ON;
4b7fac77 1375 wl1271_info("firmware booted (%s)", wl->chip.fw_ver_str);
71125abd
EP		 1376
1377 /* update hw/fw version info in wiphy struct */
1378 wiphy->hw_version = wl->chip.id;
4b7fac77 1379 strncpy(wiphy->fw_version, wl->chip.fw_ver_str,
71125abd
EP		 1380 sizeof(wiphy->fw_version));
1381
e7ddf549
LC		 1382 /* Check if any quirks are needed with older fw versions */
1383 wl->quirks |= wl1271_get_fw_ver_quirks(wl);
1384
fb6a6819
LC		 1385 /*
1386 * Now we know if 11a is supported (info from the NVS), so disable
1387 * 11a channels if not supported
1388 */
1389 if (!wl->enable_11a)
1390 wiphy->bands[IEEE80211_BAND_5GHZ]->n_channels = 0;
1391
1392 wl1271_debug(DEBUG_MAC80211, "11a is %ssupported",
1393 wl->enable_11a ? "" : "not ");
1394
eb5b28d0 1395out:
f5fc0f86
LC		 1396 mutex_unlock(&wl->mutex);
1397
f9f774c1 1398 mutex_lock(&wl_list_mutex);
eb887dfd 1399 if (!ret)
01c09162 1400 list_add(&wl->list, &wl_list);
f9f774c1 1401 mutex_unlock(&wl_list_mutex);
01c09162 1402
f5fc0f86
LC		 1403 return ret;
1404}
1405
52a2a375 1406static void __wl1271_op_remove_interface(struct wl1271 *wl)
f5fc0f86 1407{
f5fc0f86
LC		 1408 int i;
1409
1b72aecd 1410 wl1271_debug(DEBUG_MAC80211, "mac80211 remove interface");
f5fc0f86 1411
1b72aecd 1412 wl1271_info("down");
f5fc0f86 1413
f9f774c1 1414 mutex_lock(&wl_list_mutex);
01c09162 1415 list_del(&wl->list);
f9f774c1 1416 mutex_unlock(&wl_list_mutex);
01c09162 1417
f5fc0f86
LC		 1418 WARN_ON(wl->state != WL1271_STATE_ON);
1419
8d2ef7bd 1420 /* enable dyn ps just in case (if left on due to fw crash etc) */
9a547bf9 1421 if (wl->bss_type == BSS_TYPE_STA_BSS)
f532be6d 1422 ieee80211_enable_dyn_ps(wl->vif);
8d2ef7bd 1423
08688d6b 1424 if (wl->scan.state != WL1271_SCAN_STATE_IDLE) {
08688d6b 1425 wl->scan.state = WL1271_SCAN_STATE_IDLE;
4a31c11c 1426 memset(wl->scan.scanned_ch, 0, sizeof(wl->scan.scanned_ch));
b739a42c 1427 wl->scan.req = NULL;
76a029fb 1428 ieee80211_scan_completed(wl->hw, true);
f5fc0f86
LC		 1429 }
1430
1431 wl->state = WL1271_STATE_OFF;
1432
f5fc0f86
LC		 1433 mutex_unlock(&wl->mutex);
1434
a620865e
IY		 1435 wl1271_disable_interrupts(wl);
1436 wl1271_flush_deferred_work(wl);
78abd320 1437 cancel_delayed_work_sync(&wl->scan_complete_work);
a620865e 1438 cancel_work_sync(&wl->netstack_work);
f5fc0f86 1439 cancel_work_sync(&wl->tx_work);
90494a90 1440 cancel_delayed_work_sync(&wl->pspoll_work);
8c7f4f31 1441 cancel_delayed_work_sync(&wl->elp_work);
f5fc0f86
LC		 1442
1443 mutex_lock(&wl->mutex);
1444
1445 /* let's notify MAC80211 about the remaining pending TX frames */
781608c4 1446 wl1271_tx_reset(wl);
f5fc0f86
LC		 1447 wl1271_power_off(wl);
1448
1449 memset(wl->bssid, 0, ETH_ALEN);
1450 memset(wl->ssid, 0, IW_ESSID_MAX_SIZE + 1);
1451 wl->ssid_len = 0;
f5fc0f86 1452 wl->bss_type = MAX_BSS_TYPE;
5da11dcd 1453 wl->set_bss_type = MAX_BSS_TYPE;
8a5a37a6 1454 wl->band = IEEE80211_BAND_2GHZ;
f5fc0f86
LC		 1455
1456 wl->rx_counter = 0;
19ad0715 1457 wl->psm_entry_retry = 0;
f5fc0f86
LC		 1458 wl->power_level = WL1271_DEFAULT_POWER_LEVEL;
1459 wl->tx_blocks_available = 0;
1460 wl->tx_results_count = 0;
1461 wl->tx_packets_count = 0;
ac4e4ce5 1462 wl->tx_security_last_seq = 0;
04e36fc5 1463 wl->tx_security_seq = 0;
f5fc0f86
LC		 1464 wl->time_offset = 0;
1465 wl->session_counter = 0;
830fb67b 1466 wl->rate_set = CONF_TX_RATE_MASK_BASIC;
830fb67b 1467 wl->flags = 0;
1b72aecd 1468 wl->vif = NULL;
14b228a0 1469 wl->filters = 0;
7f179b46 1470 wl1271_free_ap_keys(wl);
f84f7d78 1471 memset(wl->ap_hlid_map, 0, sizeof(wl->ap_hlid_map));
b622d992
AN		 1472 wl->ap_fw_ps_map = 0;
1473 wl->ap_ps_map = 0;
48a61477 1474 wl->block_size = 0;
d6e19d13 1475
f5fc0f86
LC		 1476 for (i = 0; i < NUM_TX_QUEUES; i++)
1477 wl->tx_blocks_freed[i] = 0;
1478
1479 wl1271_debugfs_reset(wl);
bd9dc49c
JO		 1480
1481 kfree(wl->fw_status);
1482 wl->fw_status = NULL;
1483 kfree(wl->tx_res_if);
1484 wl->tx_res_if = NULL;
1485 kfree(wl->target_mem_map);
1486 wl->target_mem_map = NULL;
52a2a375 1487}
bd9dc49c 1488
52a2a375
JO		 1489static void wl1271_op_remove_interface(struct ieee80211_hw *hw,
1490 struct ieee80211_vif *vif)
1491{
1492 struct wl1271 *wl = hw->priv;
1493
1494 mutex_lock(&wl->mutex);
67353299
JO		 1495 /*
1496 * wl->vif can be null here if someone shuts down the interface
1497 * just when hardware recovery has been started.
1498 */
1499 if (wl->vif) {
1500 WARN_ON(wl->vif != vif);
1501 __wl1271_op_remove_interface(wl);
1502 }
52b0e7a6 1503
67353299 1504 mutex_unlock(&wl->mutex);
52b0e7a6 1505 cancel_work_sync(&wl->recovery_work);
f5fc0f86
LC		 1506}
1507
14b228a0
JO		 1508static void wl1271_configure_filters(struct wl1271 *wl, unsigned int filters)
1509{
ae113b57 1510 wl1271_set_default_filters(wl);
14b228a0
JO		 1511
1512 /* combine requested filters with current filter config */
1513 filters = wl->filters | filters;
1514
1515 wl1271_debug(DEBUG_FILTERS, "RX filters set: ");
1516
1517 if (filters & FIF_PROMISC_IN_BSS) {
1518 wl1271_debug(DEBUG_FILTERS, " - FIF_PROMISC_IN_BSS");
1519 wl->rx_config &= ~CFG_UNI_FILTER_EN;
1520 wl->rx_config |= CFG_BSSID_FILTER_EN;
1521 }
1522 if (filters & FIF_BCN_PRBRESP_PROMISC) {
1523 wl1271_debug(DEBUG_FILTERS, " - FIF_BCN_PRBRESP_PROMISC");
1524 wl->rx_config &= ~CFG_BSSID_FILTER_EN;
1525 wl->rx_config &= ~CFG_SSID_FILTER_EN;
1526 }
1527 if (filters & FIF_OTHER_BSS) {
1528 wl1271_debug(DEBUG_FILTERS, " - FIF_OTHER_BSS");
1529 wl->rx_config &= ~CFG_BSSID_FILTER_EN;
1530 }
1531 if (filters & FIF_CONTROL) {
1532 wl1271_debug(DEBUG_FILTERS, " - FIF_CONTROL");
1533 wl->rx_filter |= CFG_RX_CTL_EN;
1534 }
1535 if (filters & FIF_FCSFAIL) {
1536 wl1271_debug(DEBUG_FILTERS, " - FIF_FCSFAIL");
1537 wl->rx_filter |= CFG_RX_FCS_ERROR;
1538 }
1539}
1540
82429d32 1541static int wl1271_dummy_join(struct wl1271 *wl)
c7f43e45 1542{
e0d8bbf0 1543 int ret = 0;
c7f43e45
LC		 1544 /* we need to use a dummy BSSID for now */
1545 static const u8 dummy_bssid[ETH_ALEN] = { 0x0b, 0xad, 0xde,
1546 0xad, 0xbe, 0xef };
1547
c7f43e45
LC		 1548 memcpy(wl->bssid, dummy_bssid, ETH_ALEN);
1549
14b228a0
JO		 1550 /* pass through frames from all BSS */
1551 wl1271_configure_filters(wl, FIF_OTHER_BSS);
1552
5da11dcd 1553 ret = wl1271_cmd_join(wl, wl->set_bss_type);
c7f43e45
LC		 1554 if (ret < 0)
1555 goto out;
1556
71449f8d 1557 set_bit(WL1271_FLAG_JOINED, &wl->flags);
c7f43e45
LC		 1558
1559out:
1560 return ret;
1561}
1562
69e5434c 1563static int wl1271_join(struct wl1271 *wl, bool set_assoc)
82429d32
JO		 1564{
1565 int ret;
1566
69e5434c
JO		 1567 /*
1568 * One of the side effects of the JOIN command is that is clears
1569 * WPA/WPA2 keys from the chipset. Performing a JOIN while associated
1570 * to a WPA/WPA2 access point will therefore kill the data-path.
1571 * Currently there is no supported scenario for JOIN during
1572 * association - if it becomes a supported scenario, the WPA/WPA2 keys
1573 * must be handled somehow.
1574 *
1575 */
1576 if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
1577 wl1271_info("JOIN while associated.");
1578
1579 if (set_assoc)
1580 set_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags);
1581
82429d32
JO		 1582 ret = wl1271_cmd_join(wl, wl->set_bss_type);
1583 if (ret < 0)
1584 goto out;
1585
1586 set_bit(WL1271_FLAG_JOINED, &wl->flags);
1587
1588 if (!test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
1589 goto out;
1590
1591 /*
1592 * The join command disable the keep-alive mode, shut down its process,
1593 * and also clear the template config, so we need to reset it all after
1594 * the join. The acx_aid starts the keep-alive process, and the order
1595 * of the commands below is relevant.
1596 */
1597 ret = wl1271_acx_keep_alive_mode(wl, true);
1598 if (ret < 0)
1599 goto out;
1600
1601 ret = wl1271_acx_aid(wl, wl->aid);
1602 if (ret < 0)
1603 goto out;
1604
1605 ret = wl1271_cmd_build_klv_null_data(wl);
1606 if (ret < 0)
1607 goto out;
1608
1609 ret = wl1271_acx_keep_alive_config(wl, CMD_TEMPL_KLV_IDX_NULL_DATA,
1610 ACX_KEEP_ALIVE_TPL_VALID);
1611 if (ret < 0)
1612 goto out;
1613
1614out:
1615 return ret;
1616}
1617
1618static int wl1271_unjoin(struct wl1271 *wl)
c7f43e45
LC		 1619{
1620 int ret;
1621
1622 /* to stop listening to a channel, we disconnect */
1623 ret = wl1271_cmd_disconnect(wl);
1624 if (ret < 0)
1625 goto out;
1626
71449f8d 1627 clear_bit(WL1271_FLAG_JOINED, &wl->flags);
c7f43e45 1628 memset(wl->bssid, 0, ETH_ALEN);
14b228a0
JO		 1629
1630 /* stop filterting packets based on bssid */
1631 wl1271_configure_filters(wl, FIF_OTHER_BSS);
c7f43e45
LC		 1632
1633out:
1634 return ret;
1635}
1636
ebba60c6
JO		 1637static void wl1271_set_band_rate(struct wl1271 *wl)
1638{
1639 if (wl->band == IEEE80211_BAND_2GHZ)
1640 wl->basic_rate_set = wl->conf.tx.basic_rate;
1641 else
1642 wl->basic_rate_set = wl->conf.tx.basic_rate_5;
1643}
1644
bee0ffec 1645static int wl1271_sta_handle_idle(struct wl1271 *wl, bool idle)
0d58cbff
JO		 1646{
1647 int ret;
1648
1649 if (idle) {
1650 if (test_bit(WL1271_FLAG_JOINED, &wl->flags)) {
1651 ret = wl1271_unjoin(wl);
1652 if (ret < 0)
1653 goto out;
1654 }
e0fe371b 1655 wl->rate_set = wl1271_tx_min_rate_get(wl);
79b223f4 1656 ret = wl1271_acx_sta_rate_policies(wl);
0d58cbff
JO		 1657 if (ret < 0)
1658 goto out;
1659 ret = wl1271_acx_keep_alive_config(
1660 wl, CMD_TEMPL_KLV_IDX_NULL_DATA,
1661 ACX_KEEP_ALIVE_TPL_INVALID);
1662 if (ret < 0)
1663 goto out;
1664 set_bit(WL1271_FLAG_IDLE, &wl->flags);
1665 } else {
1666 /* increment the session counter */
1667 wl->session_counter++;
1668 if (wl->session_counter >= SESSION_COUNTER_MAX)
1669 wl->session_counter = 0;
1670 ret = wl1271_dummy_join(wl);
1671 if (ret < 0)
1672 goto out;
1673 clear_bit(WL1271_FLAG_IDLE, &wl->flags);
1674 }
1675
1676out:
1677 return ret;
1678}
1679
f5fc0f86
LC		 1680static int wl1271_op_config(struct ieee80211_hw *hw, u32 changed)
1681{
1682 struct wl1271 *wl = hw->priv;
1683 struct ieee80211_conf *conf = &hw->conf;
1684 int channel, ret = 0;
bee0ffec 1685 bool is_ap;
f5fc0f86
LC		 1686
1687 channel = ieee80211_frequency_to_channel(conf->channel->center_freq);
1688
bee0ffec
AN		 1689 wl1271_debug(DEBUG_MAC80211, "mac80211 config ch %d psm %s power %d %s"
1690 " changed 0x%x",
f5fc0f86
LC		 1691 channel,
1692 conf->flags & IEEE80211_CONF_PS ? "on" : "off",
c7f43e45 1693 conf->power_level,
bee0ffec
AN		 1694 conf->flags & IEEE80211_CONF_IDLE ? "idle" : "in use",
1695 changed);
f5fc0f86 1696
781608c4
JO		 1697 /*
1698 * mac80211 will go to idle nearly immediately after transmitting some
1699 * frames, such as the deauth. To make sure those frames reach the air,
1700 * wait here until the TX queue is fully flushed.
1701 */
1702 if ((changed & IEEE80211_CONF_CHANGE_IDLE) &&
1703 (conf->flags & IEEE80211_CONF_IDLE))
1704 wl1271_tx_flush(wl);
1705
f5fc0f86
LC		 1706 mutex_lock(&wl->mutex);
1707
f8d9802f 1708 if (unlikely(wl->state == WL1271_STATE_OFF)) {
17e672d6
AN		 1709 /* we support configuring the channel and band while off */
1710 if ((changed & IEEE80211_CONF_CHANGE_CHANNEL)) {
1711 wl->band = conf->channel->band;
1712 wl->channel = channel;
1713 }
1714
2c10bb9c 1715 goto out;
f8d9802f 1716 }
8a5a37a6 1717
bee0ffec
AN		 1718 is_ap = (wl->bss_type == BSS_TYPE_AP_BSS);
1719
a620865e 1720 ret = wl1271_ps_elp_wakeup(wl);
f5fc0f86
LC		 1721 if (ret < 0)
1722 goto out;
1723
ebba60c6 1724 /* if the channel changes while joined, join again */
69e5434c
JO		 1725 if (changed & IEEE80211_CONF_CHANGE_CHANNEL &&
1726 ((wl->band != conf->channel->band) ||
1727 (wl->channel != channel))) {
ebba60c6
JO		 1728 wl->band = conf->channel->band;
1729 wl->channel = channel;
1730
bee0ffec
AN		 1731 if (!is_ap) {
1732 /*
1733 * FIXME: the mac80211 should really provide a fixed
1734 * rate to use here. for now, just use the smallest
1735 * possible rate for the band as a fixed rate for
1736 * association frames and other control messages.
1737 */
1738 if (!test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
1739 wl1271_set_band_rate(wl);
1740
1741 wl->basic_rate = wl1271_tx_min_rate_get(wl);
1742 ret = wl1271_acx_sta_rate_policies(wl);
ebba60c6 1743 if (ret < 0)
bee0ffec 1744 wl1271_warning("rate policy for channel "
ebba60c6 1745 "failed %d", ret);
bee0ffec
AN		 1746
1747 if (test_bit(WL1271_FLAG_JOINED, &wl->flags)) {
1748 ret = wl1271_join(wl, false);
1749 if (ret < 0)
1750 wl1271_warning("cmd join on channel "
1751 "failed %d", ret);
1752 }
ebba60c6
JO		 1753 }
1754 }
1755
bee0ffec
AN		 1756 if (changed & IEEE80211_CONF_CHANGE_IDLE && !is_ap) {
1757 ret = wl1271_sta_handle_idle(wl,
1758 conf->flags & IEEE80211_CONF_IDLE);
0d58cbff
JO		 1759 if (ret < 0)
1760 wl1271_warning("idle mode change failed %d", ret);
f5fc0f86
LC		 1761 }
1762
90494a90
JO		 1763 /*
1764 * if mac80211 changes the PSM mode, make sure the mode is not
1765 * incorrectly changed after the pspoll failure active window.
1766 */
1767 if (changed & IEEE80211_CONF_CHANGE_PS)
1768 clear_bit(WL1271_FLAG_PSPOLL_FAILURE, &wl->flags);
1769
71449f8d
JO		 1770 if (conf->flags & IEEE80211_CONF_PS &&
1771 !test_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags)) {
1772 set_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags);
f5fc0f86
LC		 1773
1774 /*
1775 * We enter PSM only if we're already associated.
1776 * If we're not, we'll enter it when joining an SSID,
1777 * through the bss_info_changed() hook.
1778 */
830fb67b 1779 if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags)) {
18f8d468 1780 wl1271_debug(DEBUG_PSM, "psm enabled");
d8c42c0c 1781 ret = wl1271_ps_set_mode(wl, STATION_POWER_SAVE_MODE,
8eab7b47 1782 wl->basic_rate, true);
af5e084b 1783 }
f5fc0f86 1784 } else if (!(conf->flags & IEEE80211_CONF_PS) &&
71449f8d 1785 test_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags)) {
18f8d468 1786 wl1271_debug(DEBUG_PSM, "psm disabled");
f5fc0f86 1787
71449f8d 1788 clear_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags);
f5fc0f86 1789
71449f8d 1790 if (test_bit(WL1271_FLAG_PSM, &wl->flags))
d8c42c0c 1791 ret = wl1271_ps_set_mode(wl, STATION_ACTIVE_MODE,
8eab7b47 1792 wl->basic_rate, true);
f5fc0f86
LC		 1793 }
1794
1795 if (conf->power_level != wl->power_level) {
1796 ret = wl1271_acx_tx_power(wl, conf->power_level);
1797 if (ret < 0)
c6317a54 1798 goto out_sleep;
f5fc0f86
LC		 1799
1800 wl->power_level = conf->power_level;
1801 }
1802
1803out_sleep:
1804 wl1271_ps_elp_sleep(wl);
1805
1806out:
1807 mutex_unlock(&wl->mutex);
1808
1809 return ret;
1810}
1811
b54853f1
JO		 1812struct wl1271_filter_params {
1813 bool enabled;
1814 int mc_list_length;
1815 u8 mc_list[ACX_MC_ADDRESS_GROUP_MAX][ETH_ALEN];
1816};
1817
22bedad3
JP		 1818static u64 wl1271_op_prepare_multicast(struct ieee80211_hw *hw,
1819 struct netdev_hw_addr_list *mc_list)
c87dec9f 1820{
c87dec9f 1821 struct wl1271_filter_params *fp;
22bedad3 1822 struct netdev_hw_addr *ha;
2c10bb9c 1823 struct wl1271 *wl = hw->priv;
c87dec9f 1824
2c10bb9c
SD		 1825 if (unlikely(wl->state == WL1271_STATE_OFF))
1826 return 0;
c87dec9f 1827
74441130 1828 fp = kzalloc(sizeof(*fp), GFP_ATOMIC);
c87dec9f
JO		 1829 if (!fp) {
1830 wl1271_error("Out of memory setting filters.");
1831 return 0;
1832 }
1833
1834 /* update multicast filtering parameters */
c87dec9f 1835 fp->mc_list_length = 0;
22bedad3
JP		 1836 if (netdev_hw_addr_list_count(mc_list) > ACX_MC_ADDRESS_GROUP_MAX) {
1837 fp->enabled = false;
1838 } else {
1839 fp->enabled = true;
1840 netdev_hw_addr_list_for_each(ha, mc_list) {
c87dec9f 1841 memcpy(fp->mc_list[fp->mc_list_length],
22bedad3 1842 ha->addr, ETH_ALEN);
c87dec9f 1843 fp->mc_list_length++;
22bedad3 1844 }
c87dec9f
JO		 1845 }
1846
b54853f1 1847 return (u64)(unsigned long)fp;
c87dec9f 1848}
f5fc0f86 1849
b54853f1
JO		 1850#define WL1271_SUPPORTED_FILTERS (FIF_PROMISC_IN_BSS | \
1851 FIF_ALLMULTI | \
1852 FIF_FCSFAIL | \
1853 FIF_BCN_PRBRESP_PROMISC | \
1854 FIF_CONTROL | \
1855 FIF_OTHER_BSS)
1856
f5fc0f86
LC		 1857static void wl1271_op_configure_filter(struct ieee80211_hw *hw,
1858 unsigned int changed,
c87dec9f 1859 unsigned int *total, u64 multicast)
f5fc0f86 1860{
b54853f1 1861 struct wl1271_filter_params *fp = (void *)(unsigned long)multicast;
f5fc0f86 1862 struct wl1271 *wl = hw->priv;
b54853f1 1863 int ret;
f5fc0f86 1864
7d057869
AN		 1865 wl1271_debug(DEBUG_MAC80211, "mac80211 configure filter changed %x"
1866 " total %x", changed, *total);
f5fc0f86 1867
b54853f1
JO		 1868 mutex_lock(&wl->mutex);
1869
2c10bb9c
SD		 1870 *total &= WL1271_SUPPORTED_FILTERS;
1871 changed &= WL1271_SUPPORTED_FILTERS;
1872
1873 if (unlikely(wl->state == WL1271_STATE_OFF))
b54853f1
JO		 1874 goto out;
1875
a620865e 1876 ret = wl1271_ps_elp_wakeup(wl);
b54853f1
JO		 1877 if (ret < 0)
1878 goto out;
1879
7d057869
AN		 1880 if (wl->bss_type != BSS_TYPE_AP_BSS) {
1881 if (*total & FIF_ALLMULTI)
1882 ret = wl1271_acx_group_address_tbl(wl, false, NULL, 0);
1883 else if (fp)
1884 ret = wl1271_acx_group_address_tbl(wl, fp->enabled,
1885 fp->mc_list,
1886 fp->mc_list_length);
1887 if (ret < 0)
1888 goto out_sleep;
1889 }
f5fc0f86 1890
b54853f1
JO		 1891 /* determine, whether supported filter values have changed */
1892 if (changed == 0)
1893 goto out_sleep;
c87dec9f 1894
14b228a0
JO		 1895 /* configure filters */
1896 wl->filters = *total;
1897 wl1271_configure_filters(wl, 0);
1898
b54853f1
JO		 1899 /* apply configured filters */
1900 ret = wl1271_acx_rx_config(wl, wl->rx_config, wl->rx_filter);
1901 if (ret < 0)
1902 goto out_sleep;
1903
1904out_sleep:
1905 wl1271_ps_elp_sleep(wl);
1906
1907out:
1908 mutex_unlock(&wl->mutex);
14b228a0 1909 kfree(fp);
f5fc0f86
LC		 1910}
1911
7f179b46
AN		 1912static int wl1271_record_ap_key(struct wl1271 *wl, u8 id, u8 key_type,
1913 u8 key_size, const u8 *key, u8 hlid, u32 tx_seq_32,
1914 u16 tx_seq_16)
1915{
1916 struct wl1271_ap_key *ap_key;
1917 int i;
1918
1919 wl1271_debug(DEBUG_CRYPT, "record ap key id %d", (int)id);
1920
1921 if (key_size > MAX_KEY_SIZE)
1922 return -EINVAL;
1923
1924 /*
1925 * Find next free entry in ap_keys. Also check we are not replacing
1926 * an existing key.
1927 */
1928 for (i = 0; i < MAX_NUM_KEYS; i++) {
1929 if (wl->recorded_ap_keys[i] == NULL)
1930 break;
1931
1932 if (wl->recorded_ap_keys[i]->id == id) {
1933 wl1271_warning("trying to record key replacement");
1934 return -EINVAL;
1935 }
1936 }
1937
1938 if (i == MAX_NUM_KEYS)
1939 return -EBUSY;
1940
1941 ap_key = kzalloc(sizeof(*ap_key), GFP_KERNEL);
1942 if (!ap_key)
1943 return -ENOMEM;
1944
1945 ap_key->id = id;
1946 ap_key->key_type = key_type;
1947 ap_key->key_size = key_size;
1948 memcpy(ap_key->key, key, key_size);
1949 ap_key->hlid = hlid;
1950 ap_key->tx_seq_32 = tx_seq_32;
1951 ap_key->tx_seq_16 = tx_seq_16;
1952
1953 wl->recorded_ap_keys[i] = ap_key;
1954 return 0;
1955}
1956
1957static void wl1271_free_ap_keys(struct wl1271 *wl)
1958{
1959 int i;
1960
1961 for (i = 0; i < MAX_NUM_KEYS; i++) {
1962 kfree(wl->recorded_ap_keys[i]);
1963 wl->recorded_ap_keys[i] = NULL;
1964 }
1965}
1966
1967static int wl1271_ap_init_hwenc(struct wl1271 *wl)
1968{
1969 int i, ret = 0;
1970 struct wl1271_ap_key *key;
1971 bool wep_key_added = false;
1972
1973 for (i = 0; i < MAX_NUM_KEYS; i++) {
1974 if (wl->recorded_ap_keys[i] == NULL)
1975 break;
1976
1977 key = wl->recorded_ap_keys[i];
1978 ret = wl1271_cmd_set_ap_key(wl, KEY_ADD_OR_REPLACE,
1979 key->id, key->key_type,
1980 key->key_size, key->key,
1981 key->hlid, key->tx_seq_32,
1982 key->tx_seq_16);
1983 if (ret < 0)
1984 goto out;
1985
1986 if (key->key_type == KEY_WEP)
1987 wep_key_added = true;
1988 }
1989
1990 if (wep_key_added) {
1991 ret = wl1271_cmd_set_ap_default_wep_key(wl, wl->default_key);
1992 if (ret < 0)
1993 goto out;
1994 }
1995
1996out:
1997 wl1271_free_ap_keys(wl);
1998 return ret;
1999}
2000
2001static int wl1271_set_key(struct wl1271 *wl, u16 action, u8 id, u8 key_type,
2002 u8 key_size, const u8 *key, u32 tx_seq_32,
2003 u16 tx_seq_16, struct ieee80211_sta *sta)
2004{
2005 int ret;
2006 bool is_ap = (wl->bss_type == BSS_TYPE_AP_BSS);
2007
2008 if (is_ap) {
2009 struct wl1271_station *wl_sta;
2010 u8 hlid;
2011
2012 if (sta) {
2013 wl_sta = (struct wl1271_station *)sta->drv_priv;
2014 hlid = wl_sta->hlid;
2015 } else {
2016 hlid = WL1271_AP_BROADCAST_HLID;
2017 }
2018
2019 if (!test_bit(WL1271_FLAG_AP_STARTED, &wl->flags)) {
2020 /*
2021 * We do not support removing keys after AP shutdown.
2022 * Pretend we do to make mac80211 happy.
2023 */
2024 if (action != KEY_ADD_OR_REPLACE)
2025 return 0;
2026
2027 ret = wl1271_record_ap_key(wl, id,
2028 key_type, key_size,
2029 key, hlid, tx_seq_32,
2030 tx_seq_16);
2031 } else {
2032 ret = wl1271_cmd_set_ap_key(wl, action,
2033 id, key_type, key_size,
2034 key, hlid, tx_seq_32,
2035 tx_seq_16);
2036 }
2037
2038 if (ret < 0)
2039 return ret;
2040 } else {
2041 const u8 *addr;
2042 static const u8 bcast_addr[ETH_ALEN] = {
2043 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
2044 };
2045
2046 addr = sta ? sta->addr : bcast_addr;
2047
2048 if (is_zero_ether_addr(addr)) {
2049 /* We dont support TX only encryption */
2050 return -EOPNOTSUPP;
2051 }
2052
2053 /* The wl1271 does not allow to remove unicast keys - they
2054 will be cleared automatically on next CMD_JOIN. Ignore the
2055 request silently, as we dont want the mac80211 to emit
2056 an error message. */
2057 if (action == KEY_REMOVE && !is_broadcast_ether_addr(addr))
2058 return 0;
2059
2060 ret = wl1271_cmd_set_sta_key(wl, action,
2061 id, key_type, key_size,
2062 key, addr, tx_seq_32,
2063 tx_seq_16);
2064 if (ret < 0)
2065 return ret;
2066
2067 /* the default WEP key needs to be configured at least once */
2068 if (key_type == KEY_WEP) {
2069 ret = wl1271_cmd_set_sta_default_wep_key(wl,
2070 wl->default_key);
2071 if (ret < 0)
2072 return ret;
2073 }
2074 }
2075
2076 return 0;
2077}
2078
f5fc0f86
LC		 2079static int wl1271_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
2080 struct ieee80211_vif *vif,
2081 struct ieee80211_sta *sta,
2082 struct ieee80211_key_conf *key_conf)
2083{
2084 struct wl1271 *wl = hw->priv;
f5fc0f86 2085 int ret;
ac4e4ce5
JO		 2086 u32 tx_seq_32 = 0;
2087 u16 tx_seq_16 = 0;
f5fc0f86
LC		 2088 u8 key_type;
2089
f5fc0f86
LC		 2090 wl1271_debug(DEBUG_MAC80211, "mac80211 set key");
2091
7f179b46 2092 wl1271_debug(DEBUG_CRYPT, "CMD: 0x%x sta: %p", cmd, sta);
f5fc0f86 2093 wl1271_debug(DEBUG_CRYPT, "Key: algo:0x%x, id:%d, len:%d flags 0x%x",
97359d12 2094 key_conf->cipher, key_conf->keyidx,
f5fc0f86
LC		 2095 key_conf->keylen, key_conf->flags);
2096 wl1271_dump(DEBUG_CRYPT, "KEY: ", key_conf->key, key_conf->keylen);
2097
f5fc0f86
LC		 2098 mutex_lock(&wl->mutex);
2099
f8d9802f
JO		 2100 if (unlikely(wl->state == WL1271_STATE_OFF)) {
2101 ret = -EAGAIN;
2102 goto out_unlock;
2103 }
2104
a620865e 2105 ret = wl1271_ps_elp_wakeup(wl);
f5fc0f86
LC		 2106 if (ret < 0)
2107 goto out_unlock;
2108
97359d12
JB		 2109 switch (key_conf->cipher) {
2110 case WLAN_CIPHER_SUITE_WEP40:
2111 case WLAN_CIPHER_SUITE_WEP104:
f5fc0f86
LC		 2112 key_type = KEY_WEP;
2113
2114 key_conf->hw_key_idx = key_conf->keyidx;
2115 break;
97359d12 2116 case WLAN_CIPHER_SUITE_TKIP:
f5fc0f86
LC		 2117 key_type = KEY_TKIP;
2118
2119 key_conf->hw_key_idx = key_conf->keyidx;
04e36fc5
JO		 2120 tx_seq_32 = WL1271_TX_SECURITY_HI32(wl->tx_security_seq);
2121 tx_seq_16 = WL1271_TX_SECURITY_LO16(wl->tx_security_seq);
f5fc0f86 2122 break;
97359d12 2123 case WLAN_CIPHER_SUITE_CCMP:
f5fc0f86
LC		 2124 key_type = KEY_AES;
2125
2126 key_conf->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
04e36fc5
JO		 2127 tx_seq_32 = WL1271_TX_SECURITY_HI32(wl->tx_security_seq);
2128 tx_seq_16 = WL1271_TX_SECURITY_LO16(wl->tx_security_seq);
f5fc0f86 2129 break;
7a55724e
JO		 2130 case WL1271_CIPHER_SUITE_GEM:
2131 key_type = KEY_GEM;
2132 tx_seq_32 = WL1271_TX_SECURITY_HI32(wl->tx_security_seq);
2133 tx_seq_16 = WL1271_TX_SECURITY_LO16(wl->tx_security_seq);
2134 break;
f5fc0f86 2135 default:
97359d12 2136 wl1271_error("Unknown key algo 0x%x", key_conf->cipher);
f5fc0f86
LC		 2137
2138 ret = -EOPNOTSUPP;
2139 goto out_sleep;
2140 }
2141
2142 switch (cmd) {
2143 case SET_KEY:
7f179b46
AN		 2144 ret = wl1271_set_key(wl, KEY_ADD_OR_REPLACE,
2145 key_conf->keyidx, key_type,
2146 key_conf->keylen, key_conf->key,
2147 tx_seq_32, tx_seq_16, sta);
f5fc0f86
LC		 2148 if (ret < 0) {
2149 wl1271_error("Could not add or replace key");
2150 goto out_sleep;
2151 }
2152 break;
2153
2154 case DISABLE_KEY:
7f179b46
AN		 2155 ret = wl1271_set_key(wl, KEY_REMOVE,
2156 key_conf->keyidx, key_type,
2157 key_conf->keylen, key_conf->key,
2158 0, 0, sta);
f5fc0f86
LC		 2159 if (ret < 0) {
2160 wl1271_error("Could not remove key");
2161 goto out_sleep;
2162 }
2163 break;
2164
2165 default:
2166 wl1271_error("Unsupported key cmd 0x%x", cmd);
2167 ret = -EOPNOTSUPP;
f5fc0f86
LC		 2168 break;
2169 }
2170
2171out_sleep:
2172 wl1271_ps_elp_sleep(wl);
2173
2174out_unlock:
2175 mutex_unlock(&wl->mutex);
2176
f5fc0f86
LC		 2177 return ret;
2178}
2179
2180static int wl1271_op_hw_scan(struct ieee80211_hw *hw,
a060bbfe 2181 struct ieee80211_vif *vif,
f5fc0f86
LC		 2182 struct cfg80211_scan_request *req)
2183{
2184 struct wl1271 *wl = hw->priv;
2185 int ret;
2186 u8 *ssid = NULL;
abb0b3bf 2187 size_t len = 0;
f5fc0f86
LC		 2188
2189 wl1271_debug(DEBUG_MAC80211, "mac80211 hw scan");
2190
2191 if (req->n_ssids) {
2192 ssid = req->ssids[0].ssid;
abb0b3bf 2193 len = req->ssids[0].ssid_len;
f5fc0f86
LC		 2194 }
2195
2196 mutex_lock(&wl->mutex);
2197
b739a42c
JO		 2198 if (wl->state == WL1271_STATE_OFF) {
2199 /*
2200 * We cannot return -EBUSY here because cfg80211 will expect
2201 * a call to ieee80211_scan_completed if we do - in this case
2202 * there won't be any call.
2203 */
2204 ret = -EAGAIN;
2205 goto out;
2206 }
2207
a620865e 2208 ret = wl1271_ps_elp_wakeup(wl);
f5fc0f86
LC		 2209 if (ret < 0)
2210 goto out;
2211
5924f89d 2212 ret = wl1271_scan(hw->priv, ssid, len, req);
f5fc0f86
LC		 2213
2214 wl1271_ps_elp_sleep(wl);
2215
2216out:
2217 mutex_unlock(&wl->mutex);
2218
2219 return ret;
2220}
2221
68d069c4
AN		 2222static int wl1271_op_set_frag_threshold(struct ieee80211_hw *hw, u32 value)
2223{
2224 struct wl1271 *wl = hw->priv;
2225 int ret = 0;
2226
2227 mutex_lock(&wl->mutex);
2228
2229 if (unlikely(wl->state == WL1271_STATE_OFF)) {
2230 ret = -EAGAIN;
2231 goto out;
2232 }
2233
a620865e 2234 ret = wl1271_ps_elp_wakeup(wl);
68d069c4
AN		 2235 if (ret < 0)
2236 goto out;
2237
2238 ret = wl1271_acx_frag_threshold(wl, (u16)value);
2239 if (ret < 0)
2240 wl1271_warning("wl1271_op_set_frag_threshold failed: %d", ret);
2241
2242 wl1271_ps_elp_sleep(wl);
2243
2244out:
2245 mutex_unlock(&wl->mutex);
2246
2247 return ret;
2248}
2249
f5fc0f86
LC		 2250static int wl1271_op_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
2251{
2252 struct wl1271 *wl = hw->priv;
aecb0565 2253 int ret = 0;
f5fc0f86
LC		 2254
2255 mutex_lock(&wl->mutex);
2256
f8d9802f
JO		 2257 if (unlikely(wl->state == WL1271_STATE_OFF)) {
2258 ret = -EAGAIN;
aecb0565 2259 goto out;
f8d9802f 2260 }
aecb0565 2261
a620865e 2262 ret = wl1271_ps_elp_wakeup(wl);
f5fc0f86
LC		 2263 if (ret < 0)
2264 goto out;
2265
2266 ret = wl1271_acx_rts_threshold(wl, (u16) value);
2267 if (ret < 0)
2268 wl1271_warning("wl1271_op_set_rts_threshold failed: %d", ret);
2269
2270 wl1271_ps_elp_sleep(wl);
2271
2272out:
2273 mutex_unlock(&wl->mutex);
2274
2275 return ret;
2276}
2277
e78a287a 2278static int wl1271_ssid_set(struct wl1271 *wl, struct sk_buff *skb,
2f6724b2 2279 int offset)
30240fc7 2280{
2f6724b2 2281 u8 *ptr = skb->data + offset;
30240fc7
JO		 2282
2283 /* find the location of the ssid in the beacon */
2f6724b2 2284 while (ptr < skb->data + skb->len) {
30240fc7
JO		 2285 if (ptr[0] == WLAN_EID_SSID) {
2286 wl->ssid_len = ptr[1];
2287 memcpy(wl->ssid, ptr+2, wl->ssid_len);
e78a287a 2288 return 0;
30240fc7 2289 }
2f6724b2 2290 ptr += (ptr[1] + 2);
30240fc7 2291 }
e78a287a 2292
2f6724b2 2293 wl1271_error("No SSID in IEs!\n");
e78a287a 2294 return -ENOENT;
30240fc7
JO		 2295}
2296
e78a287a 2297static int wl1271_bss_erp_info_changed(struct wl1271 *wl,
f5fc0f86
LC		 2298 struct ieee80211_bss_conf *bss_conf,
2299 u32 changed)
2300{
e78a287a 2301 int ret = 0;
f5fc0f86 2302
e78a287a
AN		 2303 if (changed & BSS_CHANGED_ERP_SLOT) {
2304 if (bss_conf->use_short_slot)
2305 ret = wl1271_acx_slot(wl, SLOT_TIME_SHORT);
2306 else
2307 ret = wl1271_acx_slot(wl, SLOT_TIME_LONG);
2308 if (ret < 0) {
2309 wl1271_warning("Set slot time failed %d", ret);
2310 goto out;
2311 }
2312 }
f5fc0f86 2313
e78a287a
AN		 2314 if (changed & BSS_CHANGED_ERP_PREAMBLE) {
2315 if (bss_conf->use_short_preamble)
2316 wl1271_acx_set_preamble(wl, ACX_PREAMBLE_SHORT);
2317 else
2318 wl1271_acx_set_preamble(wl, ACX_PREAMBLE_LONG);
2319 }
f5fc0f86 2320
e78a287a
AN		 2321 if (changed & BSS_CHANGED_ERP_CTS_PROT) {
2322 if (bss_conf->use_cts_prot)
2323 ret = wl1271_acx_cts_protect(wl, CTSPROTECT_ENABLE);
2324 else
2325 ret = wl1271_acx_cts_protect(wl, CTSPROTECT_DISABLE);
2326 if (ret < 0) {
2327 wl1271_warning("Set ctsprotect failed %d", ret);
2328 goto out;
2329 }
2330 }
f8d9802f 2331
e78a287a
AN		 2332out:
2333 return ret;
2334}
f5fc0f86 2335
e78a287a
AN		 2336static int wl1271_bss_beacon_info_changed(struct wl1271 *wl,
2337 struct ieee80211_vif *vif,
2338 struct ieee80211_bss_conf *bss_conf,
2339 u32 changed)
2340{
2341 bool is_ap = (wl->bss_type == BSS_TYPE_AP_BSS);
2342 int ret = 0;
2343
2344 if ((changed & BSS_CHANGED_BEACON_INT)) {
2345 wl1271_debug(DEBUG_MASTER, "beacon interval updated: %d",
60e84c2e
JO		 2346 bss_conf->beacon_int);
2347
2348 wl->beacon_int = bss_conf->beacon_int;
60e84c2e
JO		 2349 }
2350
e78a287a
AN		 2351 if ((changed & BSS_CHANGED_BEACON)) {
2352 struct ieee80211_hdr *hdr;
2353 int ieoffset = offsetof(struct ieee80211_mgmt,
2354 u.beacon.variable);
2355 struct sk_buff *beacon = ieee80211_beacon_get(wl->hw, vif);
2356 u16 tmpl_id;
2357
2358 if (!beacon)
2359 goto out;
2360
2361 wl1271_debug(DEBUG_MASTER, "beacon updated");
2362
2363 ret = wl1271_ssid_set(wl, beacon, ieoffset);
2364 if (ret < 0) {
2365 dev_kfree_skb(beacon);
2366 goto out;
2367 }
2368 tmpl_id = is_ap ? CMD_TEMPL_AP_BEACON :
2369 CMD_TEMPL_BEACON;
2370 ret = wl1271_cmd_template_set(wl, tmpl_id,
2371 beacon->data,
2372 beacon->len, 0,
2373 wl1271_tx_min_rate_get(wl));
2374 if (ret < 0) {
2375 dev_kfree_skb(beacon);
2376 goto out;
2377 }
2378
2379 hdr = (struct ieee80211_hdr *) beacon->data;
2380 hdr->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
2381 IEEE80211_STYPE_PROBE_RESP);
2382
2383 tmpl_id = is_ap ? CMD_TEMPL_AP_PROBE_RESPONSE :
2384 CMD_TEMPL_PROBE_RESPONSE;
2385 ret = wl1271_cmd_template_set(wl,
2386 tmpl_id,
2387 beacon->data,
2388 beacon->len, 0,
2389 wl1271_tx_min_rate_get(wl));
2390 dev_kfree_skb(beacon);
2391 if (ret < 0)
2392 goto out;
2393 }
2394
2395out:
2396 return ret;
2397}
2398
2399/* AP mode changes */
2400static void wl1271_bss_info_changed_ap(struct wl1271 *wl,
2401 struct ieee80211_vif *vif,
2402 struct ieee80211_bss_conf *bss_conf,
2403 u32 changed)
2404{
2405 int ret = 0;
e0d8bbf0 2406
e78a287a
AN		 2407 if ((changed & BSS_CHANGED_BASIC_RATES)) {
2408 u32 rates = bss_conf->basic_rates;
2409 struct conf_tx_rate_class mgmt_rc;
5da11dcd 2410
e78a287a
AN		 2411 wl->basic_rate_set = wl1271_tx_enabled_rates_get(wl, rates);
2412 wl->basic_rate = wl1271_tx_min_rate_get(wl);
2413 wl1271_debug(DEBUG_AP, "basic rates: 0x%x",
2414 wl->basic_rate_set);
2415
2416 /* update the AP management rate policy with the new rates */
2417 mgmt_rc.enabled_rates = wl->basic_rate_set;
2418 mgmt_rc.long_retry_limit = 10;
2419 mgmt_rc.short_retry_limit = 10;
2420 mgmt_rc.aflags = 0;
2421 ret = wl1271_acx_ap_rate_policy(wl, &mgmt_rc,
2422 ACX_TX_AP_MODE_MGMT_RATE);
2423 if (ret < 0) {
2424 wl1271_error("AP mgmt policy change failed %d", ret);
2425 goto out;
2426 }
2427 }
2f6724b2 2428
e78a287a
AN		 2429 ret = wl1271_bss_beacon_info_changed(wl, vif, bss_conf, changed);
2430 if (ret < 0)
2431 goto out;
30240fc7 2432
e78a287a
AN		 2433 if ((changed & BSS_CHANGED_BEACON_ENABLED)) {
2434 if (bss_conf->enable_beacon) {
2435 if (!test_bit(WL1271_FLAG_AP_STARTED, &wl->flags)) {
2436 ret = wl1271_cmd_start_bss(wl);
2437 if (ret < 0)
2438 goto out;
e0d8bbf0 2439
e78a287a
AN		 2440 set_bit(WL1271_FLAG_AP_STARTED, &wl->flags);
2441 wl1271_debug(DEBUG_AP, "started AP");
7f179b46
AN		 2442
2443 ret = wl1271_ap_init_hwenc(wl);
2444 if (ret < 0)
2445 goto out;
e0d8bbf0 2446 }
e78a287a
AN		 2447 } else {
2448 if (test_bit(WL1271_FLAG_AP_STARTED, &wl->flags)) {
2449 ret = wl1271_cmd_stop_bss(wl);
2450 if (ret < 0)
2451 goto out;
e0d8bbf0 2452
e78a287a
AN		 2453 clear_bit(WL1271_FLAG_AP_STARTED, &wl->flags);
2454 wl1271_debug(DEBUG_AP, "stopped AP");
2455 }
2456 }
2457 }
e0d8bbf0 2458
e78a287a
AN		 2459 ret = wl1271_bss_erp_info_changed(wl, bss_conf, changed);
2460 if (ret < 0)
2461 goto out;
2462out:
2463 return;
2464}
8bf29b0e 2465
e78a287a
AN		 2466/* STA/IBSS mode changes */
2467static void wl1271_bss_info_changed_sta(struct wl1271 *wl,
2468 struct ieee80211_vif *vif,
2469 struct ieee80211_bss_conf *bss_conf,
2470 u32 changed)
2471{
2472 bool do_join = false, set_assoc = false;
2473 bool is_ibss = (wl->bss_type == BSS_TYPE_IBSS);
72c2d9e5 2474 u32 sta_rate_set = 0;
e78a287a 2475 int ret;
2d6e4e76 2476 struct ieee80211_sta *sta;
a100885d
AN		 2477 bool sta_exists = false;
2478 struct ieee80211_sta_ht_cap sta_ht_cap;
e78a287a
AN		 2479
2480 if (is_ibss) {
2481 ret = wl1271_bss_beacon_info_changed(wl, vif, bss_conf,
2482 changed);
2483 if (ret < 0)
2484 goto out;
e0d8bbf0
JO		 2485 }
2486
e78a287a
AN		 2487 if ((changed & BSS_CHANGED_BEACON_INT) && is_ibss)
2488 do_join = true;
2489
2490 /* Need to update the SSID (for filtering etc) */
2491 if ((changed & BSS_CHANGED_BEACON) && is_ibss)
2492 do_join = true;
2493
2494 if ((changed & BSS_CHANGED_BEACON_ENABLED) && is_ibss) {
5da11dcd
JO		 2495 wl1271_debug(DEBUG_ADHOC, "ad-hoc beaconing: %s",
2496 bss_conf->enable_beacon ? "enabled" : "disabled");
2497
2498 if (bss_conf->enable_beacon)
2499 wl->set_bss_type = BSS_TYPE_IBSS;
2500 else
2501 wl->set_bss_type = BSS_TYPE_STA_BSS;
2502 do_join = true;
2503 }
2504
e78a287a 2505 if ((changed & BSS_CHANGED_CQM)) {
00236aed
JO		 2506 bool enable = false;
2507 if (bss_conf->cqm_rssi_thold)
2508 enable = true;
2509 ret = wl1271_acx_rssi_snr_trigger(wl, enable,
2510 bss_conf->cqm_rssi_thold,
2511 bss_conf->cqm_rssi_hyst);
2512 if (ret < 0)
2513 goto out;
2514 wl->rssi_thold = bss_conf->cqm_rssi_thold;
2515 }
2516
30240fc7
JO		 2517 if ((changed & BSS_CHANGED_BSSID) &&
2518 /*
2519 * Now we know the correct bssid, so we send a new join command
2520 * and enable the BSSID filter
2521 */
2522 memcmp(wl->bssid, bss_conf->bssid, ETH_ALEN)) {
e78a287a 2523 memcpy(wl->bssid, bss_conf->bssid, ETH_ALEN);
a0cb7be4 2524
fa287b8f
EP		 2525 if (!is_zero_ether_addr(wl->bssid)) {
2526 ret = wl1271_cmd_build_null_data(wl);
2527 if (ret < 0)
2528 goto out;
30240fc7 2529
fa287b8f
EP		 2530 ret = wl1271_build_qos_null_data(wl);
2531 if (ret < 0)
2532 goto out;
30240fc7 2533
fa287b8f
EP		 2534 /* filter out all packets not from this BSSID */
2535 wl1271_configure_filters(wl, 0);
14b228a0 2536
fa287b8f
EP		 2537 /* Need to update the BSSID (for filtering etc) */
2538 do_join = true;
2539 }
30240fc7
JO		 2540 }
2541
72c2d9e5
EP		 2542 rcu_read_lock();
2543 sta = ieee80211_find_sta(vif, bss_conf->bssid);
2544 if (sta) {
2545 /* save the supp_rates of the ap */
2546 sta_rate_set = sta->supp_rates[wl->hw->conf.channel->band];
2547 if (sta->ht_cap.ht_supported)
2548 sta_rate_set |=
2549 (sta->ht_cap.mcs.rx_mask[0] << HW_HT_RATES_OFFSET);
a100885d
AN		 2550 sta_ht_cap = sta->ht_cap;
2551 sta_exists = true;
2552 }
2553 rcu_read_unlock();
72c2d9e5 2554
a100885d 2555 if (sta_exists) {
72c2d9e5
EP		 2556 /* handle new association with HT and HT information change */
2557 if ((changed & BSS_CHANGED_HT) &&
2558 (bss_conf->channel_type != NL80211_CHAN_NO_HT)) {
a100885d 2559 ret = wl1271_acx_set_ht_capabilities(wl, &sta_ht_cap,
72c2d9e5
EP		 2560 true);
2561 if (ret < 0) {
2562 wl1271_warning("Set ht cap true failed %d",
2563 ret);
72c2d9e5
EP		 2564 goto out;
2565 }
2566 ret = wl1271_acx_set_ht_information(wl,
2567 bss_conf->ht_operation_mode);
2568 if (ret < 0) {
2569 wl1271_warning("Set ht information failed %d",
2570 ret);
72c2d9e5
EP		 2571 goto out;
2572 }
2573 }
2574 /* handle new association without HT and disassociation */
2575 else if (changed & BSS_CHANGED_ASSOC) {
a100885d 2576 ret = wl1271_acx_set_ht_capabilities(wl, &sta_ht_cap,
72c2d9e5
EP		 2577 false);
2578 if (ret < 0) {
2579 wl1271_warning("Set ht cap false failed %d",
2580 ret);
72c2d9e5
EP		 2581 goto out;
2582 }
2583 }
2584 }
72c2d9e5 2585
e78a287a 2586 if ((changed & BSS_CHANGED_ASSOC)) {
f5fc0f86 2587 if (bss_conf->assoc) {
ebba60c6 2588 u32 rates;
2f6724b2 2589 int ieoffset;
f5fc0f86 2590 wl->aid = bss_conf->aid;
69e5434c 2591 set_assoc = true;
f5fc0f86 2592
90494a90
JO		 2593 wl->ps_poll_failures = 0;
2594
ebba60c6
JO		 2595 /*
2596 * use basic rates from AP, and determine lowest rate
2597 * to use with control frames.
2598 */
2599 rates = bss_conf->basic_rates;
2600 wl->basic_rate_set = wl1271_tx_enabled_rates_get(wl,
2601 rates);
e0fe371b 2602 wl->basic_rate = wl1271_tx_min_rate_get(wl);
72c2d9e5
EP		 2603 if (sta_rate_set)
2604 wl->rate_set = wl1271_tx_enabled_rates_get(wl,
2605 sta_rate_set);
79b223f4 2606 ret = wl1271_acx_sta_rate_policies(wl);
ebba60c6 2607 if (ret < 0)
e78a287a 2608 goto out;
ebba60c6 2609
ae751bab
LC		 2610 /*
2611 * with wl1271, we don't need to update the
2612 * beacon_int and dtim_period, because the firmware
2613 * updates it by itself when the first beacon is
2614 * received after a join.
2615 */
f5fc0f86
LC		 2616 ret = wl1271_cmd_build_ps_poll(wl, wl->aid);
2617 if (ret < 0)
e78a287a 2618 goto out;
f5fc0f86 2619
c2b2d99b 2620 /*
2f6724b2 2621 * Get a template for hardware connection maintenance
c2b2d99b 2622 */
2f6724b2
JO		 2623 dev_kfree_skb(wl->probereq);
2624 wl->probereq = wl1271_cmd_build_ap_probe_req(wl, NULL);
2625 ieoffset = offsetof(struct ieee80211_mgmt,
2626 u.probe_req.variable);
2627 wl1271_ssid_set(wl, wl->probereq, ieoffset);
c2b2d99b 2628
6ccbb92e
JO		 2629 /* enable the connection monitoring feature */
2630 ret = wl1271_acx_conn_monit_params(wl, true);
f5fc0f86 2631 if (ret < 0)
e78a287a 2632 goto out;
f5fc0f86
LC		 2633
2634 /* If we want to go in PSM but we're not there yet */
71449f8d
JO		 2635 if (test_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags) &&
2636 !test_bit(WL1271_FLAG_PSM, &wl->flags)) {
e78a287a
AN		 2637 enum wl1271_cmd_ps_mode mode;
2638
f5fc0f86 2639 mode = STATION_POWER_SAVE_MODE;
65cddbf1 2640 ret = wl1271_ps_set_mode(wl, mode,
8eab7b47 2641 wl->basic_rate,
65cddbf1 2642 true);
f5fc0f86 2643 if (ret < 0)
e78a287a 2644 goto out;
f5fc0f86 2645 }
d94cd297
JO		 2646 } else {
2647 /* use defaults when not associated */
c2c192ac 2648 clear_bit(WL1271_FLAG_STA_STATE_SENT, &wl->flags);
830fb67b 2649 clear_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags);
d94cd297 2650 wl->aid = 0;
6ccbb92e 2651
2f6724b2
JO		 2652 /* free probe-request template */
2653 dev_kfree_skb(wl->probereq);
2654 wl->probereq = NULL;
2655
8d2ef7bd 2656 /* re-enable dynamic ps - just in case */
f532be6d 2657 ieee80211_enable_dyn_ps(wl->vif);
8d2ef7bd 2658
ebba60c6
JO		 2659 /* revert back to minimum rates for the current band */
2660 wl1271_set_band_rate(wl);
e0fe371b 2661 wl->basic_rate = wl1271_tx_min_rate_get(wl);
79b223f4 2662 ret = wl1271_acx_sta_rate_policies(wl);
ebba60c6 2663 if (ret < 0)
e78a287a 2664 goto out;
ebba60c6 2665
6ccbb92e
JO		 2666 /* disable connection monitor features */
2667 ret = wl1271_acx_conn_monit_params(wl, false);
c1899554
JO		 2668
2669 /* Disable the keep-alive feature */
2670 ret = wl1271_acx_keep_alive_mode(wl, false);
6ccbb92e 2671 if (ret < 0)
e78a287a 2672 goto out;
b84a7d3d
JO		 2673
2674 /* restore the bssid filter and go to dummy bssid */
2675 wl1271_unjoin(wl);
2676 wl1271_dummy_join(wl);
f5fc0f86 2677 }
f5fc0f86
LC		 2678 }
2679
e78a287a
AN		 2680 ret = wl1271_bss_erp_info_changed(wl, bss_conf, changed);
2681 if (ret < 0)
2682 goto out;
f5fc0f86 2683
ca52a5eb
JO		 2684 if (changed & BSS_CHANGED_ARP_FILTER) {
2685 __be32 addr = bss_conf->arp_addr_list[0];
2686 WARN_ON(wl->bss_type != BSS_TYPE_STA_BSS);
2687
c5312772
EP		 2688 if (bss_conf->arp_addr_cnt == 1 &&
2689 bss_conf->arp_filter_enabled) {
2690 /*
2691 * The template should have been configured only upon
2692 * association. however, it seems that the correct ip
2693 * isn't being set (when sending), so we have to
2694 * reconfigure the template upon every ip change.
2695 */
2696 ret = wl1271_cmd_build_arp_rsp(wl, addr);
2697 if (ret < 0) {
2698 wl1271_warning("build arp rsp failed: %d", ret);
e78a287a 2699 goto out;
c5312772
EP		 2700 }
2701
2702 ret = wl1271_acx_arp_ip_filter(wl,
e5e2f24b 2703 ACX_ARP_FILTER_ARP_FILTERING,
c5312772
EP		 2704 addr);
2705 } else
2706 ret = wl1271_acx_arp_ip_filter(wl, 0, addr);
ca52a5eb
JO		 2707
2708 if (ret < 0)
e78a287a 2709 goto out;
ca52a5eb
JO		 2710 }
2711
8bf29b0e 2712 if (do_join) {
69e5434c 2713 ret = wl1271_join(wl, set_assoc);
8bf29b0e
JO		 2714 if (ret < 0) {
2715 wl1271_warning("cmd join failed %d", ret);
e78a287a 2716 goto out;
8bf29b0e 2717 }
c1899554
JO		 2718 }
2719
e78a287a
AN		 2720out:
2721 return;
2722}
2723
2724static void wl1271_op_bss_info_changed(struct ieee80211_hw *hw,
2725 struct ieee80211_vif *vif,
2726 struct ieee80211_bss_conf *bss_conf,
2727 u32 changed)
2728{
2729 struct wl1271 *wl = hw->priv;
2730 bool is_ap = (wl->bss_type == BSS_TYPE_AP_BSS);
2731 int ret;
2732
2733 wl1271_debug(DEBUG_MAC80211, "mac80211 bss info changed 0x%x",
2734 (int)changed);
2735
2736 mutex_lock(&wl->mutex);
2737
2738 if (unlikely(wl->state == WL1271_STATE_OFF))
2739 goto out;
2740
a620865e 2741 ret = wl1271_ps_elp_wakeup(wl);
e78a287a
AN		 2742 if (ret < 0)
2743 goto out;
2744
2745 if (is_ap)
2746 wl1271_bss_info_changed_ap(wl, vif, bss_conf, changed);
2747 else
2748 wl1271_bss_info_changed_sta(wl, vif, bss_conf, changed);
2749
f5fc0f86
LC		 2750 wl1271_ps_elp_sleep(wl);
2751
2752out:
2753 mutex_unlock(&wl->mutex);
2754}
2755
c6999d83
KV		 2756static int wl1271_op_conf_tx(struct ieee80211_hw *hw, u16 queue,
2757 const struct ieee80211_tx_queue_params *params)
2758{
2759 struct wl1271 *wl = hw->priv;
4695dc91 2760 u8 ps_scheme;
488fc540 2761 int ret = 0;
c6999d83
KV		 2762
2763 mutex_lock(&wl->mutex);
2764
2765 wl1271_debug(DEBUG_MAC80211, "mac80211 conf tx %d", queue);
2766
4695dc91
KV		 2767 if (params->uapsd)
2768 ps_scheme = CONF_PS_SCHEME_UPSD_TRIGGER;
2769 else
2770 ps_scheme = CONF_PS_SCHEME_LEGACY;
2771
488fc540
AN		 2772 if (wl->state == WL1271_STATE_OFF) {
2773 /*
2774 * If the state is off, the parameters will be recorded and
2775 * configured on init. This happens in AP-mode.
2776 */
2777 struct conf_tx_ac_category *conf_ac =
2778 &wl->conf.tx.ac_conf[wl1271_tx_get_queue(queue)];
2779 struct conf_tx_tid *conf_tid =
2780 &wl->conf.tx.tid_conf[wl1271_tx_get_queue(queue)];
2781
2782 conf_ac->ac = wl1271_tx_get_queue(queue);
2783 conf_ac->cw_min = (u8)params->cw_min;
2784 conf_ac->cw_max = params->cw_max;
2785 conf_ac->aifsn = params->aifs;
2786 conf_ac->tx_op_limit = params->txop << 5;
2787
2788 conf_tid->queue_id = wl1271_tx_get_queue(queue);
2789 conf_tid->channel_type = CONF_CHANNEL_TYPE_EDCF;
2790 conf_tid->tsid = wl1271_tx_get_queue(queue);
2791 conf_tid->ps_scheme = ps_scheme;
2792 conf_tid->ack_policy = CONF_ACK_POLICY_LEGACY;
2793 conf_tid->apsd_conf[0] = 0;
2794 conf_tid->apsd_conf[1] = 0;
c1b193eb
EP		 2795 goto out;
2796 }
488fc540 2797
c1b193eb
EP		 2798 ret = wl1271_ps_elp_wakeup(wl);
2799 if (ret < 0)
2800 goto out;
488fc540 2801
c1b193eb
EP		 2802 /*
2803 * the txop is confed in units of 32us by the mac80211,
2804 * we need us
2805 */
2806 ret = wl1271_acx_ac_cfg(wl, wl1271_tx_get_queue(queue),
2807 params->cw_min, params->cw_max,
2808 params->aifs, params->txop << 5);
2809 if (ret < 0)
2810 goto out_sleep;
2811
2812 ret = wl1271_acx_tid_cfg(wl, wl1271_tx_get_queue(queue),
2813 CONF_CHANNEL_TYPE_EDCF,
2814 wl1271_tx_get_queue(queue),
2815 ps_scheme, CONF_ACK_POLICY_LEGACY,
2816 0, 0);
c82c1dde
KV		 2817
2818out_sleep:
c1b193eb 2819 wl1271_ps_elp_sleep(wl);
c6999d83
KV		 2820
2821out:
2822 mutex_unlock(&wl->mutex);
2823
2824 return ret;
2825}
2826
bbbb538e
JO		 2827static u64 wl1271_op_get_tsf(struct ieee80211_hw *hw)
2828{
2829
2830 struct wl1271 *wl = hw->priv;
2831 u64 mactime = ULLONG_MAX;
2832 int ret;
2833
2834 wl1271_debug(DEBUG_MAC80211, "mac80211 get tsf");
2835
2836 mutex_lock(&wl->mutex);
2837
f8d9802f
JO		 2838 if (unlikely(wl->state == WL1271_STATE_OFF))
2839 goto out;
2840
a620865e 2841 ret = wl1271_ps_elp_wakeup(wl);
bbbb538e
JO		 2842 if (ret < 0)
2843 goto out;
2844
2845 ret = wl1271_acx_tsf_info(wl, &mactime);
2846 if (ret < 0)
2847 goto out_sleep;
2848
2849out_sleep:
2850 wl1271_ps_elp_sleep(wl);
2851
2852out:
2853 mutex_unlock(&wl->mutex);
2854 return mactime;
2855}
f5fc0f86 2856
ece550d0
JL		 2857static int wl1271_op_get_survey(struct ieee80211_hw *hw, int idx,
2858 struct survey_info *survey)
2859{
2860 struct wl1271 *wl = hw->priv;
2861 struct ieee80211_conf *conf = &hw->conf;
b739a42c 2862
ece550d0
JL		 2863 if (idx != 0)
2864 return -ENOENT;
b739a42c 2865
ece550d0
JL		 2866 survey->channel = conf->channel;
2867 survey->filled = SURVEY_INFO_NOISE_DBM;
2868 survey->noise = wl->noise;
b739a42c 2869
ece550d0
JL		 2870 return 0;
2871}
2872
409622ec 2873static int wl1271_allocate_sta(struct wl1271 *wl,
f84f7d78
AN		 2874 struct ieee80211_sta *sta,
2875 u8 *hlid)
2876{
2877 struct wl1271_station *wl_sta;
2878 int id;
2879
2880 id = find_first_zero_bit(wl->ap_hlid_map, AP_MAX_STATIONS);
2881 if (id >= AP_MAX_STATIONS) {
2882 wl1271_warning("could not allocate HLID - too much stations");
2883 return -EBUSY;
2884 }
2885
2886 wl_sta = (struct wl1271_station *)sta->drv_priv;
f84f7d78
AN		 2887 __set_bit(id, wl->ap_hlid_map);
2888 wl_sta->hlid = WL1271_AP_STA_HLID_START + id;
2889 *hlid = wl_sta->hlid;
b622d992 2890 memcpy(wl->links[wl_sta->hlid].addr, sta->addr, ETH_ALEN);
f84f7d78
AN		 2891 return 0;
2892}
2893
409622ec 2894static void wl1271_free_sta(struct wl1271 *wl, u8 hlid)
f84f7d78
AN		 2895{
2896 int id = hlid - WL1271_AP_STA_HLID_START;
2897
409622ec
AN		 2898 if (WARN_ON(!test_bit(id, wl->ap_hlid_map)))
2899 return;
2900
f84f7d78 2901 __clear_bit(id, wl->ap_hlid_map);
b622d992 2902 memset(wl->links[hlid].addr, 0, ETH_ALEN);
a8c0ddb5 2903 wl1271_tx_reset_link_queues(wl, hlid);
b622d992
AN		 2904 __clear_bit(hlid, &wl->ap_ps_map);
2905 __clear_bit(hlid, (unsigned long *)&wl->ap_fw_ps_map);
f84f7d78
AN		 2906}
2907
2908static int wl1271_op_sta_add(struct ieee80211_hw *hw,
2909 struct ieee80211_vif *vif,
2910 struct ieee80211_sta *sta)
2911{
2912 struct wl1271 *wl = hw->priv;
2913 int ret = 0;
2914 u8 hlid;
2915
2916 mutex_lock(&wl->mutex);
2917
2918 if (unlikely(wl->state == WL1271_STATE_OFF))
2919 goto out;
2920
2921 if (wl->bss_type != BSS_TYPE_AP_BSS)
2922 goto out;
2923
2924 wl1271_debug(DEBUG_MAC80211, "mac80211 add sta %d", (int)sta->aid);
2925
409622ec 2926 ret = wl1271_allocate_sta(wl, sta, &hlid);
f84f7d78
AN		 2927 if (ret < 0)
2928 goto out;
2929
a620865e 2930 ret = wl1271_ps_elp_wakeup(wl);
f84f7d78 2931 if (ret < 0)
409622ec 2932 goto out_free_sta;
f84f7d78
AN		 2933
2934 ret = wl1271_cmd_add_sta(wl, sta, hlid);
2935 if (ret < 0)
2936 goto out_sleep;
2937
2938out_sleep:
2939 wl1271_ps_elp_sleep(wl);
2940
409622ec
AN		 2941out_free_sta:
2942 if (ret < 0)
2943 wl1271_free_sta(wl, hlid);
2944
f84f7d78
AN		 2945out:
2946 mutex_unlock(&wl->mutex);
2947 return ret;
2948}
2949
2950static int wl1271_op_sta_remove(struct ieee80211_hw *hw,
2951 struct ieee80211_vif *vif,
2952 struct ieee80211_sta *sta)
2953{
2954 struct wl1271 *wl = hw->priv;
2955 struct wl1271_station *wl_sta;
2956 int ret = 0, id;
2957
2958 mutex_lock(&wl->mutex);
2959
2960 if (unlikely(wl->state == WL1271_STATE_OFF))
2961 goto out;
2962
2963 if (wl->bss_type != BSS_TYPE_AP_BSS)
2964 goto out;
2965
2966 wl1271_debug(DEBUG_MAC80211, "mac80211 remove sta %d", (int)sta->aid);
2967
2968 wl_sta = (struct wl1271_station *)sta->drv_priv;
2969 id = wl_sta->hlid - WL1271_AP_STA_HLID_START;
2970 if (WARN_ON(!test_bit(id, wl->ap_hlid_map)))
2971 goto out;
2972
a620865e 2973 ret = wl1271_ps_elp_wakeup(wl);
f84f7d78
AN		 2974 if (ret < 0)
2975 goto out;
2976
2977 ret = wl1271_cmd_remove_sta(wl, wl_sta->hlid);
2978 if (ret < 0)
2979 goto out_sleep;
2980
409622ec 2981 wl1271_free_sta(wl, wl_sta->hlid);
f84f7d78
AN		 2982
2983out_sleep:
2984 wl1271_ps_elp_sleep(wl);
2985
2986out:
2987 mutex_unlock(&wl->mutex);
2988 return ret;
2989}
2990
4623ec7d
LC		 2991static int wl1271_op_ampdu_action(struct ieee80211_hw *hw,
2992 struct ieee80211_vif *vif,
2993 enum ieee80211_ampdu_mlme_action action,
2994 struct ieee80211_sta *sta, u16 tid, u16 *ssn,
2995 u8 buf_size)
bbba3e68
LS		 2996{
2997 struct wl1271 *wl = hw->priv;
2998 int ret;
2999
3000 mutex_lock(&wl->mutex);
3001
3002 if (unlikely(wl->state == WL1271_STATE_OFF)) {
3003 ret = -EAGAIN;
3004 goto out;
3005 }
3006
a620865e 3007 ret = wl1271_ps_elp_wakeup(wl);
bbba3e68
LS		 3008 if (ret < 0)
3009 goto out;
3010
3011 switch (action) {
3012 case IEEE80211_AMPDU_RX_START:
3013 if (wl->ba_support) {
3014 ret = wl1271_acx_set_ba_receiver_session(wl, tid, *ssn,
3015 true);
3016 if (!ret)
3017 wl->ba_rx_bitmap |= BIT(tid);
3018 } else {
3019 ret = -ENOTSUPP;
3020 }
3021 break;
3022
3023 case IEEE80211_AMPDU_RX_STOP:
3024 ret = wl1271_acx_set_ba_receiver_session(wl, tid, 0, false);
3025 if (!ret)
3026 wl->ba_rx_bitmap &= ~BIT(tid);
3027 break;
3028
3029 /*
3030 * The BA initiator session management in FW independently.
3031 * Falling break here on purpose for all TX APDU commands.
3032 */
3033 case IEEE80211_AMPDU_TX_START:
3034 case IEEE80211_AMPDU_TX_STOP:
3035 case IEEE80211_AMPDU_TX_OPERATIONAL:
3036 ret = -EINVAL;
3037 break;
3038
3039 default:
3040 wl1271_error("Incorrect ampdu action id=%x\n", action);
3041 ret = -EINVAL;
3042 }
3043
3044 wl1271_ps_elp_sleep(wl);
3045
3046out:
3047 mutex_unlock(&wl->mutex);
3048
3049 return ret;
3050}
3051
f5fc0f86
LC		 3052/* can't be const, mac80211 writes to this */
3053static struct ieee80211_rate wl1271_rates[] = {
3054 { .bitrate = 10,
2b60100b
JO		 3055 .hw_value = CONF_HW_BIT_RATE_1MBPS,
3056 .hw_value_short = CONF_HW_BIT_RATE_1MBPS, },
f5fc0f86 3057 { .bitrate = 20,
2b60100b
JO		 3058 .hw_value = CONF_HW_BIT_RATE_2MBPS,
3059 .hw_value_short = CONF_HW_BIT_RATE_2MBPS,
f5fc0f86
LC		 3060 .flags = IEEE80211_RATE_SHORT_PREAMBLE },
3061 { .bitrate = 55,
2b60100b
JO		 3062 .hw_value = CONF_HW_BIT_RATE_5_5MBPS,
3063 .hw_value_short = CONF_HW_BIT_RATE_5_5MBPS,
f5fc0f86
LC		 3064 .flags = IEEE80211_RATE_SHORT_PREAMBLE },
3065 { .bitrate = 110,
2b60100b
JO		 3066 .hw_value = CONF_HW_BIT_RATE_11MBPS,
3067 .hw_value_short = CONF_HW_BIT_RATE_11MBPS,
f5fc0f86
LC		 3068 .flags = IEEE80211_RATE_SHORT_PREAMBLE },
3069 { .bitrate = 60,
2b60100b
JO		 3070 .hw_value = CONF_HW_BIT_RATE_6MBPS,
3071 .hw_value_short = CONF_HW_BIT_RATE_6MBPS, },
f5fc0f86 3072 { .bitrate = 90,
2b60100b
JO		 3073 .hw_value = CONF_HW_BIT_RATE_9MBPS,
3074 .hw_value_short = CONF_HW_BIT_RATE_9MBPS, },
f5fc0f86 3075 { .bitrate = 120,
2b60100b
JO		 3076 .hw_value = CONF_HW_BIT_RATE_12MBPS,
3077 .hw_value_short = CONF_HW_BIT_RATE_12MBPS, },
f5fc0f86 3078 { .bitrate = 180,
2b60100b
JO		 3079 .hw_value = CONF_HW_BIT_RATE_18MBPS,
3080 .hw_value_short = CONF_HW_BIT_RATE_18MBPS, },
f5fc0f86 3081 { .bitrate = 240,
2b60100b
JO		 3082 .hw_value = CONF_HW_BIT_RATE_24MBPS,
3083 .hw_value_short = CONF_HW_BIT_RATE_24MBPS, },
f5fc0f86 3084 { .bitrate = 360,
2b60100b
JO		 3085 .hw_value = CONF_HW_BIT_RATE_36MBPS,
3086 .hw_value_short = CONF_HW_BIT_RATE_36MBPS, },
f5fc0f86 3087 { .bitrate = 480,
2b60100b
JO		 3088 .hw_value = CONF_HW_BIT_RATE_48MBPS,
3089 .hw_value_short = CONF_HW_BIT_RATE_48MBPS, },
f5fc0f86 3090 { .bitrate = 540,
2b60100b
JO		 3091 .hw_value = CONF_HW_BIT_RATE_54MBPS,
3092 .hw_value_short = CONF_HW_BIT_RATE_54MBPS, },
f5fc0f86
LC		 3093};
3094
fa97f46b 3095/* can't be const, mac80211 writes to this */
f5fc0f86 3096static struct ieee80211_channel wl1271_channels[] = {
a2d0e3f1 3097 { .hw_value = 1, .center_freq = 2412, .max_power = 25 },
fa21c7a9 3098 { .hw_value = 2, .center_freq = 2417, .max_power = 25 },
fa97f46b
JO		 3099 { .hw_value = 3, .center_freq = 2422, .max_power = 25 },
3100 { .hw_value = 4, .center_freq = 2427, .max_power = 25 },
3101 { .hw_value = 5, .center_freq = 2432, .max_power = 25 },
fa21c7a9 3102 { .hw_value = 6, .center_freq = 2437, .max_power = 25 },
fa97f46b
JO		 3103 { .hw_value = 7, .center_freq = 2442, .max_power = 25 },
3104 { .hw_value = 8, .center_freq = 2447, .max_power = 25 },
3105 { .hw_value = 9, .center_freq = 2452, .max_power = 25 },
fa21c7a9 3106 { .hw_value = 10, .center_freq = 2457, .max_power = 25 },
fa97f46b
JO		 3107 { .hw_value = 11, .center_freq = 2462, .max_power = 25 },
3108 { .hw_value = 12, .center_freq = 2467, .max_power = 25 },
3109 { .hw_value = 13, .center_freq = 2472, .max_power = 25 },
6c89b7b2 3110 { .hw_value = 14, .center_freq = 2484, .max_power = 25 },
f5fc0f86
LC		 3111};
3112
f876bb9a 3113/* mapping to indexes for wl1271_rates */
a0ea9493 3114static const u8 wl1271_rate_to_idx_2ghz[] = {
f876bb9a 3115 /* MCS rates are used only with 11n */
18357850
SL		 3116 7, /* CONF_HW_RXTX_RATE_MCS7 */
3117 6, /* CONF_HW_RXTX_RATE_MCS6 */
3118 5, /* CONF_HW_RXTX_RATE_MCS5 */
3119 4, /* CONF_HW_RXTX_RATE_MCS4 */
3120 3, /* CONF_HW_RXTX_RATE_MCS3 */
3121 2, /* CONF_HW_RXTX_RATE_MCS2 */
3122 1, /* CONF_HW_RXTX_RATE_MCS1 */
3123 0, /* CONF_HW_RXTX_RATE_MCS0 */
f876bb9a
JO		 3124
3125 11, /* CONF_HW_RXTX_RATE_54 */
3126 10, /* CONF_HW_RXTX_RATE_48 */
3127 9, /* CONF_HW_RXTX_RATE_36 */
3128 8, /* CONF_HW_RXTX_RATE_24 */
3129
3130 /* TI-specific rate */
3131 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_22 */
3132
3133 7, /* CONF_HW_RXTX_RATE_18 */
3134 6, /* CONF_HW_RXTX_RATE_12 */
3135 3, /* CONF_HW_RXTX_RATE_11 */
3136 5, /* CONF_HW_RXTX_RATE_9 */
3137 4, /* CONF_HW_RXTX_RATE_6 */
3138 2, /* CONF_HW_RXTX_RATE_5_5 */
3139 1, /* CONF_HW_RXTX_RATE_2 */
3140 0 /* CONF_HW_RXTX_RATE_1 */
3141};
3142
e8b03a2b
SL		 3143/* 11n STA capabilities */
3144#define HW_RX_HIGHEST_RATE 72
3145
00d20100
SL		 3146#ifdef CONFIG_WL12XX_HT
3147#define WL12XX_HT_CAP { \
871d0c3b
SL		 3148 .cap = IEEE80211_HT_CAP_GRN_FLD | IEEE80211_HT_CAP_SGI_20 | \
3149 (1 << IEEE80211_HT_CAP_RX_STBC_SHIFT), \
e8b03a2b
SL		 3150 .ht_supported = true, \
3151 .ampdu_factor = IEEE80211_HT_MAX_AMPDU_8K, \
3152 .ampdu_density = IEEE80211_HT_MPDU_DENSITY_8, \
3153 .mcs = { \
3154 .rx_mask = { 0xff, 0, 0, 0, 0, 0, 0, 0, 0, 0, }, \
3155 .rx_highest = cpu_to_le16(HW_RX_HIGHEST_RATE), \
3156 .tx_params = IEEE80211_HT_MCS_TX_DEFINED, \
3157 }, \
3158}
18357850 3159#else
00d20100 3160#define WL12XX_HT_CAP { \
18357850
SL		 3161 .ht_supported = false, \
3162}
3163#endif
e8b03a2b 3164
f5fc0f86
LC		 3165/* can't be const, mac80211 writes to this */
3166static struct ieee80211_supported_band wl1271_band_2ghz = {
3167 .channels = wl1271_channels,
3168 .n_channels = ARRAY_SIZE(wl1271_channels),
3169 .bitrates = wl1271_rates,
3170 .n_bitrates = ARRAY_SIZE(wl1271_rates),
00d20100 3171 .ht_cap = WL12XX_HT_CAP,
f5fc0f86
LC		 3172};
3173
1ebec3d7
TP		 3174/* 5 GHz data rates for WL1273 */
3175static struct ieee80211_rate wl1271_rates_5ghz[] = {
3176 { .bitrate = 60,
3177 .hw_value = CONF_HW_BIT_RATE_6MBPS,
3178 .hw_value_short = CONF_HW_BIT_RATE_6MBPS, },
3179 { .bitrate = 90,
3180 .hw_value = CONF_HW_BIT_RATE_9MBPS,
3181 .hw_value_short = CONF_HW_BIT_RATE_9MBPS, },
3182 { .bitrate = 120,
3183 .hw_value = CONF_HW_BIT_RATE_12MBPS,
3184 .hw_value_short = CONF_HW_BIT_RATE_12MBPS, },
3185 { .bitrate = 180,
3186 .hw_value = CONF_HW_BIT_RATE_18MBPS,
3187 .hw_value_short = CONF_HW_BIT_RATE_18MBPS, },
3188 { .bitrate = 240,
3189 .hw_value = CONF_HW_BIT_RATE_24MBPS,
3190 .hw_value_short = CONF_HW_BIT_RATE_24MBPS, },
3191 { .bitrate = 360,
3192 .hw_value = CONF_HW_BIT_RATE_36MBPS,
3193 .hw_value_short = CONF_HW_BIT_RATE_36MBPS, },
3194 { .bitrate = 480,
3195 .hw_value = CONF_HW_BIT_RATE_48MBPS,
3196 .hw_value_short = CONF_HW_BIT_RATE_48MBPS, },
3197 { .bitrate = 540,
3198 .hw_value = CONF_HW_BIT_RATE_54MBPS,
3199 .hw_value_short = CONF_HW_BIT_RATE_54MBPS, },
3200};
3201
fa97f46b 3202/* 5 GHz band channels for WL1273 */
1ebec3d7 3203static struct ieee80211_channel wl1271_channels_5ghz[] = {
fa21c7a9 3204 { .hw_value = 7, .center_freq = 5035},
fa97f46b
JO		 3205 { .hw_value = 8, .center_freq = 5040},
3206 { .hw_value = 9, .center_freq = 5045},
3207 { .hw_value = 11, .center_freq = 5055},
3208 { .hw_value = 12, .center_freq = 5060},
fa21c7a9 3209 { .hw_value = 16, .center_freq = 5080},
fa97f46b
JO		 3210 { .hw_value = 34, .center_freq = 5170},
3211 { .hw_value = 36, .center_freq = 5180},
3212 { .hw_value = 38, .center_freq = 5190},
3213 { .hw_value = 40, .center_freq = 5200},
fa21c7a9 3214 { .hw_value = 42, .center_freq = 5210},
fa97f46b
JO		 3215 { .hw_value = 44, .center_freq = 5220},
3216 { .hw_value = 46, .center_freq = 5230},
3217 { .hw_value = 48, .center_freq = 5240},
3218 { .hw_value = 52, .center_freq = 5260},
fa21c7a9 3219 { .hw_value = 56, .center_freq = 5280},
fa97f46b
JO		 3220 { .hw_value = 60, .center_freq = 5300},
3221 { .hw_value = 64, .center_freq = 5320},
3222 { .hw_value = 100, .center_freq = 5500},
3223 { .hw_value = 104, .center_freq = 5520},
fa21c7a9 3224 { .hw_value = 108, .center_freq = 5540},
fa97f46b
JO		 3225 { .hw_value = 112, .center_freq = 5560},
3226 { .hw_value = 116, .center_freq = 5580},
3227 { .hw_value = 120, .center_freq = 5600},
3228 { .hw_value = 124, .center_freq = 5620},
fa21c7a9 3229 { .hw_value = 128, .center_freq = 5640},
fa97f46b
JO		 3230 { .hw_value = 132, .center_freq = 5660},
3231 { .hw_value = 136, .center_freq = 5680},
3232 { .hw_value = 140, .center_freq = 5700},
3233 { .hw_value = 149, .center_freq = 5745},
fa21c7a9 3234 { .hw_value = 153, .center_freq = 5765},
fa97f46b
JO		 3235 { .hw_value = 157, .center_freq = 5785},
3236 { .hw_value = 161, .center_freq = 5805},
1ebec3d7
TP		 3237 { .hw_value = 165, .center_freq = 5825},
3238};
3239
f876bb9a 3240/* mapping to indexes for wl1271_rates_5ghz */
a0ea9493 3241static const u8 wl1271_rate_to_idx_5ghz[] = {
f876bb9a 3242 /* MCS rates are used only with 11n */
18357850
SL		 3243 7, /* CONF_HW_RXTX_RATE_MCS7 */
3244 6, /* CONF_HW_RXTX_RATE_MCS6 */
3245 5, /* CONF_HW_RXTX_RATE_MCS5 */
3246 4, /* CONF_HW_RXTX_RATE_MCS4 */
3247 3, /* CONF_HW_RXTX_RATE_MCS3 */
3248 2, /* CONF_HW_RXTX_RATE_MCS2 */
3249 1, /* CONF_HW_RXTX_RATE_MCS1 */
3250 0, /* CONF_HW_RXTX_RATE_MCS0 */
f876bb9a
JO		 3251
3252 7, /* CONF_HW_RXTX_RATE_54 */
3253 6, /* CONF_HW_RXTX_RATE_48 */
3254 5, /* CONF_HW_RXTX_RATE_36 */
3255 4, /* CONF_HW_RXTX_RATE_24 */
3256
3257 /* TI-specific rate */
3258 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_22 */
3259
3260 3, /* CONF_HW_RXTX_RATE_18 */
3261 2, /* CONF_HW_RXTX_RATE_12 */
3262 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_11 */
3263 1, /* CONF_HW_RXTX_RATE_9 */
3264 0, /* CONF_HW_RXTX_RATE_6 */
3265 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_5_5 */
3266 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_2 */
3267 CONF_HW_RXTX_RATE_UNSUPPORTED /* CONF_HW_RXTX_RATE_1 */
3268};
1ebec3d7
TP		 3269
3270static struct ieee80211_supported_band wl1271_band_5ghz = {
3271 .channels = wl1271_channels_5ghz,
3272 .n_channels = ARRAY_SIZE(wl1271_channels_5ghz),
3273 .bitrates = wl1271_rates_5ghz,
3274 .n_bitrates = ARRAY_SIZE(wl1271_rates_5ghz),
00d20100 3275 .ht_cap = WL12XX_HT_CAP,
1ebec3d7
TP		 3276};
3277
a0ea9493 3278static const u8 *wl1271_band_rate_to_idx[] = {
f876bb9a
JO		 3279 [IEEE80211_BAND_2GHZ] = wl1271_rate_to_idx_2ghz,
3280 [IEEE80211_BAND_5GHZ] = wl1271_rate_to_idx_5ghz
3281};
3282
f5fc0f86
LC		 3283static const struct ieee80211_ops wl1271_ops = {
3284 .start = wl1271_op_start,
3285 .stop = wl1271_op_stop,
3286 .add_interface = wl1271_op_add_interface,
3287 .remove_interface = wl1271_op_remove_interface,
3288 .config = wl1271_op_config,
c87dec9f 3289 .prepare_multicast = wl1271_op_prepare_multicast,
f5fc0f86
LC		 3290 .configure_filter = wl1271_op_configure_filter,
3291 .tx = wl1271_op_tx,
3292 .set_key = wl1271_op_set_key,
3293 .hw_scan = wl1271_op_hw_scan,
3294 .bss_info_changed = wl1271_op_bss_info_changed,
68d069c4 3295 .set_frag_threshold = wl1271_op_set_frag_threshold,
f5fc0f86 3296 .set_rts_threshold = wl1271_op_set_rts_threshold,
c6999d83 3297 .conf_tx = wl1271_op_conf_tx,
bbbb538e 3298 .get_tsf = wl1271_op_get_tsf,
ece550d0 3299 .get_survey = wl1271_op_get_survey,
f84f7d78
AN		 3300 .sta_add = wl1271_op_sta_add,
3301 .sta_remove = wl1271_op_sta_remove,
bbba3e68 3302 .ampdu_action = wl1271_op_ampdu_action,
c8c90873 3303 CFG80211_TESTMODE_CMD(wl1271_tm_cmd)
f5fc0f86
LC		 3304};
3305
f876bb9a 3306
6a2de93b 3307u8 wl1271_rate_to_idx(int rate, enum ieee80211_band band)
f876bb9a
JO		 3308{
3309 u8 idx;
3310
6a2de93b 3311 BUG_ON(band >= sizeof(wl1271_band_rate_to_idx)/sizeof(u8 *));
f876bb9a
JO		 3312
3313 if (unlikely(rate >= CONF_HW_RXTX_RATE_MAX)) {
3314 wl1271_error("Illegal RX rate from HW: %d", rate);
3315 return 0;
3316 }
3317
6a2de93b 3318 idx = wl1271_band_rate_to_idx[band][rate];
f876bb9a
JO		 3319 if (unlikely(idx == CONF_HW_RXTX_RATE_UNSUPPORTED)) {
3320 wl1271_error("Unsupported RX rate from HW: %d", rate);
3321 return 0;
3322 }
3323
3324 return idx;
3325}
3326
7fc3a864
JO		 3327static ssize_t wl1271_sysfs_show_bt_coex_state(struct device *dev,
3328 struct device_attribute *attr,
3329 char *buf)
3330{
3331 struct wl1271 *wl = dev_get_drvdata(dev);
3332 ssize_t len;
3333
2f63b011 3334 len = PAGE_SIZE;
7fc3a864
JO		 3335
3336 mutex_lock(&wl->mutex);
3337 len = snprintf(buf, len, "%d\n\n0 - off\n1 - on\n",
3338 wl->sg_enabled);
3339 mutex_unlock(&wl->mutex);
3340
3341 return len;
3342
3343}
3344
3345static ssize_t wl1271_sysfs_store_bt_coex_state(struct device *dev,
3346 struct device_attribute *attr,
3347 const char *buf, size_t count)
3348{
3349 struct wl1271 *wl = dev_get_drvdata(dev);
3350 unsigned long res;
3351 int ret;
3352
3353 ret = strict_strtoul(buf, 10, &res);
3354
3355 if (ret < 0) {
3356 wl1271_warning("incorrect value written to bt_coex_mode");
3357 return count;
3358 }
3359
3360 mutex_lock(&wl->mutex);
3361
3362 res = !!res;
3363
3364 if (res == wl->sg_enabled)
3365 goto out;
3366
3367 wl->sg_enabled = res;
3368
3369 if (wl->state == WL1271_STATE_OFF)
3370 goto out;
3371
a620865e 3372 ret = wl1271_ps_elp_wakeup(wl);
7fc3a864
JO		 3373 if (ret < 0)
3374 goto out;
3375
3376 wl1271_acx_sg_enable(wl, wl->sg_enabled);
3377 wl1271_ps_elp_sleep(wl);
3378
3379 out:
3380 mutex_unlock(&wl->mutex);
3381 return count;
3382}
3383
3384static DEVICE_ATTR(bt_coex_state, S_IRUGO | S_IWUSR,
3385 wl1271_sysfs_show_bt_coex_state,
3386 wl1271_sysfs_store_bt_coex_state);
3387
d717fd61
JO		 3388static ssize_t wl1271_sysfs_show_hw_pg_ver(struct device *dev,
3389 struct device_attribute *attr,
3390 char *buf)
3391{
3392 struct wl1271 *wl = dev_get_drvdata(dev);
3393 ssize_t len;
3394
2f63b011 3395 len = PAGE_SIZE;
d717fd61
JO		 3396
3397 mutex_lock(&wl->mutex);
3398 if (wl->hw_pg_ver >= 0)
3399 len = snprintf(buf, len, "%d\n", wl->hw_pg_ver);
3400 else
3401 len = snprintf(buf, len, "n/a\n");
3402 mutex_unlock(&wl->mutex);
3403
3404 return len;
3405}
3406
3407static DEVICE_ATTR(hw_pg_ver, S_IRUGO | S_IWUSR,
3408 wl1271_sysfs_show_hw_pg_ver, NULL);
3409
2d5e82b8 3410int wl1271_register_hw(struct wl1271 *wl)
f5fc0f86
LC		 3411{
3412 int ret;
3413
3414 if (wl->mac80211_registered)
3415 return 0;
3416
31d26ec6
AN		 3417 ret = wl1271_fetch_nvs(wl);
3418 if (ret == 0) {
bc765bf3
SL		 3419 /* NOTE: The wl->nvs->nvs element must be first, in
3420 * order to simplify the casting, we assume it is at
3421 * the beginning of the wl->nvs structure.
3422 */
3423 u8 *nvs_ptr = (u8 *)wl->nvs;
31d26ec6
AN		 3424
3425 wl->mac_addr[0] = nvs_ptr[11];
3426 wl->mac_addr[1] = nvs_ptr[10];
3427 wl->mac_addr[2] = nvs_ptr[6];
3428 wl->mac_addr[3] = nvs_ptr[5];
3429 wl->mac_addr[4] = nvs_ptr[4];
3430 wl->mac_addr[5] = nvs_ptr[3];
3431 }
3432
f5fc0f86
LC		 3433 SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr);
3434
3435 ret = ieee80211_register_hw(wl->hw);
3436 if (ret < 0) {
3437 wl1271_error("unable to register mac80211 hw: %d", ret);
3438 return ret;
3439 }
3440
3441 wl->mac80211_registered = true;
3442
d60080ae
EP		 3443 wl1271_debugfs_init(wl);
3444
c2c192ac
JO		 3445 register_netdevice_notifier(&wl1271_dev_notifier);
3446
f5fc0f86
LC		 3447 wl1271_notice("loaded");
3448
3449 return 0;
3450}
50b3eb4b 3451EXPORT_SYMBOL_GPL(wl1271_register_hw);
f5fc0f86 3452
3b56dd6a
TP		 3453void wl1271_unregister_hw(struct wl1271 *wl)
3454{
4ae3fa87
JO		 3455 if (wl->state == WL1271_STATE_PLT)
3456 __wl1271_plt_stop(wl);
3457
c2c192ac 3458 unregister_netdevice_notifier(&wl1271_dev_notifier);
3b56dd6a
TP		 3459 ieee80211_unregister_hw(wl->hw);
3460 wl->mac80211_registered = false;
3461
3462}
3463EXPORT_SYMBOL_GPL(wl1271_unregister_hw);
3464
2d5e82b8 3465int wl1271_init_ieee80211(struct wl1271 *wl)
f5fc0f86 3466{
7a55724e
JO		 3467 static const u32 cipher_suites[] = {
3468 WLAN_CIPHER_SUITE_WEP40,
3469 WLAN_CIPHER_SUITE_WEP104,
3470 WLAN_CIPHER_SUITE_TKIP,
3471 WLAN_CIPHER_SUITE_CCMP,
3472 WL1271_CIPHER_SUITE_GEM,
3473 };
3474
1e2b7976
JO		 3475 /* The tx descriptor buffer and the TKIP space. */
3476 wl->hw->extra_tx_headroom = WL1271_TKIP_IV_SPACE +
3477 sizeof(struct wl1271_tx_hw_descr);
f5fc0f86
LC		 3478
3479 /* unit us */
3480 /* FIXME: find a proper value */
3481 wl->hw->channel_change_time = 10000;
50c500ad 3482 wl->hw->max_listen_interval = wl->conf.conn.max_listen_interval;
f5fc0f86
LC		 3483
3484 wl->hw->flags = IEEE80211_HW_SIGNAL_DBM |
03442a33 3485 IEEE80211_HW_BEACON_FILTER |
0a34332f 3486 IEEE80211_HW_SUPPORTS_PS |
4695dc91 3487 IEEE80211_HW_SUPPORTS_UAPSD |
a9af092b 3488 IEEE80211_HW_HAS_RATE_CONTROL |
00236aed 3489 IEEE80211_HW_CONNECTION_MONITOR |
62c0740c 3490 IEEE80211_HW_SUPPORTS_CQM_RSSI |
ba7c082a
AN		 3491 IEEE80211_HW_REPORTS_TX_ACK_STATUS |
3492 IEEE80211_HW_AP_LINK_PS;
f5fc0f86 3493
7a55724e
JO		 3494 wl->hw->wiphy->cipher_suites = cipher_suites;
3495 wl->hw->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
3496
e0d8bbf0 3497 wl->hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
038d925b 3498 BIT(NL80211_IFTYPE_ADHOC) | BIT(NL80211_IFTYPE_AP);
f5fc0f86 3499 wl->hw->wiphy->max_scan_ssids = 1;
ea559b46
GE		 3500 /*
3501 * Maximum length of elements in scanning probe request templates
3502 * should be the maximum length possible for a template, without
3503 * the IEEE80211 header of the template
3504 */
3505 wl->hw->wiphy->max_scan_ie_len = WL1271_CMD_TEMPL_MAX_SIZE -
3506 sizeof(struct ieee80211_header);
a8aaaf53 3507
4a31c11c
LC		 3508 /* make sure all our channels fit in the scanned_ch bitmask */
3509 BUILD_BUG_ON(ARRAY_SIZE(wl1271_channels) +
3510 ARRAY_SIZE(wl1271_channels_5ghz) >
3511 WL1271_MAX_CHANNELS);
a8aaaf53
LC		 3512 /*
3513 * We keep local copies of the band structs because we need to
3514 * modify them on a per-device basis.
3515 */
3516 memcpy(&wl->bands[IEEE80211_BAND_2GHZ], &wl1271_band_2ghz,
3517 sizeof(wl1271_band_2ghz));
3518 memcpy(&wl->bands[IEEE80211_BAND_5GHZ], &wl1271_band_5ghz,
3519 sizeof(wl1271_band_5ghz));
3520
3521 wl->hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
3522 &wl->bands[IEEE80211_BAND_2GHZ];
3523 wl->hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
3524 &wl->bands[IEEE80211_BAND_5GHZ];
1ebec3d7 3525
12bd8949 3526 wl->hw->queues = 4;
31627dc5 3527 wl->hw->max_rates = 1;
12bd8949 3528
b7417d93
JO		 3529 wl->hw->wiphy->reg_notifier = wl1271_reg_notify;
3530
8197b711 3531 SET_IEEE80211_DEV(wl->hw, wl1271_wl_to_dev(wl));
f5fc0f86 3532
f84f7d78
AN		 3533 wl->hw->sta_data_size = sizeof(struct wl1271_station);
3534
4c9cfa78
LC		 3535 wl->hw->max_rx_aggregation_subframes = 8;
3536
f5fc0f86
LC		 3537 return 0;
3538}
50b3eb4b 3539EXPORT_SYMBOL_GPL(wl1271_init_ieee80211);
f5fc0f86 3540
f5fc0f86 3541#define WL1271_DEFAULT_CHANNEL 0
c332a4b8 3542
2d5e82b8 3543struct ieee80211_hw *wl1271_alloc_hw(void)
f5fc0f86 3544{
f5fc0f86 3545 struct ieee80211_hw *hw;
3b56dd6a 3546 struct platform_device *plat_dev = NULL;
f5fc0f86 3547 struct wl1271 *wl;
a8c0ddb5 3548 int i, j, ret;
1f37cbc9 3549 unsigned int order;
f5fc0f86
LC		 3550
3551 hw = ieee80211_alloc_hw(sizeof(*wl), &wl1271_ops);
3552 if (!hw) {
3553 wl1271_error("could not alloc ieee80211_hw");
a1dd8187 3554 ret = -ENOMEM;
3b56dd6a
TP		 3555 goto err_hw_alloc;
3556 }
3557
929ebd30 3558 plat_dev = kmemdup(&wl1271_device, sizeof(wl1271_device), GFP_KERNEL);
3b56dd6a
TP		 3559 if (!plat_dev) {
3560 wl1271_error("could not allocate platform_device");
3561 ret = -ENOMEM;
3562 goto err_plat_alloc;
f5fc0f86
LC		 3563 }
3564
3565 wl = hw->priv;
3566 memset(wl, 0, sizeof(*wl));
3567
01c09162
JO		 3568 INIT_LIST_HEAD(&wl->list);
3569
f5fc0f86 3570 wl->hw = hw;
3b56dd6a 3571 wl->plat_dev = plat_dev;
f5fc0f86 3572
6742f554
JO		 3573 for (i = 0; i < NUM_TX_QUEUES; i++)
3574 skb_queue_head_init(&wl->tx_queue[i]);
f5fc0f86 3575
a8c0ddb5
AN		 3576 for (i = 0; i < NUM_TX_QUEUES; i++)
3577 for (j = 0; j < AP_MAX_LINKS; j++)
3578 skb_queue_head_init(&wl->links[j].tx_queue[i]);
3579
a620865e
IY		 3580 skb_queue_head_init(&wl->deferred_rx_queue);
3581 skb_queue_head_init(&wl->deferred_tx_queue);
3582
37b70a81 3583 INIT_DELAYED_WORK(&wl->elp_work, wl1271_elp_work);
90494a90 3584 INIT_DELAYED_WORK(&wl->pspoll_work, wl1271_pspoll_work);
a620865e 3585 INIT_WORK(&wl->netstack_work, wl1271_netstack_work);
117b38d0
JO		 3586 INIT_WORK(&wl->tx_work, wl1271_tx_work);
3587 INIT_WORK(&wl->recovery_work, wl1271_recovery_work);
3588 INIT_DELAYED_WORK(&wl->scan_complete_work, wl1271_scan_complete_work);
f5fc0f86 3589 wl->channel = WL1271_DEFAULT_CHANNEL;
60e84c2e 3590 wl->beacon_int = WL1271_DEFAULT_BEACON_INT;
f5fc0f86 3591 wl->default_key = 0;
f5fc0f86 3592 wl->rx_counter = 0;
ae113b57
AN		 3593 wl->rx_config = WL1271_DEFAULT_STA_RX_CONFIG;
3594 wl->rx_filter = WL1271_DEFAULT_STA_RX_FILTER;
19ad0715 3595 wl->psm_entry_retry = 0;
f5fc0f86 3596 wl->power_level = WL1271_DEFAULT_POWER_LEVEL;
a6fe2313 3597 wl->basic_rate_set = CONF_TX_RATE_MASK_BASIC;
ebba60c6 3598 wl->basic_rate = CONF_TX_RATE_MASK_BASIC;
830fb67b 3599 wl->rate_set = CONF_TX_RATE_MASK_BASIC;
8a5a37a6 3600 wl->band = IEEE80211_BAND_2GHZ;
b771eee5 3601 wl->vif = NULL;
830fb67b 3602 wl->flags = 0;
7fc3a864 3603 wl->sg_enabled = true;
d717fd61 3604 wl->hw_pg_ver = -1;
166d504e
AN		 3605 wl->bss_type = MAX_BSS_TYPE;
3606 wl->set_bss_type = MAX_BSS_TYPE;
3607 wl->fw_bss_type = MAX_BSS_TYPE;
a8c0ddb5 3608 wl->last_tx_hlid = 0;
b622d992
AN		 3609 wl->ap_ps_map = 0;
3610 wl->ap_fw_ps_map = 0;
606ea9fa 3611 wl->quirks = 0;
48a61477 3612 wl->block_size = 0;
f5fc0f86 3613
25eeb9e3 3614 memset(wl->tx_frames_map, 0, sizeof(wl->tx_frames_map));
be7078c2 3615 for (i = 0; i < ACX_TX_DESCRIPTORS; i++)
f5fc0f86
LC		 3616 wl->tx_frames[i] = NULL;
3617
3618 spin_lock_init(&wl->wl_lock);
3619
f5fc0f86
LC		 3620 wl->state = WL1271_STATE_OFF;
3621 mutex_init(&wl->mutex);
3622
c332a4b8
TP		 3623 /* Apply default driver configuration. */
3624 wl1271_conf_init(wl);
3625
1f37cbc9
IY		 3626 order = get_order(WL1271_AGGR_BUFFER_SIZE);
3627 wl->aggr_buf = (u8 *)__get_free_pages(GFP_KERNEL, order);
3628 if (!wl->aggr_buf) {
3629 ret = -ENOMEM;
3630 goto err_hw;
3631 }
3632
a1dd8187 3633 /* Register platform device */
3b56dd6a 3634 ret = platform_device_register(wl->plat_dev);
a1dd8187
JO		 3635 if (ret) {
3636 wl1271_error("couldn't register platform device");
1f37cbc9 3637 goto err_aggr;
a1dd8187 3638 }
3b56dd6a 3639 dev_set_drvdata(&wl->plat_dev->dev, wl);
a1dd8187 3640
7fc3a864 3641 /* Create sysfs file to control bt coex state */
3b56dd6a 3642 ret = device_create_file(&wl->plat_dev->dev, &dev_attr_bt_coex_state);
7fc3a864
JO		 3643 if (ret < 0) {
3644 wl1271_error("failed to create sysfs file bt_coex_state");
3645 goto err_platform;
3646 }
a1dd8187 3647
d717fd61
JO		 3648 /* Create sysfs file to get HW PG version */
3649 ret = device_create_file(&wl->plat_dev->dev, &dev_attr_hw_pg_ver);
3650 if (ret < 0) {
3651 wl1271_error("failed to create sysfs file hw_pg_ver");
3652 goto err_bt_coex_state;
3653 }
3654
c332a4b8 3655 return hw;
a1dd8187 3656
d717fd61
JO		 3657err_bt_coex_state:
3658 device_remove_file(&wl->plat_dev->dev, &dev_attr_bt_coex_state);
3659
7fc3a864 3660err_platform:
3b56dd6a 3661 platform_device_unregister(wl->plat_dev);
7fc3a864 3662
1f37cbc9
IY		 3663err_aggr:
3664 free_pages((unsigned long)wl->aggr_buf, order);
3665
a1dd8187 3666err_hw:
3b56dd6a
TP		 3667 wl1271_debugfs_exit(wl);
3668 kfree(plat_dev);
3669
3670err_plat_alloc:
3671 ieee80211_free_hw(hw);
3672
3673err_hw_alloc:
a1dd8187 3674
a1dd8187 3675 return ERR_PTR(ret);
c332a4b8 3676}
50b3eb4b 3677EXPORT_SYMBOL_GPL(wl1271_alloc_hw);
c332a4b8
TP		 3678
3679int wl1271_free_hw(struct wl1271 *wl)
3680{
3b56dd6a 3681 platform_device_unregister(wl->plat_dev);
1f37cbc9
IY		 3682 free_pages((unsigned long)wl->aggr_buf,
3683 get_order(WL1271_AGGR_BUFFER_SIZE));
3b56dd6a 3684 kfree(wl->plat_dev);
c332a4b8
TP		 3685
3686 wl1271_debugfs_exit(wl);
3687
c332a4b8
TP		 3688 vfree(wl->fw);
3689 wl->fw = NULL;
3690 kfree(wl->nvs);
3691 wl->nvs = NULL;
3692
3693 kfree(wl->fw_status);
3694 kfree(wl->tx_res_if);
3695
3696 ieee80211_free_hw(wl->hw);
3697
3698 return 0;
3699}
50b3eb4b
TP		 3700EXPORT_SYMBOL_GPL(wl1271_free_hw);
3701
491bbd6b 3702u32 wl12xx_debug_level = DEBUG_NONE;
17c1755c 3703EXPORT_SYMBOL_GPL(wl12xx_debug_level);
491bbd6b 3704module_param_named(debug_level, wl12xx_debug_level, uint, S_IRUSR | S_IWUSR);
17c1755c
EP		 3705MODULE_PARM_DESC(debug_level, "wl12xx debugging level");
3706
50b3eb4b 3707MODULE_LICENSE("GPL");
b1a48cab 3708MODULE_AUTHOR("Luciano Coelho <coelho@ti.com>");
50b3eb4b 3709MODULE_AUTHOR("Juuso Oikarinen <juuso.oikarinen@nokia.com>");
Linux kernel - Deliverables
This page took 0.499125 seconds and 5 git commands to generate.