blob: 7d409b0f335753406526e7d1e89a0e234b9fcc55 [file] [log] [blame]
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001/*
2 * This file is part of wl1271
3 *
Juuso Oikarinen8bf29b02010-02-18 13:25:51 +02004 * Copyright (C) 2008-2010 Nokia Corporation
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03005 *
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>
Luciano Coelhof5fc0f82009-08-06 16:25:28 +030025#include <linux/firmware.h>
26#include <linux/delay.h>
Luciano Coelhof5fc0f82009-08-06 16:25:28 +030027#include <linux/spi/spi.h>
28#include <linux/crc32.h>
29#include <linux/etherdevice.h>
Juuso Oikarinen1fba4972009-10-08 21:56:32 +030030#include <linux/vmalloc.h>
Juuso Oikarinena1dd8182010-03-18 12:26:31 +020031#include <linux/platform_device.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090032#include <linux/slab.h>
Ido Yariv341b7cd2011-03-31 10:07:01 +020033#include <linux/wl12xx.h>
Ido Yariv95dac04f2011-06-06 14:57:06 +030034#include <linux/sched.h>
Luciano Coelhof5fc0f82009-08-06 16:25:28 +030035
Shahar Levi00d20102010-11-08 11:20:10 +000036#include "wl12xx.h"
Luciano Coelhof5fc0f82009-08-06 16:25:28 +030037#include "wl12xx_80211.h"
Shahar Levi00d20102010-11-08 11:20:10 +000038#include "reg.h"
39#include "io.h"
40#include "event.h"
41#include "tx.h"
42#include "rx.h"
43#include "ps.h"
44#include "init.h"
45#include "debugfs.h"
46#include "cmd.h"
47#include "boot.h"
48#include "testmode.h"
49#include "scan.h"
Luciano Coelhof5fc0f82009-08-06 16:25:28 +030050
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +020051#define WL1271_BOOT_RETRIES 3
52
Juuso Oikarinen8a080482009-10-13 12:47:44 +030053static struct conf_drv_settings default_conf = {
54 .sg = {
Eliad Peller3be41122011-08-14 13:17:19 +030055 .params = {
56 [CONF_SG_ACL_BT_MASTER_MIN_BR] = 10,
57 [CONF_SG_ACL_BT_MASTER_MAX_BR] = 180,
58 [CONF_SG_ACL_BT_SLAVE_MIN_BR] = 10,
59 [CONF_SG_ACL_BT_SLAVE_MAX_BR] = 180,
60 [CONF_SG_ACL_BT_MASTER_MIN_EDR] = 10,
61 [CONF_SG_ACL_BT_MASTER_MAX_EDR] = 80,
62 [CONF_SG_ACL_BT_SLAVE_MIN_EDR] = 10,
63 [CONF_SG_ACL_BT_SLAVE_MAX_EDR] = 80,
64 [CONF_SG_ACL_WLAN_PS_MASTER_BR] = 8,
65 [CONF_SG_ACL_WLAN_PS_SLAVE_BR] = 8,
66 [CONF_SG_ACL_WLAN_PS_MASTER_EDR] = 20,
67 [CONF_SG_ACL_WLAN_PS_SLAVE_EDR] = 20,
68 [CONF_SG_ACL_WLAN_ACTIVE_MASTER_MIN_BR] = 20,
69 [CONF_SG_ACL_WLAN_ACTIVE_MASTER_MAX_BR] = 35,
70 [CONF_SG_ACL_WLAN_ACTIVE_SLAVE_MIN_BR] = 16,
71 [CONF_SG_ACL_WLAN_ACTIVE_SLAVE_MAX_BR] = 35,
72 [CONF_SG_ACL_WLAN_ACTIVE_MASTER_MIN_EDR] = 32,
73 [CONF_SG_ACL_WLAN_ACTIVE_MASTER_MAX_EDR] = 50,
74 [CONF_SG_ACL_WLAN_ACTIVE_SLAVE_MIN_EDR] = 28,
75 [CONF_SG_ACL_WLAN_ACTIVE_SLAVE_MAX_EDR] = 50,
76 [CONF_SG_ACL_ACTIVE_SCAN_WLAN_BR] = 10,
77 [CONF_SG_ACL_ACTIVE_SCAN_WLAN_EDR] = 20,
78 [CONF_SG_ACL_PASSIVE_SCAN_BT_BR] = 75,
79 [CONF_SG_ACL_PASSIVE_SCAN_WLAN_BR] = 15,
80 [CONF_SG_ACL_PASSIVE_SCAN_BT_EDR] = 27,
81 [CONF_SG_ACL_PASSIVE_SCAN_WLAN_EDR] = 17,
82 /* active scan params */
83 [CONF_SG_AUTO_SCAN_PROBE_REQ] = 170,
84 [CONF_SG_ACTIVE_SCAN_DURATION_FACTOR_HV3] = 50,
85 [CONF_SG_ACTIVE_SCAN_DURATION_FACTOR_A2DP] = 100,
86 /* passive scan params */
87 [CONF_SG_PASSIVE_SCAN_DURATION_FACTOR_A2DP_BR] = 800,
88 [CONF_SG_PASSIVE_SCAN_DURATION_FACTOR_A2DP_EDR] = 200,
89 [CONF_SG_PASSIVE_SCAN_DURATION_FACTOR_HV3] = 200,
90 /* passive scan in dual antenna params */
91 [CONF_SG_CONSECUTIVE_HV3_IN_PASSIVE_SCAN] = 0,
92 [CONF_SG_BCN_HV3_COLLISION_THRESH_IN_PASSIVE_SCAN] = 0,
93 [CONF_SG_TX_RX_PROTECTION_BWIDTH_IN_PASSIVE_SCAN] = 0,
94 /* general params */
95 [CONF_SG_STA_FORCE_PS_IN_BT_SCO] = 1,
96 [CONF_SG_ANTENNA_CONFIGURATION] = 0,
97 [CONF_SG_BEACON_MISS_PERCENT] = 60,
98 [CONF_SG_DHCP_TIME] = 5000,
99 [CONF_SG_RXT] = 1200,
100 [CONF_SG_TXT] = 1000,
101 [CONF_SG_ADAPTIVE_RXT_TXT] = 1,
102 [CONF_SG_GENERAL_USAGE_BIT_MAP] = 3,
103 [CONF_SG_HV3_MAX_SERVED] = 6,
104 [CONF_SG_PS_POLL_TIMEOUT] = 10,
105 [CONF_SG_UPSD_TIMEOUT] = 10,
106 [CONF_SG_CONSECUTIVE_CTS_THRESHOLD] = 2,
107 [CONF_SG_STA_RX_WINDOW_AFTER_DTIM] = 5,
108 [CONF_SG_STA_CONNECTION_PROTECTION_TIME] = 30,
109 /* AP params */
110 [CONF_AP_BEACON_MISS_TX] = 3,
111 [CONF_AP_RX_WINDOW_AFTER_BEACON] = 10,
112 [CONF_AP_BEACON_WINDOW_INTERVAL] = 2,
113 [CONF_AP_CONNECTION_PROTECTION_TIME] = 0,
114 [CONF_AP_BT_ACL_VAL_BT_SERVE_TIME] = 25,
115 [CONF_AP_BT_ACL_VAL_WL_SERVE_TIME] = 25,
Arik Nemtsov801f8702011-04-18 14:15:20 +0300116 },
Juuso Oikarinen1b00f542010-03-18 12:26:30 +0200117 .state = CONF_SG_PROTECTIVE,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300118 },
119 .rx = {
120 .rx_msdu_life_time = 512000,
121 .packet_detection_threshold = 0,
122 .ps_poll_timeout = 15,
123 .upsd_timeout = 15,
Arik Nemtsov5f704d12011-04-18 14:15:21 +0300124 .rts_threshold = IEEE80211_MAX_RTS_THRESHOLD,
Luciano Coelho3ed8f2c2009-12-11 15:40:54 +0200125 .rx_cca_threshold = 0,
126 .irq_blk_threshold = 0xFFFF,
127 .irq_pkt_threshold = 0,
128 .irq_timeout = 600,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300129 .queue_type = CONF_RX_QUEUE_TYPE_LOW_PRIORITY,
130 },
131 .tx = {
132 .tx_energy_detection = 0,
Arik Nemtsov1e05a812010-10-16 17:44:51 +0200133 .sta_rc_conf = {
Juuso Oikarinenebba60c2010-04-01 11:38:20 +0300134 .enabled_rates = 0,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300135 .short_retry_limit = 10,
136 .long_retry_limit = 10,
Arik Nemtsov1e05a812010-10-16 17:44:51 +0200137 .aflags = 0,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300138 },
139 .ac_conf_count = 4,
140 .ac_conf = {
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200141 [CONF_TX_AC_BE] = {
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300142 .ac = CONF_TX_AC_BE,
143 .cw_min = 15,
144 .cw_max = 63,
145 .aifsn = 3,
146 .tx_op_limit = 0,
147 },
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200148 [CONF_TX_AC_BK] = {
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300149 .ac = CONF_TX_AC_BK,
150 .cw_min = 15,
151 .cw_max = 63,
152 .aifsn = 7,
153 .tx_op_limit = 0,
154 },
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200155 [CONF_TX_AC_VI] = {
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300156 .ac = CONF_TX_AC_VI,
157 .cw_min = 15,
158 .cw_max = 63,
159 .aifsn = CONF_TX_AIFS_PIFS,
160 .tx_op_limit = 3008,
161 },
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200162 [CONF_TX_AC_VO] = {
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300163 .ac = CONF_TX_AC_VO,
164 .cw_min = 15,
165 .cw_max = 63,
166 .aifsn = CONF_TX_AIFS_PIFS,
167 .tx_op_limit = 1504,
168 },
169 },
Arik Nemtsov3618f302011-06-26 10:36:03 +0300170 .max_tx_retries = 100,
171 .ap_aging_period = 300,
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200172 .tid_conf_count = 4,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300173 .tid_conf = {
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200174 [CONF_TX_AC_BE] = {
175 .queue_id = CONF_TX_AC_BE,
176 .channel_type = CONF_CHANNEL_TYPE_EDCF,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300177 .tsid = CONF_TX_AC_BE,
178 .ps_scheme = CONF_PS_SCHEME_LEGACY,
179 .ack_policy = CONF_ACK_POLICY_LEGACY,
180 .apsd_conf = {0, 0},
181 },
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200182 [CONF_TX_AC_BK] = {
183 .queue_id = CONF_TX_AC_BK,
184 .channel_type = CONF_CHANNEL_TYPE_EDCF,
185 .tsid = CONF_TX_AC_BK,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300186 .ps_scheme = CONF_PS_SCHEME_LEGACY,
187 .ack_policy = CONF_ACK_POLICY_LEGACY,
188 .apsd_conf = {0, 0},
189 },
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200190 [CONF_TX_AC_VI] = {
191 .queue_id = CONF_TX_AC_VI,
192 .channel_type = CONF_CHANNEL_TYPE_EDCF,
193 .tsid = CONF_TX_AC_VI,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300194 .ps_scheme = CONF_PS_SCHEME_LEGACY,
195 .ack_policy = CONF_ACK_POLICY_LEGACY,
196 .apsd_conf = {0, 0},
197 },
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200198 [CONF_TX_AC_VO] = {
199 .queue_id = CONF_TX_AC_VO,
200 .channel_type = CONF_CHANNEL_TYPE_EDCF,
201 .tsid = CONF_TX_AC_VO,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300202 .ps_scheme = CONF_PS_SCHEME_LEGACY,
203 .ack_policy = CONF_ACK_POLICY_LEGACY,
204 .apsd_conf = {0, 0},
205 },
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300206 },
207 .frag_threshold = IEEE80211_MAX_FRAG_THRESHOLD,
Luciano Coelho3ed8f2c2009-12-11 15:40:54 +0200208 .tx_compl_timeout = 700,
Juuso Oikarinenebba60c2010-04-01 11:38:20 +0300209 .tx_compl_threshold = 4,
210 .basic_rate = CONF_HW_BIT_RATE_1MBPS,
211 .basic_rate_5 = CONF_HW_BIT_RATE_6MBPS,
Arik Nemtsov1e05a812010-10-16 17:44:51 +0200212 .tmpl_short_retry_limit = 10,
213 .tmpl_long_retry_limit = 10,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300214 },
215 .conn = {
216 .wake_up_event = CONF_WAKE_UP_EVENT_DTIM,
Juuso Oikarinen50c500a2010-04-01 11:38:22 +0300217 .listen_interval = 1,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300218 .bcn_filt_mode = CONF_BCN_FILT_MODE_ENABLED,
Shahar Levibc76b942011-05-11 11:14:22 +0300219 .bcn_filt_ie_count = 2,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300220 .bcn_filt_ie = {
221 [0] = {
222 .ie = WLAN_EID_CHANNEL_SWITCH,
223 .rule = CONF_BCN_RULE_PASS_ON_APPEARANCE,
Shahar Levibc76b942011-05-11 11:14:22 +0300224 },
225 [1] = {
226 .ie = WLAN_EID_HT_INFORMATION,
227 .rule = CONF_BCN_RULE_PASS_ON_CHANGE,
228 },
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300229 },
Luciano Coelho3ed8f2c2009-12-11 15:40:54 +0200230 .synch_fail_thold = 10,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300231 .bss_lose_timeout = 100,
232 .beacon_rx_timeout = 10000,
233 .broadcast_timeout = 20000,
234 .rx_broadcast_in_ps = 1,
Juuso Oikarinen90494a92010-07-08 17:50:00 +0300235 .ps_poll_threshold = 10,
236 .ps_poll_recovery_period = 700,
Juuso Oikarinen11f70f92009-10-13 12:47:46 +0300237 .bet_enable = CONF_BET_MODE_ENABLE,
Ohad Ben-Cohen958b20e2011-03-14 18:53:10 +0200238 .bet_max_consecutive = 50,
Eliad Pellera879ed72011-08-23 16:37:02 +0300239 .psm_entry_retries = 8,
Shahar Levi23708412011-04-13 14:52:50 +0300240 .psm_exit_retries = 16,
Juuso Oikarinen8eab7b42010-09-24 03:10:11 +0200241 .psm_entry_nullfunc_retries = 3,
Juuso Oikarinen50c500a2010-04-01 11:38:22 +0300242 .keep_alive_interval = 55000,
243 .max_listen_interval = 20,
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300244 },
Luciano Coelho6e92b412009-12-11 15:40:50 +0200245 .itrim = {
246 .enable = false,
247 .timeout = 50000,
Juuso Oikarinen38ad2d82009-12-11 15:41:08 +0200248 },
249 .pm_config = {
250 .host_clk_settling_time = 5000,
251 .host_fast_wakeup_support = false
Juuso Oikarinen00236aed2010-04-09 11:07:30 +0300252 },
253 .roam_trigger = {
Juuso Oikarinen00236aed2010-04-09 11:07:30 +0300254 .trigger_pacing = 1,
255 .avg_weight_rssi_beacon = 20,
256 .avg_weight_rssi_data = 10,
257 .avg_weight_snr_beacon = 20,
Levi, Shahar4b7fac72011-01-23 07:27:22 +0100258 .avg_weight_snr_data = 10,
Juuso Oikarinenbea39d62010-09-21 08:14:31 +0200259 },
260 .scan = {
261 .min_dwell_time_active = 7500,
262 .max_dwell_time_active = 30000,
Juuso Oikarinenea45b2c2011-01-24 07:01:54 +0100263 .min_dwell_time_passive = 100000,
264 .max_dwell_time_passive = 100000,
Juuso Oikarinenbea39d62010-09-21 08:14:31 +0200265 .num_probe_reqs = 2,
266 },
Luciano Coelho3a9d60e2011-05-10 14:06:31 +0300267 .sched_scan = {
268 /* sched_scan requires dwell times in TU instead of TU/1000 */
Luciano Coelho221737d2011-09-02 14:28:22 +0300269 .min_dwell_time_active = 30,
270 .max_dwell_time_active = 60,
Luciano Coelho3a9d60e2011-05-10 14:06:31 +0300271 .dwell_time_passive = 100,
Luciano Coelho50a66d72011-05-27 15:34:47 +0300272 .dwell_time_dfs = 150,
Luciano Coelho3a9d60e2011-05-10 14:06:31 +0300273 .num_probe_reqs = 2,
274 .rssi_threshold = -90,
275 .snr_threshold = 0,
276 },
Juuso Oikarinen644a4862010-10-05 13:11:56 +0200277 .rf = {
278 .tx_per_channel_power_compensation_2 = {
279 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
280 },
281 .tx_per_channel_power_compensation_5 = {
282 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
283 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
284 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
285 },
286 },
Levi, Shahar4b7fac72011-01-23 07:27:22 +0100287 .ht = {
Arik Nemtsov0f9c8252011-08-17 10:45:49 +0300288 .rx_ba_win_size = 8,
Levi, Shahar4b7fac72011-01-23 07:27:22 +0100289 .tx_ba_win_size = 64,
290 .inactivity_timeout = 10000,
Arik Nemtsov0f9c8252011-08-17 10:45:49 +0300291 .tx_ba_tid_bitmap = CONF_TX_BA_ENABLED_TID_BITMAP,
Levi, Shahar4b7fac72011-01-23 07:27:22 +0100292 },
Shahar Levi13b107d2011-03-06 16:32:12 +0200293 .mem_wl127x = {
Eliad Pellerfe5ef092011-02-02 09:59:36 +0200294 .num_stations = 1,
295 .ssid_profiles = 1,
296 .rx_block_num = 70,
297 .tx_min_block_num = 40,
Ido Yariv4cf557f2011-04-18 16:45:10 +0300298 .dynamic_memory = 1,
Ido Yarivb16d4b62011-03-01 15:14:44 +0200299 .min_req_tx_blocks = 100,
Eliad Pellerc8bde242011-02-02 09:59:35 +0200300 .min_req_rx_blocks = 22,
301 .tx_min = 27,
Shahar Levi13b107d2011-03-06 16:32:12 +0200302 },
303 .mem_wl128x = {
304 .num_stations = 1,
305 .ssid_profiles = 1,
306 .rx_block_num = 40,
307 .tx_min_block_num = 40,
308 .dynamic_memory = 1,
309 .min_req_tx_blocks = 45,
310 .min_req_rx_blocks = 22,
311 .tx_min = 27,
312 },
Shahar Leviff868432011-04-11 15:41:46 +0300313 .fm_coex = {
314 .enable = true,
315 .swallow_period = 5,
316 .n_divider_fref_set_1 = 0xff, /* default */
317 .n_divider_fref_set_2 = 12,
318 .m_divider_fref_set_1 = 148,
319 .m_divider_fref_set_2 = 0xffff, /* default */
320 .coex_pll_stabilization_time = 0xffffffff, /* default */
321 .ldo_stabilization_time = 0xffff, /* default */
322 .fm_disturbed_band_margin = 0xff, /* default */
323 .swallow_clk_diff = 0xff, /* default */
324 },
Eliad Pellerf84673d2011-05-15 11:10:28 +0300325 .rx_streaming = {
326 .duration = 150,
327 .queues = 0x1,
328 .interval = 20,
Eliad Peller77ddaa12011-05-15 11:10:29 +0300329 .always = 0,
Eliad Pellerf84673d2011-05-15 11:10:28 +0300330 },
Ido Yariv95dac04f2011-06-06 14:57:06 +0300331 .fwlog = {
332 .mode = WL12XX_FWLOG_ON_DEMAND,
333 .mem_blocks = 2,
334 .severity = 0,
335 .timestamp = WL12XX_FWLOG_TIMESTAMP_DISABLED,
336 .output = WL12XX_FWLOG_OUTPUT_HOST,
337 .threshold = 0,
338 },
Luciano Coelhoafb7d3c2011-04-01 20:48:02 +0300339 .hci_io_ds = HCI_IO_DS_6MA,
Eliad Pellerfa6ad9f2011-08-14 13:17:14 +0300340 .rate = {
341 .rate_retry_score = 32000,
342 .per_add = 8192,
343 .per_th1 = 2048,
344 .per_th2 = 4096,
345 .max_per = 8100,
346 .inverse_curiosity_factor = 5,
347 .tx_fail_low_th = 4,
348 .tx_fail_high_th = 10,
349 .per_alpha_shift = 4,
350 .per_add_shift = 13,
351 .per_beta1_shift = 10,
352 .per_beta2_shift = 8,
353 .rate_check_up = 2,
354 .rate_check_down = 12,
355 .rate_retry_policy = {
356 0x00, 0x00, 0x00, 0x00, 0x00,
357 0x00, 0x00, 0x00, 0x00, 0x00,
358 0x00, 0x00, 0x00,
359 },
360 },
Eliad Peller94877752011-08-28 15:11:56 +0300361 .hangover = {
362 .recover_time = 0,
363 .hangover_period = 20,
364 .dynamic_mode = 1,
365 .early_termination_mode = 1,
366 .max_period = 20,
367 .min_period = 1,
368 .increase_delta = 1,
369 .decrease_delta = 2,
370 .quiet_time = 4,
371 .increase_time = 1,
372 .window_size = 16,
373 },
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300374};
375
Ido Yariv95dac04f2011-06-06 14:57:06 +0300376static char *fwlog_param;
Eliad Peller2a5bff02011-08-25 18:10:59 +0300377static bool bug_on_recovery;
Ido Yariv95dac04f2011-06-06 14:57:06 +0300378
Arik Nemtsov7dece1c2011-04-18 14:15:28 +0300379static void __wl1271_op_remove_interface(struct wl1271 *wl,
380 bool reset_tx_queues);
Arik Nemtsov7f179b42010-10-16 21:39:06 +0200381static void wl1271_free_ap_keys(struct wl1271 *wl);
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +0200382
383
Juuso Oikarinena1dd8182010-03-18 12:26:31 +0200384static void wl1271_device_release(struct device *dev)
385{
386
387}
388
389static struct platform_device wl1271_device = {
390 .name = "wl1271",
391 .id = -1,
392
393 /* device model insists to have a release function */
394 .dev = {
395 .release = wl1271_device_release,
396 },
397};
398
Juuso Oikarinenf9f774c2011-03-21 10:43:36 +0200399static DEFINE_MUTEX(wl_list_mutex);
Juuso Oikarinen01c09162009-10-13 12:47:55 +0300400static LIST_HEAD(wl_list);
401
Eliad Pelleref4b29e2011-06-06 13:03:12 +0300402static int wl1271_check_operstate(struct wl1271 *wl, unsigned char operstate)
403{
404 int ret;
405 if (operstate != IF_OPER_UP)
406 return 0;
407
408 if (test_and_set_bit(WL1271_FLAG_STA_STATE_SENT, &wl->flags))
409 return 0;
410
Eliad Pellerb67476e2011-08-14 13:17:23 +0300411 ret = wl12xx_cmd_set_peer_state(wl, wl->sta_hlid);
Eliad Pelleref4b29e2011-06-06 13:03:12 +0300412 if (ret < 0)
413 return ret;
414
Eliad Peller251c1772011-08-14 13:17:17 +0300415 wl12xx_croc(wl, wl->role_id);
416
Eliad Pelleref4b29e2011-06-06 13:03:12 +0300417 wl1271_info("Association completed.");
418 return 0;
419}
Juuso Oikarinenc2c192a2010-07-27 03:30:09 +0300420static int wl1271_dev_notify(struct notifier_block *me, unsigned long what,
421 void *arg)
422{
423 struct net_device *dev = arg;
424 struct wireless_dev *wdev;
425 struct wiphy *wiphy;
426 struct ieee80211_hw *hw;
427 struct wl1271 *wl;
428 struct wl1271 *wl_temp;
429 int ret = 0;
430
431 /* Check that this notification is for us. */
432 if (what != NETDEV_CHANGE)
433 return NOTIFY_DONE;
434
435 wdev = dev->ieee80211_ptr;
436 if (wdev == NULL)
437 return NOTIFY_DONE;
438
439 wiphy = wdev->wiphy;
440 if (wiphy == NULL)
441 return NOTIFY_DONE;
442
443 hw = wiphy_priv(wiphy);
444 if (hw == NULL)
445 return NOTIFY_DONE;
446
447 wl_temp = hw->priv;
Juuso Oikarinenf9f774c2011-03-21 10:43:36 +0200448 mutex_lock(&wl_list_mutex);
Juuso Oikarinenc2c192a2010-07-27 03:30:09 +0300449 list_for_each_entry(wl, &wl_list, list) {
450 if (wl == wl_temp)
451 break;
452 }
Juuso Oikarinenf9f774c2011-03-21 10:43:36 +0200453 mutex_unlock(&wl_list_mutex);
Juuso Oikarinenc2c192a2010-07-27 03:30:09 +0300454 if (wl != wl_temp)
455 return NOTIFY_DONE;
456
457 mutex_lock(&wl->mutex);
458
459 if (wl->state == WL1271_STATE_OFF)
460 goto out;
461
462 if (!test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
463 goto out;
464
Ido Yariva6208652011-03-01 15:14:41 +0200465 ret = wl1271_ps_elp_wakeup(wl);
Juuso Oikarinenc2c192a2010-07-27 03:30:09 +0300466 if (ret < 0)
467 goto out;
468
Eliad Pelleref4b29e2011-06-06 13:03:12 +0300469 wl1271_check_operstate(wl, dev->operstate);
Juuso Oikarinenc2c192a2010-07-27 03:30:09 +0300470
471 wl1271_ps_elp_sleep(wl);
472
473out:
474 mutex_unlock(&wl->mutex);
475
476 return NOTIFY_OK;
477}
478
Juuso Oikarinenb7417d92010-11-10 11:27:19 +0100479static int wl1271_reg_notify(struct wiphy *wiphy,
Luciano Coelho573c67c2010-11-26 13:44:59 +0200480 struct regulatory_request *request)
481{
Juuso Oikarinenb7417d92010-11-10 11:27:19 +0100482 struct ieee80211_supported_band *band;
483 struct ieee80211_channel *ch;
484 int i;
485
486 band = wiphy->bands[IEEE80211_BAND_5GHZ];
487 for (i = 0; i < band->n_channels; i++) {
488 ch = &band->channels[i];
489 if (ch->flags & IEEE80211_CHAN_DISABLED)
490 continue;
491
492 if (ch->flags & IEEE80211_CHAN_RADAR)
493 ch->flags |= IEEE80211_CHAN_NO_IBSS |
494 IEEE80211_CHAN_PASSIVE_SCAN;
495
496 }
497
498 return 0;
499}
500
Eliad Peller77ddaa12011-05-15 11:10:29 +0300501static int wl1271_set_rx_streaming(struct wl1271 *wl, bool enable)
502{
503 int ret = 0;
504
505 /* we should hold wl->mutex */
506 ret = wl1271_acx_ps_rx_streaming(wl, enable);
507 if (ret < 0)
508 goto out;
509
510 if (enable)
511 set_bit(WL1271_FLAG_RX_STREAMING_STARTED, &wl->flags);
512 else
513 clear_bit(WL1271_FLAG_RX_STREAMING_STARTED, &wl->flags);
514out:
515 return ret;
516}
517
518/*
519 * this function is being called when the rx_streaming interval
520 * has beed changed or rx_streaming should be disabled
521 */
522int wl1271_recalc_rx_streaming(struct wl1271 *wl)
523{
524 int ret = 0;
525 int period = wl->conf.rx_streaming.interval;
526
527 /* don't reconfigure if rx_streaming is disabled */
528 if (!test_bit(WL1271_FLAG_RX_STREAMING_STARTED, &wl->flags))
529 goto out;
530
531 /* reconfigure/disable according to new streaming_period */
532 if (period &&
533 test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags) &&
534 (wl->conf.rx_streaming.always ||
535 test_bit(WL1271_FLAG_SOFT_GEMINI, &wl->flags)))
536 ret = wl1271_set_rx_streaming(wl, true);
537 else {
538 ret = wl1271_set_rx_streaming(wl, false);
539 /* don't cancel_work_sync since we might deadlock */
540 del_timer_sync(&wl->rx_streaming_timer);
541 }
542out:
543 return ret;
544}
545
546static void wl1271_rx_streaming_enable_work(struct work_struct *work)
547{
548 int ret;
549 struct wl1271 *wl =
550 container_of(work, struct wl1271, rx_streaming_enable_work);
551
552 mutex_lock(&wl->mutex);
553
554 if (test_bit(WL1271_FLAG_RX_STREAMING_STARTED, &wl->flags) ||
555 !test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags) ||
556 (!wl->conf.rx_streaming.always &&
557 !test_bit(WL1271_FLAG_SOFT_GEMINI, &wl->flags)))
558 goto out;
559
560 if (!wl->conf.rx_streaming.interval)
561 goto out;
562
563 ret = wl1271_ps_elp_wakeup(wl);
564 if (ret < 0)
565 goto out;
566
567 ret = wl1271_set_rx_streaming(wl, true);
568 if (ret < 0)
569 goto out_sleep;
570
571 /* stop it after some time of inactivity */
572 mod_timer(&wl->rx_streaming_timer,
573 jiffies + msecs_to_jiffies(wl->conf.rx_streaming.duration));
574
575out_sleep:
576 wl1271_ps_elp_sleep(wl);
577out:
578 mutex_unlock(&wl->mutex);
579}
580
581static void wl1271_rx_streaming_disable_work(struct work_struct *work)
582{
583 int ret;
584 struct wl1271 *wl =
585 container_of(work, struct wl1271, rx_streaming_disable_work);
586
587 mutex_lock(&wl->mutex);
588
589 if (!test_bit(WL1271_FLAG_RX_STREAMING_STARTED, &wl->flags))
590 goto out;
591
592 ret = wl1271_ps_elp_wakeup(wl);
593 if (ret < 0)
594 goto out;
595
596 ret = wl1271_set_rx_streaming(wl, false);
597 if (ret)
598 goto out_sleep;
599
600out_sleep:
601 wl1271_ps_elp_sleep(wl);
602out:
603 mutex_unlock(&wl->mutex);
604}
605
606static void wl1271_rx_streaming_timer(unsigned long data)
607{
608 struct wl1271 *wl = (struct wl1271 *)data;
609 ieee80211_queue_work(wl->hw, &wl->rx_streaming_disable_work);
610}
611
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +0300612static void wl1271_conf_init(struct wl1271 *wl)
613{
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +0300614
615 /*
616 * This function applies the default configuration to the driver. This
617 * function is invoked upon driver load (spi probe.)
618 *
619 * The configuration is stored in a run-time structure in order to
620 * facilitate for run-time adjustment of any of the parameters. Making
621 * changes to the configuration structure will apply the new values on
622 * the next interface up (wl1271_op_start.)
623 */
624
625 /* apply driver default configuration */
Juuso Oikarinen8a080482009-10-13 12:47:44 +0300626 memcpy(&wl->conf, &default_conf, sizeof(default_conf));
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +0300627
Ido Yariv95dac04f2011-06-06 14:57:06 +0300628 /* Adjust settings according to optional module parameters */
629 if (fwlog_param) {
630 if (!strcmp(fwlog_param, "continuous")) {
631 wl->conf.fwlog.mode = WL12XX_FWLOG_CONTINUOUS;
632 } else if (!strcmp(fwlog_param, "ondemand")) {
633 wl->conf.fwlog.mode = WL12XX_FWLOG_ON_DEMAND;
634 } else if (!strcmp(fwlog_param, "dbgpins")) {
635 wl->conf.fwlog.mode = WL12XX_FWLOG_CONTINUOUS;
636 wl->conf.fwlog.output = WL12XX_FWLOG_OUTPUT_DBG_PINS;
637 } else if (!strcmp(fwlog_param, "disable")) {
638 wl->conf.fwlog.mem_blocks = 0;
639 wl->conf.fwlog.output = WL12XX_FWLOG_OUTPUT_NONE;
640 } else {
641 wl1271_error("Unknown fwlog parameter %s", fwlog_param);
642 }
643 }
644}
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +0300645
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300646static int wl1271_plt_init(struct wl1271 *wl)
647{
Luciano Coelho12419cc2010-02-18 13:25:44 +0200648 struct conf_tx_ac_category *conf_ac;
649 struct conf_tx_tid *conf_tid;
650 int ret, i;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300651
Shahar Levi49d750ca2011-03-06 16:32:09 +0200652 if (wl->chip.id == CHIP_ID_1283_PG20)
653 ret = wl128x_cmd_general_parms(wl);
654 else
655 ret = wl1271_cmd_general_parms(wl);
Luciano Coelho4a904062009-11-23 23:22:18 +0200656 if (ret < 0)
Luciano Coelhocc7defa2009-11-23 23:22:16 +0200657 return ret;
658
Shahar Levi49d750ca2011-03-06 16:32:09 +0200659 if (wl->chip.id == CHIP_ID_1283_PG20)
660 ret = wl128x_cmd_radio_parms(wl);
661 else
662 ret = wl1271_cmd_radio_parms(wl);
Luciano Coelho4a904062009-11-23 23:22:18 +0200663 if (ret < 0)
Luciano Coelhocc7defa2009-11-23 23:22:16 +0200664 return ret;
665
Shahar Levi49d750ca2011-03-06 16:32:09 +0200666 if (wl->chip.id != CHIP_ID_1283_PG20) {
667 ret = wl1271_cmd_ext_radio_parms(wl);
668 if (ret < 0)
669 return ret;
670 }
Juuso Oikarinen644a4862010-10-05 13:11:56 +0200671 if (ret < 0)
672 return ret;
673
Shahar Levi48a61472011-03-06 16:32:08 +0200674 /* Chip-specific initializations */
675 ret = wl1271_chip_specific_init(wl);
676 if (ret < 0)
677 return ret;
678
Arik Nemtsove0fe3712010-10-16 18:19:53 +0200679 ret = wl1271_sta_init_templates_config(wl);
Luciano Coelho12419cc2010-02-18 13:25:44 +0200680 if (ret < 0)
681 return ret;
682
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300683 ret = wl1271_acx_init_mem_config(wl);
684 if (ret < 0)
685 return ret;
686
Luciano Coelho12419cc2010-02-18 13:25:44 +0200687 /* PHY layer config */
688 ret = wl1271_init_phy_config(wl);
689 if (ret < 0)
690 goto out_free_memmap;
691
692 ret = wl1271_acx_dco_itrim_params(wl);
693 if (ret < 0)
694 goto out_free_memmap;
695
696 /* Initialize connection monitoring thresholds */
Juuso Oikarinen6ccbb922010-03-26 12:53:23 +0200697 ret = wl1271_acx_conn_monit_params(wl, false);
Luciano Coelho12419cc2010-02-18 13:25:44 +0200698 if (ret < 0)
699 goto out_free_memmap;
700
701 /* Bluetooth WLAN coexistence */
702 ret = wl1271_init_pta(wl);
703 if (ret < 0)
704 goto out_free_memmap;
705
Shahar Leviff868432011-04-11 15:41:46 +0300706 /* FM WLAN coexistence */
707 ret = wl1271_acx_fm_coex(wl);
708 if (ret < 0)
709 goto out_free_memmap;
710
Luciano Coelho12419cc2010-02-18 13:25:44 +0200711 /* Energy detection */
712 ret = wl1271_init_energy_detection(wl);
713 if (ret < 0)
714 goto out_free_memmap;
715
Eliad Peller7f0979882011-08-14 13:17:06 +0300716 ret = wl12xx_acx_mem_cfg(wl);
Gery Kahn1ec610e2011-02-01 03:03:08 -0600717 if (ret < 0)
718 goto out_free_memmap;
719
Luciano Coelho12419cc2010-02-18 13:25:44 +0200720 /* Default fragmentation threshold */
Arik Nemtsov68d069c2010-11-08 10:51:07 +0100721 ret = wl1271_acx_frag_threshold(wl, wl->conf.tx.frag_threshold);
Luciano Coelho12419cc2010-02-18 13:25:44 +0200722 if (ret < 0)
723 goto out_free_memmap;
724
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200725 /* Default TID/AC configuration */
726 BUG_ON(wl->conf.tx.tid_conf_count != wl->conf.tx.ac_conf_count);
Luciano Coelho12419cc2010-02-18 13:25:44 +0200727 for (i = 0; i < wl->conf.tx.tid_conf_count; i++) {
Juuso Oikarinen9987a9d2010-09-01 11:31:12 +0200728 conf_ac = &wl->conf.tx.ac_conf[i];
729 ret = wl1271_acx_ac_cfg(wl, conf_ac->ac, conf_ac->cw_min,
730 conf_ac->cw_max, conf_ac->aifsn,
731 conf_ac->tx_op_limit);
732 if (ret < 0)
733 goto out_free_memmap;
734
Luciano Coelho12419cc2010-02-18 13:25:44 +0200735 conf_tid = &wl->conf.tx.tid_conf[i];
736 ret = wl1271_acx_tid_cfg(wl, conf_tid->queue_id,
737 conf_tid->channel_type,
738 conf_tid->tsid,
739 conf_tid->ps_scheme,
740 conf_tid->ack_policy,
741 conf_tid->apsd_conf[0],
742 conf_tid->apsd_conf[1]);
743 if (ret < 0)
744 goto out_free_memmap;
745 }
746
Luciano Coelho12419cc2010-02-18 13:25:44 +0200747 /* Enable data path */
Luciano Coelho94210892009-12-11 15:40:55 +0200748 ret = wl1271_cmd_data_path(wl, 1);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300749 if (ret < 0)
Luciano Coelho12419cc2010-02-18 13:25:44 +0200750 goto out_free_memmap;
751
752 /* Configure for CAM power saving (ie. always active) */
753 ret = wl1271_acx_sleep_auth(wl, WL1271_PSM_CAM);
754 if (ret < 0)
755 goto out_free_memmap;
756
757 /* configure PM */
758 ret = wl1271_acx_pm_config(wl);
759 if (ret < 0)
760 goto out_free_memmap;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300761
762 return 0;
Luciano Coelho12419cc2010-02-18 13:25:44 +0200763
764 out_free_memmap:
765 kfree(wl->target_mem_map);
766 wl->target_mem_map = NULL;
767
768 return ret;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300769}
770
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300771static void wl12xx_irq_ps_regulate_link(struct wl1271 *wl, u8 hlid, u8 tx_pkts)
Arik Nemtsovb622d992011-02-23 00:22:31 +0200772{
Arik Nemtsovda032092011-08-25 12:43:15 +0300773 bool fw_ps, single_sta;
Arik Nemtsovb622d992011-02-23 00:22:31 +0200774
775 /* only regulate station links */
776 if (hlid < WL1271_AP_STA_HLID_START)
777 return;
778
779 fw_ps = test_bit(hlid, (unsigned long *)&wl->ap_fw_ps_map);
Arik Nemtsovda032092011-08-25 12:43:15 +0300780 single_sta = (wl->active_sta_count == 1);
Arik Nemtsovb622d992011-02-23 00:22:31 +0200781
782 /*
783 * Wake up from high level PS if the STA is asleep with too little
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300784 * packets in FW or if the STA is awake.
Arik Nemtsovb622d992011-02-23 00:22:31 +0200785 */
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300786 if (!fw_ps || tx_pkts < WL1271_PS_STA_MAX_PACKETS)
Arik Nemtsovb622d992011-02-23 00:22:31 +0200787 wl1271_ps_link_end(wl, hlid);
788
Arik Nemtsovda032092011-08-25 12:43:15 +0300789 /*
790 * Start high-level PS if the STA is asleep with enough blocks in FW.
791 * Make an exception if this is the only connected station. In this
792 * case FW-memory congestion is not a problem.
793 */
794 else if (!single_sta && fw_ps && tx_pkts >= WL1271_PS_STA_MAX_PACKETS)
Arik Nemtsovb622d992011-02-23 00:22:31 +0200795 wl1271_ps_link_start(wl, hlid, true);
796}
797
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300798bool wl1271_is_active_sta(struct wl1271 *wl, u8 hlid)
799{
Arik Nemtsov04216da2011-08-14 13:17:38 +0300800 int id;
801
802 /* global/broadcast "stations" are always active */
803 if (hlid < WL1271_AP_STA_HLID_START)
804 return true;
805
806 id = hlid - WL1271_AP_STA_HLID_START;
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300807 return test_bit(id, wl->ap_hlid_map);
808}
809
810static void wl12xx_irq_update_links_status(struct wl1271 *wl,
811 struct wl12xx_fw_status *status)
Arik Nemtsovb622d992011-02-23 00:22:31 +0200812{
813 u32 cur_fw_ps_map;
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300814 u8 hlid, cnt;
815
816 /* TODO: also use link_fast_bitmap here */
Arik Nemtsovb622d992011-02-23 00:22:31 +0200817
818 cur_fw_ps_map = le32_to_cpu(status->link_ps_bitmap);
819 if (wl->ap_fw_ps_map != cur_fw_ps_map) {
820 wl1271_debug(DEBUG_PSM,
821 "link ps prev 0x%x cur 0x%x changed 0x%x",
822 wl->ap_fw_ps_map, cur_fw_ps_map,
823 wl->ap_fw_ps_map ^ cur_fw_ps_map);
824
825 wl->ap_fw_ps_map = cur_fw_ps_map;
826 }
827
828 for (hlid = WL1271_AP_STA_HLID_START; hlid < AP_MAX_LINKS; hlid++) {
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300829 if (!wl1271_is_active_sta(wl, hlid))
830 continue;
Arik Nemtsovb622d992011-02-23 00:22:31 +0200831
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300832 cnt = status->tx_lnk_free_pkts[hlid] -
833 wl->links[hlid].prev_freed_pkts;
Arik Nemtsovb622d992011-02-23 00:22:31 +0200834
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300835 wl->links[hlid].prev_freed_pkts =
836 status->tx_lnk_free_pkts[hlid];
837 wl->links[hlid].allocated_pkts -= cnt;
838
839 wl12xx_irq_ps_regulate_link(wl, hlid,
840 wl->links[hlid].allocated_pkts);
Arik Nemtsovb622d992011-02-23 00:22:31 +0200841 }
842}
843
Eliad Peller4d56ad92011-08-14 13:17:05 +0300844static void wl12xx_fw_status(struct wl1271 *wl,
845 struct wl12xx_fw_status *status)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300846{
Juuso Oikarinenac5e1e32010-02-22 08:38:38 +0200847 struct timespec ts;
Shahar Levi13b107d2011-03-06 16:32:12 +0200848 u32 old_tx_blk_count = wl->tx_blocks_available;
Eliad Peller4d56ad92011-08-14 13:17:05 +0300849 int avail, freed_blocks;
Arik Nemtsovbf54e302011-08-14 13:17:32 +0300850 int i;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300851
Eliad Peller4d56ad92011-08-14 13:17:05 +0300852 wl1271_raw_read(wl, FW_STATUS_ADDR, status, sizeof(*status), false);
Shahar Levi13b107d2011-03-06 16:32:12 +0200853
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300854 wl1271_debug(DEBUG_IRQ, "intr: 0x%x (fw_rx_counter = %d, "
855 "drv_rx_counter = %d, tx_results_counter = %d)",
856 status->intr,
857 status->fw_rx_counter,
858 status->drv_rx_counter,
859 status->tx_results_counter);
860
Arik Nemtsovbf54e302011-08-14 13:17:32 +0300861 for (i = 0; i < NUM_TX_QUEUES; i++) {
862 /* prevent wrap-around in freed-packets counter */
Arik Nemtsov742246f2011-08-14 13:17:33 +0300863 wl->tx_allocated_pkts[i] -=
Arik Nemtsovbf54e302011-08-14 13:17:32 +0300864 (status->tx_released_pkts[i] -
865 wl->tx_pkts_freed[i]) & 0xff;
866
867 wl->tx_pkts_freed[i] = status->tx_released_pkts[i];
868 }
869
Arik Nemtsovbdf91cf2011-08-14 13:17:34 +0300870 /* prevent wrap-around in total blocks counter */
871 if (likely(wl->tx_blocks_freed <=
872 le32_to_cpu(status->total_released_blks)))
873 freed_blocks = le32_to_cpu(status->total_released_blks) -
874 wl->tx_blocks_freed;
875 else
876 freed_blocks = 0x100000000LL - wl->tx_blocks_freed +
877 le32_to_cpu(status->total_released_blks);
878
Eliad Peller4d56ad92011-08-14 13:17:05 +0300879 wl->tx_blocks_freed = le32_to_cpu(status->total_released_blks);
Shahar Levi13b107d2011-03-06 16:32:12 +0200880
Arik Nemtsov7bb5d6c2011-08-14 13:17:00 +0300881 wl->tx_allocated_blocks -= freed_blocks;
882
Eliad Peller4d56ad92011-08-14 13:17:05 +0300883 avail = le32_to_cpu(status->tx_total) - wl->tx_allocated_blocks;
Ido Yarivd2f4d472011-03-31 10:07:00 +0200884
Eliad Peller4d56ad92011-08-14 13:17:05 +0300885 /*
886 * The FW might change the total number of TX memblocks before
887 * we get a notification about blocks being released. Thus, the
888 * available blocks calculation might yield a temporary result
889 * which is lower than the actual available blocks. Keeping in
890 * mind that only blocks that were allocated can be moved from
891 * TX to RX, tx_blocks_available should never decrease here.
892 */
893 wl->tx_blocks_available = max((int)wl->tx_blocks_available,
894 avail);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300895
Ido Yariva5225502010-10-12 14:49:10 +0200896 /* if more blocks are available now, tx work can be scheduled */
Shahar Levi13b107d2011-03-06 16:32:12 +0200897 if (wl->tx_blocks_available > old_tx_blk_count)
Ido Yariva5225502010-10-12 14:49:10 +0200898 clear_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300899
Eliad Peller4d56ad92011-08-14 13:17:05 +0300900 /* for AP update num of allocated TX blocks per link and ps status */
Arik Nemtsov9b17f1b2011-08-14 13:17:35 +0300901 if (wl->bss_type == BSS_TYPE_AP_BSS)
902 wl12xx_irq_update_links_status(wl, status);
Eliad Peller4d56ad92011-08-14 13:17:05 +0300903
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300904 /* update the host-chipset time offset */
Juuso Oikarinenac5e1e32010-02-22 08:38:38 +0200905 getnstimeofday(&ts);
906 wl->time_offset = (timespec_to_ns(&ts) >> 10) -
907 (s64)le32_to_cpu(status->fw_localtime);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300908}
909
Ido Yariva6208652011-03-01 15:14:41 +0200910static void wl1271_flush_deferred_work(struct wl1271 *wl)
911{
912 struct sk_buff *skb;
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +0200913
Ido Yariva6208652011-03-01 15:14:41 +0200914 /* Pass all received frames to the network stack */
915 while ((skb = skb_dequeue(&wl->deferred_rx_queue)))
916 ieee80211_rx_ni(wl->hw, skb);
917
918 /* Return sent skbs to the network stack */
919 while ((skb = skb_dequeue(&wl->deferred_tx_queue)))
Eliad Pellerc27d3ac2011-06-07 10:40:39 +0300920 ieee80211_tx_status_ni(wl->hw, skb);
Ido Yariva6208652011-03-01 15:14:41 +0200921}
922
923static void wl1271_netstack_work(struct work_struct *work)
924{
925 struct wl1271 *wl =
926 container_of(work, struct wl1271, netstack_work);
927
928 do {
929 wl1271_flush_deferred_work(wl);
930 } while (skb_queue_len(&wl->deferred_rx_queue));
931}
932
933#define WL1271_IRQ_MAX_LOOPS 256
934
935irqreturn_t wl1271_irq(int irq, void *cookie)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300936{
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300937 int ret;
Juuso Oikarinenc15f63b2009-10-12 15:08:50 +0300938 u32 intr;
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +0200939 int loopcount = WL1271_IRQ_MAX_LOOPS;
Ido Yariva6208652011-03-01 15:14:41 +0200940 struct wl1271 *wl = (struct wl1271 *)cookie;
941 bool done = false;
942 unsigned int defer_count;
Ido Yarivb07d4032011-03-01 15:14:43 +0200943 unsigned long flags;
944
945 /* TX might be handled here, avoid redundant work */
946 set_bit(WL1271_FLAG_TX_PENDING, &wl->flags);
947 cancel_work_sync(&wl->tx_work);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300948
Ido Yariv341b7cd2011-03-31 10:07:01 +0200949 /*
950 * In case edge triggered interrupt must be used, we cannot iterate
951 * more than once without introducing race conditions with the hardirq.
952 */
953 if (wl->platform_quirks & WL12XX_PLATFORM_QUIRK_EDGE_IRQ)
954 loopcount = 1;
955
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300956 mutex_lock(&wl->mutex);
957
958 wl1271_debug(DEBUG_IRQ, "IRQ work");
959
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +0200960 if (unlikely(wl->state == WL1271_STATE_OFF))
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300961 goto out;
962
Ido Yariva6208652011-03-01 15:14:41 +0200963 ret = wl1271_ps_elp_wakeup(wl);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +0300964 if (ret < 0)
965 goto out;
966
Ido Yariva6208652011-03-01 15:14:41 +0200967 while (!done && loopcount--) {
968 /*
969 * In order to avoid a race with the hardirq, clear the flag
970 * before acknowledging the chip. Since the mutex is held,
971 * wl1271_ps_elp_wakeup cannot be called concurrently.
972 */
973 clear_bit(WL1271_FLAG_IRQ_RUNNING, &wl->flags);
974 smp_mb__after_clear_bit();
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +0200975
Eliad Peller4d56ad92011-08-14 13:17:05 +0300976 wl12xx_fw_status(wl, wl->fw_status);
977 intr = le32_to_cpu(wl->fw_status->intr);
Ido Yariva6208652011-03-01 15:14:41 +0200978 intr &= WL1271_INTR_MASK;
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +0200979 if (!intr) {
Ido Yariva6208652011-03-01 15:14:41 +0200980 done = true;
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +0200981 continue;
982 }
983
Eliad Pellerccc83b02010-10-27 14:09:57 +0200984 if (unlikely(intr & WL1271_ACX_INTR_WATCHDOG)) {
985 wl1271_error("watchdog interrupt received! "
986 "starting recovery.");
Ido Yarivbaacb9a2011-06-06 14:57:05 +0300987 wl12xx_queue_recovery_work(wl);
Eliad Pellerccc83b02010-10-27 14:09:57 +0200988
989 /* restarting the chip. ignore any other interrupt. */
990 goto out;
991 }
992
Ido Yariva6208652011-03-01 15:14:41 +0200993 if (likely(intr & WL1271_ACX_INTR_DATA)) {
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +0200994 wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_DATA");
995
Eliad Peller4d56ad92011-08-14 13:17:05 +0300996 wl12xx_rx(wl, wl->fw_status);
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +0200997
Ido Yariva5225502010-10-12 14:49:10 +0200998 /* Check if any tx blocks were freed */
Ido Yarivb07d4032011-03-01 15:14:43 +0200999 spin_lock_irqsave(&wl->wl_lock, flags);
Ido Yariva5225502010-10-12 14:49:10 +02001000 if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
Arik Nemtsovf1a46382011-07-07 14:25:23 +03001001 wl1271_tx_total_queue_count(wl) > 0) {
Ido Yarivb07d4032011-03-01 15:14:43 +02001002 spin_unlock_irqrestore(&wl->wl_lock, flags);
Ido Yariva5225502010-10-12 14:49:10 +02001003 /*
1004 * In order to avoid starvation of the TX path,
1005 * call the work function directly.
1006 */
1007 wl1271_tx_work_locked(wl);
Ido Yarivb07d4032011-03-01 15:14:43 +02001008 } else {
1009 spin_unlock_irqrestore(&wl->wl_lock, flags);
Ido Yariva5225502010-10-12 14:49:10 +02001010 }
1011
Ido Yariv8aad2462011-03-01 15:14:38 +02001012 /* check for tx results */
Eliad Peller4d56ad92011-08-14 13:17:05 +03001013 if (wl->fw_status->tx_results_counter !=
Ido Yariv8aad2462011-03-01 15:14:38 +02001014 (wl->tx_results_count & 0xff))
1015 wl1271_tx_complete(wl);
Ido Yariva6208652011-03-01 15:14:41 +02001016
1017 /* Make sure the deferred queues don't get too long */
1018 defer_count = skb_queue_len(&wl->deferred_tx_queue) +
1019 skb_queue_len(&wl->deferred_rx_queue);
1020 if (defer_count > WL1271_DEFERRED_QUEUE_LIMIT)
1021 wl1271_flush_deferred_work(wl);
Juuso Oikarinen1e73eb62010-02-22 08:38:37 +02001022 }
1023
1024 if (intr & WL1271_ACX_INTR_EVENT_A) {
1025 wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_EVENT_A");
1026 wl1271_event_handle(wl, 0);
1027 }
1028
1029 if (intr & WL1271_ACX_INTR_EVENT_B) {
1030 wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_EVENT_B");
1031 wl1271_event_handle(wl, 1);
1032 }
1033
1034 if (intr & WL1271_ACX_INTR_INIT_COMPLETE)
1035 wl1271_debug(DEBUG_IRQ,
1036 "WL1271_ACX_INTR_INIT_COMPLETE");
1037
1038 if (intr & WL1271_ACX_INTR_HW_AVAILABLE)
1039 wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_HW_AVAILABLE");
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001040 }
1041
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001042 wl1271_ps_elp_sleep(wl);
1043
1044out:
Ido Yarivb07d4032011-03-01 15:14:43 +02001045 spin_lock_irqsave(&wl->wl_lock, flags);
1046 /* In case TX was not handled here, queue TX work */
1047 clear_bit(WL1271_FLAG_TX_PENDING, &wl->flags);
1048 if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
Arik Nemtsovf1a46382011-07-07 14:25:23 +03001049 wl1271_tx_total_queue_count(wl) > 0)
Ido Yarivb07d4032011-03-01 15:14:43 +02001050 ieee80211_queue_work(wl->hw, &wl->tx_work);
1051 spin_unlock_irqrestore(&wl->wl_lock, flags);
1052
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001053 mutex_unlock(&wl->mutex);
Ido Yariva6208652011-03-01 15:14:41 +02001054
1055 return IRQ_HANDLED;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001056}
Ido Yariva6208652011-03-01 15:14:41 +02001057EXPORT_SYMBOL_GPL(wl1271_irq);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001058
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001059static int wl1271_fetch_firmware(struct wl1271 *wl)
1060{
1061 const struct firmware *fw;
Arik Nemtsov166d5042010-10-16 21:44:57 +02001062 const char *fw_name;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001063 int ret;
1064
Arik Nemtsovc302b2c2011-08-17 10:45:48 +03001065 if (wl->chip.id == CHIP_ID_1283_PG20)
1066 fw_name = WL128X_FW_NAME;
1067 else
1068 fw_name = WL127X_FW_NAME;
Arik Nemtsov166d5042010-10-16 21:44:57 +02001069
1070 wl1271_debug(DEBUG_BOOT, "booting firmware %s", fw_name);
1071
1072 ret = request_firmware(&fw, fw_name, wl1271_wl_to_dev(wl));
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001073
1074 if (ret < 0) {
1075 wl1271_error("could not get firmware: %d", ret);
1076 return ret;
1077 }
1078
1079 if (fw->size % 4) {
1080 wl1271_error("firmware size is not multiple of 32 bits: %zu",
1081 fw->size);
1082 ret = -EILSEQ;
1083 goto out;
1084 }
1085
Arik Nemtsov166d5042010-10-16 21:44:57 +02001086 vfree(wl->fw);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001087 wl->fw_len = fw->size;
Juuso Oikarinen1fba4972009-10-08 21:56:32 +03001088 wl->fw = vmalloc(wl->fw_len);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001089
1090 if (!wl->fw) {
1091 wl1271_error("could not allocate memory for the firmware");
1092 ret = -ENOMEM;
1093 goto out;
1094 }
1095
1096 memcpy(wl->fw, fw->data, wl->fw_len);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001097 ret = 0;
1098
1099out:
1100 release_firmware(fw);
1101
1102 return ret;
1103}
1104
1105static int wl1271_fetch_nvs(struct wl1271 *wl)
1106{
1107 const struct firmware *fw;
1108 int ret;
1109
Shahar Levi5aa42342011-03-06 16:32:07 +02001110 ret = request_firmware(&fw, WL12XX_NVS_NAME, wl1271_wl_to_dev(wl));
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001111
1112 if (ret < 0) {
1113 wl1271_error("could not get nvs file: %d", ret);
1114 return ret;
1115 }
1116
Shahar Levibc765bf2011-03-06 16:32:10 +02001117 wl->nvs = kmemdup(fw->data, fw->size, GFP_KERNEL);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001118
1119 if (!wl->nvs) {
1120 wl1271_error("could not allocate memory for the nvs file");
1121 ret = -ENOMEM;
1122 goto out;
1123 }
1124
Juuso Oikarinen02fabb02010-08-19 04:41:15 +02001125 wl->nvs_len = fw->size;
1126
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001127out:
1128 release_firmware(fw);
1129
1130 return ret;
1131}
1132
Ido Yarivbaacb9a2011-06-06 14:57:05 +03001133void wl12xx_queue_recovery_work(struct wl1271 *wl)
1134{
1135 if (!test_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags))
1136 ieee80211_queue_work(wl->hw, &wl->recovery_work);
1137}
1138
Ido Yariv95dac04f2011-06-06 14:57:06 +03001139size_t wl12xx_copy_fwlog(struct wl1271 *wl, u8 *memblock, size_t maxlen)
1140{
1141 size_t len = 0;
1142
1143 /* The FW log is a length-value list, find where the log end */
1144 while (len < maxlen) {
1145 if (memblock[len] == 0)
1146 break;
1147 if (len + memblock[len] + 1 > maxlen)
1148 break;
1149 len += memblock[len] + 1;
1150 }
1151
1152 /* Make sure we have enough room */
1153 len = min(len, (size_t)(PAGE_SIZE - wl->fwlog_size));
1154
1155 /* Fill the FW log file, consumed by the sysfs fwlog entry */
1156 memcpy(wl->fwlog + wl->fwlog_size, memblock, len);
1157 wl->fwlog_size += len;
1158
1159 return len;
1160}
1161
1162static void wl12xx_read_fwlog_panic(struct wl1271 *wl)
1163{
1164 u32 addr;
1165 u32 first_addr;
1166 u8 *block;
1167
1168 if ((wl->quirks & WL12XX_QUIRK_FWLOG_NOT_IMPLEMENTED) ||
1169 (wl->conf.fwlog.mode != WL12XX_FWLOG_ON_DEMAND) ||
1170 (wl->conf.fwlog.mem_blocks == 0))
1171 return;
1172
1173 wl1271_info("Reading FW panic log");
1174
1175 block = kmalloc(WL12XX_HW_BLOCK_SIZE, GFP_KERNEL);
1176 if (!block)
1177 return;
1178
1179 /*
1180 * Make sure the chip is awake and the logger isn't active.
1181 * This might fail if the firmware hanged.
1182 */
1183 if (!wl1271_ps_elp_wakeup(wl))
1184 wl12xx_cmd_stop_fwlog(wl);
1185
1186 /* Read the first memory block address */
Eliad Peller4d56ad92011-08-14 13:17:05 +03001187 wl12xx_fw_status(wl, wl->fw_status);
1188 first_addr = le32_to_cpu(wl->fw_status->log_start_addr);
Ido Yariv95dac04f2011-06-06 14:57:06 +03001189 if (!first_addr)
1190 goto out;
1191
1192 /* Traverse the memory blocks linked list */
1193 addr = first_addr;
1194 do {
1195 memset(block, 0, WL12XX_HW_BLOCK_SIZE);
1196 wl1271_read_hwaddr(wl, addr, block, WL12XX_HW_BLOCK_SIZE,
1197 false);
1198
1199 /*
1200 * Memory blocks are linked to one another. The first 4 bytes
1201 * of each memory block hold the hardware address of the next
1202 * one. The last memory block points to the first one.
1203 */
Eliad Peller4d56ad92011-08-14 13:17:05 +03001204 addr = le32_to_cpup((__le32 *)block);
Ido Yariv95dac04f2011-06-06 14:57:06 +03001205 if (!wl12xx_copy_fwlog(wl, block + sizeof(addr),
1206 WL12XX_HW_BLOCK_SIZE - sizeof(addr)))
1207 break;
1208 } while (addr && (addr != first_addr));
1209
1210 wake_up_interruptible(&wl->fwlog_waitq);
1211
1212out:
1213 kfree(block);
1214}
1215
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +02001216static void wl1271_recovery_work(struct work_struct *work)
1217{
1218 struct wl1271 *wl =
1219 container_of(work, struct wl1271, recovery_work);
1220
1221 mutex_lock(&wl->mutex);
1222
1223 if (wl->state != WL1271_STATE_ON)
1224 goto out;
1225
Ido Yarivbaacb9a2011-06-06 14:57:05 +03001226 /* Avoid a recursive recovery */
1227 set_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags);
1228
Ido Yariv95dac04f2011-06-06 14:57:06 +03001229 wl12xx_read_fwlog_panic(wl);
1230
Arik Nemtsov52dcaf52011-04-18 14:15:24 +03001231 wl1271_info("Hardware recovery in progress. FW ver: %s pc: 0x%x",
1232 wl->chip.fw_ver_str, wl1271_read32(wl, SCR_PAD4));
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +02001233
Eliad Peller2a5bff02011-08-25 18:10:59 +03001234 BUG_ON(bug_on_recovery);
1235
Oz Krakowskib992c682011-06-26 10:36:02 +03001236 /*
1237 * Advance security sequence number to overcome potential progress
1238 * in the firmware during recovery. This doens't hurt if the network is
1239 * not encrypted.
1240 */
1241 if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags) ||
1242 test_bit(WL1271_FLAG_AP_STARTED, &wl->flags))
1243 wl->tx_security_seq += WL1271_TX_SQN_POST_RECOVERY_PADDING;
1244
Arik Nemtsov7dece1c2011-04-18 14:15:28 +03001245 /* Prevent spurious TX during FW restart */
1246 ieee80211_stop_queues(wl->hw);
1247
Luciano Coelho33c2c062011-05-10 14:46:02 +03001248 if (wl->sched_scanning) {
1249 ieee80211_sched_scan_stopped(wl->hw);
1250 wl->sched_scanning = false;
1251 }
1252
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +02001253 /* reboot the chipset */
Arik Nemtsov7dece1c2011-04-18 14:15:28 +03001254 __wl1271_op_remove_interface(wl, false);
Ido Yarivbaacb9a2011-06-06 14:57:05 +03001255
1256 clear_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags);
1257
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +02001258 ieee80211_restart_hw(wl->hw);
1259
Arik Nemtsov7dece1c2011-04-18 14:15:28 +03001260 /*
1261 * Its safe to enable TX now - the queues are stopped after a request
1262 * to restart the HW.
1263 */
1264 ieee80211_wake_queues(wl->hw);
1265
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +02001266out:
1267 mutex_unlock(&wl->mutex);
1268}
1269
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001270static void wl1271_fw_wakeup(struct wl1271 *wl)
1271{
1272 u32 elp_reg;
1273
1274 elp_reg = ELPCTRL_WAKE_UP;
Juuso Oikarinen74621412009-10-12 15:08:54 +03001275 wl1271_raw_write32(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, elp_reg);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001276}
1277
1278static int wl1271_setup(struct wl1271 *wl)
1279{
1280 wl->fw_status = kmalloc(sizeof(*wl->fw_status), GFP_KERNEL);
1281 if (!wl->fw_status)
1282 return -ENOMEM;
1283
1284 wl->tx_res_if = kmalloc(sizeof(*wl->tx_res_if), GFP_KERNEL);
1285 if (!wl->tx_res_if) {
1286 kfree(wl->fw_status);
1287 return -ENOMEM;
1288 }
1289
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001290 return 0;
1291}
1292
1293static int wl1271_chip_wakeup(struct wl1271 *wl)
1294{
Juuso Oikarinen451de972009-10-12 15:08:46 +03001295 struct wl1271_partition_set partition;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001296 int ret = 0;
1297
Juuso Oikarinen01ac17e2009-12-11 15:41:02 +02001298 msleep(WL1271_PRE_POWER_ON_SLEEP);
Ohad Ben-Cohen2cc78ff2010-09-16 01:22:04 +02001299 ret = wl1271_power_on(wl);
1300 if (ret < 0)
1301 goto out;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001302 msleep(WL1271_POWER_ON_SLEEP);
Teemu Paasikivi9b280722010-02-18 13:25:56 +02001303 wl1271_io_reset(wl);
1304 wl1271_io_init(wl);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001305
1306 /* We don't need a real memory partition here, because we only want
1307 * to use the registers at this point. */
Juuso Oikarinen451de972009-10-12 15:08:46 +03001308 memset(&partition, 0, sizeof(partition));
1309 partition.reg.start = REGISTERS_BASE;
1310 partition.reg.size = REGISTERS_DOWN_SIZE;
1311 wl1271_set_partition(wl, &partition);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001312
1313 /* ELP module wake up */
1314 wl1271_fw_wakeup(wl);
1315
1316 /* whal_FwCtrl_BootSm() */
1317
1318 /* 0. read chip id from CHIP_ID */
Teemu Paasikivi7b048c52010-02-18 13:25:55 +02001319 wl->chip.id = wl1271_read32(wl, CHIP_ID_B);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001320
1321 /* 1. check if chip id is valid */
1322
1323 switch (wl->chip.id) {
1324 case CHIP_ID_1271_PG10:
1325 wl1271_warning("chip id 0x%x (1271 PG10) support is obsolete",
1326 wl->chip.id);
1327
1328 ret = wl1271_setup(wl);
1329 if (ret < 0)
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001330 goto out;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001331 break;
1332 case CHIP_ID_1271_PG20:
1333 wl1271_debug(DEBUG_BOOT, "chip id 0x%x (1271 PG20)",
1334 wl->chip.id);
1335
Shahar Levi0c005042011-06-12 10:34:43 +03001336 /*
1337 * 'end-of-transaction flag' and 'LPD mode flag'
1338 * should be set in wl127x AP mode only
1339 */
Shahar Levi564f5952011-04-04 10:20:39 +03001340 if (wl->bss_type == BSS_TYPE_AP_BSS)
Shahar Levi0c005042011-06-12 10:34:43 +03001341 wl->quirks |= (WL12XX_QUIRK_END_OF_TRANSACTION |
1342 WL12XX_QUIRK_LPD_MODE);
Shahar Levi564f5952011-04-04 10:20:39 +03001343
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001344 ret = wl1271_setup(wl);
1345 if (ret < 0)
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001346 goto out;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001347 break;
Shahar Levi0830cee2011-03-06 16:32:20 +02001348 case CHIP_ID_1283_PG20:
1349 wl1271_debug(DEBUG_BOOT, "chip id 0x%x (1283 PG20)",
1350 wl->chip.id);
1351
1352 ret = wl1271_setup(wl);
1353 if (ret < 0)
1354 goto out;
Shahar Levi0c005042011-06-12 10:34:43 +03001355
Ido Yariv0da13da2011-03-31 10:06:58 +02001356 if (wl1271_set_block_size(wl))
1357 wl->quirks |= WL12XX_QUIRK_BLOCKSIZE_ALIGNMENT;
Shahar Levi0830cee2011-03-06 16:32:20 +02001358 break;
1359 case CHIP_ID_1283_PG10:
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001360 default:
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001361 wl1271_warning("unsupported chip id: 0x%x", wl->chip.id);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001362 ret = -ENODEV;
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001363 goto out;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001364 }
1365
Arik Nemtsovc302b2c2011-08-17 10:45:48 +03001366 if (wl->fw == NULL) {
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001367 ret = wl1271_fetch_firmware(wl);
1368 if (ret < 0)
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001369 goto out;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001370 }
1371
1372 /* No NVS from netlink, try to get it from the filesystem */
1373 if (wl->nvs == NULL) {
1374 ret = wl1271_fetch_nvs(wl);
1375 if (ret < 0)
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001376 goto out;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001377 }
1378
1379out:
1380 return ret;
1381}
1382
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001383int wl1271_plt_start(struct wl1271 *wl)
1384{
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001385 int retries = WL1271_BOOT_RETRIES;
Gery Kahn6f07b722011-07-18 14:21:49 +03001386 struct wiphy *wiphy = wl->hw->wiphy;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001387 int ret;
1388
1389 mutex_lock(&wl->mutex);
1390
1391 wl1271_notice("power up");
1392
1393 if (wl->state != WL1271_STATE_OFF) {
1394 wl1271_error("cannot go into PLT state because not "
1395 "in off state: %d", wl->state);
1396 ret = -EBUSY;
1397 goto out;
1398 }
1399
Arik Nemtsov166d5042010-10-16 21:44:57 +02001400 wl->bss_type = BSS_TYPE_STA_BSS;
1401
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001402 while (retries) {
1403 retries--;
1404 ret = wl1271_chip_wakeup(wl);
1405 if (ret < 0)
1406 goto power_off;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001407
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001408 ret = wl1271_boot(wl);
1409 if (ret < 0)
1410 goto power_off;
1411
1412 ret = wl1271_plt_init(wl);
1413 if (ret < 0)
1414 goto irq_disable;
1415
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001416 wl->state = WL1271_STATE_PLT;
1417 wl1271_notice("firmware booted in PLT mode (%s)",
Levi, Shahar4b7fac72011-01-23 07:27:22 +01001418 wl->chip.fw_ver_str);
Luciano Coelhoe7ddf542011-03-10 15:24:57 +02001419
Gery Kahn6f07b722011-07-18 14:21:49 +03001420 /* update hw/fw version info in wiphy struct */
1421 wiphy->hw_version = wl->chip.id;
1422 strncpy(wiphy->fw_version, wl->chip.fw_ver_str,
1423 sizeof(wiphy->fw_version));
1424
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001425 goto out;
1426
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001427irq_disable:
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001428 mutex_unlock(&wl->mutex);
1429 /* Unlocking the mutex in the middle of handling is
1430 inherently unsafe. In this case we deem it safe to do,
1431 because we need to let any possibly pending IRQ out of
1432 the system (and while we are WL1271_STATE_OFF the IRQ
1433 work function will not do anything.) Also, any other
1434 possible concurrent operations will fail due to the
1435 current state, hence the wl1271 struct should be safe. */
Ido Yariva6208652011-03-01 15:14:41 +02001436 wl1271_disable_interrupts(wl);
1437 wl1271_flush_deferred_work(wl);
1438 cancel_work_sync(&wl->netstack_work);
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001439 mutex_lock(&wl->mutex);
1440power_off:
1441 wl1271_power_off(wl);
1442 }
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001443
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001444 wl1271_error("firmware boot in PLT mode failed despite %d retries",
1445 WL1271_BOOT_RETRIES);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001446out:
1447 mutex_unlock(&wl->mutex);
1448
1449 return ret;
1450}
1451
Luciano Coelho4623ec72011-03-21 19:26:41 +02001452static int __wl1271_plt_stop(struct wl1271 *wl)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001453{
1454 int ret = 0;
1455
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001456 wl1271_notice("power down");
1457
1458 if (wl->state != WL1271_STATE_PLT) {
1459 wl1271_error("cannot power down because not in PLT "
1460 "state: %d", wl->state);
1461 ret = -EBUSY;
1462 goto out;
1463 }
1464
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001465 wl1271_power_off(wl);
1466
1467 wl->state = WL1271_STATE_OFF;
Luciano Coelhobd5ea182009-10-13 12:47:58 +03001468 wl->rx_counter = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001469
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001470 mutex_unlock(&wl->mutex);
Ido Yariva6208652011-03-01 15:14:41 +02001471 wl1271_disable_interrupts(wl);
1472 wl1271_flush_deferred_work(wl);
1473 cancel_work_sync(&wl->netstack_work);
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +02001474 cancel_work_sync(&wl->recovery_work);
Juuso Oikarinen4ae3fa82011-01-14 12:48:46 +01001475 mutex_lock(&wl->mutex);
1476out:
1477 return ret;
1478}
Juuso Oikarinen8c7f4f32010-09-21 06:23:29 +02001479
Juuso Oikarinen4ae3fa82011-01-14 12:48:46 +01001480int wl1271_plt_stop(struct wl1271 *wl)
1481{
1482 int ret;
1483
1484 mutex_lock(&wl->mutex);
1485 ret = __wl1271_plt_stop(wl);
1486 mutex_unlock(&wl->mutex);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001487 return ret;
1488}
1489
Johannes Berg7bb45682011-02-24 14:42:06 +01001490static void wl1271_op_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001491{
1492 struct wl1271 *wl = hw->priv;
Juuso Oikarinen830fb672009-12-11 15:41:06 +02001493 unsigned long flags;
Arik Nemtsov708bb3c2011-06-24 13:03:37 +03001494 int q, mapping;
Arik Nemtsova8c0ddb2011-02-23 00:22:26 +02001495 u8 hlid = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001496
Arik Nemtsov708bb3c2011-06-24 13:03:37 +03001497 mapping = skb_get_queue_mapping(skb);
1498 q = wl1271_tx_get_queue(mapping);
Ido Yarivb07d4032011-03-01 15:14:43 +02001499
1500 if (wl->bss_type == BSS_TYPE_AP_BSS)
Eliad Pellerf4df1bd2011-08-14 13:17:15 +03001501 hlid = wl12xx_tx_get_hlid_ap(wl, skb);
Ido Yarivb07d4032011-03-01 15:14:43 +02001502
Juuso Oikarinen830fb672009-12-11 15:41:06 +02001503 spin_lock_irqsave(&wl->wl_lock, flags);
Ido Yarivb07d4032011-03-01 15:14:43 +02001504
Juuso Oikarinen830fb672009-12-11 15:41:06 +02001505 /* queue the packet */
Arik Nemtsova8c0ddb2011-02-23 00:22:26 +02001506 if (wl->bss_type == BSS_TYPE_AP_BSS) {
Arik Nemtsov04216da2011-08-14 13:17:38 +03001507 if (!wl1271_is_active_sta(wl, hlid)) {
1508 wl1271_debug(DEBUG_TX, "DROP skb hlid %d q %d",
1509 hlid, q);
1510 dev_kfree_skb(skb);
1511 goto out;
1512 }
1513
Arik Nemtsova8c0ddb2011-02-23 00:22:26 +02001514 wl1271_debug(DEBUG_TX, "queue skb hlid %d q %d", hlid, q);
1515 skb_queue_tail(&wl->links[hlid].tx_queue[q], skb);
1516 } else {
1517 skb_queue_tail(&wl->tx_queue[q], skb);
1518 }
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001519
Arik Nemtsov04b4d692011-08-14 13:17:39 +03001520 wl->tx_queue_count[q]++;
1521
1522 /*
1523 * The workqueue is slow to process the tx_queue and we need stop
1524 * the queue here, otherwise the queue will get too long.
1525 */
1526 if (wl->tx_queue_count[q] >= WL1271_TX_QUEUE_HIGH_WATERMARK) {
1527 wl1271_debug(DEBUG_TX, "op_tx: stopping queues for q %d", q);
1528 ieee80211_stop_queue(wl->hw, mapping);
1529 set_bit(q, &wl->stopped_queues_map);
1530 }
1531
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001532 /*
1533 * The chip specific setup must run before the first TX packet -
1534 * before that, the tx_work will not be initialized!
1535 */
1536
Ido Yarivb07d4032011-03-01 15:14:43 +02001537 if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
1538 !test_bit(WL1271_FLAG_TX_PENDING, &wl->flags))
Ido Yariva5225502010-10-12 14:49:10 +02001539 ieee80211_queue_work(wl->hw, &wl->tx_work);
Ido Yarivb07d4032011-03-01 15:14:43 +02001540
Arik Nemtsov04216da2011-08-14 13:17:38 +03001541out:
Ido Yarivb07d4032011-03-01 15:14:43 +02001542 spin_unlock_irqrestore(&wl->wl_lock, flags);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001543}
1544
Shahar Leviae47c452011-03-06 16:32:14 +02001545int wl1271_tx_dummy_packet(struct wl1271 *wl)
1546{
Ido Yariv990f5de2011-03-31 10:06:59 +02001547 unsigned long flags;
Arik Nemtsov14623782011-08-28 15:11:57 +03001548 int q;
1549
1550 /* no need to queue a new dummy packet if one is already pending */
1551 if (test_bit(WL1271_FLAG_DUMMY_PACKET_PENDING, &wl->flags))
1552 return 0;
1553
1554 q = wl1271_tx_get_queue(skb_get_queue_mapping(wl->dummy_packet));
Shahar Leviae47c452011-03-06 16:32:14 +02001555
Ido Yariv990f5de2011-03-31 10:06:59 +02001556 spin_lock_irqsave(&wl->wl_lock, flags);
1557 set_bit(WL1271_FLAG_DUMMY_PACKET_PENDING, &wl->flags);
Arik Nemtsovf1a46382011-07-07 14:25:23 +03001558 wl->tx_queue_count[q]++;
Ido Yariv990f5de2011-03-31 10:06:59 +02001559 spin_unlock_irqrestore(&wl->wl_lock, flags);
1560
1561 /* The FW is low on RX memory blocks, so send the dummy packet asap */
1562 if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags))
1563 wl1271_tx_work_locked(wl);
1564
1565 /*
1566 * If the FW TX is busy, TX work will be scheduled by the threaded
1567 * interrupt handler function
1568 */
1569 return 0;
1570}
1571
1572/*
1573 * The size of the dummy packet should be at least 1400 bytes. However, in
1574 * order to minimize the number of bus transactions, aligning it to 512 bytes
1575 * boundaries could be beneficial, performance wise
1576 */
1577#define TOTAL_TX_DUMMY_PACKET_SIZE (ALIGN(1400, 512))
1578
Luciano Coelhocf27d862011-04-01 21:08:23 +03001579static struct sk_buff *wl12xx_alloc_dummy_packet(struct wl1271 *wl)
Ido Yariv990f5de2011-03-31 10:06:59 +02001580{
1581 struct sk_buff *skb;
1582 struct ieee80211_hdr_3addr *hdr;
1583 unsigned int dummy_packet_size;
1584
1585 dummy_packet_size = TOTAL_TX_DUMMY_PACKET_SIZE -
1586 sizeof(struct wl1271_tx_hw_descr) - sizeof(*hdr);
1587
1588 skb = dev_alloc_skb(TOTAL_TX_DUMMY_PACKET_SIZE);
Shahar Leviae47c452011-03-06 16:32:14 +02001589 if (!skb) {
Ido Yariv990f5de2011-03-31 10:06:59 +02001590 wl1271_warning("Failed to allocate a dummy packet skb");
1591 return NULL;
Shahar Leviae47c452011-03-06 16:32:14 +02001592 }
1593
1594 skb_reserve(skb, sizeof(struct wl1271_tx_hw_descr));
1595
1596 hdr = (struct ieee80211_hdr_3addr *) skb_put(skb, sizeof(*hdr));
1597 memset(hdr, 0, sizeof(*hdr));
1598 hdr->frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA |
Ido Yariv990f5de2011-03-31 10:06:59 +02001599 IEEE80211_STYPE_NULLFUNC |
1600 IEEE80211_FCTL_TODS);
Shahar Leviae47c452011-03-06 16:32:14 +02001601
Ido Yariv990f5de2011-03-31 10:06:59 +02001602 memset(skb_put(skb, dummy_packet_size), 0, dummy_packet_size);
Shahar Leviae47c452011-03-06 16:32:14 +02001603
Luciano Coelho18b92ff2011-03-21 16:35:21 +02001604 /* Dummy packets require the TID to be management */
1605 skb->priority = WL1271_TID_MGMT;
Ido Yariv990f5de2011-03-31 10:06:59 +02001606
1607 /* Initialize all fields that might be used */
Hauke Mehrtens86c438f2011-04-26 23:27:44 +02001608 skb_set_queue_mapping(skb, 0);
Ido Yariv990f5de2011-03-31 10:06:59 +02001609 memset(IEEE80211_SKB_CB(skb), 0, sizeof(struct ieee80211_tx_info));
Shahar Leviae47c452011-03-06 16:32:14 +02001610
Ido Yariv990f5de2011-03-31 10:06:59 +02001611 return skb;
Shahar Leviae47c452011-03-06 16:32:14 +02001612}
1613
Ido Yariv990f5de2011-03-31 10:06:59 +02001614
Juuso Oikarinenc2c192a2010-07-27 03:30:09 +03001615static struct notifier_block wl1271_dev_notifier = {
1616 .notifier_call = wl1271_dev_notify,
1617};
1618
Luciano Coelhof634a4e2011-05-18 16:51:26 -04001619#ifdef CONFIG_PM
Eliad Peller8a7cf3f2011-06-06 12:21:54 +03001620static int wl1271_configure_suspend_sta(struct wl1271 *wl)
Eliad Peller94390642011-05-13 11:57:13 +03001621{
Eliad Pellere85d1622011-06-27 13:06:43 +03001622 int ret = 0;
Eliad Peller94390642011-05-13 11:57:13 +03001623
Eliad Peller94390642011-05-13 11:57:13 +03001624 mutex_lock(&wl->mutex);
1625
Eliad Pellere85d1622011-06-27 13:06:43 +03001626 if (!test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
1627 goto out_unlock;
1628
Eliad Peller94390642011-05-13 11:57:13 +03001629 ret = wl1271_ps_elp_wakeup(wl);
1630 if (ret < 0)
1631 goto out_unlock;
1632
1633 /* enter psm if needed*/
1634 if (!test_bit(WL1271_FLAG_PSM, &wl->flags)) {
1635 DECLARE_COMPLETION_ONSTACK(compl);
1636
1637 wl->ps_compl = &compl;
1638 ret = wl1271_ps_set_mode(wl, STATION_POWER_SAVE_MODE,
1639 wl->basic_rate, true);
1640 if (ret < 0)
1641 goto out_sleep;
1642
1643 /* we must unlock here so we will be able to get events */
1644 wl1271_ps_elp_sleep(wl);
1645 mutex_unlock(&wl->mutex);
1646
1647 ret = wait_for_completion_timeout(
1648 &compl, msecs_to_jiffies(WL1271_PS_COMPLETE_TIMEOUT));
1649 if (ret <= 0) {
1650 wl1271_warning("couldn't enter ps mode!");
1651 ret = -EBUSY;
1652 goto out;
1653 }
1654
1655 /* take mutex again, and wakeup */
1656 mutex_lock(&wl->mutex);
1657
1658 ret = wl1271_ps_elp_wakeup(wl);
1659 if (ret < 0)
1660 goto out_unlock;
1661 }
1662out_sleep:
1663 wl1271_ps_elp_sleep(wl);
1664out_unlock:
1665 mutex_unlock(&wl->mutex);
1666out:
1667 return ret;
1668
1669}
1670
Eliad Peller8a7cf3f2011-06-06 12:21:54 +03001671static int wl1271_configure_suspend_ap(struct wl1271 *wl)
Eliad Peller94390642011-05-13 11:57:13 +03001672{
Eliad Pellere85d1622011-06-27 13:06:43 +03001673 int ret = 0;
Eliad Peller94390642011-05-13 11:57:13 +03001674
Eliad Peller8a7cf3f2011-06-06 12:21:54 +03001675 mutex_lock(&wl->mutex);
1676
Eliad Pellere85d1622011-06-27 13:06:43 +03001677 if (!test_bit(WL1271_FLAG_AP_STARTED, &wl->flags))
1678 goto out_unlock;
1679
Eliad Peller8a7cf3f2011-06-06 12:21:54 +03001680 ret = wl1271_ps_elp_wakeup(wl);
1681 if (ret < 0)
1682 goto out_unlock;
1683
Eliad Pellerf42bd2c2011-08-14 13:17:13 +03001684 ret = wl1271_acx_beacon_filter_opt(wl, true);
Eliad Peller8a7cf3f2011-06-06 12:21:54 +03001685
1686 wl1271_ps_elp_sleep(wl);
1687out_unlock:
1688 mutex_unlock(&wl->mutex);
1689 return ret;
1690
1691}
1692
1693static int wl1271_configure_suspend(struct wl1271 *wl)
1694{
1695 if (wl->bss_type == BSS_TYPE_STA_BSS)
1696 return wl1271_configure_suspend_sta(wl);
1697 if (wl->bss_type == BSS_TYPE_AP_BSS)
1698 return wl1271_configure_suspend_ap(wl);
1699 return 0;
1700}
1701
1702static void wl1271_configure_resume(struct wl1271 *wl)
1703{
1704 int ret;
1705 bool is_sta = wl->bss_type == BSS_TYPE_STA_BSS;
1706 bool is_ap = wl->bss_type == BSS_TYPE_AP_BSS;
1707
1708 if (!is_sta && !is_ap)
Eliad Peller94390642011-05-13 11:57:13 +03001709 return;
1710
1711 mutex_lock(&wl->mutex);
1712 ret = wl1271_ps_elp_wakeup(wl);
1713 if (ret < 0)
1714 goto out;
1715
Eliad Peller8a7cf3f2011-06-06 12:21:54 +03001716 if (is_sta) {
1717 /* exit psm if it wasn't configured */
1718 if (!test_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags))
1719 wl1271_ps_set_mode(wl, STATION_ACTIVE_MODE,
1720 wl->basic_rate, true);
1721 } else if (is_ap) {
Eliad Pellerf42bd2c2011-08-14 13:17:13 +03001722 wl1271_acx_beacon_filter_opt(wl, false);
Eliad Peller8a7cf3f2011-06-06 12:21:54 +03001723 }
Eliad Peller94390642011-05-13 11:57:13 +03001724
1725 wl1271_ps_elp_sleep(wl);
1726out:
1727 mutex_unlock(&wl->mutex);
1728}
1729
Eliad Peller402e48612011-05-13 11:57:09 +03001730static int wl1271_op_suspend(struct ieee80211_hw *hw,
1731 struct cfg80211_wowlan *wow)
1732{
1733 struct wl1271 *wl = hw->priv;
Eliad Peller4a859df2011-06-06 12:21:52 +03001734 int ret;
1735
Eliad Peller402e48612011-05-13 11:57:09 +03001736 wl1271_debug(DEBUG_MAC80211, "mac80211 suspend wow=%d", !!wow);
Eliad Peller4a859df2011-06-06 12:21:52 +03001737 WARN_ON(!wow || !wow->any);
Eliad Pellerf44e5862011-05-13 11:57:11 +03001738
Eliad Peller4a859df2011-06-06 12:21:52 +03001739 wl->wow_enabled = true;
1740 ret = wl1271_configure_suspend(wl);
1741 if (ret < 0) {
1742 wl1271_warning("couldn't prepare device to suspend");
1743 return ret;
Eliad Pellerf44e5862011-05-13 11:57:11 +03001744 }
Eliad Peller4a859df2011-06-06 12:21:52 +03001745 /* flush any remaining work */
1746 wl1271_debug(DEBUG_MAC80211, "flushing remaining works");
Eliad Peller4a859df2011-06-06 12:21:52 +03001747
1748 /*
1749 * disable and re-enable interrupts in order to flush
1750 * the threaded_irq
1751 */
1752 wl1271_disable_interrupts(wl);
1753
1754 /*
1755 * set suspended flag to avoid triggering a new threaded_irq
1756 * work. no need for spinlock as interrupts are disabled.
1757 */
1758 set_bit(WL1271_FLAG_SUSPENDED, &wl->flags);
1759
1760 wl1271_enable_interrupts(wl);
1761 flush_work(&wl->tx_work);
1762 flush_delayed_work(&wl->pspoll_work);
1763 flush_delayed_work(&wl->elp_work);
1764
Eliad Peller402e48612011-05-13 11:57:09 +03001765 return 0;
1766}
1767
1768static int wl1271_op_resume(struct ieee80211_hw *hw)
1769{
1770 struct wl1271 *wl = hw->priv;
Eliad Peller4a859df2011-06-06 12:21:52 +03001771 unsigned long flags;
1772 bool run_irq_work = false;
1773
Eliad Peller402e48612011-05-13 11:57:09 +03001774 wl1271_debug(DEBUG_MAC80211, "mac80211 resume wow=%d",
1775 wl->wow_enabled);
Eliad Peller4a859df2011-06-06 12:21:52 +03001776 WARN_ON(!wl->wow_enabled);
Eliad Pellerf44e5862011-05-13 11:57:11 +03001777
1778 /*
1779 * re-enable irq_work enqueuing, and call irq_work directly if
1780 * there is a pending work.
1781 */
Eliad Peller4a859df2011-06-06 12:21:52 +03001782 spin_lock_irqsave(&wl->wl_lock, flags);
1783 clear_bit(WL1271_FLAG_SUSPENDED, &wl->flags);
1784 if (test_and_clear_bit(WL1271_FLAG_PENDING_WORK, &wl->flags))
1785 run_irq_work = true;
1786 spin_unlock_irqrestore(&wl->wl_lock, flags);
Eliad Pellerf44e5862011-05-13 11:57:11 +03001787
Eliad Peller4a859df2011-06-06 12:21:52 +03001788 if (run_irq_work) {
1789 wl1271_debug(DEBUG_MAC80211,
1790 "run postponed irq_work directly");
1791 wl1271_irq(0, wl);
1792 wl1271_enable_interrupts(wl);
Eliad Pellerf44e5862011-05-13 11:57:11 +03001793 }
Eliad Peller4a859df2011-06-06 12:21:52 +03001794 wl1271_configure_resume(wl);
Eliad Pellerff91afc2011-06-06 12:21:53 +03001795 wl->wow_enabled = false;
Eliad Pellerf44e5862011-05-13 11:57:11 +03001796
Eliad Peller402e48612011-05-13 11:57:09 +03001797 return 0;
1798}
Luciano Coelhof634a4e2011-05-18 16:51:26 -04001799#endif
Eliad Peller402e48612011-05-13 11:57:09 +03001800
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001801static int wl1271_op_start(struct ieee80211_hw *hw)
1802{
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001803 wl1271_debug(DEBUG_MAC80211, "mac80211 start");
1804
1805 /*
1806 * We have to delay the booting of the hardware because
1807 * we need to know the local MAC address before downloading and
1808 * initializing the firmware. The MAC address cannot be changed
1809 * after boot, and without the proper MAC address, the firmware
1810 * will not function properly.
1811 *
1812 * The MAC address is first known when the corresponding interface
1813 * is added. That is where we will initialize the hardware.
1814 */
1815
1816 return 0;
1817}
1818
1819static void wl1271_op_stop(struct ieee80211_hw *hw)
1820{
1821 wl1271_debug(DEBUG_MAC80211, "mac80211 stop");
1822}
1823
Eliad Pellerb78b47e2011-08-14 13:17:08 +03001824static u8 wl12xx_get_role_type(struct wl1271 *wl)
1825{
1826 switch (wl->bss_type) {
1827 case BSS_TYPE_AP_BSS:
Eliad Peller045c7452011-08-28 15:23:01 +03001828 if (wl->p2p)
1829 return WL1271_ROLE_P2P_GO;
1830 else
1831 return WL1271_ROLE_AP;
Eliad Pellerb78b47e2011-08-14 13:17:08 +03001832
1833 case BSS_TYPE_STA_BSS:
Eliad Peller045c7452011-08-28 15:23:01 +03001834 if (wl->p2p)
1835 return WL1271_ROLE_P2P_CL;
1836 else
1837 return WL1271_ROLE_STA;
Eliad Pellerb78b47e2011-08-14 13:17:08 +03001838
Eliad Peller227e81e2011-08-14 13:17:26 +03001839 case BSS_TYPE_IBSS:
1840 return WL1271_ROLE_IBSS;
1841
Eliad Pellerb78b47e2011-08-14 13:17:08 +03001842 default:
1843 wl1271_error("invalid bss_type: %d", wl->bss_type);
1844 }
1845 return WL12XX_INVALID_ROLE_TYPE;
1846}
1847
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001848static int wl1271_op_add_interface(struct ieee80211_hw *hw,
1849 struct ieee80211_vif *vif)
1850{
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001851 struct wl1271 *wl = hw->priv;
John W. Linvilleac01e942010-07-28 17:09:41 -04001852 struct wiphy *wiphy = hw->wiphy;
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001853 int retries = WL1271_BOOT_RETRIES;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001854 int ret = 0;
Eliad Pellerb78b47e2011-08-14 13:17:08 +03001855 u8 role_type;
Eliad Peller71125ab2010-10-28 21:46:43 +02001856 bool booted = false;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001857
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001858 wl1271_debug(DEBUG_MAC80211, "mac80211 add interface type %d mac %pM",
Eliad Peller045c7452011-08-28 15:23:01 +03001859 ieee80211_vif_type_p2p(vif), vif->addr);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001860
1861 mutex_lock(&wl->mutex);
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001862 if (wl->vif) {
Eliad Peller71125ab2010-10-28 21:46:43 +02001863 wl1271_debug(DEBUG_MAC80211,
1864 "multiple vifs are not supported yet");
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001865 ret = -EBUSY;
1866 goto out;
1867 }
1868
Juuso Oikarinen13026de2011-03-29 16:43:50 +03001869 /*
1870 * in some very corner case HW recovery scenarios its possible to
1871 * get here before __wl1271_op_remove_interface is complete, so
1872 * opt out if that is the case.
1873 */
1874 if (test_bit(WL1271_FLAG_IF_INITIALIZED, &wl->flags)) {
1875 ret = -EBUSY;
1876 goto out;
1877 }
1878
Eliad Peller045c7452011-08-28 15:23:01 +03001879 switch (ieee80211_vif_type_p2p(vif)) {
1880 case NL80211_IFTYPE_P2P_CLIENT:
1881 wl->p2p = 1;
1882 /* fall-through */
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001883 case NL80211_IFTYPE_STATION:
1884 wl->bss_type = BSS_TYPE_STA_BSS;
Juuso Oikarinen5da11dc2010-03-26 12:53:24 +02001885 wl->set_bss_type = BSS_TYPE_STA_BSS;
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001886 break;
1887 case NL80211_IFTYPE_ADHOC:
1888 wl->bss_type = BSS_TYPE_IBSS;
Juuso Oikarinen5da11dc2010-03-26 12:53:24 +02001889 wl->set_bss_type = BSS_TYPE_STA_BSS;
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001890 break;
Eliad Peller045c7452011-08-28 15:23:01 +03001891 case NL80211_IFTYPE_P2P_GO:
1892 wl->p2p = 1;
1893 /* fall-through */
Arik Nemtsov038d9252010-10-16 21:53:24 +02001894 case NL80211_IFTYPE_AP:
1895 wl->bss_type = BSS_TYPE_AP_BSS;
1896 break;
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001897 default:
1898 ret = -EOPNOTSUPP;
1899 goto out;
1900 }
1901
Eliad Pellerb78b47e2011-08-14 13:17:08 +03001902 role_type = wl12xx_get_role_type(wl);
1903 if (role_type == WL12XX_INVALID_ROLE_TYPE) {
1904 ret = -EINVAL;
1905 goto out;
1906 }
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02001907 memcpy(wl->mac_addr, vif->addr, ETH_ALEN);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001908
1909 if (wl->state != WL1271_STATE_OFF) {
1910 wl1271_error("cannot start because not in off state: %d",
1911 wl->state);
1912 ret = -EBUSY;
1913 goto out;
1914 }
1915
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001916 while (retries) {
1917 retries--;
1918 ret = wl1271_chip_wakeup(wl);
1919 if (ret < 0)
1920 goto power_off;
1921
1922 ret = wl1271_boot(wl);
1923 if (ret < 0)
1924 goto power_off;
1925
Eliad Peller227e81e2011-08-14 13:17:26 +03001926 if (wl->bss_type == BSS_TYPE_STA_BSS ||
1927 wl->bss_type == BSS_TYPE_IBSS) {
Eliad Peller04e80792011-08-14 13:17:09 +03001928 /*
1929 * The device role is a special role used for
1930 * rx and tx frames prior to association (as
1931 * the STA role can get packets only from
1932 * its associated bssid)
1933 */
1934 ret = wl12xx_cmd_role_enable(wl,
1935 WL1271_ROLE_DEVICE,
1936 &wl->dev_role_id);
1937 if (ret < 0)
1938 goto irq_disable;
1939 }
1940
Eliad Pellerb78b47e2011-08-14 13:17:08 +03001941 ret = wl12xx_cmd_role_enable(wl, role_type, &wl->role_id);
1942 if (ret < 0)
1943 goto irq_disable;
1944
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001945 ret = wl1271_hw_init(wl);
1946 if (ret < 0)
1947 goto irq_disable;
1948
Eliad Peller71125ab2010-10-28 21:46:43 +02001949 booted = true;
1950 break;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001951
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001952irq_disable:
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001953 mutex_unlock(&wl->mutex);
1954 /* Unlocking the mutex in the middle of handling is
1955 inherently unsafe. In this case we deem it safe to do,
1956 because we need to let any possibly pending IRQ out of
1957 the system (and while we are WL1271_STATE_OFF the IRQ
1958 work function will not do anything.) Also, any other
1959 possible concurrent operations will fail due to the
1960 current state, hence the wl1271 struct should be safe. */
Ido Yariva6208652011-03-01 15:14:41 +02001961 wl1271_disable_interrupts(wl);
1962 wl1271_flush_deferred_work(wl);
1963 cancel_work_sync(&wl->netstack_work);
Juuso Oikarinen9ccd9212009-12-11 15:41:01 +02001964 mutex_lock(&wl->mutex);
1965power_off:
1966 wl1271_power_off(wl);
1967 }
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001968
Eliad Peller71125ab2010-10-28 21:46:43 +02001969 if (!booted) {
1970 wl1271_error("firmware boot failed despite %d retries",
1971 WL1271_BOOT_RETRIES);
1972 goto out;
1973 }
1974
1975 wl->vif = vif;
1976 wl->state = WL1271_STATE_ON;
Juuso Oikarinen13026de2011-03-29 16:43:50 +03001977 set_bit(WL1271_FLAG_IF_INITIALIZED, &wl->flags);
Levi, Shahar4b7fac72011-01-23 07:27:22 +01001978 wl1271_info("firmware booted (%s)", wl->chip.fw_ver_str);
Eliad Peller71125ab2010-10-28 21:46:43 +02001979
1980 /* update hw/fw version info in wiphy struct */
1981 wiphy->hw_version = wl->chip.id;
Levi, Shahar4b7fac72011-01-23 07:27:22 +01001982 strncpy(wiphy->fw_version, wl->chip.fw_ver_str,
Eliad Peller71125ab2010-10-28 21:46:43 +02001983 sizeof(wiphy->fw_version));
1984
Luciano Coelhofb6a6812010-12-03 17:05:40 +02001985 /*
1986 * Now we know if 11a is supported (info from the NVS), so disable
1987 * 11a channels if not supported
1988 */
1989 if (!wl->enable_11a)
1990 wiphy->bands[IEEE80211_BAND_5GHZ]->n_channels = 0;
1991
1992 wl1271_debug(DEBUG_MAC80211, "11a is %ssupported",
1993 wl->enable_11a ? "" : "not ");
1994
Juuso Oikarineneb5b28d2009-10-13 12:47:45 +03001995out:
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03001996 mutex_unlock(&wl->mutex);
1997
Juuso Oikarinenf9f774c2011-03-21 10:43:36 +02001998 mutex_lock(&wl_list_mutex);
Juuso Oikarineneb887df2010-07-08 17:49:58 +03001999 if (!ret)
Juuso Oikarinen01c09162009-10-13 12:47:55 +03002000 list_add(&wl->list, &wl_list);
Juuso Oikarinenf9f774c2011-03-21 10:43:36 +02002001 mutex_unlock(&wl_list_mutex);
Juuso Oikarinen01c09162009-10-13 12:47:55 +03002002
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002003 return ret;
2004}
2005
Arik Nemtsov7dece1c2011-04-18 14:15:28 +03002006static void __wl1271_op_remove_interface(struct wl1271 *wl,
2007 bool reset_tx_queues)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002008{
Arik Nemtsovbf54e302011-08-14 13:17:32 +03002009 int ret, i;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002010
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02002011 wl1271_debug(DEBUG_MAC80211, "mac80211 remove interface");
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002012
Juuso Oikarinen13026de2011-03-29 16:43:50 +03002013 /* because of hardware recovery, we may get here twice */
2014 if (wl->state != WL1271_STATE_ON)
2015 return;
2016
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02002017 wl1271_info("down");
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002018
Juuso Oikarinenf9f774c2011-03-21 10:43:36 +02002019 mutex_lock(&wl_list_mutex);
Juuso Oikarinen01c09162009-10-13 12:47:55 +03002020 list_del(&wl->list);
Juuso Oikarinenf9f774c2011-03-21 10:43:36 +02002021 mutex_unlock(&wl_list_mutex);
Juuso Oikarinen01c09162009-10-13 12:47:55 +03002022
Juuso Oikarinen8d2ef7b2010-07-08 17:50:03 +03002023 /* enable dyn ps just in case (if left on due to fw crash etc) */
Juuso Oikarinen9a547bf2010-07-08 17:50:04 +03002024 if (wl->bss_type == BSS_TYPE_STA_BSS)
Juuso Oikarinenf532be62010-07-08 17:50:05 +03002025 ieee80211_enable_dyn_ps(wl->vif);
Juuso Oikarinen8d2ef7b2010-07-08 17:50:03 +03002026
Luciano Coelho08688d62010-07-08 17:50:07 +03002027 if (wl->scan.state != WL1271_SCAN_STATE_IDLE) {
Luciano Coelho08688d62010-07-08 17:50:07 +03002028 wl->scan.state = WL1271_SCAN_STATE_IDLE;
Luciano Coelho4a31c112011-03-21 23:16:14 +02002029 memset(wl->scan.scanned_ch, 0, sizeof(wl->scan.scanned_ch));
Juuso Oikarinenb739a422010-10-26 13:24:38 +02002030 wl->scan.req = NULL;
Juuso Oikarinen76a029f2010-07-29 04:54:45 +03002031 ieee80211_scan_completed(wl->hw, true);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002032 }
2033
Eliad Pellerb78b47e2011-08-14 13:17:08 +03002034 if (!test_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags)) {
2035 /* disable active roles */
2036 ret = wl1271_ps_elp_wakeup(wl);
2037 if (ret < 0)
2038 goto deinit;
2039
Eliad Peller04e80792011-08-14 13:17:09 +03002040 if (wl->bss_type == BSS_TYPE_STA_BSS) {
2041 ret = wl12xx_cmd_role_disable(wl, &wl->dev_role_id);
2042 if (ret < 0)
2043 goto deinit;
2044 }
2045
Eliad Pellerb78b47e2011-08-14 13:17:08 +03002046 ret = wl12xx_cmd_role_disable(wl, &wl->role_id);
2047 if (ret < 0)
2048 goto deinit;
2049
2050 wl1271_ps_elp_sleep(wl);
2051 }
2052deinit:
Arik Nemtsove51ae9b2011-08-14 13:17:21 +03002053 /* clear all hlids (except system_hlid) */
Eliad Pellerb78b47e2011-08-14 13:17:08 +03002054 wl->sta_hlid = WL12XX_INVALID_LINK_ID;
Eliad Peller04e80792011-08-14 13:17:09 +03002055 wl->dev_hlid = WL12XX_INVALID_LINK_ID;
Arik Nemtsove51ae9b2011-08-14 13:17:21 +03002056 wl->ap_bcast_hlid = WL12XX_INVALID_LINK_ID;
2057 wl->ap_global_hlid = WL12XX_INVALID_LINK_ID;
Eliad Pellerb78b47e2011-08-14 13:17:08 +03002058
Juuso Oikarinen13026de2011-03-29 16:43:50 +03002059 /*
2060 * this must be before the cancel_work calls below, so that the work
2061 * functions don't perform further work.
2062 */
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002063 wl->state = WL1271_STATE_OFF;
2064
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002065 mutex_unlock(&wl->mutex);
2066
Ido Yariva6208652011-03-01 15:14:41 +02002067 wl1271_disable_interrupts(wl);
2068 wl1271_flush_deferred_work(wl);
Juuso Oikarinen78abd322010-09-21 06:23:32 +02002069 cancel_delayed_work_sync(&wl->scan_complete_work);
Ido Yariva6208652011-03-01 15:14:41 +02002070 cancel_work_sync(&wl->netstack_work);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002071 cancel_work_sync(&wl->tx_work);
Eliad Peller77ddaa12011-05-15 11:10:29 +03002072 del_timer_sync(&wl->rx_streaming_timer);
2073 cancel_work_sync(&wl->rx_streaming_enable_work);
2074 cancel_work_sync(&wl->rx_streaming_disable_work);
Juuso Oikarinen90494a92010-07-08 17:50:00 +03002075 cancel_delayed_work_sync(&wl->pspoll_work);
Juuso Oikarinen8c7f4f32010-09-21 06:23:29 +02002076 cancel_delayed_work_sync(&wl->elp_work);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002077
2078 mutex_lock(&wl->mutex);
2079
2080 /* let's notify MAC80211 about the remaining pending TX frames */
Arik Nemtsov7dece1c2011-04-18 14:15:28 +03002081 wl1271_tx_reset(wl, reset_tx_queues);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002082 wl1271_power_off(wl);
2083
2084 memset(wl->bssid, 0, ETH_ALEN);
Johannes Berg3b40c042011-07-13 10:39:16 +02002085 memset(wl->ssid, 0, IEEE80211_MAX_SSID_LEN + 1);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002086 wl->ssid_len = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002087 wl->bss_type = MAX_BSS_TYPE;
Juuso Oikarinen5da11dc2010-03-26 12:53:24 +02002088 wl->set_bss_type = MAX_BSS_TYPE;
Eliad Peller045c7452011-08-28 15:23:01 +03002089 wl->p2p = 0;
Juuso Oikarinen8a5a37a2009-10-08 21:56:24 +03002090 wl->band = IEEE80211_BAND_2GHZ;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002091
2092 wl->rx_counter = 0;
Juuso Oikarinen19ad0712009-11-02 20:22:11 +02002093 wl->psm_entry_retry = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002094 wl->power_level = WL1271_DEFAULT_POWER_LEVEL;
2095 wl->tx_blocks_available = 0;
Arik Nemtsov7bb5d6c2011-08-14 13:17:00 +03002096 wl->tx_allocated_blocks = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002097 wl->tx_results_count = 0;
2098 wl->tx_packets_count = 0;
2099 wl->time_offset = 0;
2100 wl->session_counter = 0;
Juuso Oikarinen830fb672009-12-11 15:41:06 +02002101 wl->rate_set = CONF_TX_RATE_MASK_BASIC;
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03002102 wl->bitrate_masks[IEEE80211_BAND_2GHZ] = wl->conf.tx.basic_rate;
2103 wl->bitrate_masks[IEEE80211_BAND_5GHZ] = wl->conf.tx.basic_rate_5;
Juuso Oikarinen1b72aec2010-03-18 12:26:39 +02002104 wl->vif = NULL;
Guy Eilame9eb8cb2011-08-16 19:49:12 +03002105 wl->tx_spare_blocks = TX_HW_BLOCK_SPARE_DEFAULT;
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002106 wl1271_free_ap_keys(wl);
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02002107 memset(wl->ap_hlid_map, 0, sizeof(wl->ap_hlid_map));
Arik Nemtsovb622d992011-02-23 00:22:31 +02002108 wl->ap_fw_ps_map = 0;
2109 wl->ap_ps_map = 0;
Luciano Coelho33c2c062011-05-10 14:46:02 +03002110 wl->sched_scanning = false;
Eliad Peller7f0979882011-08-14 13:17:06 +03002111 wl->role_id = WL12XX_INVALID_ROLE_ID;
Eliad Peller04e80792011-08-14 13:17:09 +03002112 wl->dev_role_id = WL12XX_INVALID_ROLE_ID;
Eliad Pellerc690ec82011-08-14 13:17:07 +03002113 memset(wl->roles_map, 0, sizeof(wl->roles_map));
2114 memset(wl->links_map, 0, sizeof(wl->links_map));
Eliad Peller251c1772011-08-14 13:17:17 +03002115 memset(wl->roc_map, 0, sizeof(wl->roc_map));
Arik Nemtsovda032092011-08-25 12:43:15 +03002116 wl->active_sta_count = 0;
Luciano Coelhod6e19d12009-10-12 15:08:43 +03002117
Eliad Pellerf4df1bd2011-08-14 13:17:15 +03002118 /* The system link is always allocated */
2119 __set_bit(WL12XX_SYSTEM_HLID, wl->links_map);
2120
Juuso Oikarinen13026de2011-03-29 16:43:50 +03002121 /*
2122 * this is performed after the cancel_work calls and the associated
2123 * mutex_lock, so that wl1271_op_add_interface does not accidentally
2124 * get executed before all these vars have been reset.
2125 */
2126 wl->flags = 0;
2127
Eliad Peller4d56ad92011-08-14 13:17:05 +03002128 wl->tx_blocks_freed = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002129
Arik Nemtsov742246f2011-08-14 13:17:33 +03002130 for (i = 0; i < NUM_TX_QUEUES; i++) {
Arik Nemtsovbf54e302011-08-14 13:17:32 +03002131 wl->tx_pkts_freed[i] = 0;
Arik Nemtsov742246f2011-08-14 13:17:33 +03002132 wl->tx_allocated_pkts[i] = 0;
2133 }
Arik Nemtsovbf54e302011-08-14 13:17:32 +03002134
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002135 wl1271_debugfs_reset(wl);
Juuso Oikarinenbd9dc492010-04-09 11:07:26 +03002136
2137 kfree(wl->fw_status);
2138 wl->fw_status = NULL;
2139 kfree(wl->tx_res_if);
2140 wl->tx_res_if = NULL;
2141 kfree(wl->target_mem_map);
2142 wl->target_mem_map = NULL;
Juuso Oikarinen52a2a372010-09-21 06:23:30 +02002143}
Juuso Oikarinenbd9dc492010-04-09 11:07:26 +03002144
Juuso Oikarinen52a2a372010-09-21 06:23:30 +02002145static void wl1271_op_remove_interface(struct ieee80211_hw *hw,
2146 struct ieee80211_vif *vif)
2147{
2148 struct wl1271 *wl = hw->priv;
2149
2150 mutex_lock(&wl->mutex);
Juuso Oikarinen67353292010-11-18 15:19:02 +02002151 /*
2152 * wl->vif can be null here if someone shuts down the interface
2153 * just when hardware recovery has been started.
2154 */
2155 if (wl->vif) {
2156 WARN_ON(wl->vif != vif);
Arik Nemtsov7dece1c2011-04-18 14:15:28 +03002157 __wl1271_op_remove_interface(wl, true);
Juuso Oikarinen67353292010-11-18 15:19:02 +02002158 }
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +02002159
Juuso Oikarinen67353292010-11-18 15:19:02 +02002160 mutex_unlock(&wl->mutex);
Juuso Oikarinen52b0e7a2010-09-21 06:23:31 +02002161 cancel_work_sync(&wl->recovery_work);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002162}
2163
Juuso Oikarinen69e54342010-05-07 11:39:00 +03002164static int wl1271_join(struct wl1271 *wl, bool set_assoc)
Juuso Oikarinen82429d32010-04-28 09:50:01 +03002165{
2166 int ret;
Eliad Peller227e81e2011-08-14 13:17:26 +03002167 bool is_ibss = (wl->bss_type == BSS_TYPE_IBSS);
Juuso Oikarinen82429d32010-04-28 09:50:01 +03002168
Juuso Oikarinen69e54342010-05-07 11:39:00 +03002169 /*
2170 * One of the side effects of the JOIN command is that is clears
2171 * WPA/WPA2 keys from the chipset. Performing a JOIN while associated
2172 * to a WPA/WPA2 access point will therefore kill the data-path.
Ohad Ben-Cohen8bf69aa2011-03-30 19:18:31 +02002173 * Currently the only valid scenario for JOIN during association
2174 * is on roaming, in which case we will also be given new keys.
2175 * Keep the below message for now, unless it starts bothering
2176 * users who really like to roam a lot :)
Juuso Oikarinen69e54342010-05-07 11:39:00 +03002177 */
2178 if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
2179 wl1271_info("JOIN while associated.");
2180
2181 if (set_assoc)
2182 set_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags);
2183
Eliad Peller227e81e2011-08-14 13:17:26 +03002184 if (is_ibss)
2185 ret = wl12xx_cmd_role_start_ibss(wl);
2186 else
2187 ret = wl12xx_cmd_role_start_sta(wl);
Juuso Oikarinen82429d32010-04-28 09:50:01 +03002188 if (ret < 0)
2189 goto out;
2190
Juuso Oikarinen82429d32010-04-28 09:50:01 +03002191 if (!test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
2192 goto out;
2193
2194 /*
2195 * The join command disable the keep-alive mode, shut down its process,
2196 * and also clear the template config, so we need to reset it all after
2197 * the join. The acx_aid starts the keep-alive process, and the order
2198 * of the commands below is relevant.
2199 */
2200 ret = wl1271_acx_keep_alive_mode(wl, true);
2201 if (ret < 0)
2202 goto out;
2203
2204 ret = wl1271_acx_aid(wl, wl->aid);
2205 if (ret < 0)
2206 goto out;
2207
2208 ret = wl1271_cmd_build_klv_null_data(wl);
2209 if (ret < 0)
2210 goto out;
2211
2212 ret = wl1271_acx_keep_alive_config(wl, CMD_TEMPL_KLV_IDX_NULL_DATA,
2213 ACX_KEEP_ALIVE_TPL_VALID);
2214 if (ret < 0)
2215 goto out;
2216
2217out:
2218 return ret;
2219}
2220
2221static int wl1271_unjoin(struct wl1271 *wl)
Luciano Coelhoc7f43e42009-12-11 15:40:44 +02002222{
2223 int ret;
2224
2225 /* to stop listening to a channel, we disconnect */
Eliad Pellerc690ec82011-08-14 13:17:07 +03002226 ret = wl12xx_cmd_role_stop_sta(wl);
Luciano Coelhoc7f43e42009-12-11 15:40:44 +02002227 if (ret < 0)
2228 goto out;
2229
Luciano Coelhoc7f43e42009-12-11 15:40:44 +02002230 memset(wl->bssid, 0, ETH_ALEN);
Juuso Oikarinen14b228a2010-03-18 12:26:43 +02002231
Oz Krakowskib992c682011-06-26 10:36:02 +03002232 /* reset TX security counters on a clean disconnect */
2233 wl->tx_security_last_seq_lsb = 0;
2234 wl->tx_security_seq = 0;
2235
Luciano Coelhoc7f43e42009-12-11 15:40:44 +02002236out:
2237 return ret;
2238}
2239
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03002240static void wl1271_set_band_rate(struct wl1271 *wl)
2241{
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03002242 wl->basic_rate_set = wl->bitrate_masks[wl->band];
2243 wl->rate_set = wl->basic_rate_set;
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03002244}
2245
Eliad Peller251c1772011-08-14 13:17:17 +03002246static bool wl12xx_is_roc(struct wl1271 *wl)
2247{
2248 u8 role_id;
2249
2250 role_id = find_first_bit(wl->roc_map, WL12XX_MAX_ROLES);
2251 if (role_id >= WL12XX_MAX_ROLES)
2252 return false;
2253
2254 return true;
2255}
2256
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002257static int wl1271_sta_handle_idle(struct wl1271 *wl, bool idle)
Juuso Oikarinen0d58cbf2010-05-24 11:18:16 +03002258{
2259 int ret;
2260
2261 if (idle) {
Eliad Peller251c1772011-08-14 13:17:17 +03002262 /* no need to croc if we weren't busy (e.g. during boot) */
2263 if (wl12xx_is_roc(wl)) {
2264 ret = wl12xx_croc(wl, wl->dev_role_id);
2265 if (ret < 0)
2266 goto out;
2267
2268 ret = wl12xx_cmd_role_stop_dev(wl);
Juuso Oikarinen0d58cbf2010-05-24 11:18:16 +03002269 if (ret < 0)
2270 goto out;
2271 }
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03002272 wl->rate_set = wl1271_tx_min_rate_get(wl, wl->basic_rate_set);
Arik Nemtsov79b223f2010-10-16 17:52:59 +02002273 ret = wl1271_acx_sta_rate_policies(wl);
Juuso Oikarinen0d58cbf2010-05-24 11:18:16 +03002274 if (ret < 0)
2275 goto out;
2276 ret = wl1271_acx_keep_alive_config(
2277 wl, CMD_TEMPL_KLV_IDX_NULL_DATA,
2278 ACX_KEEP_ALIVE_TPL_INVALID);
2279 if (ret < 0)
2280 goto out;
2281 set_bit(WL1271_FLAG_IDLE, &wl->flags);
2282 } else {
Luciano Coelho33c2c062011-05-10 14:46:02 +03002283 /* The current firmware only supports sched_scan in idle */
2284 if (wl->sched_scanning) {
2285 wl1271_scan_sched_scan_stop(wl);
2286 ieee80211_sched_scan_stopped(wl->hw);
2287 }
2288
Eliad Peller251c1772011-08-14 13:17:17 +03002289 ret = wl12xx_cmd_role_start_dev(wl);
2290 if (ret < 0)
2291 goto out;
2292
2293 ret = wl12xx_roc(wl, wl->dev_role_id);
Juuso Oikarinen0d58cbf2010-05-24 11:18:16 +03002294 if (ret < 0)
2295 goto out;
2296 clear_bit(WL1271_FLAG_IDLE, &wl->flags);
2297 }
2298
2299out:
2300 return ret;
2301}
2302
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002303static int wl1271_op_config(struct ieee80211_hw *hw, u32 changed)
2304{
2305 struct wl1271 *wl = hw->priv;
2306 struct ieee80211_conf *conf = &hw->conf;
2307 int channel, ret = 0;
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002308 bool is_ap;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002309
2310 channel = ieee80211_frequency_to_channel(conf->channel->center_freq);
2311
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002312 wl1271_debug(DEBUG_MAC80211, "mac80211 config ch %d psm %s power %d %s"
2313 " changed 0x%x",
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002314 channel,
2315 conf->flags & IEEE80211_CONF_PS ? "on" : "off",
Luciano Coelhoc7f43e42009-12-11 15:40:44 +02002316 conf->power_level,
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002317 conf->flags & IEEE80211_CONF_IDLE ? "idle" : "in use",
2318 changed);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002319
Juuso Oikarinen781608c2010-05-24 11:18:17 +03002320 /*
2321 * mac80211 will go to idle nearly immediately after transmitting some
2322 * frames, such as the deauth. To make sure those frames reach the air,
2323 * wait here until the TX queue is fully flushed.
2324 */
2325 if ((changed & IEEE80211_CONF_CHANGE_IDLE) &&
2326 (conf->flags & IEEE80211_CONF_IDLE))
2327 wl1271_tx_flush(wl);
2328
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002329 mutex_lock(&wl->mutex);
2330
Juuso Oikarinenf8d98022010-10-26 13:24:39 +02002331 if (unlikely(wl->state == WL1271_STATE_OFF)) {
Arik Nemtsov17e672d2011-03-22 10:07:47 +02002332 /* we support configuring the channel and band while off */
2333 if ((changed & IEEE80211_CONF_CHANGE_CHANNEL)) {
2334 wl->band = conf->channel->band;
2335 wl->channel = channel;
2336 }
2337
Arik Nemtsov097f8822011-06-27 22:06:34 +03002338 if ((changed & IEEE80211_CONF_CHANGE_POWER))
2339 wl->power_level = conf->power_level;
2340
Saravanan Dhanabal2c10bb92010-04-09 11:07:27 +03002341 goto out;
Juuso Oikarinenf8d98022010-10-26 13:24:39 +02002342 }
Juuso Oikarinen8a5a37a2009-10-08 21:56:24 +03002343
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002344 is_ap = (wl->bss_type == BSS_TYPE_AP_BSS);
2345
Ido Yariva6208652011-03-01 15:14:41 +02002346 ret = wl1271_ps_elp_wakeup(wl);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002347 if (ret < 0)
2348 goto out;
2349
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03002350 /* if the channel changes while joined, join again */
Juuso Oikarinen69e54342010-05-07 11:39:00 +03002351 if (changed & IEEE80211_CONF_CHANGE_CHANNEL &&
2352 ((wl->band != conf->channel->band) ||
2353 (wl->channel != channel))) {
Eliad Pellerc6930b02011-09-15 13:00:01 +03002354 /* send all pending packets */
2355 wl1271_tx_work_locked(wl);
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03002356 wl->band = conf->channel->band;
2357 wl->channel = channel;
2358
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002359 if (!is_ap) {
2360 /*
2361 * FIXME: the mac80211 should really provide a fixed
2362 * rate to use here. for now, just use the smallest
2363 * possible rate for the band as a fixed rate for
2364 * association frames and other control messages.
2365 */
2366 if (!test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags))
2367 wl1271_set_band_rate(wl);
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03002368
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03002369 wl->basic_rate =
2370 wl1271_tx_min_rate_get(wl, wl->basic_rate_set);
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002371 ret = wl1271_acx_sta_rate_policies(wl);
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03002372 if (ret < 0)
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002373 wl1271_warning("rate policy for channel "
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03002374 "failed %d", ret);
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002375
Eliad Peller251c1772011-08-14 13:17:17 +03002376 if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags)) {
2377 if (wl12xx_is_roc(wl)) {
2378 /* roaming */
2379 ret = wl12xx_croc(wl, wl->dev_role_id);
2380 if (ret < 0)
2381 goto out_sleep;
2382 }
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002383 ret = wl1271_join(wl, false);
2384 if (ret < 0)
2385 wl1271_warning("cmd join on channel "
2386 "failed %d", ret);
Eliad Peller251c1772011-08-14 13:17:17 +03002387 } else {
2388 /*
2389 * change the ROC channel. do it only if we are
2390 * not idle. otherwise, CROC will be called
2391 * anyway.
2392 */
2393 if (wl12xx_is_roc(wl) &&
2394 !(conf->flags & IEEE80211_CONF_IDLE)) {
2395 ret = wl12xx_croc(wl, wl->dev_role_id);
2396 if (ret < 0)
2397 goto out_sleep;
2398
2399 ret = wl12xx_roc(wl, wl->dev_role_id);
2400 if (ret < 0)
2401 wl1271_warning("roc failed %d",
2402 ret);
2403 }
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002404 }
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03002405 }
2406 }
2407
Arik Nemtsovbee0ffe2010-10-16 19:17:02 +02002408 if (changed & IEEE80211_CONF_CHANGE_IDLE && !is_ap) {
2409 ret = wl1271_sta_handle_idle(wl,
2410 conf->flags & IEEE80211_CONF_IDLE);
Juuso Oikarinen0d58cbf2010-05-24 11:18:16 +03002411 if (ret < 0)
2412 wl1271_warning("idle mode change failed %d", ret);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002413 }
2414
Juuso Oikarinen90494a92010-07-08 17:50:00 +03002415 /*
2416 * if mac80211 changes the PSM mode, make sure the mode is not
2417 * incorrectly changed after the pspoll failure active window.
2418 */
2419 if (changed & IEEE80211_CONF_CHANGE_PS)
2420 clear_bit(WL1271_FLAG_PSPOLL_FAILURE, &wl->flags);
2421
Juuso Oikarinen71449f82009-12-11 15:41:07 +02002422 if (conf->flags & IEEE80211_CONF_PS &&
2423 !test_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags)) {
2424 set_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002425
2426 /*
2427 * We enter PSM only if we're already associated.
2428 * If we're not, we'll enter it when joining an SSID,
2429 * through the bss_info_changed() hook.
2430 */
Juuso Oikarinen830fb672009-12-11 15:41:06 +02002431 if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags)) {
Juuso Oikarinen18f8d462010-02-22 08:38:34 +02002432 wl1271_debug(DEBUG_PSM, "psm enabled");
Juuso Oikarinend8c42c02010-02-18 13:25:36 +02002433 ret = wl1271_ps_set_mode(wl, STATION_POWER_SAVE_MODE,
Juuso Oikarinen8eab7b42010-09-24 03:10:11 +02002434 wl->basic_rate, true);
Juuso Oikarinenaf5e0842009-12-11 15:41:00 +02002435 }
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002436 } else if (!(conf->flags & IEEE80211_CONF_PS) &&
Juuso Oikarinen71449f82009-12-11 15:41:07 +02002437 test_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags)) {
Juuso Oikarinen18f8d462010-02-22 08:38:34 +02002438 wl1271_debug(DEBUG_PSM, "psm disabled");
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002439
Juuso Oikarinen71449f82009-12-11 15:41:07 +02002440 clear_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002441
Juuso Oikarinen71449f82009-12-11 15:41:07 +02002442 if (test_bit(WL1271_FLAG_PSM, &wl->flags))
Juuso Oikarinend8c42c02010-02-18 13:25:36 +02002443 ret = wl1271_ps_set_mode(wl, STATION_ACTIVE_MODE,
Juuso Oikarinen8eab7b42010-09-24 03:10:11 +02002444 wl->basic_rate, true);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002445 }
2446
2447 if (conf->power_level != wl->power_level) {
2448 ret = wl1271_acx_tx_power(wl, conf->power_level);
2449 if (ret < 0)
Juuso Oikarinenc6317a52009-11-02 20:22:08 +02002450 goto out_sleep;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002451
2452 wl->power_level = conf->power_level;
2453 }
2454
2455out_sleep:
2456 wl1271_ps_elp_sleep(wl);
2457
2458out:
2459 mutex_unlock(&wl->mutex);
2460
2461 return ret;
2462}
2463
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002464struct wl1271_filter_params {
2465 bool enabled;
2466 int mc_list_length;
2467 u8 mc_list[ACX_MC_ADDRESS_GROUP_MAX][ETH_ALEN];
2468};
2469
Jiri Pirko22bedad2010-04-01 21:22:57 +00002470static u64 wl1271_op_prepare_multicast(struct ieee80211_hw *hw,
2471 struct netdev_hw_addr_list *mc_list)
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002472{
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002473 struct wl1271_filter_params *fp;
Jiri Pirko22bedad2010-04-01 21:22:57 +00002474 struct netdev_hw_addr *ha;
Saravanan Dhanabal2c10bb92010-04-09 11:07:27 +03002475 struct wl1271 *wl = hw->priv;
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002476
Saravanan Dhanabal2c10bb92010-04-09 11:07:27 +03002477 if (unlikely(wl->state == WL1271_STATE_OFF))
2478 return 0;
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002479
Juuso Oikarinen74441132009-10-13 12:47:53 +03002480 fp = kzalloc(sizeof(*fp), GFP_ATOMIC);
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002481 if (!fp) {
2482 wl1271_error("Out of memory setting filters.");
2483 return 0;
2484 }
2485
2486 /* update multicast filtering parameters */
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002487 fp->mc_list_length = 0;
Jiri Pirko22bedad2010-04-01 21:22:57 +00002488 if (netdev_hw_addr_list_count(mc_list) > ACX_MC_ADDRESS_GROUP_MAX) {
2489 fp->enabled = false;
2490 } else {
2491 fp->enabled = true;
2492 netdev_hw_addr_list_for_each(ha, mc_list) {
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002493 memcpy(fp->mc_list[fp->mc_list_length],
Jiri Pirko22bedad2010-04-01 21:22:57 +00002494 ha->addr, ETH_ALEN);
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002495 fp->mc_list_length++;
Jiri Pirko22bedad2010-04-01 21:22:57 +00002496 }
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002497 }
2498
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002499 return (u64)(unsigned long)fp;
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002500}
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002501
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002502#define WL1271_SUPPORTED_FILTERS (FIF_PROMISC_IN_BSS | \
2503 FIF_ALLMULTI | \
2504 FIF_FCSFAIL | \
2505 FIF_BCN_PRBRESP_PROMISC | \
2506 FIF_CONTROL | \
2507 FIF_OTHER_BSS)
2508
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002509static void wl1271_op_configure_filter(struct ieee80211_hw *hw,
2510 unsigned int changed,
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03002511 unsigned int *total, u64 multicast)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002512{
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002513 struct wl1271_filter_params *fp = (void *)(unsigned long)multicast;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002514 struct wl1271 *wl = hw->priv;
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002515 int ret;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002516
Arik Nemtsov7d057862010-10-16 19:25:35 +02002517 wl1271_debug(DEBUG_MAC80211, "mac80211 configure filter changed %x"
2518 " total %x", changed, *total);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002519
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002520 mutex_lock(&wl->mutex);
2521
Saravanan Dhanabal2c10bb92010-04-09 11:07:27 +03002522 *total &= WL1271_SUPPORTED_FILTERS;
2523 changed &= WL1271_SUPPORTED_FILTERS;
2524
2525 if (unlikely(wl->state == WL1271_STATE_OFF))
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002526 goto out;
2527
Ido Yariva6208652011-03-01 15:14:41 +02002528 ret = wl1271_ps_elp_wakeup(wl);
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002529 if (ret < 0)
2530 goto out;
2531
Arik Nemtsov7d057862010-10-16 19:25:35 +02002532 if (wl->bss_type != BSS_TYPE_AP_BSS) {
2533 if (*total & FIF_ALLMULTI)
2534 ret = wl1271_acx_group_address_tbl(wl, false, NULL, 0);
2535 else if (fp)
2536 ret = wl1271_acx_group_address_tbl(wl, fp->enabled,
2537 fp->mc_list,
2538 fp->mc_list_length);
2539 if (ret < 0)
2540 goto out_sleep;
2541 }
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002542
Eliad Peller08c1d1c2011-08-14 13:17:04 +03002543 /*
2544 * the fw doesn't provide an api to configure the filters. instead,
2545 * the filters configuration is based on the active roles / ROC
2546 * state.
2547 */
Juuso Oikarinenb54853f2009-10-13 12:47:59 +03002548
2549out_sleep:
2550 wl1271_ps_elp_sleep(wl);
2551
2552out:
2553 mutex_unlock(&wl->mutex);
Juuso Oikarinen14b228a2010-03-18 12:26:43 +02002554 kfree(fp);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002555}
2556
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002557static int wl1271_record_ap_key(struct wl1271 *wl, u8 id, u8 key_type,
2558 u8 key_size, const u8 *key, u8 hlid, u32 tx_seq_32,
2559 u16 tx_seq_16)
2560{
2561 struct wl1271_ap_key *ap_key;
2562 int i;
2563
2564 wl1271_debug(DEBUG_CRYPT, "record ap key id %d", (int)id);
2565
2566 if (key_size > MAX_KEY_SIZE)
2567 return -EINVAL;
2568
2569 /*
2570 * Find next free entry in ap_keys. Also check we are not replacing
2571 * an existing key.
2572 */
2573 for (i = 0; i < MAX_NUM_KEYS; i++) {
2574 if (wl->recorded_ap_keys[i] == NULL)
2575 break;
2576
2577 if (wl->recorded_ap_keys[i]->id == id) {
2578 wl1271_warning("trying to record key replacement");
2579 return -EINVAL;
2580 }
2581 }
2582
2583 if (i == MAX_NUM_KEYS)
2584 return -EBUSY;
2585
2586 ap_key = kzalloc(sizeof(*ap_key), GFP_KERNEL);
2587 if (!ap_key)
2588 return -ENOMEM;
2589
2590 ap_key->id = id;
2591 ap_key->key_type = key_type;
2592 ap_key->key_size = key_size;
2593 memcpy(ap_key->key, key, key_size);
2594 ap_key->hlid = hlid;
2595 ap_key->tx_seq_32 = tx_seq_32;
2596 ap_key->tx_seq_16 = tx_seq_16;
2597
2598 wl->recorded_ap_keys[i] = ap_key;
2599 return 0;
2600}
2601
2602static void wl1271_free_ap_keys(struct wl1271 *wl)
2603{
2604 int i;
2605
2606 for (i = 0; i < MAX_NUM_KEYS; i++) {
2607 kfree(wl->recorded_ap_keys[i]);
2608 wl->recorded_ap_keys[i] = NULL;
2609 }
2610}
2611
2612static int wl1271_ap_init_hwenc(struct wl1271 *wl)
2613{
2614 int i, ret = 0;
2615 struct wl1271_ap_key *key;
2616 bool wep_key_added = false;
2617
2618 for (i = 0; i < MAX_NUM_KEYS; i++) {
Eliad Peller7f97b482011-08-14 13:17:30 +03002619 u8 hlid;
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002620 if (wl->recorded_ap_keys[i] == NULL)
2621 break;
2622
2623 key = wl->recorded_ap_keys[i];
Eliad Peller7f97b482011-08-14 13:17:30 +03002624 hlid = key->hlid;
2625 if (hlid == WL12XX_INVALID_LINK_ID)
2626 hlid = wl->ap_bcast_hlid;
2627
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002628 ret = wl1271_cmd_set_ap_key(wl, KEY_ADD_OR_REPLACE,
2629 key->id, key->key_type,
2630 key->key_size, key->key,
Eliad Peller7f97b482011-08-14 13:17:30 +03002631 hlid, key->tx_seq_32,
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002632 key->tx_seq_16);
2633 if (ret < 0)
2634 goto out;
2635
2636 if (key->key_type == KEY_WEP)
2637 wep_key_added = true;
2638 }
2639
2640 if (wep_key_added) {
Eliad Pellerc690ec82011-08-14 13:17:07 +03002641 ret = wl12xx_cmd_set_default_wep_key(wl, wl->default_key,
Arik Nemtsove51ae9b2011-08-14 13:17:21 +03002642 wl->ap_bcast_hlid);
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002643 if (ret < 0)
2644 goto out;
2645 }
2646
2647out:
2648 wl1271_free_ap_keys(wl);
2649 return ret;
2650}
2651
2652static int wl1271_set_key(struct wl1271 *wl, u16 action, u8 id, u8 key_type,
2653 u8 key_size, const u8 *key, u32 tx_seq_32,
2654 u16 tx_seq_16, struct ieee80211_sta *sta)
2655{
2656 int ret;
2657 bool is_ap = (wl->bss_type == BSS_TYPE_AP_BSS);
2658
2659 if (is_ap) {
2660 struct wl1271_station *wl_sta;
2661 u8 hlid;
2662
2663 if (sta) {
2664 wl_sta = (struct wl1271_station *)sta->drv_priv;
2665 hlid = wl_sta->hlid;
2666 } else {
Arik Nemtsove51ae9b2011-08-14 13:17:21 +03002667 hlid = wl->ap_bcast_hlid;
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002668 }
2669
2670 if (!test_bit(WL1271_FLAG_AP_STARTED, &wl->flags)) {
2671 /*
2672 * We do not support removing keys after AP shutdown.
2673 * Pretend we do to make mac80211 happy.
2674 */
2675 if (action != KEY_ADD_OR_REPLACE)
2676 return 0;
2677
2678 ret = wl1271_record_ap_key(wl, id,
2679 key_type, key_size,
2680 key, hlid, tx_seq_32,
2681 tx_seq_16);
2682 } else {
2683 ret = wl1271_cmd_set_ap_key(wl, action,
2684 id, key_type, key_size,
2685 key, hlid, tx_seq_32,
2686 tx_seq_16);
2687 }
2688
2689 if (ret < 0)
2690 return ret;
2691 } else {
2692 const u8 *addr;
2693 static const u8 bcast_addr[ETH_ALEN] = {
2694 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
2695 };
2696
Guy Eilame9eb8cb2011-08-16 19:49:12 +03002697 /*
2698 * A STA set to GEM cipher requires 2 tx spare blocks.
2699 * Return to default value when GEM cipher key is removed
2700 */
2701 if (key_type == KEY_GEM) {
2702 if (action == KEY_ADD_OR_REPLACE)
2703 wl->tx_spare_blocks = 2;
2704 else if (action == KEY_REMOVE)
2705 wl->tx_spare_blocks = TX_HW_BLOCK_SPARE_DEFAULT;
2706 }
2707
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002708 addr = sta ? sta->addr : bcast_addr;
2709
2710 if (is_zero_ether_addr(addr)) {
2711 /* We dont support TX only encryption */
2712 return -EOPNOTSUPP;
2713 }
2714
2715 /* The wl1271 does not allow to remove unicast keys - they
2716 will be cleared automatically on next CMD_JOIN. Ignore the
2717 request silently, as we dont want the mac80211 to emit
2718 an error message. */
2719 if (action == KEY_REMOVE && !is_broadcast_ether_addr(addr))
2720 return 0;
2721
Eliad Peller010d3d32011-08-14 13:17:31 +03002722 /* don't remove key if hlid was already deleted */
2723 if (action == KEY_REMOVE &&
2724 wl->sta_hlid == WL12XX_INVALID_LINK_ID)
2725 return 0;
2726
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002727 ret = wl1271_cmd_set_sta_key(wl, action,
2728 id, key_type, key_size,
2729 key, addr, tx_seq_32,
2730 tx_seq_16);
2731 if (ret < 0)
2732 return ret;
2733
2734 /* the default WEP key needs to be configured at least once */
2735 if (key_type == KEY_WEP) {
Eliad Pellerc690ec82011-08-14 13:17:07 +03002736 ret = wl12xx_cmd_set_default_wep_key(wl,
2737 wl->default_key,
2738 wl->sta_hlid);
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002739 if (ret < 0)
2740 return ret;
2741 }
2742 }
2743
2744 return 0;
2745}
2746
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002747static int wl1271_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
2748 struct ieee80211_vif *vif,
2749 struct ieee80211_sta *sta,
2750 struct ieee80211_key_conf *key_conf)
2751{
2752 struct wl1271 *wl = hw->priv;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002753 int ret;
Juuso Oikarinenac4e4ce2009-10-08 21:56:19 +03002754 u32 tx_seq_32 = 0;
2755 u16 tx_seq_16 = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002756 u8 key_type;
2757
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002758 wl1271_debug(DEBUG_MAC80211, "mac80211 set key");
2759
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002760 wl1271_debug(DEBUG_CRYPT, "CMD: 0x%x sta: %p", cmd, sta);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002761 wl1271_debug(DEBUG_CRYPT, "Key: algo:0x%x, id:%d, len:%d flags 0x%x",
Johannes Berg97359d12010-08-10 09:46:38 +02002762 key_conf->cipher, key_conf->keyidx,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002763 key_conf->keylen, key_conf->flags);
2764 wl1271_dump(DEBUG_CRYPT, "KEY: ", key_conf->key, key_conf->keylen);
2765
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002766 mutex_lock(&wl->mutex);
2767
Juuso Oikarinenf8d98022010-10-26 13:24:39 +02002768 if (unlikely(wl->state == WL1271_STATE_OFF)) {
2769 ret = -EAGAIN;
2770 goto out_unlock;
2771 }
2772
Ido Yariva6208652011-03-01 15:14:41 +02002773 ret = wl1271_ps_elp_wakeup(wl);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002774 if (ret < 0)
2775 goto out_unlock;
2776
Johannes Berg97359d12010-08-10 09:46:38 +02002777 switch (key_conf->cipher) {
2778 case WLAN_CIPHER_SUITE_WEP40:
2779 case WLAN_CIPHER_SUITE_WEP104:
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002780 key_type = KEY_WEP;
2781
2782 key_conf->hw_key_idx = key_conf->keyidx;
2783 break;
Johannes Berg97359d12010-08-10 09:46:38 +02002784 case WLAN_CIPHER_SUITE_TKIP:
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002785 key_type = KEY_TKIP;
2786
2787 key_conf->hw_key_idx = key_conf->keyidx;
Juuso Oikarinen04e36fc2010-02-22 08:38:40 +02002788 tx_seq_32 = WL1271_TX_SECURITY_HI32(wl->tx_security_seq);
2789 tx_seq_16 = WL1271_TX_SECURITY_LO16(wl->tx_security_seq);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002790 break;
Johannes Berg97359d12010-08-10 09:46:38 +02002791 case WLAN_CIPHER_SUITE_CCMP:
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002792 key_type = KEY_AES;
2793
2794 key_conf->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
Juuso Oikarinen04e36fc2010-02-22 08:38:40 +02002795 tx_seq_32 = WL1271_TX_SECURITY_HI32(wl->tx_security_seq);
2796 tx_seq_16 = WL1271_TX_SECURITY_LO16(wl->tx_security_seq);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002797 break;
Juuso Oikarinen7a557242010-09-27 12:42:07 +02002798 case WL1271_CIPHER_SUITE_GEM:
2799 key_type = KEY_GEM;
2800 tx_seq_32 = WL1271_TX_SECURITY_HI32(wl->tx_security_seq);
2801 tx_seq_16 = WL1271_TX_SECURITY_LO16(wl->tx_security_seq);
2802 break;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002803 default:
Johannes Berg97359d12010-08-10 09:46:38 +02002804 wl1271_error("Unknown key algo 0x%x", key_conf->cipher);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002805
2806 ret = -EOPNOTSUPP;
2807 goto out_sleep;
2808 }
2809
2810 switch (cmd) {
2811 case SET_KEY:
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002812 ret = wl1271_set_key(wl, KEY_ADD_OR_REPLACE,
2813 key_conf->keyidx, key_type,
2814 key_conf->keylen, key_conf->key,
2815 tx_seq_32, tx_seq_16, sta);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002816 if (ret < 0) {
2817 wl1271_error("Could not add or replace key");
2818 goto out_sleep;
2819 }
2820 break;
2821
2822 case DISABLE_KEY:
Arik Nemtsov7f179b42010-10-16 21:39:06 +02002823 ret = wl1271_set_key(wl, KEY_REMOVE,
2824 key_conf->keyidx, key_type,
2825 key_conf->keylen, key_conf->key,
2826 0, 0, sta);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002827 if (ret < 0) {
2828 wl1271_error("Could not remove key");
2829 goto out_sleep;
2830 }
2831 break;
2832
2833 default:
2834 wl1271_error("Unsupported key cmd 0x%x", cmd);
2835 ret = -EOPNOTSUPP;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002836 break;
2837 }
2838
2839out_sleep:
2840 wl1271_ps_elp_sleep(wl);
2841
2842out_unlock:
2843 mutex_unlock(&wl->mutex);
2844
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002845 return ret;
2846}
2847
2848static int wl1271_op_hw_scan(struct ieee80211_hw *hw,
Johannes Berga060bbf2010-04-27 11:59:34 +02002849 struct ieee80211_vif *vif,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002850 struct cfg80211_scan_request *req)
2851{
2852 struct wl1271 *wl = hw->priv;
2853 int ret;
2854 u8 *ssid = NULL;
Teemu Paasikiviabb0b3b2009-10-13 12:47:50 +03002855 size_t len = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002856
2857 wl1271_debug(DEBUG_MAC80211, "mac80211 hw scan");
2858
2859 if (req->n_ssids) {
2860 ssid = req->ssids[0].ssid;
Teemu Paasikiviabb0b3b2009-10-13 12:47:50 +03002861 len = req->ssids[0].ssid_len;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002862 }
2863
2864 mutex_lock(&wl->mutex);
2865
Juuso Oikarinenb739a422010-10-26 13:24:38 +02002866 if (wl->state == WL1271_STATE_OFF) {
2867 /*
2868 * We cannot return -EBUSY here because cfg80211 will expect
2869 * a call to ieee80211_scan_completed if we do - in this case
2870 * there won't be any call.
2871 */
2872 ret = -EAGAIN;
2873 goto out;
2874 }
2875
Ido Yariva6208652011-03-01 15:14:41 +02002876 ret = wl1271_ps_elp_wakeup(wl);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002877 if (ret < 0)
2878 goto out;
2879
Eliad Peller251c1772011-08-14 13:17:17 +03002880 /* cancel ROC before scanning */
2881 if (wl12xx_is_roc(wl)) {
2882 if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags)) {
2883 /* don't allow scanning right now */
2884 ret = -EBUSY;
2885 goto out_sleep;
2886 }
2887 wl12xx_croc(wl, wl->dev_role_id);
2888 wl12xx_cmd_role_stop_dev(wl);
2889 }
2890
Luciano Coelho5924f892010-08-04 03:46:22 +03002891 ret = wl1271_scan(hw->priv, ssid, len, req);
Eliad Peller251c1772011-08-14 13:17:17 +03002892out_sleep:
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002893 wl1271_ps_elp_sleep(wl);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03002894out:
2895 mutex_unlock(&wl->mutex);
2896
2897 return ret;
2898}
2899
Eliad Peller73ecce32011-06-27 13:06:45 +03002900static void wl1271_op_cancel_hw_scan(struct ieee80211_hw *hw,
2901 struct ieee80211_vif *vif)
2902{
2903 struct wl1271 *wl = hw->priv;
2904 int ret;
2905
2906 wl1271_debug(DEBUG_MAC80211, "mac80211 cancel hw scan");
2907
2908 mutex_lock(&wl->mutex);
2909
2910 if (wl->state == WL1271_STATE_OFF)
2911 goto out;
2912
2913 if (wl->scan.state == WL1271_SCAN_STATE_IDLE)
2914 goto out;
2915
2916 ret = wl1271_ps_elp_wakeup(wl);
2917 if (ret < 0)
2918 goto out;
2919
2920 if (wl->scan.state != WL1271_SCAN_STATE_DONE) {
2921 ret = wl1271_scan_stop(wl);
2922 if (ret < 0)
2923 goto out_sleep;
2924 }
2925 wl->scan.state = WL1271_SCAN_STATE_IDLE;
2926 memset(wl->scan.scanned_ch, 0, sizeof(wl->scan.scanned_ch));
2927 wl->scan.req = NULL;
2928 ieee80211_scan_completed(wl->hw, true);
2929
2930out_sleep:
2931 wl1271_ps_elp_sleep(wl);
2932out:
2933 mutex_unlock(&wl->mutex);
2934
2935 cancel_delayed_work_sync(&wl->scan_complete_work);
2936}
2937
Luciano Coelho33c2c062011-05-10 14:46:02 +03002938static int wl1271_op_sched_scan_start(struct ieee80211_hw *hw,
2939 struct ieee80211_vif *vif,
2940 struct cfg80211_sched_scan_request *req,
2941 struct ieee80211_sched_scan_ies *ies)
2942{
2943 struct wl1271 *wl = hw->priv;
2944 int ret;
2945
2946 wl1271_debug(DEBUG_MAC80211, "wl1271_op_sched_scan_start");
2947
2948 mutex_lock(&wl->mutex);
2949
2950 ret = wl1271_ps_elp_wakeup(wl);
2951 if (ret < 0)
2952 goto out;
2953
2954 ret = wl1271_scan_sched_scan_config(wl, req, ies);
2955 if (ret < 0)
2956 goto out_sleep;
2957
2958 ret = wl1271_scan_sched_scan_start(wl);
2959 if (ret < 0)
2960 goto out_sleep;
2961
2962 wl->sched_scanning = true;
2963
2964out_sleep:
2965 wl1271_ps_elp_sleep(wl);
2966out:
2967 mutex_unlock(&wl->mutex);
2968 return ret;
2969}
2970
2971static void wl1271_op_sched_scan_stop(struct ieee80211_hw *hw,
2972 struct ieee80211_vif *vif)
2973{
2974 struct wl1271 *wl = hw->priv;
2975 int ret;
2976
2977 wl1271_debug(DEBUG_MAC80211, "wl1271_op_sched_scan_stop");
2978
2979 mutex_lock(&wl->mutex);
2980
2981 ret = wl1271_ps_elp_wakeup(wl);
2982 if (ret < 0)
2983 goto out;
2984
2985 wl1271_scan_sched_scan_stop(wl);
2986
2987 wl1271_ps_elp_sleep(wl);
2988out:
2989 mutex_unlock(&wl->mutex);
2990}
2991
Arik Nemtsov68d069c2010-11-08 10:51:07 +01002992static int wl1271_op_set_frag_threshold(struct ieee80211_hw *hw, u32 value)
2993{
2994 struct wl1271 *wl = hw->priv;
2995 int ret = 0;
2996
2997 mutex_lock(&wl->mutex);
2998
2999 if (unlikely(wl->state == WL1271_STATE_OFF)) {
3000 ret = -EAGAIN;
3001 goto out;
3002 }
3003
Ido Yariva6208652011-03-01 15:14:41 +02003004 ret = wl1271_ps_elp_wakeup(wl);
Arik Nemtsov68d069c2010-11-08 10:51:07 +01003005 if (ret < 0)
3006 goto out;
3007
Arik Nemtsov5f704d12011-04-18 14:15:21 +03003008 ret = wl1271_acx_frag_threshold(wl, value);
Arik Nemtsov68d069c2010-11-08 10:51:07 +01003009 if (ret < 0)
3010 wl1271_warning("wl1271_op_set_frag_threshold failed: %d", ret);
3011
3012 wl1271_ps_elp_sleep(wl);
3013
3014out:
3015 mutex_unlock(&wl->mutex);
3016
3017 return ret;
3018}
3019
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003020static int wl1271_op_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
3021{
3022 struct wl1271 *wl = hw->priv;
Saravanan Dhanabalaecb0562010-04-09 11:07:28 +03003023 int ret = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003024
3025 mutex_lock(&wl->mutex);
3026
Juuso Oikarinenf8d98022010-10-26 13:24:39 +02003027 if (unlikely(wl->state == WL1271_STATE_OFF)) {
3028 ret = -EAGAIN;
Saravanan Dhanabalaecb0562010-04-09 11:07:28 +03003029 goto out;
Juuso Oikarinenf8d98022010-10-26 13:24:39 +02003030 }
Saravanan Dhanabalaecb0562010-04-09 11:07:28 +03003031
Ido Yariva6208652011-03-01 15:14:41 +02003032 ret = wl1271_ps_elp_wakeup(wl);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003033 if (ret < 0)
3034 goto out;
3035
Arik Nemtsov5f704d12011-04-18 14:15:21 +03003036 ret = wl1271_acx_rts_threshold(wl, value);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003037 if (ret < 0)
3038 wl1271_warning("wl1271_op_set_rts_threshold failed: %d", ret);
3039
3040 wl1271_ps_elp_sleep(wl);
3041
3042out:
3043 mutex_unlock(&wl->mutex);
3044
3045 return ret;
3046}
3047
Arik Nemtsove78a2872010-10-16 19:07:21 +02003048static int wl1271_ssid_set(struct wl1271 *wl, struct sk_buff *skb,
Juuso Oikarinen2f6724b2010-11-24 08:16:57 +02003049 int offset)
Juuso Oikarinen30240fc2010-02-18 13:25:38 +02003050{
Eliad Peller889cb362011-05-01 09:56:45 +03003051 u8 ssid_len;
3052 const u8 *ptr = cfg80211_find_ie(WLAN_EID_SSID, skb->data + offset,
3053 skb->len - offset);
Juuso Oikarinen30240fc2010-02-18 13:25:38 +02003054
Eliad Peller889cb362011-05-01 09:56:45 +03003055 if (!ptr) {
3056 wl1271_error("No SSID in IEs!");
3057 return -ENOENT;
Juuso Oikarinen30240fc2010-02-18 13:25:38 +02003058 }
Arik Nemtsove78a2872010-10-16 19:07:21 +02003059
Eliad Peller889cb362011-05-01 09:56:45 +03003060 ssid_len = ptr[1];
3061 if (ssid_len > IEEE80211_MAX_SSID_LEN) {
3062 wl1271_error("SSID is too long!");
3063 return -EINVAL;
3064 }
3065
3066 wl->ssid_len = ssid_len;
3067 memcpy(wl->ssid, ptr+2, ssid_len);
3068 return 0;
Juuso Oikarinen30240fc2010-02-18 13:25:38 +02003069}
3070
Eliad Pellerd48055d2011-09-15 12:07:04 +03003071static void wl12xx_remove_ie(struct sk_buff *skb, u8 eid, int ieoffset)
3072{
3073 int len;
3074 const u8 *next, *end = skb->data + skb->len;
3075 u8 *ie = (u8 *)cfg80211_find_ie(eid, skb->data + ieoffset,
3076 skb->len - ieoffset);
3077 if (!ie)
3078 return;
3079 len = ie[1] + 2;
3080 next = ie + len;
3081 memmove(ie, next, end - next);
3082 skb_trim(skb, skb->len - len);
3083}
3084
Eliad Peller26b4bf22011-09-15 12:07:05 +03003085static void wl12xx_remove_vendor_ie(struct sk_buff *skb,
3086 unsigned int oui, u8 oui_type,
3087 int ieoffset)
3088{
3089 int len;
3090 const u8 *next, *end = skb->data + skb->len;
3091 u8 *ie = (u8 *)cfg80211_find_vendor_ie(oui, oui_type,
3092 skb->data + ieoffset,
3093 skb->len - ieoffset);
3094 if (!ie)
3095 return;
3096 len = ie[1] + 2;
3097 next = ie + len;
3098 memmove(ie, next, end - next);
3099 skb_trim(skb, skb->len - len);
3100}
3101
Arik Nemtsov68eaaf62011-09-03 20:22:03 +03003102static int wl1271_ap_set_probe_resp_tmpl(struct wl1271 *wl,
3103 u8 *probe_rsp_data,
3104 size_t probe_rsp_len,
3105 u32 rates)
3106{
3107 struct ieee80211_bss_conf *bss_conf = &wl->vif->bss_conf;
3108 u8 probe_rsp_templ[WL1271_CMD_TEMPL_MAX_SIZE];
3109 int ssid_ie_offset, ie_offset, templ_len;
3110 const u8 *ptr;
3111
3112 /* no need to change probe response if the SSID is set correctly */
3113 if (wl->ssid_len > 0)
3114 return wl1271_cmd_template_set(wl,
3115 CMD_TEMPL_AP_PROBE_RESPONSE,
3116 probe_rsp_data,
3117 probe_rsp_len, 0,
3118 rates);
3119
3120 if (probe_rsp_len + bss_conf->ssid_len > WL1271_CMD_TEMPL_MAX_SIZE) {
3121 wl1271_error("probe_rsp template too big");
3122 return -EINVAL;
3123 }
3124
3125 /* start searching from IE offset */
3126 ie_offset = offsetof(struct ieee80211_mgmt, u.probe_resp.variable);
3127
3128 ptr = cfg80211_find_ie(WLAN_EID_SSID, probe_rsp_data + ie_offset,
3129 probe_rsp_len - ie_offset);
3130 if (!ptr) {
3131 wl1271_error("No SSID in beacon!");
3132 return -EINVAL;
3133 }
3134
3135 ssid_ie_offset = ptr - probe_rsp_data;
3136 ptr += (ptr[1] + 2);
3137
3138 memcpy(probe_rsp_templ, probe_rsp_data, ssid_ie_offset);
3139
3140 /* insert SSID from bss_conf */
3141 probe_rsp_templ[ssid_ie_offset] = WLAN_EID_SSID;
3142 probe_rsp_templ[ssid_ie_offset + 1] = bss_conf->ssid_len;
3143 memcpy(probe_rsp_templ + ssid_ie_offset + 2,
3144 bss_conf->ssid, bss_conf->ssid_len);
3145 templ_len = ssid_ie_offset + 2 + bss_conf->ssid_len;
3146
3147 memcpy(probe_rsp_templ + ssid_ie_offset + 2 + bss_conf->ssid_len,
3148 ptr, probe_rsp_len - (ptr - probe_rsp_data));
3149 templ_len += probe_rsp_len - (ptr - probe_rsp_data);
3150
3151 return wl1271_cmd_template_set(wl,
3152 CMD_TEMPL_AP_PROBE_RESPONSE,
3153 probe_rsp_templ,
3154 templ_len, 0,
3155 rates);
3156}
3157
Arik Nemtsove78a2872010-10-16 19:07:21 +02003158static int wl1271_bss_erp_info_changed(struct wl1271 *wl,
3159 struct ieee80211_bss_conf *bss_conf,
3160 u32 changed)
3161{
3162 int ret = 0;
3163
3164 if (changed & BSS_CHANGED_ERP_SLOT) {
3165 if (bss_conf->use_short_slot)
3166 ret = wl1271_acx_slot(wl, SLOT_TIME_SHORT);
3167 else
3168 ret = wl1271_acx_slot(wl, SLOT_TIME_LONG);
3169 if (ret < 0) {
3170 wl1271_warning("Set slot time failed %d", ret);
3171 goto out;
3172 }
3173 }
3174
3175 if (changed & BSS_CHANGED_ERP_PREAMBLE) {
3176 if (bss_conf->use_short_preamble)
3177 wl1271_acx_set_preamble(wl, ACX_PREAMBLE_SHORT);
3178 else
3179 wl1271_acx_set_preamble(wl, ACX_PREAMBLE_LONG);
3180 }
3181
3182 if (changed & BSS_CHANGED_ERP_CTS_PROT) {
3183 if (bss_conf->use_cts_prot)
3184 ret = wl1271_acx_cts_protect(wl, CTSPROTECT_ENABLE);
3185 else
3186 ret = wl1271_acx_cts_protect(wl, CTSPROTECT_DISABLE);
3187 if (ret < 0) {
3188 wl1271_warning("Set ctsprotect failed %d", ret);
3189 goto out;
3190 }
3191 }
3192
3193out:
3194 return ret;
3195}
3196
3197static int wl1271_bss_beacon_info_changed(struct wl1271 *wl,
3198 struct ieee80211_vif *vif,
3199 struct ieee80211_bss_conf *bss_conf,
3200 u32 changed)
3201{
3202 bool is_ap = (wl->bss_type == BSS_TYPE_AP_BSS);
3203 int ret = 0;
3204
3205 if ((changed & BSS_CHANGED_BEACON_INT)) {
3206 wl1271_debug(DEBUG_MASTER, "beacon interval updated: %d",
3207 bss_conf->beacon_int);
3208
3209 wl->beacon_int = bss_conf->beacon_int;
3210 }
3211
3212 if ((changed & BSS_CHANGED_BEACON)) {
3213 struct ieee80211_hdr *hdr;
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003214 u32 min_rate;
Arik Nemtsove78a2872010-10-16 19:07:21 +02003215 int ieoffset = offsetof(struct ieee80211_mgmt,
3216 u.beacon.variable);
3217 struct sk_buff *beacon = ieee80211_beacon_get(wl->hw, vif);
3218 u16 tmpl_id;
3219
3220 if (!beacon)
3221 goto out;
3222
3223 wl1271_debug(DEBUG_MASTER, "beacon updated");
3224
3225 ret = wl1271_ssid_set(wl, beacon, ieoffset);
3226 if (ret < 0) {
3227 dev_kfree_skb(beacon);
3228 goto out;
3229 }
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003230 min_rate = wl1271_tx_min_rate_get(wl, wl->basic_rate_set);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003231 tmpl_id = is_ap ? CMD_TEMPL_AP_BEACON :
3232 CMD_TEMPL_BEACON;
3233 ret = wl1271_cmd_template_set(wl, tmpl_id,
3234 beacon->data,
3235 beacon->len, 0,
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003236 min_rate);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003237 if (ret < 0) {
3238 dev_kfree_skb(beacon);
3239 goto out;
3240 }
3241
Eliad Pellerd48055d2011-09-15 12:07:04 +03003242 /* remove TIM ie from probe response */
3243 wl12xx_remove_ie(beacon, WLAN_EID_TIM, ieoffset);
3244
Eliad Peller26b4bf22011-09-15 12:07:05 +03003245 /*
3246 * remove p2p ie from probe response.
3247 * the fw reponds to probe requests that don't include
3248 * the p2p ie. probe requests with p2p ie will be passed,
3249 * and will be responded by the supplicant (the spec
3250 * forbids including the p2p ie when responding to probe
3251 * requests that didn't include it).
3252 */
3253 wl12xx_remove_vendor_ie(beacon, WLAN_OUI_WFA,
3254 WLAN_OUI_TYPE_WFA_P2P, ieoffset);
3255
Arik Nemtsove78a2872010-10-16 19:07:21 +02003256 hdr = (struct ieee80211_hdr *) beacon->data;
3257 hdr->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
3258 IEEE80211_STYPE_PROBE_RESP);
Arik Nemtsov68eaaf62011-09-03 20:22:03 +03003259 if (is_ap)
3260 ret = wl1271_ap_set_probe_resp_tmpl(wl,
3261 beacon->data,
3262 beacon->len,
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003263 min_rate);
Arik Nemtsov68eaaf62011-09-03 20:22:03 +03003264 else
3265 ret = wl1271_cmd_template_set(wl,
3266 CMD_TEMPL_PROBE_RESPONSE,
3267 beacon->data,
3268 beacon->len, 0,
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003269 min_rate);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003270 dev_kfree_skb(beacon);
3271 if (ret < 0)
3272 goto out;
3273 }
3274
3275out:
3276 return ret;
3277}
3278
3279/* AP mode changes */
3280static void wl1271_bss_info_changed_ap(struct wl1271 *wl,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003281 struct ieee80211_vif *vif,
3282 struct ieee80211_bss_conf *bss_conf,
3283 u32 changed)
3284{
Arik Nemtsove78a2872010-10-16 19:07:21 +02003285 int ret = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003286
Arik Nemtsove78a2872010-10-16 19:07:21 +02003287 if ((changed & BSS_CHANGED_BASIC_RATES)) {
3288 u32 rates = bss_conf->basic_rates;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003289
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003290 wl->basic_rate_set = wl1271_tx_enabled_rates_get(wl, rates,
3291 wl->band);
3292 wl->basic_rate = wl1271_tx_min_rate_get(wl,
3293 wl->basic_rate_set);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003294
Arik Nemtsov70f47422011-04-18 14:15:25 +03003295 ret = wl1271_init_ap_rates(wl);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003296 if (ret < 0) {
Arik Nemtsov70f47422011-04-18 14:15:25 +03003297 wl1271_error("AP rate policy change failed %d", ret);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003298 goto out;
Juuso Oikarinene0d8bbf2009-12-11 15:41:04 +02003299 }
Arik Nemtsovc45a85b2011-04-18 14:15:26 +03003300
3301 ret = wl1271_ap_init_templates(wl);
3302 if (ret < 0)
3303 goto out;
Juuso Oikarinene0d8bbf2009-12-11 15:41:04 +02003304 }
3305
Arik Nemtsove78a2872010-10-16 19:07:21 +02003306 ret = wl1271_bss_beacon_info_changed(wl, vif, bss_conf, changed);
3307 if (ret < 0)
3308 goto out;
3309
3310 if ((changed & BSS_CHANGED_BEACON_ENABLED)) {
3311 if (bss_conf->enable_beacon) {
3312 if (!test_bit(WL1271_FLAG_AP_STARTED, &wl->flags)) {
Eliad Pellerc690ec82011-08-14 13:17:07 +03003313 ret = wl12xx_cmd_role_start_ap(wl);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003314 if (ret < 0)
3315 goto out;
3316
Arik Nemtsov7f179b42010-10-16 21:39:06 +02003317 ret = wl1271_ap_init_hwenc(wl);
3318 if (ret < 0)
3319 goto out;
Arik Nemtsovcf420392011-08-14 13:17:37 +03003320
3321 set_bit(WL1271_FLAG_AP_STARTED, &wl->flags);
3322 wl1271_debug(DEBUG_AP, "started AP");
Arik Nemtsove78a2872010-10-16 19:07:21 +02003323 }
3324 } else {
3325 if (test_bit(WL1271_FLAG_AP_STARTED, &wl->flags)) {
Eliad Pellerc690ec82011-08-14 13:17:07 +03003326 ret = wl12xx_cmd_role_stop_ap(wl);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003327 if (ret < 0)
3328 goto out;
3329
3330 clear_bit(WL1271_FLAG_AP_STARTED, &wl->flags);
3331 wl1271_debug(DEBUG_AP, "stopped AP");
3332 }
3333 }
3334 }
3335
3336 ret = wl1271_bss_erp_info_changed(wl, bss_conf, changed);
3337 if (ret < 0)
3338 goto out;
Arik Nemtsov0b932ab2011-08-14 13:17:27 +03003339
3340 /* Handle HT information change */
3341 if ((changed & BSS_CHANGED_HT) &&
3342 (bss_conf->channel_type != NL80211_CHAN_NO_HT)) {
3343 ret = wl1271_acx_set_ht_information(wl,
3344 bss_conf->ht_operation_mode);
3345 if (ret < 0) {
3346 wl1271_warning("Set ht information failed %d", ret);
3347 goto out;
3348 }
3349 }
3350
Arik Nemtsove78a2872010-10-16 19:07:21 +02003351out:
3352 return;
3353}
3354
3355/* STA/IBSS mode changes */
3356static void wl1271_bss_info_changed_sta(struct wl1271 *wl,
3357 struct ieee80211_vif *vif,
3358 struct ieee80211_bss_conf *bss_conf,
3359 u32 changed)
3360{
3361 bool do_join = false, set_assoc = false;
3362 bool is_ibss = (wl->bss_type == BSS_TYPE_IBSS);
Eliad Peller227e81e2011-08-14 13:17:26 +03003363 bool ibss_joined = false;
Eliad Peller72c2d9e2011-02-02 09:59:37 +02003364 u32 sta_rate_set = 0;
Arik Nemtsove78a2872010-10-16 19:07:21 +02003365 int ret;
Luciano Coelho2d6e4e762011-01-11 19:07:21 +01003366 struct ieee80211_sta *sta;
Arik Nemtsova1008852011-02-12 23:24:20 +02003367 bool sta_exists = false;
3368 struct ieee80211_sta_ht_cap sta_ht_cap;
Arik Nemtsove78a2872010-10-16 19:07:21 +02003369
3370 if (is_ibss) {
3371 ret = wl1271_bss_beacon_info_changed(wl, vif, bss_conf,
3372 changed);
3373 if (ret < 0)
3374 goto out;
3375 }
3376
Eliad Peller227e81e2011-08-14 13:17:26 +03003377 if (changed & BSS_CHANGED_IBSS) {
3378 if (bss_conf->ibss_joined) {
3379 set_bit(WL1271_FLAG_IBSS_JOINED, &wl->flags);
3380 ibss_joined = true;
3381 } else {
3382 if (test_and_clear_bit(WL1271_FLAG_IBSS_JOINED,
3383 &wl->flags)) {
3384 wl1271_unjoin(wl);
3385 wl12xx_cmd_role_start_dev(wl);
3386 wl12xx_roc(wl, wl->dev_role_id);
3387 }
3388 }
3389 }
3390
3391 if ((changed & BSS_CHANGED_BEACON_INT) && ibss_joined)
Arik Nemtsove78a2872010-10-16 19:07:21 +02003392 do_join = true;
3393
3394 /* Need to update the SSID (for filtering etc) */
Eliad Peller227e81e2011-08-14 13:17:26 +03003395 if ((changed & BSS_CHANGED_BEACON) && ibss_joined)
Arik Nemtsove78a2872010-10-16 19:07:21 +02003396 do_join = true;
3397
Eliad Peller227e81e2011-08-14 13:17:26 +03003398 if ((changed & BSS_CHANGED_BEACON_ENABLED) && ibss_joined) {
Juuso Oikarinen5da11dc2010-03-26 12:53:24 +02003399 wl1271_debug(DEBUG_ADHOC, "ad-hoc beaconing: %s",
3400 bss_conf->enable_beacon ? "enabled" : "disabled");
3401
3402 if (bss_conf->enable_beacon)
3403 wl->set_bss_type = BSS_TYPE_IBSS;
3404 else
3405 wl->set_bss_type = BSS_TYPE_STA_BSS;
3406 do_join = true;
3407 }
3408
Arik Nemtsove78a2872010-10-16 19:07:21 +02003409 if ((changed & BSS_CHANGED_CQM)) {
Juuso Oikarinen00236aed2010-04-09 11:07:30 +03003410 bool enable = false;
3411 if (bss_conf->cqm_rssi_thold)
3412 enable = true;
3413 ret = wl1271_acx_rssi_snr_trigger(wl, enable,
3414 bss_conf->cqm_rssi_thold,
3415 bss_conf->cqm_rssi_hyst);
3416 if (ret < 0)
3417 goto out;
3418 wl->rssi_thold = bss_conf->cqm_rssi_thold;
3419 }
3420
Juuso Oikarinen30240fc2010-02-18 13:25:38 +02003421 if ((changed & BSS_CHANGED_BSSID) &&
3422 /*
3423 * Now we know the correct bssid, so we send a new join command
3424 * and enable the BSSID filter
3425 */
3426 memcmp(wl->bssid, bss_conf->bssid, ETH_ALEN)) {
Arik Nemtsove78a2872010-10-16 19:07:21 +02003427 memcpy(wl->bssid, bss_conf->bssid, ETH_ALEN);
Juuso Oikarinena0cb7be2010-03-18 12:26:44 +02003428
Eliad Pellerfa287b82010-12-26 09:27:50 +01003429 if (!is_zero_ether_addr(wl->bssid)) {
3430 ret = wl1271_cmd_build_null_data(wl);
3431 if (ret < 0)
3432 goto out;
Juuso Oikarinen30240fc2010-02-18 13:25:38 +02003433
Eliad Pellerfa287b82010-12-26 09:27:50 +01003434 ret = wl1271_build_qos_null_data(wl);
3435 if (ret < 0)
3436 goto out;
Saravanan Dhanabal141418c2010-04-28 09:50:00 +03003437
Eliad Pellerfa287b82010-12-26 09:27:50 +01003438 /* Need to update the BSSID (for filtering etc) */
3439 do_join = true;
3440 }
Juuso Oikarinen30240fc2010-02-18 13:25:38 +02003441 }
3442
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03003443 if (changed & (BSS_CHANGED_ASSOC | BSS_CHANGED_HT)) {
3444 rcu_read_lock();
3445 sta = ieee80211_find_sta(vif, bss_conf->bssid);
3446 if (!sta)
3447 goto sta_not_found;
3448
Eliad Peller72c2d9e2011-02-02 09:59:37 +02003449 /* save the supp_rates of the ap */
3450 sta_rate_set = sta->supp_rates[wl->hw->conf.channel->band];
3451 if (sta->ht_cap.ht_supported)
3452 sta_rate_set |=
3453 (sta->ht_cap.mcs.rx_mask[0] << HW_HT_RATES_OFFSET);
Arik Nemtsova1008852011-02-12 23:24:20 +02003454 sta_ht_cap = sta->ht_cap;
3455 sta_exists = true;
Eliad Peller72c2d9e2011-02-02 09:59:37 +02003456
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03003457sta_not_found:
3458 rcu_read_unlock();
Eliad Peller72c2d9e2011-02-02 09:59:37 +02003459 }
Eliad Peller72c2d9e2011-02-02 09:59:37 +02003460
Arik Nemtsove78a2872010-10-16 19:07:21 +02003461 if ((changed & BSS_CHANGED_ASSOC)) {
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003462 if (bss_conf->assoc) {
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03003463 u32 rates;
Juuso Oikarinen2f6724b2010-11-24 08:16:57 +02003464 int ieoffset;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003465 wl->aid = bss_conf->aid;
Juuso Oikarinen69e54342010-05-07 11:39:00 +03003466 set_assoc = true;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003467
Juuso Oikarinen90494a92010-07-08 17:50:00 +03003468 wl->ps_poll_failures = 0;
3469
Luciano Coelhoae751ba2009-10-12 15:08:57 +03003470 /*
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03003471 * use basic rates from AP, and determine lowest rate
3472 * to use with control frames.
3473 */
3474 rates = bss_conf->basic_rates;
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003475 wl->basic_rate_set =
3476 wl1271_tx_enabled_rates_get(wl, rates,
3477 wl->band);
3478 wl->basic_rate =
3479 wl1271_tx_min_rate_get(wl, wl->basic_rate_set);
Eliad Peller72c2d9e2011-02-02 09:59:37 +02003480 if (sta_rate_set)
3481 wl->rate_set = wl1271_tx_enabled_rates_get(wl,
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003482 sta_rate_set,
3483 wl->band);
Arik Nemtsov79b223f2010-10-16 17:52:59 +02003484 ret = wl1271_acx_sta_rate_policies(wl);
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03003485 if (ret < 0)
Arik Nemtsove78a2872010-10-16 19:07:21 +02003486 goto out;
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03003487
3488 /*
Luciano Coelhoae751ba2009-10-12 15:08:57 +03003489 * with wl1271, we don't need to update the
3490 * beacon_int and dtim_period, because the firmware
3491 * updates it by itself when the first beacon is
3492 * received after a join.
3493 */
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003494 ret = wl1271_cmd_build_ps_poll(wl, wl->aid);
3495 if (ret < 0)
Arik Nemtsove78a2872010-10-16 19:07:21 +02003496 goto out;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003497
Juuso Oikarinenc2b2d992010-03-26 12:53:28 +02003498 /*
Juuso Oikarinen2f6724b2010-11-24 08:16:57 +02003499 * Get a template for hardware connection maintenance
Juuso Oikarinenc2b2d992010-03-26 12:53:28 +02003500 */
Juuso Oikarinen2f6724b2010-11-24 08:16:57 +02003501 dev_kfree_skb(wl->probereq);
3502 wl->probereq = wl1271_cmd_build_ap_probe_req(wl, NULL);
3503 ieoffset = offsetof(struct ieee80211_mgmt,
3504 u.probe_req.variable);
3505 wl1271_ssid_set(wl, wl->probereq, ieoffset);
Juuso Oikarinenc2b2d992010-03-26 12:53:28 +02003506
Juuso Oikarinen6ccbb922010-03-26 12:53:23 +02003507 /* enable the connection monitoring feature */
3508 ret = wl1271_acx_conn_monit_params(wl, true);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003509 if (ret < 0)
Arik Nemtsove78a2872010-10-16 19:07:21 +02003510 goto out;
Juuso Oikarinend94cd292009-10-08 21:56:25 +03003511 } else {
3512 /* use defaults when not associated */
Eliad Peller30df14d2011-04-05 19:13:28 +03003513 bool was_assoc =
3514 !!test_and_clear_bit(WL1271_FLAG_STA_ASSOCIATED,
3515 &wl->flags);
Eliad Peller251c1772011-08-14 13:17:17 +03003516 bool was_ifup =
3517 !!test_and_clear_bit(WL1271_FLAG_STA_STATE_SENT,
3518 &wl->flags);
Juuso Oikarinend94cd292009-10-08 21:56:25 +03003519 wl->aid = 0;
Juuso Oikarinen6ccbb922010-03-26 12:53:23 +02003520
Juuso Oikarinen2f6724b2010-11-24 08:16:57 +02003521 /* free probe-request template */
3522 dev_kfree_skb(wl->probereq);
3523 wl->probereq = NULL;
3524
Juuso Oikarinen8d2ef7b2010-07-08 17:50:03 +03003525 /* re-enable dynamic ps - just in case */
Juuso Oikarinenf532be62010-07-08 17:50:05 +03003526 ieee80211_enable_dyn_ps(wl->vif);
Juuso Oikarinen8d2ef7b2010-07-08 17:50:03 +03003527
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03003528 /* revert back to minimum rates for the current band */
3529 wl1271_set_band_rate(wl);
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003530 wl->basic_rate =
3531 wl1271_tx_min_rate_get(wl, wl->basic_rate_set);
Arik Nemtsov79b223f2010-10-16 17:52:59 +02003532 ret = wl1271_acx_sta_rate_policies(wl);
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03003533 if (ret < 0)
Arik Nemtsove78a2872010-10-16 19:07:21 +02003534 goto out;
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03003535
Juuso Oikarinen6ccbb922010-03-26 12:53:23 +02003536 /* disable connection monitor features */
3537 ret = wl1271_acx_conn_monit_params(wl, false);
Juuso Oikarinenc1899552010-03-26 12:53:32 +02003538
3539 /* Disable the keep-alive feature */
3540 ret = wl1271_acx_keep_alive_mode(wl, false);
Juuso Oikarinen6ccbb922010-03-26 12:53:23 +02003541 if (ret < 0)
Arik Nemtsove78a2872010-10-16 19:07:21 +02003542 goto out;
Juuso Oikarinenb84a7d32010-11-22 12:59:08 +02003543
3544 /* restore the bssid filter and go to dummy bssid */
Eliad Peller30df14d2011-04-05 19:13:28 +03003545 if (was_assoc) {
Eliad Peller251c1772011-08-14 13:17:17 +03003546 u32 conf_flags = wl->hw->conf.flags;
3547 /*
3548 * we might have to disable roc, if there was
3549 * no IF_OPER_UP notification.
3550 */
3551 if (!was_ifup) {
3552 ret = wl12xx_croc(wl, wl->role_id);
3553 if (ret < 0)
3554 goto out;
3555 }
3556 /*
3557 * (we also need to disable roc in case of
3558 * roaming on the same channel. until we will
3559 * have a better flow...)
3560 */
3561 if (test_bit(wl->dev_role_id, wl->roc_map)) {
3562 ret = wl12xx_croc(wl, wl->dev_role_id);
3563 if (ret < 0)
3564 goto out;
3565 }
3566
Eliad Peller30df14d2011-04-05 19:13:28 +03003567 wl1271_unjoin(wl);
Eliad Peller251c1772011-08-14 13:17:17 +03003568 if (!(conf_flags & IEEE80211_CONF_IDLE)) {
3569 wl12xx_cmd_role_start_dev(wl);
3570 wl12xx_roc(wl, wl->dev_role_id);
3571 }
Eliad Peller30df14d2011-04-05 19:13:28 +03003572 }
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003573 }
3574 }
Juuso Oikarinen8a5a37a2009-10-08 21:56:24 +03003575
Eliad Pellerd192d262011-05-24 14:33:08 +03003576 if (changed & BSS_CHANGED_IBSS) {
3577 wl1271_debug(DEBUG_ADHOC, "ibss_joined: %d",
3578 bss_conf->ibss_joined);
3579
3580 if (bss_conf->ibss_joined) {
3581 u32 rates = bss_conf->basic_rates;
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03003582 wl->basic_rate_set =
3583 wl1271_tx_enabled_rates_get(wl, rates,
3584 wl->band);
3585 wl->basic_rate =
3586 wl1271_tx_min_rate_get(wl, wl->basic_rate_set);
Eliad Pellerd192d262011-05-24 14:33:08 +03003587
Shahar Levi06b660e2011-09-05 13:54:36 +03003588 /* by default, use 11b + OFDM rates */
Eliad Pellerd192d262011-05-24 14:33:08 +03003589 wl->rate_set = CONF_TX_IBSS_DEFAULT_RATES;
3590 ret = wl1271_acx_sta_rate_policies(wl);
3591 if (ret < 0)
3592 goto out;
3593 }
3594 }
3595
Arik Nemtsove78a2872010-10-16 19:07:21 +02003596 ret = wl1271_bss_erp_info_changed(wl, bss_conf, changed);
3597 if (ret < 0)
3598 goto out;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003599
Juuso Oikarinenca52a5e2010-07-08 17:50:02 +03003600 if (changed & BSS_CHANGED_ARP_FILTER) {
3601 __be32 addr = bss_conf->arp_addr_list[0];
3602 WARN_ON(wl->bss_type != BSS_TYPE_STA_BSS);
3603
Eliad Pellerc5312772010-12-09 11:31:27 +02003604 if (bss_conf->arp_addr_cnt == 1 &&
3605 bss_conf->arp_filter_enabled) {
3606 /*
3607 * The template should have been configured only upon
3608 * association. however, it seems that the correct ip
3609 * isn't being set (when sending), so we have to
3610 * reconfigure the template upon every ip change.
3611 */
3612 ret = wl1271_cmd_build_arp_rsp(wl, addr);
3613 if (ret < 0) {
3614 wl1271_warning("build arp rsp failed: %d", ret);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003615 goto out;
Eliad Pellerc5312772010-12-09 11:31:27 +02003616 }
3617
3618 ret = wl1271_acx_arp_ip_filter(wl,
Eliad Pellere5e2f242011-01-24 19:19:03 +01003619 ACX_ARP_FILTER_ARP_FILTERING,
Eliad Pellerc5312772010-12-09 11:31:27 +02003620 addr);
3621 } else
3622 ret = wl1271_acx_arp_ip_filter(wl, 0, addr);
Juuso Oikarinenca52a5e2010-07-08 17:50:02 +03003623
3624 if (ret < 0)
Arik Nemtsove78a2872010-10-16 19:07:21 +02003625 goto out;
Juuso Oikarinenca52a5e2010-07-08 17:50:02 +03003626 }
3627
Juuso Oikarinen8bf29b02010-02-18 13:25:51 +02003628 if (do_join) {
Juuso Oikarinen69e54342010-05-07 11:39:00 +03003629 ret = wl1271_join(wl, set_assoc);
Juuso Oikarinen8bf29b02010-02-18 13:25:51 +02003630 if (ret < 0) {
3631 wl1271_warning("cmd join failed %d", ret);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003632 goto out;
Juuso Oikarinen8bf29b02010-02-18 13:25:51 +02003633 }
Eliad Peller251c1772011-08-14 13:17:17 +03003634
3635 /* ROC until connected (after EAPOL exchange) */
3636 if (!is_ibss) {
3637 ret = wl12xx_roc(wl, wl->role_id);
3638 if (ret < 0)
3639 goto out;
3640
3641 wl1271_check_operstate(wl,
3642 ieee80211_get_operstate(vif));
3643 }
3644 /*
3645 * stop device role if started (we might already be in
3646 * STA role). TODO: make it better.
3647 */
3648 if (wl->dev_role_id != WL12XX_INVALID_ROLE_ID) {
3649 ret = wl12xx_croc(wl, wl->dev_role_id);
3650 if (ret < 0)
3651 goto out;
3652
3653 ret = wl12xx_cmd_role_stop_dev(wl);
3654 if (ret < 0)
3655 goto out;
3656 }
Eliad Peller05dba352011-08-23 16:37:01 +03003657
3658 /* If we want to go in PSM but we're not there yet */
3659 if (test_bit(WL1271_FLAG_PSM_REQUESTED, &wl->flags) &&
3660 !test_bit(WL1271_FLAG_PSM, &wl->flags)) {
3661 enum wl1271_cmd_ps_mode mode;
3662
3663 mode = STATION_POWER_SAVE_MODE;
3664 ret = wl1271_ps_set_mode(wl, mode,
3665 wl->basic_rate,
3666 true);
3667 if (ret < 0)
3668 goto out;
3669 }
Juuso Oikarinenc1899552010-03-26 12:53:32 +02003670 }
3671
Arik Nemtsov0b932ab2011-08-14 13:17:27 +03003672 /* Handle new association with HT. Do this after join. */
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03003673 if (sta_exists) {
3674 if ((changed & BSS_CHANGED_HT) &&
3675 (bss_conf->channel_type != NL80211_CHAN_NO_HT)) {
Arik Nemtsov0b932ab2011-08-14 13:17:27 +03003676 ret = wl1271_acx_set_ht_capabilities(wl,
3677 &sta_ht_cap,
3678 true,
3679 wl->sta_hlid);
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03003680 if (ret < 0) {
3681 wl1271_warning("Set ht cap true failed %d",
3682 ret);
3683 goto out;
3684 }
3685 }
3686 /* handle new association without HT and disassociation */
3687 else if (changed & BSS_CHANGED_ASSOC) {
Arik Nemtsov0b932ab2011-08-14 13:17:27 +03003688 ret = wl1271_acx_set_ht_capabilities(wl,
3689 &sta_ht_cap,
3690 false,
3691 wl->sta_hlid);
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03003692 if (ret < 0) {
3693 wl1271_warning("Set ht cap false failed %d",
3694 ret);
3695 goto out;
3696 }
3697 }
3698 }
3699
Arik Nemtsov0b932ab2011-08-14 13:17:27 +03003700 /* Handle HT information change. Done after join. */
3701 if ((changed & BSS_CHANGED_HT) &&
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03003702 (bss_conf->channel_type != NL80211_CHAN_NO_HT)) {
3703 ret = wl1271_acx_set_ht_information(wl,
3704 bss_conf->ht_operation_mode);
3705 if (ret < 0) {
3706 wl1271_warning("Set ht information failed %d", ret);
3707 goto out;
3708 }
3709 }
3710
Arik Nemtsove78a2872010-10-16 19:07:21 +02003711out:
3712 return;
3713}
3714
3715static void wl1271_op_bss_info_changed(struct ieee80211_hw *hw,
3716 struct ieee80211_vif *vif,
3717 struct ieee80211_bss_conf *bss_conf,
3718 u32 changed)
3719{
3720 struct wl1271 *wl = hw->priv;
3721 bool is_ap = (wl->bss_type == BSS_TYPE_AP_BSS);
3722 int ret;
3723
3724 wl1271_debug(DEBUG_MAC80211, "mac80211 bss info changed 0x%x",
3725 (int)changed);
3726
3727 mutex_lock(&wl->mutex);
3728
3729 if (unlikely(wl->state == WL1271_STATE_OFF))
3730 goto out;
3731
Ido Yariva6208652011-03-01 15:14:41 +02003732 ret = wl1271_ps_elp_wakeup(wl);
Arik Nemtsove78a2872010-10-16 19:07:21 +02003733 if (ret < 0)
3734 goto out;
3735
3736 if (is_ap)
3737 wl1271_bss_info_changed_ap(wl, vif, bss_conf, changed);
3738 else
3739 wl1271_bss_info_changed_sta(wl, vif, bss_conf, changed);
3740
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003741 wl1271_ps_elp_sleep(wl);
3742
3743out:
3744 mutex_unlock(&wl->mutex);
3745}
3746
Kalle Valoc6999d82010-02-18 13:25:41 +02003747static int wl1271_op_conf_tx(struct ieee80211_hw *hw, u16 queue,
3748 const struct ieee80211_tx_queue_params *params)
3749{
3750 struct wl1271 *wl = hw->priv;
Kalle Valo4695dc92010-03-18 12:26:38 +02003751 u8 ps_scheme;
Arik Nemtsov488fc542010-10-16 20:33:45 +02003752 int ret = 0;
Kalle Valoc6999d82010-02-18 13:25:41 +02003753
3754 mutex_lock(&wl->mutex);
3755
3756 wl1271_debug(DEBUG_MAC80211, "mac80211 conf tx %d", queue);
3757
Kalle Valo4695dc92010-03-18 12:26:38 +02003758 if (params->uapsd)
3759 ps_scheme = CONF_PS_SCHEME_UPSD_TRIGGER;
3760 else
3761 ps_scheme = CONF_PS_SCHEME_LEGACY;
3762
Arik Nemtsov488fc542010-10-16 20:33:45 +02003763 if (wl->state == WL1271_STATE_OFF) {
3764 /*
3765 * If the state is off, the parameters will be recorded and
3766 * configured on init. This happens in AP-mode.
3767 */
3768 struct conf_tx_ac_category *conf_ac =
3769 &wl->conf.tx.ac_conf[wl1271_tx_get_queue(queue)];
3770 struct conf_tx_tid *conf_tid =
3771 &wl->conf.tx.tid_conf[wl1271_tx_get_queue(queue)];
3772
3773 conf_ac->ac = wl1271_tx_get_queue(queue);
3774 conf_ac->cw_min = (u8)params->cw_min;
3775 conf_ac->cw_max = params->cw_max;
3776 conf_ac->aifsn = params->aifs;
3777 conf_ac->tx_op_limit = params->txop << 5;
3778
3779 conf_tid->queue_id = wl1271_tx_get_queue(queue);
3780 conf_tid->channel_type = CONF_CHANNEL_TYPE_EDCF;
3781 conf_tid->tsid = wl1271_tx_get_queue(queue);
3782 conf_tid->ps_scheme = ps_scheme;
3783 conf_tid->ack_policy = CONF_ACK_POLICY_LEGACY;
3784 conf_tid->apsd_conf[0] = 0;
3785 conf_tid->apsd_conf[1] = 0;
Eliad Pellerc1b193e2011-03-23 22:22:15 +02003786 goto out;
3787 }
Arik Nemtsov488fc542010-10-16 20:33:45 +02003788
Eliad Pellerc1b193e2011-03-23 22:22:15 +02003789 ret = wl1271_ps_elp_wakeup(wl);
3790 if (ret < 0)
3791 goto out;
Arik Nemtsov488fc542010-10-16 20:33:45 +02003792
Eliad Pellerc1b193e2011-03-23 22:22:15 +02003793 /*
3794 * the txop is confed in units of 32us by the mac80211,
3795 * we need us
3796 */
3797 ret = wl1271_acx_ac_cfg(wl, wl1271_tx_get_queue(queue),
3798 params->cw_min, params->cw_max,
3799 params->aifs, params->txop << 5);
3800 if (ret < 0)
3801 goto out_sleep;
3802
3803 ret = wl1271_acx_tid_cfg(wl, wl1271_tx_get_queue(queue),
3804 CONF_CHANNEL_TYPE_EDCF,
3805 wl1271_tx_get_queue(queue),
3806 ps_scheme, CONF_ACK_POLICY_LEGACY,
3807 0, 0);
Kalle Valoc82c1dd2010-02-18 13:25:47 +02003808
3809out_sleep:
Eliad Pellerc1b193e2011-03-23 22:22:15 +02003810 wl1271_ps_elp_sleep(wl);
Kalle Valoc6999d82010-02-18 13:25:41 +02003811
3812out:
3813 mutex_unlock(&wl->mutex);
3814
3815 return ret;
3816}
3817
Eliad Peller37a41b42011-09-21 14:06:11 +03003818static u64 wl1271_op_get_tsf(struct ieee80211_hw *hw,
3819 struct ieee80211_vif *vif)
Juuso Oikarinenbbbb5382010-07-08 17:49:57 +03003820{
3821
3822 struct wl1271 *wl = hw->priv;
3823 u64 mactime = ULLONG_MAX;
3824 int ret;
3825
3826 wl1271_debug(DEBUG_MAC80211, "mac80211 get tsf");
3827
3828 mutex_lock(&wl->mutex);
3829
Juuso Oikarinenf8d98022010-10-26 13:24:39 +02003830 if (unlikely(wl->state == WL1271_STATE_OFF))
3831 goto out;
3832
Ido Yariva6208652011-03-01 15:14:41 +02003833 ret = wl1271_ps_elp_wakeup(wl);
Juuso Oikarinenbbbb5382010-07-08 17:49:57 +03003834 if (ret < 0)
3835 goto out;
3836
3837 ret = wl1271_acx_tsf_info(wl, &mactime);
3838 if (ret < 0)
3839 goto out_sleep;
3840
3841out_sleep:
3842 wl1271_ps_elp_sleep(wl);
3843
3844out:
3845 mutex_unlock(&wl->mutex);
3846 return mactime;
3847}
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03003848
John W. Linvilleece550d2010-07-28 16:41:06 -04003849static int wl1271_op_get_survey(struct ieee80211_hw *hw, int idx,
3850 struct survey_info *survey)
3851{
3852 struct wl1271 *wl = hw->priv;
3853 struct ieee80211_conf *conf = &hw->conf;
Juuso Oikarinenb739a422010-10-26 13:24:38 +02003854
John W. Linvilleece550d2010-07-28 16:41:06 -04003855 if (idx != 0)
3856 return -ENOENT;
Juuso Oikarinenb739a422010-10-26 13:24:38 +02003857
John W. Linvilleece550d2010-07-28 16:41:06 -04003858 survey->channel = conf->channel;
3859 survey->filled = SURVEY_INFO_NOISE_DBM;
3860 survey->noise = wl->noise;
Juuso Oikarinenb739a422010-10-26 13:24:38 +02003861
John W. Linvilleece550d2010-07-28 16:41:06 -04003862 return 0;
3863}
3864
Arik Nemtsov409622e2011-02-23 00:22:29 +02003865static int wl1271_allocate_sta(struct wl1271 *wl,
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003866 struct ieee80211_sta *sta,
3867 u8 *hlid)
3868{
3869 struct wl1271_station *wl_sta;
3870 int id;
3871
3872 id = find_first_zero_bit(wl->ap_hlid_map, AP_MAX_STATIONS);
3873 if (id >= AP_MAX_STATIONS) {
3874 wl1271_warning("could not allocate HLID - too much stations");
3875 return -EBUSY;
3876 }
3877
3878 wl_sta = (struct wl1271_station *)sta->drv_priv;
Arik Nemtsov04216da2011-08-14 13:17:38 +03003879 set_bit(id, wl->ap_hlid_map);
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003880 wl_sta->hlid = WL1271_AP_STA_HLID_START + id;
3881 *hlid = wl_sta->hlid;
Arik Nemtsovb622d992011-02-23 00:22:31 +02003882 memcpy(wl->links[wl_sta->hlid].addr, sta->addr, ETH_ALEN);
Arik Nemtsovda032092011-08-25 12:43:15 +03003883 wl->active_sta_count++;
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003884 return 0;
3885}
3886
Arik Nemtsovf1acea92011-08-25 12:43:17 +03003887void wl1271_free_sta(struct wl1271 *wl, u8 hlid)
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003888{
3889 int id = hlid - WL1271_AP_STA_HLID_START;
3890
Arik Nemtsovf1acea92011-08-25 12:43:17 +03003891 if (hlid < WL1271_AP_STA_HLID_START)
3892 return;
3893
3894 if (!test_bit(id, wl->ap_hlid_map))
Arik Nemtsov409622e2011-02-23 00:22:29 +02003895 return;
3896
Arik Nemtsov04216da2011-08-14 13:17:38 +03003897 clear_bit(id, wl->ap_hlid_map);
Arik Nemtsovb622d992011-02-23 00:22:31 +02003898 memset(wl->links[hlid].addr, 0, ETH_ALEN);
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03003899 wl->links[hlid].ba_bitmap = 0;
Arik Nemtsova8c0ddb2011-02-23 00:22:26 +02003900 wl1271_tx_reset_link_queues(wl, hlid);
Arik Nemtsovb622d992011-02-23 00:22:31 +02003901 __clear_bit(hlid, &wl->ap_ps_map);
3902 __clear_bit(hlid, (unsigned long *)&wl->ap_fw_ps_map);
Arik Nemtsovda032092011-08-25 12:43:15 +03003903 wl->active_sta_count--;
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003904}
3905
3906static int wl1271_op_sta_add(struct ieee80211_hw *hw,
3907 struct ieee80211_vif *vif,
3908 struct ieee80211_sta *sta)
3909{
3910 struct wl1271 *wl = hw->priv;
3911 int ret = 0;
3912 u8 hlid;
3913
3914 mutex_lock(&wl->mutex);
3915
3916 if (unlikely(wl->state == WL1271_STATE_OFF))
3917 goto out;
3918
3919 if (wl->bss_type != BSS_TYPE_AP_BSS)
3920 goto out;
3921
3922 wl1271_debug(DEBUG_MAC80211, "mac80211 add sta %d", (int)sta->aid);
3923
Arik Nemtsov409622e2011-02-23 00:22:29 +02003924 ret = wl1271_allocate_sta(wl, sta, &hlid);
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003925 if (ret < 0)
3926 goto out;
3927
Ido Yariva6208652011-03-01 15:14:41 +02003928 ret = wl1271_ps_elp_wakeup(wl);
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003929 if (ret < 0)
Arik Nemtsov409622e2011-02-23 00:22:29 +02003930 goto out_free_sta;
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003931
Eliad Pellerc690ec82011-08-14 13:17:07 +03003932 ret = wl12xx_cmd_add_peer(wl, sta, hlid);
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003933 if (ret < 0)
3934 goto out_sleep;
3935
Eliad Pellerb67476e2011-08-14 13:17:23 +03003936 ret = wl12xx_cmd_set_peer_state(wl, hlid);
3937 if (ret < 0)
3938 goto out_sleep;
3939
Arik Nemtsov0b932ab2011-08-14 13:17:27 +03003940 ret = wl1271_acx_set_ht_capabilities(wl, &sta->ht_cap, true, hlid);
3941 if (ret < 0)
3942 goto out_sleep;
3943
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003944out_sleep:
3945 wl1271_ps_elp_sleep(wl);
3946
Arik Nemtsov409622e2011-02-23 00:22:29 +02003947out_free_sta:
3948 if (ret < 0)
3949 wl1271_free_sta(wl, hlid);
3950
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003951out:
3952 mutex_unlock(&wl->mutex);
3953 return ret;
3954}
3955
3956static int wl1271_op_sta_remove(struct ieee80211_hw *hw,
3957 struct ieee80211_vif *vif,
3958 struct ieee80211_sta *sta)
3959{
3960 struct wl1271 *wl = hw->priv;
3961 struct wl1271_station *wl_sta;
3962 int ret = 0, id;
3963
3964 mutex_lock(&wl->mutex);
3965
3966 if (unlikely(wl->state == WL1271_STATE_OFF))
3967 goto out;
3968
3969 if (wl->bss_type != BSS_TYPE_AP_BSS)
3970 goto out;
3971
3972 wl1271_debug(DEBUG_MAC80211, "mac80211 remove sta %d", (int)sta->aid);
3973
3974 wl_sta = (struct wl1271_station *)sta->drv_priv;
3975 id = wl_sta->hlid - WL1271_AP_STA_HLID_START;
3976 if (WARN_ON(!test_bit(id, wl->ap_hlid_map)))
3977 goto out;
3978
Ido Yariva6208652011-03-01 15:14:41 +02003979 ret = wl1271_ps_elp_wakeup(wl);
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003980 if (ret < 0)
3981 goto out;
3982
Eliad Pellerc690ec82011-08-14 13:17:07 +03003983 ret = wl12xx_cmd_remove_peer(wl, wl_sta->hlid);
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003984 if (ret < 0)
3985 goto out_sleep;
3986
Arik Nemtsov409622e2011-02-23 00:22:29 +02003987 wl1271_free_sta(wl, wl_sta->hlid);
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02003988
3989out_sleep:
3990 wl1271_ps_elp_sleep(wl);
3991
3992out:
3993 mutex_unlock(&wl->mutex);
3994 return ret;
3995}
3996
Luciano Coelho4623ec72011-03-21 19:26:41 +02003997static int wl1271_op_ampdu_action(struct ieee80211_hw *hw,
3998 struct ieee80211_vif *vif,
3999 enum ieee80211_ampdu_mlme_action action,
4000 struct ieee80211_sta *sta, u16 tid, u16 *ssn,
4001 u8 buf_size)
Levi, Shaharbbba3e62011-01-23 07:27:23 +01004002{
4003 struct wl1271 *wl = hw->priv;
4004 int ret;
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03004005 u8 hlid, *ba_bitmap;
4006
4007 wl1271_debug(DEBUG_MAC80211, "mac80211 ampdu action %d tid %d", action,
4008 tid);
4009
4010 /* sanity check - the fields in FW are only 8bits wide */
4011 if (WARN_ON(tid > 0xFF))
4012 return -ENOTSUPP;
Levi, Shaharbbba3e62011-01-23 07:27:23 +01004013
4014 mutex_lock(&wl->mutex);
4015
4016 if (unlikely(wl->state == WL1271_STATE_OFF)) {
4017 ret = -EAGAIN;
4018 goto out;
4019 }
4020
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03004021 if (wl->bss_type == BSS_TYPE_STA_BSS) {
4022 hlid = wl->sta_hlid;
4023 ba_bitmap = &wl->ba_rx_bitmap;
4024 } else if (wl->bss_type == BSS_TYPE_AP_BSS) {
4025 struct wl1271_station *wl_sta;
4026
4027 wl_sta = (struct wl1271_station *)sta->drv_priv;
4028 hlid = wl_sta->hlid;
4029 ba_bitmap = &wl->links[hlid].ba_bitmap;
4030 } else {
4031 ret = -EINVAL;
4032 goto out;
4033 }
4034
Ido Yariva6208652011-03-01 15:14:41 +02004035 ret = wl1271_ps_elp_wakeup(wl);
Levi, Shaharbbba3e62011-01-23 07:27:23 +01004036 if (ret < 0)
4037 goto out;
4038
Shahar Levi70559a02011-05-22 16:10:22 +03004039 wl1271_debug(DEBUG_MAC80211, "mac80211 ampdu: Rx tid %d action %d",
4040 tid, action);
4041
Levi, Shaharbbba3e62011-01-23 07:27:23 +01004042 switch (action) {
4043 case IEEE80211_AMPDU_RX_START:
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03004044 if (!wl->ba_support || !wl->ba_allowed) {
Levi, Shaharbbba3e62011-01-23 07:27:23 +01004045 ret = -ENOTSUPP;
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03004046 break;
4047 }
4048
4049 if (wl->ba_rx_session_count >= RX_BA_MAX_SESSIONS) {
4050 ret = -EBUSY;
4051 wl1271_error("exceeded max RX BA sessions");
4052 break;
4053 }
4054
4055 if (*ba_bitmap & BIT(tid)) {
4056 ret = -EINVAL;
4057 wl1271_error("cannot enable RX BA session on active "
4058 "tid: %d", tid);
4059 break;
4060 }
4061
4062 ret = wl12xx_acx_set_ba_receiver_session(wl, tid, *ssn, true,
4063 hlid);
4064 if (!ret) {
4065 *ba_bitmap |= BIT(tid);
4066 wl->ba_rx_session_count++;
Levi, Shaharbbba3e62011-01-23 07:27:23 +01004067 }
4068 break;
4069
4070 case IEEE80211_AMPDU_RX_STOP:
Arik Nemtsov0f9c8252011-08-17 10:45:49 +03004071 if (!(*ba_bitmap & BIT(tid))) {
4072 ret = -EINVAL;
4073 wl1271_error("no active RX BA session on tid: %d",
4074 tid);
4075 break;
4076 }
4077
4078 ret = wl12xx_acx_set_ba_receiver_session(wl, tid, 0, false,
4079 hlid);
4080 if (!ret) {
4081 *ba_bitmap &= ~BIT(tid);
4082 wl->ba_rx_session_count--;
4083 }
Levi, Shaharbbba3e62011-01-23 07:27:23 +01004084 break;
4085
4086 /*
4087 * The BA initiator session management in FW independently.
4088 * Falling break here on purpose for all TX APDU commands.
4089 */
4090 case IEEE80211_AMPDU_TX_START:
4091 case IEEE80211_AMPDU_TX_STOP:
4092 case IEEE80211_AMPDU_TX_OPERATIONAL:
4093 ret = -EINVAL;
4094 break;
4095
4096 default:
4097 wl1271_error("Incorrect ampdu action id=%x\n", action);
4098 ret = -EINVAL;
4099 }
4100
4101 wl1271_ps_elp_sleep(wl);
4102
4103out:
4104 mutex_unlock(&wl->mutex);
4105
4106 return ret;
4107}
4108
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03004109static int wl12xx_set_bitrate_mask(struct ieee80211_hw *hw,
4110 struct ieee80211_vif *vif,
4111 const struct cfg80211_bitrate_mask *mask)
4112{
4113 struct wl1271 *wl = hw->priv;
4114 int i;
4115
4116 wl1271_debug(DEBUG_MAC80211, "mac80211 set_bitrate_mask 0x%x 0x%x",
4117 mask->control[NL80211_BAND_2GHZ].legacy,
4118 mask->control[NL80211_BAND_5GHZ].legacy);
4119
4120 mutex_lock(&wl->mutex);
4121
4122 for (i = 0; i < IEEE80211_NUM_BANDS; i++)
4123 wl->bitrate_masks[i] =
4124 wl1271_tx_enabled_rates_get(wl,
4125 mask->control[i].legacy,
4126 i);
4127 mutex_unlock(&wl->mutex);
4128
4129 return 0;
4130}
4131
Arik Nemtsov33437892011-04-26 23:35:39 +03004132static bool wl1271_tx_frames_pending(struct ieee80211_hw *hw)
4133{
4134 struct wl1271 *wl = hw->priv;
4135 bool ret = false;
4136
4137 mutex_lock(&wl->mutex);
4138
4139 if (unlikely(wl->state == WL1271_STATE_OFF))
4140 goto out;
4141
4142 /* packets are considered pending if in the TX queue or the FW */
Arik Nemtsovf1a46382011-07-07 14:25:23 +03004143 ret = (wl1271_tx_total_queue_count(wl) > 0) || (wl->tx_frames_cnt > 0);
Arik Nemtsov33437892011-04-26 23:35:39 +03004144
4145 /* the above is appropriate for STA mode for PS purposes */
4146 WARN_ON(wl->bss_type != BSS_TYPE_STA_BSS);
4147
4148out:
4149 mutex_unlock(&wl->mutex);
4150
4151 return ret;
4152}
4153
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004154/* can't be const, mac80211 writes to this */
4155static struct ieee80211_rate wl1271_rates[] = {
4156 { .bitrate = 10,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004157 .hw_value = CONF_HW_BIT_RATE_1MBPS,
4158 .hw_value_short = CONF_HW_BIT_RATE_1MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004159 { .bitrate = 20,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004160 .hw_value = CONF_HW_BIT_RATE_2MBPS,
4161 .hw_value_short = CONF_HW_BIT_RATE_2MBPS,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004162 .flags = IEEE80211_RATE_SHORT_PREAMBLE },
4163 { .bitrate = 55,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004164 .hw_value = CONF_HW_BIT_RATE_5_5MBPS,
4165 .hw_value_short = CONF_HW_BIT_RATE_5_5MBPS,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004166 .flags = IEEE80211_RATE_SHORT_PREAMBLE },
4167 { .bitrate = 110,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004168 .hw_value = CONF_HW_BIT_RATE_11MBPS,
4169 .hw_value_short = CONF_HW_BIT_RATE_11MBPS,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004170 .flags = IEEE80211_RATE_SHORT_PREAMBLE },
4171 { .bitrate = 60,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004172 .hw_value = CONF_HW_BIT_RATE_6MBPS,
4173 .hw_value_short = CONF_HW_BIT_RATE_6MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004174 { .bitrate = 90,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004175 .hw_value = CONF_HW_BIT_RATE_9MBPS,
4176 .hw_value_short = CONF_HW_BIT_RATE_9MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004177 { .bitrate = 120,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004178 .hw_value = CONF_HW_BIT_RATE_12MBPS,
4179 .hw_value_short = CONF_HW_BIT_RATE_12MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004180 { .bitrate = 180,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004181 .hw_value = CONF_HW_BIT_RATE_18MBPS,
4182 .hw_value_short = CONF_HW_BIT_RATE_18MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004183 { .bitrate = 240,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004184 .hw_value = CONF_HW_BIT_RATE_24MBPS,
4185 .hw_value_short = CONF_HW_BIT_RATE_24MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004186 { .bitrate = 360,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004187 .hw_value = CONF_HW_BIT_RATE_36MBPS,
4188 .hw_value_short = CONF_HW_BIT_RATE_36MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004189 { .bitrate = 480,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004190 .hw_value = CONF_HW_BIT_RATE_48MBPS,
4191 .hw_value_short = CONF_HW_BIT_RATE_48MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004192 { .bitrate = 540,
Juuso Oikarinen2b60100b2009-10-13 12:47:39 +03004193 .hw_value = CONF_HW_BIT_RATE_54MBPS,
4194 .hw_value_short = CONF_HW_BIT_RATE_54MBPS, },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004195};
4196
Juuso Oikarinenfa97f462010-11-10 11:27:20 +01004197/* can't be const, mac80211 writes to this */
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004198static struct ieee80211_channel wl1271_channels[] = {
Luciano Coelhoa2d0e3f2009-12-11 15:40:46 +02004199 { .hw_value = 1, .center_freq = 2412, .max_power = 25 },
Juuso Oikarinenfa21c7a2010-08-10 08:22:02 +02004200 { .hw_value = 2, .center_freq = 2417, .max_power = 25 },
Juuso Oikarinenfa97f462010-11-10 11:27:20 +01004201 { .hw_value = 3, .center_freq = 2422, .max_power = 25 },
4202 { .hw_value = 4, .center_freq = 2427, .max_power = 25 },
4203 { .hw_value = 5, .center_freq = 2432, .max_power = 25 },
Juuso Oikarinenfa21c7a2010-08-10 08:22:02 +02004204 { .hw_value = 6, .center_freq = 2437, .max_power = 25 },
Juuso Oikarinenfa97f462010-11-10 11:27:20 +01004205 { .hw_value = 7, .center_freq = 2442, .max_power = 25 },
4206 { .hw_value = 8, .center_freq = 2447, .max_power = 25 },
4207 { .hw_value = 9, .center_freq = 2452, .max_power = 25 },
Juuso Oikarinenfa21c7a2010-08-10 08:22:02 +02004208 { .hw_value = 10, .center_freq = 2457, .max_power = 25 },
Juuso Oikarinenfa97f462010-11-10 11:27:20 +01004209 { .hw_value = 11, .center_freq = 2462, .max_power = 25 },
4210 { .hw_value = 12, .center_freq = 2467, .max_power = 25 },
4211 { .hw_value = 13, .center_freq = 2472, .max_power = 25 },
Arik Nemtsov6c89b7b2011-01-18 20:39:52 +01004212 { .hw_value = 14, .center_freq = 2484, .max_power = 25 },
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004213};
4214
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004215/* mapping to indexes for wl1271_rates */
Tobias Klausera0ea9492010-05-20 10:38:11 +02004216static const u8 wl1271_rate_to_idx_2ghz[] = {
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004217 /* MCS rates are used only with 11n */
Shahar Levi18357852010-10-13 16:09:41 +02004218 7, /* CONF_HW_RXTX_RATE_MCS7 */
4219 6, /* CONF_HW_RXTX_RATE_MCS6 */
4220 5, /* CONF_HW_RXTX_RATE_MCS5 */
4221 4, /* CONF_HW_RXTX_RATE_MCS4 */
4222 3, /* CONF_HW_RXTX_RATE_MCS3 */
4223 2, /* CONF_HW_RXTX_RATE_MCS2 */
4224 1, /* CONF_HW_RXTX_RATE_MCS1 */
4225 0, /* CONF_HW_RXTX_RATE_MCS0 */
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004226
4227 11, /* CONF_HW_RXTX_RATE_54 */
4228 10, /* CONF_HW_RXTX_RATE_48 */
4229 9, /* CONF_HW_RXTX_RATE_36 */
4230 8, /* CONF_HW_RXTX_RATE_24 */
4231
4232 /* TI-specific rate */
4233 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_22 */
4234
4235 7, /* CONF_HW_RXTX_RATE_18 */
4236 6, /* CONF_HW_RXTX_RATE_12 */
4237 3, /* CONF_HW_RXTX_RATE_11 */
4238 5, /* CONF_HW_RXTX_RATE_9 */
4239 4, /* CONF_HW_RXTX_RATE_6 */
4240 2, /* CONF_HW_RXTX_RATE_5_5 */
4241 1, /* CONF_HW_RXTX_RATE_2 */
4242 0 /* CONF_HW_RXTX_RATE_1 */
4243};
4244
Shahar Levie8b03a22010-10-13 16:09:39 +02004245/* 11n STA capabilities */
4246#define HW_RX_HIGHEST_RATE 72
4247
Shahar Levi00d20102010-11-08 11:20:10 +00004248#define WL12XX_HT_CAP { \
Shahar Levi871d0c32011-03-13 11:24:40 +02004249 .cap = IEEE80211_HT_CAP_GRN_FLD | IEEE80211_HT_CAP_SGI_20 | \
4250 (1 << IEEE80211_HT_CAP_RX_STBC_SHIFT), \
Shahar Levie8b03a22010-10-13 16:09:39 +02004251 .ht_supported = true, \
4252 .ampdu_factor = IEEE80211_HT_MAX_AMPDU_8K, \
4253 .ampdu_density = IEEE80211_HT_MPDU_DENSITY_8, \
4254 .mcs = { \
4255 .rx_mask = { 0xff, 0, 0, 0, 0, 0, 0, 0, 0, 0, }, \
4256 .rx_highest = cpu_to_le16(HW_RX_HIGHEST_RATE), \
4257 .tx_params = IEEE80211_HT_MCS_TX_DEFINED, \
4258 }, \
4259}
4260
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004261/* can't be const, mac80211 writes to this */
4262static struct ieee80211_supported_band wl1271_band_2ghz = {
4263 .channels = wl1271_channels,
4264 .n_channels = ARRAY_SIZE(wl1271_channels),
4265 .bitrates = wl1271_rates,
4266 .n_bitrates = ARRAY_SIZE(wl1271_rates),
Shahar Levi00d20102010-11-08 11:20:10 +00004267 .ht_cap = WL12XX_HT_CAP,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004268};
4269
Teemu Paasikivi1ebec3d2009-10-13 12:47:48 +03004270/* 5 GHz data rates for WL1273 */
4271static struct ieee80211_rate wl1271_rates_5ghz[] = {
4272 { .bitrate = 60,
4273 .hw_value = CONF_HW_BIT_RATE_6MBPS,
4274 .hw_value_short = CONF_HW_BIT_RATE_6MBPS, },
4275 { .bitrate = 90,
4276 .hw_value = CONF_HW_BIT_RATE_9MBPS,
4277 .hw_value_short = CONF_HW_BIT_RATE_9MBPS, },
4278 { .bitrate = 120,
4279 .hw_value = CONF_HW_BIT_RATE_12MBPS,
4280 .hw_value_short = CONF_HW_BIT_RATE_12MBPS, },
4281 { .bitrate = 180,
4282 .hw_value = CONF_HW_BIT_RATE_18MBPS,
4283 .hw_value_short = CONF_HW_BIT_RATE_18MBPS, },
4284 { .bitrate = 240,
4285 .hw_value = CONF_HW_BIT_RATE_24MBPS,
4286 .hw_value_short = CONF_HW_BIT_RATE_24MBPS, },
4287 { .bitrate = 360,
4288 .hw_value = CONF_HW_BIT_RATE_36MBPS,
4289 .hw_value_short = CONF_HW_BIT_RATE_36MBPS, },
4290 { .bitrate = 480,
4291 .hw_value = CONF_HW_BIT_RATE_48MBPS,
4292 .hw_value_short = CONF_HW_BIT_RATE_48MBPS, },
4293 { .bitrate = 540,
4294 .hw_value = CONF_HW_BIT_RATE_54MBPS,
4295 .hw_value_short = CONF_HW_BIT_RATE_54MBPS, },
4296};
4297
Juuso Oikarinenfa97f462010-11-10 11:27:20 +01004298/* 5 GHz band channels for WL1273 */
Teemu Paasikivi1ebec3d2009-10-13 12:47:48 +03004299static struct ieee80211_channel wl1271_channels_5ghz[] = {
Arik Nemtsov6cfa5cf2011-06-27 22:06:33 +03004300 { .hw_value = 7, .center_freq = 5035, .max_power = 25 },
4301 { .hw_value = 8, .center_freq = 5040, .max_power = 25 },
4302 { .hw_value = 9, .center_freq = 5045, .max_power = 25 },
4303 { .hw_value = 11, .center_freq = 5055, .max_power = 25 },
4304 { .hw_value = 12, .center_freq = 5060, .max_power = 25 },
4305 { .hw_value = 16, .center_freq = 5080, .max_power = 25 },
4306 { .hw_value = 34, .center_freq = 5170, .max_power = 25 },
4307 { .hw_value = 36, .center_freq = 5180, .max_power = 25 },
4308 { .hw_value = 38, .center_freq = 5190, .max_power = 25 },
4309 { .hw_value = 40, .center_freq = 5200, .max_power = 25 },
4310 { .hw_value = 42, .center_freq = 5210, .max_power = 25 },
4311 { .hw_value = 44, .center_freq = 5220, .max_power = 25 },
4312 { .hw_value = 46, .center_freq = 5230, .max_power = 25 },
4313 { .hw_value = 48, .center_freq = 5240, .max_power = 25 },
4314 { .hw_value = 52, .center_freq = 5260, .max_power = 25 },
4315 { .hw_value = 56, .center_freq = 5280, .max_power = 25 },
4316 { .hw_value = 60, .center_freq = 5300, .max_power = 25 },
4317 { .hw_value = 64, .center_freq = 5320, .max_power = 25 },
4318 { .hw_value = 100, .center_freq = 5500, .max_power = 25 },
4319 { .hw_value = 104, .center_freq = 5520, .max_power = 25 },
4320 { .hw_value = 108, .center_freq = 5540, .max_power = 25 },
4321 { .hw_value = 112, .center_freq = 5560, .max_power = 25 },
4322 { .hw_value = 116, .center_freq = 5580, .max_power = 25 },
4323 { .hw_value = 120, .center_freq = 5600, .max_power = 25 },
4324 { .hw_value = 124, .center_freq = 5620, .max_power = 25 },
4325 { .hw_value = 128, .center_freq = 5640, .max_power = 25 },
4326 { .hw_value = 132, .center_freq = 5660, .max_power = 25 },
4327 { .hw_value = 136, .center_freq = 5680, .max_power = 25 },
4328 { .hw_value = 140, .center_freq = 5700, .max_power = 25 },
4329 { .hw_value = 149, .center_freq = 5745, .max_power = 25 },
4330 { .hw_value = 153, .center_freq = 5765, .max_power = 25 },
4331 { .hw_value = 157, .center_freq = 5785, .max_power = 25 },
4332 { .hw_value = 161, .center_freq = 5805, .max_power = 25 },
4333 { .hw_value = 165, .center_freq = 5825, .max_power = 25 },
Teemu Paasikivi1ebec3d2009-10-13 12:47:48 +03004334};
4335
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004336/* mapping to indexes for wl1271_rates_5ghz */
Tobias Klausera0ea9492010-05-20 10:38:11 +02004337static const u8 wl1271_rate_to_idx_5ghz[] = {
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004338 /* MCS rates are used only with 11n */
Shahar Levi18357852010-10-13 16:09:41 +02004339 7, /* CONF_HW_RXTX_RATE_MCS7 */
4340 6, /* CONF_HW_RXTX_RATE_MCS6 */
4341 5, /* CONF_HW_RXTX_RATE_MCS5 */
4342 4, /* CONF_HW_RXTX_RATE_MCS4 */
4343 3, /* CONF_HW_RXTX_RATE_MCS3 */
4344 2, /* CONF_HW_RXTX_RATE_MCS2 */
4345 1, /* CONF_HW_RXTX_RATE_MCS1 */
4346 0, /* CONF_HW_RXTX_RATE_MCS0 */
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004347
4348 7, /* CONF_HW_RXTX_RATE_54 */
4349 6, /* CONF_HW_RXTX_RATE_48 */
4350 5, /* CONF_HW_RXTX_RATE_36 */
4351 4, /* CONF_HW_RXTX_RATE_24 */
4352
4353 /* TI-specific rate */
4354 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_22 */
4355
4356 3, /* CONF_HW_RXTX_RATE_18 */
4357 2, /* CONF_HW_RXTX_RATE_12 */
4358 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_11 */
4359 1, /* CONF_HW_RXTX_RATE_9 */
4360 0, /* CONF_HW_RXTX_RATE_6 */
4361 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_5_5 */
4362 CONF_HW_RXTX_RATE_UNSUPPORTED, /* CONF_HW_RXTX_RATE_2 */
4363 CONF_HW_RXTX_RATE_UNSUPPORTED /* CONF_HW_RXTX_RATE_1 */
4364};
Teemu Paasikivi1ebec3d2009-10-13 12:47:48 +03004365
4366static struct ieee80211_supported_band wl1271_band_5ghz = {
4367 .channels = wl1271_channels_5ghz,
4368 .n_channels = ARRAY_SIZE(wl1271_channels_5ghz),
4369 .bitrates = wl1271_rates_5ghz,
4370 .n_bitrates = ARRAY_SIZE(wl1271_rates_5ghz),
Shahar Levi00d20102010-11-08 11:20:10 +00004371 .ht_cap = WL12XX_HT_CAP,
Teemu Paasikivi1ebec3d2009-10-13 12:47:48 +03004372};
4373
Tobias Klausera0ea9492010-05-20 10:38:11 +02004374static const u8 *wl1271_band_rate_to_idx[] = {
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004375 [IEEE80211_BAND_2GHZ] = wl1271_rate_to_idx_2ghz,
4376 [IEEE80211_BAND_5GHZ] = wl1271_rate_to_idx_5ghz
4377};
4378
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004379static const struct ieee80211_ops wl1271_ops = {
4380 .start = wl1271_op_start,
4381 .stop = wl1271_op_stop,
4382 .add_interface = wl1271_op_add_interface,
4383 .remove_interface = wl1271_op_remove_interface,
Luciano Coelhof634a4e2011-05-18 16:51:26 -04004384#ifdef CONFIG_PM
Eliad Peller402e48612011-05-13 11:57:09 +03004385 .suspend = wl1271_op_suspend,
4386 .resume = wl1271_op_resume,
Luciano Coelhof634a4e2011-05-18 16:51:26 -04004387#endif
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004388 .config = wl1271_op_config,
Juuso Oikarinenc87dec92009-10-08 21:56:31 +03004389 .prepare_multicast = wl1271_op_prepare_multicast,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004390 .configure_filter = wl1271_op_configure_filter,
4391 .tx = wl1271_op_tx,
4392 .set_key = wl1271_op_set_key,
4393 .hw_scan = wl1271_op_hw_scan,
Eliad Peller73ecce32011-06-27 13:06:45 +03004394 .cancel_hw_scan = wl1271_op_cancel_hw_scan,
Luciano Coelho33c2c062011-05-10 14:46:02 +03004395 .sched_scan_start = wl1271_op_sched_scan_start,
4396 .sched_scan_stop = wl1271_op_sched_scan_stop,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004397 .bss_info_changed = wl1271_op_bss_info_changed,
Arik Nemtsov68d069c2010-11-08 10:51:07 +01004398 .set_frag_threshold = wl1271_op_set_frag_threshold,
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004399 .set_rts_threshold = wl1271_op_set_rts_threshold,
Kalle Valoc6999d82010-02-18 13:25:41 +02004400 .conf_tx = wl1271_op_conf_tx,
Juuso Oikarinenbbbb5382010-07-08 17:49:57 +03004401 .get_tsf = wl1271_op_get_tsf,
John W. Linvilleece550d2010-07-28 16:41:06 -04004402 .get_survey = wl1271_op_get_survey,
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02004403 .sta_add = wl1271_op_sta_add,
4404 .sta_remove = wl1271_op_sta_remove,
Levi, Shaharbbba3e62011-01-23 07:27:23 +01004405 .ampdu_action = wl1271_op_ampdu_action,
Arik Nemtsov33437892011-04-26 23:35:39 +03004406 .tx_frames_pending = wl1271_tx_frames_pending,
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03004407 .set_bitrate_mask = wl12xx_set_bitrate_mask,
Kalle Valoc8c90872010-02-18 13:25:53 +02004408 CFG80211_TESTMODE_CMD(wl1271_tm_cmd)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004409};
4410
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004411
Teemu Paasikivi6a2de932010-10-14 11:00:04 +02004412u8 wl1271_rate_to_idx(int rate, enum ieee80211_band band)
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004413{
4414 u8 idx;
4415
Teemu Paasikivi6a2de932010-10-14 11:00:04 +02004416 BUG_ON(band >= sizeof(wl1271_band_rate_to_idx)/sizeof(u8 *));
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004417
4418 if (unlikely(rate >= CONF_HW_RXTX_RATE_MAX)) {
4419 wl1271_error("Illegal RX rate from HW: %d", rate);
4420 return 0;
4421 }
4422
Teemu Paasikivi6a2de932010-10-14 11:00:04 +02004423 idx = wl1271_band_rate_to_idx[band][rate];
Juuso Oikarinenf876bb92010-03-26 12:53:11 +02004424 if (unlikely(idx == CONF_HW_RXTX_RATE_UNSUPPORTED)) {
4425 wl1271_error("Unsupported RX rate from HW: %d", rate);
4426 return 0;
4427 }
4428
4429 return idx;
4430}
4431
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004432static ssize_t wl1271_sysfs_show_bt_coex_state(struct device *dev,
4433 struct device_attribute *attr,
4434 char *buf)
4435{
4436 struct wl1271 *wl = dev_get_drvdata(dev);
4437 ssize_t len;
4438
Juuso Oikarinen2f63b012010-08-10 06:38:35 +02004439 len = PAGE_SIZE;
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004440
4441 mutex_lock(&wl->mutex);
4442 len = snprintf(buf, len, "%d\n\n0 - off\n1 - on\n",
4443 wl->sg_enabled);
4444 mutex_unlock(&wl->mutex);
4445
4446 return len;
4447
4448}
4449
4450static ssize_t wl1271_sysfs_store_bt_coex_state(struct device *dev,
4451 struct device_attribute *attr,
4452 const char *buf, size_t count)
4453{
4454 struct wl1271 *wl = dev_get_drvdata(dev);
4455 unsigned long res;
4456 int ret;
4457
Luciano Coelho6277ed62011-04-01 17:49:54 +03004458 ret = kstrtoul(buf, 10, &res);
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004459 if (ret < 0) {
4460 wl1271_warning("incorrect value written to bt_coex_mode");
4461 return count;
4462 }
4463
4464 mutex_lock(&wl->mutex);
4465
4466 res = !!res;
4467
4468 if (res == wl->sg_enabled)
4469 goto out;
4470
4471 wl->sg_enabled = res;
4472
4473 if (wl->state == WL1271_STATE_OFF)
4474 goto out;
4475
Ido Yariva6208652011-03-01 15:14:41 +02004476 ret = wl1271_ps_elp_wakeup(wl);
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004477 if (ret < 0)
4478 goto out;
4479
4480 wl1271_acx_sg_enable(wl, wl->sg_enabled);
4481 wl1271_ps_elp_sleep(wl);
4482
4483 out:
4484 mutex_unlock(&wl->mutex);
4485 return count;
4486}
4487
4488static DEVICE_ATTR(bt_coex_state, S_IRUGO | S_IWUSR,
4489 wl1271_sysfs_show_bt_coex_state,
4490 wl1271_sysfs_store_bt_coex_state);
4491
Juuso Oikarinend717fd62010-05-07 11:38:58 +03004492static ssize_t wl1271_sysfs_show_hw_pg_ver(struct device *dev,
4493 struct device_attribute *attr,
4494 char *buf)
4495{
4496 struct wl1271 *wl = dev_get_drvdata(dev);
4497 ssize_t len;
4498
Juuso Oikarinen2f63b012010-08-10 06:38:35 +02004499 len = PAGE_SIZE;
Juuso Oikarinend717fd62010-05-07 11:38:58 +03004500
4501 mutex_lock(&wl->mutex);
4502 if (wl->hw_pg_ver >= 0)
4503 len = snprintf(buf, len, "%d\n", wl->hw_pg_ver);
4504 else
4505 len = snprintf(buf, len, "n/a\n");
4506 mutex_unlock(&wl->mutex);
4507
4508 return len;
4509}
4510
Gery Kahn6f07b722011-07-18 14:21:49 +03004511static DEVICE_ATTR(hw_pg_ver, S_IRUGO,
Juuso Oikarinend717fd62010-05-07 11:38:58 +03004512 wl1271_sysfs_show_hw_pg_ver, NULL);
4513
Ido Yariv95dac04f2011-06-06 14:57:06 +03004514static ssize_t wl1271_sysfs_read_fwlog(struct file *filp, struct kobject *kobj,
4515 struct bin_attribute *bin_attr,
4516 char *buffer, loff_t pos, size_t count)
4517{
4518 struct device *dev = container_of(kobj, struct device, kobj);
4519 struct wl1271 *wl = dev_get_drvdata(dev);
4520 ssize_t len;
4521 int ret;
4522
4523 ret = mutex_lock_interruptible(&wl->mutex);
4524 if (ret < 0)
4525 return -ERESTARTSYS;
4526
4527 /* Let only one thread read the log at a time, blocking others */
4528 while (wl->fwlog_size == 0) {
4529 DEFINE_WAIT(wait);
4530
4531 prepare_to_wait_exclusive(&wl->fwlog_waitq,
4532 &wait,
4533 TASK_INTERRUPTIBLE);
4534
4535 if (wl->fwlog_size != 0) {
4536 finish_wait(&wl->fwlog_waitq, &wait);
4537 break;
4538 }
4539
4540 mutex_unlock(&wl->mutex);
4541
4542 schedule();
4543 finish_wait(&wl->fwlog_waitq, &wait);
4544
4545 if (signal_pending(current))
4546 return -ERESTARTSYS;
4547
4548 ret = mutex_lock_interruptible(&wl->mutex);
4549 if (ret < 0)
4550 return -ERESTARTSYS;
4551 }
4552
4553 /* Check if the fwlog is still valid */
4554 if (wl->fwlog_size < 0) {
4555 mutex_unlock(&wl->mutex);
4556 return 0;
4557 }
4558
4559 /* Seeking is not supported - old logs are not kept. Disregard pos. */
4560 len = min(count, (size_t)wl->fwlog_size);
4561 wl->fwlog_size -= len;
4562 memcpy(buffer, wl->fwlog, len);
4563
4564 /* Make room for new messages */
4565 memmove(wl->fwlog, wl->fwlog + len, wl->fwlog_size);
4566
4567 mutex_unlock(&wl->mutex);
4568
4569 return len;
4570}
4571
4572static struct bin_attribute fwlog_attr = {
4573 .attr = {.name = "fwlog", .mode = S_IRUSR},
4574 .read = wl1271_sysfs_read_fwlog,
4575};
4576
Teemu Paasikivi2d5e82b2010-02-22 08:38:21 +02004577int wl1271_register_hw(struct wl1271 *wl)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004578{
4579 int ret;
4580
4581 if (wl->mac80211_registered)
4582 return 0;
4583
Arik Nemtsov31d26ec2010-10-16 21:49:52 +02004584 ret = wl1271_fetch_nvs(wl);
4585 if (ret == 0) {
Shahar Levibc765bf2011-03-06 16:32:10 +02004586 /* NOTE: The wl->nvs->nvs element must be first, in
4587 * order to simplify the casting, we assume it is at
4588 * the beginning of the wl->nvs structure.
4589 */
4590 u8 *nvs_ptr = (u8 *)wl->nvs;
Arik Nemtsov31d26ec2010-10-16 21:49:52 +02004591
4592 wl->mac_addr[0] = nvs_ptr[11];
4593 wl->mac_addr[1] = nvs_ptr[10];
4594 wl->mac_addr[2] = nvs_ptr[6];
4595 wl->mac_addr[3] = nvs_ptr[5];
4596 wl->mac_addr[4] = nvs_ptr[4];
4597 wl->mac_addr[5] = nvs_ptr[3];
4598 }
4599
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004600 SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr);
4601
4602 ret = ieee80211_register_hw(wl->hw);
4603 if (ret < 0) {
4604 wl1271_error("unable to register mac80211 hw: %d", ret);
4605 return ret;
4606 }
4607
4608 wl->mac80211_registered = true;
4609
Eliad Pellerd60080a2010-11-24 12:53:16 +02004610 wl1271_debugfs_init(wl);
4611
Juuso Oikarinenc2c192a2010-07-27 03:30:09 +03004612 register_netdevice_notifier(&wl1271_dev_notifier);
4613
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004614 wl1271_notice("loaded");
4615
4616 return 0;
4617}
Teemu Paasikivi50b3eb42010-02-22 08:38:26 +02004618EXPORT_SYMBOL_GPL(wl1271_register_hw);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004619
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004620void wl1271_unregister_hw(struct wl1271 *wl)
4621{
Juuso Oikarinen4ae3fa82011-01-14 12:48:46 +01004622 if (wl->state == WL1271_STATE_PLT)
4623 __wl1271_plt_stop(wl);
4624
Juuso Oikarinenc2c192a2010-07-27 03:30:09 +03004625 unregister_netdevice_notifier(&wl1271_dev_notifier);
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004626 ieee80211_unregister_hw(wl->hw);
4627 wl->mac80211_registered = false;
4628
4629}
4630EXPORT_SYMBOL_GPL(wl1271_unregister_hw);
4631
Teemu Paasikivi2d5e82b2010-02-22 08:38:21 +02004632int wl1271_init_ieee80211(struct wl1271 *wl)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004633{
Juuso Oikarinen7a557242010-09-27 12:42:07 +02004634 static const u32 cipher_suites[] = {
4635 WLAN_CIPHER_SUITE_WEP40,
4636 WLAN_CIPHER_SUITE_WEP104,
4637 WLAN_CIPHER_SUITE_TKIP,
4638 WLAN_CIPHER_SUITE_CCMP,
4639 WL1271_CIPHER_SUITE_GEM,
4640 };
4641
Juuso Oikarinen1e2b7972009-10-08 21:56:20 +03004642 /* The tx descriptor buffer and the TKIP space. */
4643 wl->hw->extra_tx_headroom = WL1271_TKIP_IV_SPACE +
4644 sizeof(struct wl1271_tx_hw_descr);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004645
4646 /* unit us */
4647 /* FIXME: find a proper value */
4648 wl->hw->channel_change_time = 10000;
Juuso Oikarinen50c500a2010-04-01 11:38:22 +03004649 wl->hw->max_listen_interval = wl->conf.conn.max_listen_interval;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004650
4651 wl->hw->flags = IEEE80211_HW_SIGNAL_DBM |
Juuso Oikarinen03442a32009-11-23 23:22:14 +02004652 IEEE80211_HW_BEACON_FILTER |
Juuso Oikarinen0a343322010-02-22 08:38:41 +02004653 IEEE80211_HW_SUPPORTS_PS |
Kalle Valo4695dc92010-03-18 12:26:38 +02004654 IEEE80211_HW_SUPPORTS_UAPSD |
Juuso Oikarinena9af0922010-03-26 12:53:30 +02004655 IEEE80211_HW_HAS_RATE_CONTROL |
Juuso Oikarinen00236aed2010-04-09 11:07:30 +03004656 IEEE80211_HW_CONNECTION_MONITOR |
Eliad Peller62c07402011-02-02 11:20:05 +02004657 IEEE80211_HW_SUPPORTS_CQM_RSSI |
Luciano Coelho25eaea302011-05-02 12:37:33 +03004658 IEEE80211_HW_REPORTS_TX_ACK_STATUS |
Shahar Levifcd23b62011-05-11 12:12:56 +03004659 IEEE80211_HW_SPECTRUM_MGMT |
Arik Nemtsov93f8c8e2011-08-30 09:34:01 +03004660 IEEE80211_HW_AP_LINK_PS |
4661 IEEE80211_HW_AMPDU_AGGREGATION |
4662 IEEE80211_HW_TX_AMPDU_SETUP_IN_HW;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004663
Juuso Oikarinen7a557242010-09-27 12:42:07 +02004664 wl->hw->wiphy->cipher_suites = cipher_suites;
4665 wl->hw->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
4666
Juuso Oikarinene0d8bbf2009-12-11 15:41:04 +02004667 wl->hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
Eliad Peller045c7452011-08-28 15:23:01 +03004668 BIT(NL80211_IFTYPE_ADHOC) | BIT(NL80211_IFTYPE_AP) |
4669 BIT(NL80211_IFTYPE_P2P_CLIENT) | BIT(NL80211_IFTYPE_P2P_GO);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004670 wl->hw->wiphy->max_scan_ssids = 1;
Luciano Coelho221737d2011-09-02 14:28:22 +03004671 wl->hw->wiphy->max_sched_scan_ssids = 16;
4672 wl->hw->wiphy->max_match_sets = 16;
Guy Eilamea559b42010-12-09 16:54:59 +02004673 /*
4674 * Maximum length of elements in scanning probe request templates
4675 * should be the maximum length possible for a template, without
4676 * the IEEE80211 header of the template
4677 */
Eliad Peller154037d2011-08-14 13:17:12 +03004678 wl->hw->wiphy->max_scan_ie_len = WL1271_CMD_TEMPL_DFLT_SIZE -
Guy Eilamea559b42010-12-09 16:54:59 +02004679 sizeof(struct ieee80211_header);
Luciano Coelhoa8aaaf52011-01-11 18:25:18 +01004680
Eliad Peller1ec23f72011-08-25 14:26:54 +03004681 wl->hw->wiphy->flags |= WIPHY_FLAG_AP_UAPSD;
4682
Luciano Coelho4a31c112011-03-21 23:16:14 +02004683 /* make sure all our channels fit in the scanned_ch bitmask */
4684 BUILD_BUG_ON(ARRAY_SIZE(wl1271_channels) +
4685 ARRAY_SIZE(wl1271_channels_5ghz) >
4686 WL1271_MAX_CHANNELS);
Luciano Coelhoa8aaaf52011-01-11 18:25:18 +01004687 /*
4688 * We keep local copies of the band structs because we need to
4689 * modify them on a per-device basis.
4690 */
4691 memcpy(&wl->bands[IEEE80211_BAND_2GHZ], &wl1271_band_2ghz,
4692 sizeof(wl1271_band_2ghz));
4693 memcpy(&wl->bands[IEEE80211_BAND_5GHZ], &wl1271_band_5ghz,
4694 sizeof(wl1271_band_5ghz));
4695
4696 wl->hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
4697 &wl->bands[IEEE80211_BAND_2GHZ];
4698 wl->hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
4699 &wl->bands[IEEE80211_BAND_5GHZ];
Teemu Paasikivi1ebec3d2009-10-13 12:47:48 +03004700
Kalle Valo12bd8942010-03-18 12:26:33 +02004701 wl->hw->queues = 4;
Juuso Oikarinen31627dc2010-03-26 12:53:12 +02004702 wl->hw->max_rates = 1;
Kalle Valo12bd8942010-03-18 12:26:33 +02004703
Juuso Oikarinenb7417d92010-11-10 11:27:19 +01004704 wl->hw->wiphy->reg_notifier = wl1271_reg_notify;
4705
Teemu Paasikivi8197b712010-02-22 08:38:23 +02004706 SET_IEEE80211_DEV(wl->hw, wl1271_wl_to_dev(wl));
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004707
Arik Nemtsovf84f7d72010-10-16 20:21:23 +02004708 wl->hw->sta_data_size = sizeof(struct wl1271_station);
4709
Luciano Coelho4c9cfa72011-01-12 14:27:03 +01004710 wl->hw->max_rx_aggregation_subframes = 8;
4711
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004712 return 0;
4713}
Teemu Paasikivi50b3eb42010-02-22 08:38:26 +02004714EXPORT_SYMBOL_GPL(wl1271_init_ieee80211);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004715
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004716#define WL1271_DEFAULT_CHANNEL 0
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004717
Teemu Paasikivi2d5e82b2010-02-22 08:38:21 +02004718struct ieee80211_hw *wl1271_alloc_hw(void)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004719{
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004720 struct ieee80211_hw *hw;
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004721 struct platform_device *plat_dev = NULL;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004722 struct wl1271 *wl;
Arik Nemtsova8c0ddb2011-02-23 00:22:26 +02004723 int i, j, ret;
Ido Yariv1f37cbc2010-09-30 13:28:27 +02004724 unsigned int order;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004725
Arik Nemtsovf80c2d12011-09-22 09:52:05 +03004726 BUILD_BUG_ON(AP_MAX_LINKS > WL12XX_MAX_LINKS);
4727
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004728 hw = ieee80211_alloc_hw(sizeof(*wl), &wl1271_ops);
4729 if (!hw) {
4730 wl1271_error("could not alloc ieee80211_hw");
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004731 ret = -ENOMEM;
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004732 goto err_hw_alloc;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004733 }
4734
Julia Lawall929ebd32010-05-15 23:16:39 +02004735 plat_dev = kmemdup(&wl1271_device, sizeof(wl1271_device), GFP_KERNEL);
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004736 if (!plat_dev) {
4737 wl1271_error("could not allocate platform_device");
4738 ret = -ENOMEM;
4739 goto err_plat_alloc;
4740 }
4741
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004742 wl = hw->priv;
4743 memset(wl, 0, sizeof(*wl));
4744
Juuso Oikarinen01c09162009-10-13 12:47:55 +03004745 INIT_LIST_HEAD(&wl->list);
4746
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004747 wl->hw = hw;
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004748 wl->plat_dev = plat_dev;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004749
Juuso Oikarinen6742f552010-12-13 09:52:37 +02004750 for (i = 0; i < NUM_TX_QUEUES; i++)
4751 skb_queue_head_init(&wl->tx_queue[i]);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004752
Arik Nemtsova8c0ddb2011-02-23 00:22:26 +02004753 for (i = 0; i < NUM_TX_QUEUES; i++)
4754 for (j = 0; j < AP_MAX_LINKS; j++)
4755 skb_queue_head_init(&wl->links[j].tx_queue[i]);
4756
Ido Yariva6208652011-03-01 15:14:41 +02004757 skb_queue_head_init(&wl->deferred_rx_queue);
4758 skb_queue_head_init(&wl->deferred_tx_queue);
4759
Juuso Oikarinen37b70a82009-10-08 21:56:21 +03004760 INIT_DELAYED_WORK(&wl->elp_work, wl1271_elp_work);
Juuso Oikarinen90494a92010-07-08 17:50:00 +03004761 INIT_DELAYED_WORK(&wl->pspoll_work, wl1271_pspoll_work);
Ido Yariva6208652011-03-01 15:14:41 +02004762 INIT_WORK(&wl->netstack_work, wl1271_netstack_work);
Juuso Oikarinen117b38d2010-09-30 10:43:28 +02004763 INIT_WORK(&wl->tx_work, wl1271_tx_work);
4764 INIT_WORK(&wl->recovery_work, wl1271_recovery_work);
4765 INIT_DELAYED_WORK(&wl->scan_complete_work, wl1271_scan_complete_work);
Eliad Peller77ddaa12011-05-15 11:10:29 +03004766 INIT_WORK(&wl->rx_streaming_enable_work,
4767 wl1271_rx_streaming_enable_work);
4768 INIT_WORK(&wl->rx_streaming_disable_work,
4769 wl1271_rx_streaming_disable_work);
4770
Eliad Peller92ef8962011-06-07 12:50:46 +03004771 wl->freezable_wq = create_freezable_workqueue("wl12xx_wq");
4772 if (!wl->freezable_wq) {
4773 ret = -ENOMEM;
4774 goto err_hw;
4775 }
4776
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004777 wl->channel = WL1271_DEFAULT_CHANNEL;
Juuso Oikarinen60e84c22010-03-26 12:53:25 +02004778 wl->beacon_int = WL1271_DEFAULT_BEACON_INT;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004779 wl->default_key = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004780 wl->rx_counter = 0;
Juuso Oikarinen19ad0712009-11-02 20:22:11 +02004781 wl->psm_entry_retry = 0;
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004782 wl->power_level = WL1271_DEFAULT_POWER_LEVEL;
Juuso Oikarinena6fe2312009-12-11 15:40:58 +02004783 wl->basic_rate_set = CONF_TX_RATE_MASK_BASIC;
Juuso Oikarinenebba60c2010-04-01 11:38:20 +03004784 wl->basic_rate = CONF_TX_RATE_MASK_BASIC;
Juuso Oikarinen830fb672009-12-11 15:41:06 +02004785 wl->rate_set = CONF_TX_RATE_MASK_BASIC;
Juuso Oikarinen8a5a37a2009-10-08 21:56:24 +03004786 wl->band = IEEE80211_BAND_2GHZ;
Juuso Oikarinenb771eee2009-10-08 21:56:34 +03004787 wl->vif = NULL;
Juuso Oikarinen830fb672009-12-11 15:41:06 +02004788 wl->flags = 0;
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004789 wl->sg_enabled = true;
Juuso Oikarinend717fd62010-05-07 11:38:58 +03004790 wl->hw_pg_ver = -1;
Arik Nemtsov166d5042010-10-16 21:44:57 +02004791 wl->bss_type = MAX_BSS_TYPE;
4792 wl->set_bss_type = MAX_BSS_TYPE;
Arik Nemtsova8c0ddb2011-02-23 00:22:26 +02004793 wl->last_tx_hlid = 0;
Arik Nemtsovb622d992011-02-23 00:22:31 +02004794 wl->ap_ps_map = 0;
4795 wl->ap_fw_ps_map = 0;
Ido Yariv606ea9f2011-03-01 15:14:39 +02004796 wl->quirks = 0;
Ido Yariv341b7cd2011-03-31 10:07:01 +02004797 wl->platform_quirks = 0;
Luciano Coelho33c2c062011-05-10 14:46:02 +03004798 wl->sched_scanning = false;
Oz Krakowskib992c682011-06-26 10:36:02 +03004799 wl->tx_security_seq = 0;
4800 wl->tx_security_last_seq_lsb = 0;
Guy Eilame9eb8cb2011-08-16 19:49:12 +03004801 wl->tx_spare_blocks = TX_HW_BLOCK_SPARE_DEFAULT;
Eliad Peller7f0979882011-08-14 13:17:06 +03004802 wl->role_id = WL12XX_INVALID_ROLE_ID;
Eliad Pellerf4df1bd2011-08-14 13:17:15 +03004803 wl->system_hlid = WL12XX_SYSTEM_HLID;
Eliad Peller7f0979882011-08-14 13:17:06 +03004804 wl->sta_hlid = WL12XX_INVALID_LINK_ID;
Eliad Peller04e80792011-08-14 13:17:09 +03004805 wl->dev_role_id = WL12XX_INVALID_ROLE_ID;
4806 wl->dev_hlid = WL12XX_INVALID_LINK_ID;
Arik Nemtsov712e9bf2011-08-14 13:17:20 +03004807 wl->session_counter = 0;
Arik Nemtsove51ae9b2011-08-14 13:17:21 +03004808 wl->ap_bcast_hlid = WL12XX_INVALID_LINK_ID;
4809 wl->ap_global_hlid = WL12XX_INVALID_LINK_ID;
Arik Nemtsovda032092011-08-25 12:43:15 +03004810 wl->active_sta_count = 0;
Eliad Peller77ddaa12011-05-15 11:10:29 +03004811 setup_timer(&wl->rx_streaming_timer, wl1271_rx_streaming_timer,
4812 (unsigned long) wl);
Ido Yariv95dac04f2011-06-06 14:57:06 +03004813 wl->fwlog_size = 0;
4814 init_waitqueue_head(&wl->fwlog_waitq);
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004815
Eliad Pellerf4df1bd2011-08-14 13:17:15 +03004816 /* The system link is always allocated */
4817 __set_bit(WL12XX_SYSTEM_HLID, wl->links_map);
4818
Ido Yariv25eeb9e2010-10-12 16:20:06 +02004819 memset(wl->tx_frames_map, 0, sizeof(wl->tx_frames_map));
Juuso Oikarinenbe7078c2009-10-08 21:56:26 +03004820 for (i = 0; i < ACX_TX_DESCRIPTORS; i++)
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004821 wl->tx_frames[i] = NULL;
4822
4823 spin_lock_init(&wl->wl_lock);
4824
Luciano Coelhof5fc0f82009-08-06 16:25:28 +03004825 wl->state = WL1271_STATE_OFF;
4826 mutex_init(&wl->mutex);
4827
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004828 /* Apply default driver configuration. */
4829 wl1271_conf_init(wl);
Eliad Pelleraf7fbb22011-09-19 13:51:42 +03004830 wl->bitrate_masks[IEEE80211_BAND_2GHZ] = wl->conf.tx.basic_rate;
4831 wl->bitrate_masks[IEEE80211_BAND_5GHZ] = wl->conf.tx.basic_rate_5;
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004832
Ido Yariv1f37cbc2010-09-30 13:28:27 +02004833 order = get_order(WL1271_AGGR_BUFFER_SIZE);
4834 wl->aggr_buf = (u8 *)__get_free_pages(GFP_KERNEL, order);
4835 if (!wl->aggr_buf) {
4836 ret = -ENOMEM;
Eliad Peller92ef8962011-06-07 12:50:46 +03004837 goto err_wq;
Ido Yariv1f37cbc2010-09-30 13:28:27 +02004838 }
4839
Ido Yariv990f5de2011-03-31 10:06:59 +02004840 wl->dummy_packet = wl12xx_alloc_dummy_packet(wl);
4841 if (!wl->dummy_packet) {
4842 ret = -ENOMEM;
4843 goto err_aggr;
4844 }
4845
Ido Yariv95dac04f2011-06-06 14:57:06 +03004846 /* Allocate one page for the FW log */
4847 wl->fwlog = (u8 *)get_zeroed_page(GFP_KERNEL);
4848 if (!wl->fwlog) {
4849 ret = -ENOMEM;
4850 goto err_dummy_packet;
4851 }
4852
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004853 /* Register platform device */
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004854 ret = platform_device_register(wl->plat_dev);
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004855 if (ret) {
4856 wl1271_error("couldn't register platform device");
Ido Yariv95dac04f2011-06-06 14:57:06 +03004857 goto err_fwlog;
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004858 }
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004859 dev_set_drvdata(&wl->plat_dev->dev, wl);
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004860
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004861 /* Create sysfs file to control bt coex state */
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004862 ret = device_create_file(&wl->plat_dev->dev, &dev_attr_bt_coex_state);
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004863 if (ret < 0) {
4864 wl1271_error("failed to create sysfs file bt_coex_state");
4865 goto err_platform;
4866 }
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004867
Juuso Oikarinend717fd62010-05-07 11:38:58 +03004868 /* Create sysfs file to get HW PG version */
4869 ret = device_create_file(&wl->plat_dev->dev, &dev_attr_hw_pg_ver);
4870 if (ret < 0) {
4871 wl1271_error("failed to create sysfs file hw_pg_ver");
4872 goto err_bt_coex_state;
4873 }
4874
Ido Yariv95dac04f2011-06-06 14:57:06 +03004875 /* Create sysfs file for the FW log */
4876 ret = device_create_bin_file(&wl->plat_dev->dev, &fwlog_attr);
4877 if (ret < 0) {
4878 wl1271_error("failed to create sysfs file fwlog");
4879 goto err_hw_pg_ver;
4880 }
4881
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004882 return hw;
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004883
Ido Yariv95dac04f2011-06-06 14:57:06 +03004884err_hw_pg_ver:
4885 device_remove_file(&wl->plat_dev->dev, &dev_attr_hw_pg_ver);
4886
Juuso Oikarinend717fd62010-05-07 11:38:58 +03004887err_bt_coex_state:
4888 device_remove_file(&wl->plat_dev->dev, &dev_attr_bt_coex_state);
4889
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004890err_platform:
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004891 platform_device_unregister(wl->plat_dev);
Juuso Oikarinen7fc3a862010-03-18 12:26:32 +02004892
Ido Yariv95dac04f2011-06-06 14:57:06 +03004893err_fwlog:
4894 free_page((unsigned long)wl->fwlog);
4895
Ido Yariv990f5de2011-03-31 10:06:59 +02004896err_dummy_packet:
4897 dev_kfree_skb(wl->dummy_packet);
4898
Ido Yariv1f37cbc2010-09-30 13:28:27 +02004899err_aggr:
4900 free_pages((unsigned long)wl->aggr_buf, order);
4901
Eliad Peller92ef8962011-06-07 12:50:46 +03004902err_wq:
4903 destroy_workqueue(wl->freezable_wq);
4904
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004905err_hw:
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004906 wl1271_debugfs_exit(wl);
4907 kfree(plat_dev);
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004908
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004909err_plat_alloc:
4910 ieee80211_free_hw(hw);
4911
4912err_hw_alloc:
4913
Juuso Oikarinena1dd8182010-03-18 12:26:31 +02004914 return ERR_PTR(ret);
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004915}
Teemu Paasikivi50b3eb42010-02-22 08:38:26 +02004916EXPORT_SYMBOL_GPL(wl1271_alloc_hw);
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004917
4918int wl1271_free_hw(struct wl1271 *wl)
4919{
Ido Yariv95dac04f2011-06-06 14:57:06 +03004920 /* Unblock any fwlog readers */
4921 mutex_lock(&wl->mutex);
4922 wl->fwlog_size = -1;
4923 wake_up_interruptible_all(&wl->fwlog_waitq);
4924 mutex_unlock(&wl->mutex);
4925
4926 device_remove_bin_file(&wl->plat_dev->dev, &fwlog_attr);
Gery Kahn6f07b722011-07-18 14:21:49 +03004927
4928 device_remove_file(&wl->plat_dev->dev, &dev_attr_hw_pg_ver);
4929
4930 device_remove_file(&wl->plat_dev->dev, &dev_attr_bt_coex_state);
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004931 platform_device_unregister(wl->plat_dev);
Ido Yariv95dac04f2011-06-06 14:57:06 +03004932 free_page((unsigned long)wl->fwlog);
Ido Yariv990f5de2011-03-31 10:06:59 +02004933 dev_kfree_skb(wl->dummy_packet);
Ido Yariv1f37cbc2010-09-30 13:28:27 +02004934 free_pages((unsigned long)wl->aggr_buf,
4935 get_order(WL1271_AGGR_BUFFER_SIZE));
Teemu Paasikivi3b56dd62010-03-18 12:26:46 +02004936 kfree(wl->plat_dev);
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004937
4938 wl1271_debugfs_exit(wl);
4939
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004940 vfree(wl->fw);
4941 wl->fw = NULL;
4942 kfree(wl->nvs);
4943 wl->nvs = NULL;
4944
4945 kfree(wl->fw_status);
4946 kfree(wl->tx_res_if);
Eliad Peller92ef8962011-06-07 12:50:46 +03004947 destroy_workqueue(wl->freezable_wq);
Teemu Paasikivic332a4b2010-02-18 13:25:57 +02004948
4949 ieee80211_free_hw(wl->hw);
4950
4951 return 0;
4952}
Teemu Paasikivi50b3eb42010-02-22 08:38:26 +02004953EXPORT_SYMBOL_GPL(wl1271_free_hw);
4954
Guy Eilam491bbd62011-01-12 10:33:29 +01004955u32 wl12xx_debug_level = DEBUG_NONE;
Eliad Peller17c17552010-12-12 12:15:35 +02004956EXPORT_SYMBOL_GPL(wl12xx_debug_level);
Guy Eilam491bbd62011-01-12 10:33:29 +01004957module_param_named(debug_level, wl12xx_debug_level, uint, S_IRUSR | S_IWUSR);
Eliad Peller17c17552010-12-12 12:15:35 +02004958MODULE_PARM_DESC(debug_level, "wl12xx debugging level");
4959
Ido Yariv95dac04f2011-06-06 14:57:06 +03004960module_param_named(fwlog, fwlog_param, charp, 0);
4961MODULE_PARM_DESC(keymap,
4962 "FW logger options: continuous, ondemand, dbgpins or disable");
4963
Eliad Peller2a5bff02011-08-25 18:10:59 +03004964module_param(bug_on_recovery, bool, S_IRUSR | S_IWUSR);
4965MODULE_PARM_DESC(bug_on_recovery, "BUG() on fw recovery");
4966
Teemu Paasikivi50b3eb42010-02-22 08:38:26 +02004967MODULE_LICENSE("GPL");
Luciano Coelhob1a48ca2011-02-22 14:19:28 +02004968MODULE_AUTHOR("Luciano Coelho <coelho@ti.com>");
Teemu Paasikivi50b3eb42010-02-22 08:38:26 +02004969MODULE_AUTHOR("Juuso Oikarinen <juuso.oikarinen@nokia.com>");