blob: 89bfd858bb280949f499c463a6ec26034bddcdad [file] [log] [blame]
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001/* src/prism2/driver/prism2mgmt.c
2*
3* Management request handler functions.
4*
5* Copyright (C) 1999 AbsoluteValue Systems, Inc. All Rights Reserved.
6* --------------------------------------------------------------------
7*
8* linux-wlan
9*
10* The contents of this file are subject to the Mozilla Public
11* License Version 1.1 (the "License"); you may not use this file
12* except in compliance with the License. You may obtain a copy of
13* the License at http://www.mozilla.org/MPL/
14*
15* Software distributed under the License is distributed on an "AS
16* IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
17* implied. See the License for the specific language governing
18* rights and limitations under the License.
19*
20* Alternatively, the contents of this file may be used under the
21* terms of the GNU Public License version 2 (the "GPL"), in which
22* case the provisions of the GPL are applicable instead of the
23* above. If you wish to allow the use of your version of this file
24* only under the terms of the GPL and not to allow others to use
25* your version of this file under the MPL, indicate your decision
26* by deleting the provisions above and replace them with the notice
27* and other provisions required by the GPL. If you do not delete
28* the provisions above, a recipient may use your version of this
29* file under either the MPL or the GPL.
30*
31* --------------------------------------------------------------------
32*
33* Inquiries regarding the linux-wlan Open Source project can be
34* made directly to:
35*
36* AbsoluteValue Systems Inc.
37* info@linux-wlan.com
38* http://www.linux-wlan.com
39*
40* --------------------------------------------------------------------
41*
42* Portions of the development of this software were funded by
43* Intersil Corporation as part of PRISM(R) chipset product development.
44*
45* --------------------------------------------------------------------
46*
47* The functions in this file handle management requests sent from
48* user mode.
49*
50* Most of these functions have two separate blocks of code that are
51* conditional on whether this is a station or an AP. This is used
52* to separate out the STA and AP responses to these management primitives.
53* It's a choice (good, bad, indifferent?) to have the code in the same
54* place so it's clear that the same primitive is implemented in both
55* cases but has different behavior.
56*
57* --------------------------------------------------------------------
58*/
59
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070060#include <linux/if_arp.h>
61#include <linux/module.h>
62#include <linux/kernel.h>
63#include <linux/wait.h>
64#include <linux/sched.h>
65#include <linux/types.h>
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070066#include <linux/wireless.h>
67#include <linux/netdevice.h>
68#include <linux/delay.h>
Andrew Elwellef1a0ed2010-02-18 23:56:12 +010069#include <linux/io.h>
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070070#include <asm/byteorder.h>
71#include <linux/random.h>
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070072#include <linux/usb.h>
Moritz Muehlenhoff7f6e0e42009-01-25 21:54:55 +010073#include <linux/bitops.h>
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070074
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070075#include "p80211types.h"
76#include "p80211hdr.h"
77#include "p80211mgmt.h"
78#include "p80211conv.h"
79#include "p80211msg.h"
80#include "p80211netdev.h"
81#include "p80211metadef.h"
82#include "p80211metastruct.h"
83#include "hfa384x.h"
84#include "prism2mgmt.h"
85
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070086/* Converts 802.11 format rate specifications to prism2 */
Moritz Muehlenhoff7f6e0e42009-01-25 21:54:55 +010087#define p80211rate_to_p2bit(n) ((((n)&~BIT(7)) == 2) ? BIT(0) : \
88 (((n)&~BIT(7)) == 4) ? BIT(1) : \
89 (((n)&~BIT(7)) == 11) ? BIT(2) : \
90 (((n)&~BIT(7)) == 22) ? BIT(3) : 0)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070091
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -070092/*----------------------------------------------------------------
93* prism2mgmt_scan
94*
95* Initiate a scan for BSSs.
96*
97* This function corresponds to MLME-scan.request and part of
98* MLME-scan.confirm. As far as I can tell in the standard, there
99* are no restrictions on when a scan.request may be issued. We have
100* to handle in whatever state the driver/MAC happen to be.
101*
102* Arguments:
103* wlandev wlan device structure
104* msgp ptr to msg buffer
105*
106* Returns:
107* 0 success and done
108* <0 success, but we're waiting for something to finish.
109* >0 an error occurred while handling the message.
110* Side effects:
111*
112* Call context:
113* process thread (usually)
114* interrupt
115----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +0530116int prism2mgmt_scan(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700117{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100118 int result = 0;
119 hfa384x_t *hw = wlandev->priv;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300120 struct p80211msg_dot11req_scan *msg = msgp;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100121 u16 roamingmode, word;
122 int i, timeout;
123 int istmpenable = 0;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700124
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100125 hfa384x_HostScanRequest_data_t scanreq;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700126
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100127 /* gatekeeper check */
128 if (HFA384x_FIRMWARE_VERSION(hw->ident_sta_fw.major,
129 hw->ident_sta_fw.minor,
130 hw->ident_sta_fw.variant) <
131 HFA384x_FIRMWARE_VERSION(1, 3, 2)) {
132 printk(KERN_ERR
133 "HostScan not supported with current firmware (<1.3.2).\n");
134 result = 1;
135 msg->resultcode.data = P80211ENUM_resultcode_not_supported;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700136 goto exit;
137 }
138
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100139 memset(&scanreq, 0, sizeof(scanreq));
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700140
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100141 /* save current roaming mode */
142 result = hfa384x_drvr_getconfig16(hw,
143 HFA384x_RID_CNFROAMINGMODE,
144 &roamingmode);
145 if (result) {
146 printk(KERN_ERR "getconfig(ROAMMODE) failed. result=%d\n",
147 result);
148 msg->resultcode.data =
149 P80211ENUM_resultcode_implementation_failure;
150 goto exit;
151 }
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700152
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100153 /* drop into mode 3 for the scan */
154 result = hfa384x_drvr_setconfig16(hw,
155 HFA384x_RID_CNFROAMINGMODE,
156 HFA384x_ROAMMODE_HOSTSCAN_HOSTROAM);
157 if (result) {
158 printk(KERN_ERR "setconfig(ROAMINGMODE) failed. result=%d\n",
159 result);
160 msg->resultcode.data =
161 P80211ENUM_resultcode_implementation_failure;
162 goto exit;
163 }
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700164
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100165 /* active or passive? */
166 if (HFA384x_FIRMWARE_VERSION(hw->ident_sta_fw.major,
167 hw->ident_sta_fw.minor,
168 hw->ident_sta_fw.variant) >
169 HFA384x_FIRMWARE_VERSION(1, 5, 0)) {
170 if (msg->scantype.data != P80211ENUM_scantype_active)
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100171 word = cpu_to_le16(msg->maxchanneltime.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100172 else
173 word = 0;
174
175 result =
176 hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFPASSIVESCANCTRL,
177 word);
178 if (result) {
179 printk(KERN_WARNING "Passive scan not supported with "
180 "current firmware. (<1.5.1)\n");
181 }
182 }
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700183
184 /* set up the txrate to be 2MBPS. Should be fastest basicrate... */
185 word = HFA384x_RATEBIT_2;
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100186 scanreq.txRate = cpu_to_le16(word);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700187
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100188 /* set up the channel list */
189 word = 0;
190 for (i = 0; i < msg->channellist.data.len; i++) {
191 u8 channel = msg->channellist.data.data[i];
192 if (channel > 14)
193 continue;
194 /* channel 1 is BIT 0 ... channel 14 is BIT 13 */
195 word |= (1 << (channel - 1));
196 }
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100197 scanreq.channelList = cpu_to_le16(word);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700198
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100199 /* set up the ssid, if present. */
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100200 scanreq.ssid.len = cpu_to_le16(msg->ssid.data.len);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100201 memcpy(scanreq.ssid.data, msg->ssid.data.data, msg->ssid.data.len);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700202
203 /* Enable the MAC port if it's not already enabled */
204 result = hfa384x_drvr_getconfig16(hw, HFA384x_RID_PORTSTATUS, &word);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100205 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100206 printk(KERN_ERR "getconfig(PORTSTATUS) failed. "
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100207 "result=%d\n", result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700208 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100209 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700210 goto exit;
211 }
212 if (word == HFA384x_PORTSTATUS_DISABLED) {
Solomon Peachyaaad4302008-10-29 10:42:53 -0400213 u16 wordbuf[17];
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700214
215 result = hfa384x_drvr_setconfig16(hw,
Johan Meiringf83dfd02010-11-06 18:23:44 +0200216 HFA384x_RID_CNFROAMINGMODE,
217 HFA384x_ROAMMODE_HOSTSCAN_HOSTROAM);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100218 if (result) {
219 printk(KERN_ERR
220 "setconfig(ROAMINGMODE) failed. result=%d\n",
221 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700222 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100223 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700224 goto exit;
225 }
226 /* Construct a bogus SSID and assign it to OwnSSID and
227 * DesiredSSID
228 */
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100229 wordbuf[0] = cpu_to_le16(WLAN_SSID_MAXLEN);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700230 get_random_bytes(&wordbuf[1], WLAN_SSID_MAXLEN);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100231 result = hfa384x_drvr_setconfig(hw, HFA384x_RID_CNFOWNSSID,
232 wordbuf,
233 HFA384x_RID_CNFOWNSSID_LEN);
234 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100235 printk(KERN_ERR "Failed to set OwnSSID.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700236 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100237 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700238 goto exit;
239 }
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100240 result = hfa384x_drvr_setconfig(hw, HFA384x_RID_CNFDESIREDSSID,
241 wordbuf,
242 HFA384x_RID_CNFDESIREDSSID_LEN);
243 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100244 printk(KERN_ERR "Failed to set DesiredSSID.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700245 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100246 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700247 goto exit;
248 }
249 /* bsstype */
250 result = hfa384x_drvr_setconfig16(hw,
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100251 HFA384x_RID_CNFPORTTYPE,
252 HFA384x_PORTTYPE_IBSS);
253 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100254 printk(KERN_ERR "Failed to set CNFPORTTYPE.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700255 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100256 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700257 goto exit;
258 }
259 /* ibss options */
260 result = hfa384x_drvr_setconfig16(hw,
Johan Meiringf83dfd02010-11-06 18:23:44 +0200261 HFA384x_RID_CREATEIBSS,
262 HFA384x_CREATEIBSS_JOINCREATEIBSS);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100263 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100264 printk(KERN_ERR "Failed to set CREATEIBSS.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700265 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100266 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700267 goto exit;
268 }
269 result = hfa384x_drvr_enable(hw, 0);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100270 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100271 printk(KERN_ERR "drvr_enable(0) failed. "
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100272 "result=%d\n", result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700273 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100274 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700275 goto exit;
276 }
277 istmpenable = 1;
278 }
279
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100280 /* Figure out our timeout first Kus, then HZ */
281 timeout = msg->channellist.data.len * msg->maxchanneltime.data;
282 timeout = (timeout * HZ) / 1000;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700283
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100284 /* Issue the scan request */
285 hw->scanflag = 0;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700286
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100287 result = hfa384x_drvr_setconfig(hw,
288 HFA384x_RID_HOSTSCAN, &scanreq,
289 sizeof(hfa384x_HostScanRequest_data_t));
290 if (result) {
291 printk(KERN_ERR "setconfig(SCANREQUEST) failed. result=%d\n",
292 result);
293 msg->resultcode.data =
294 P80211ENUM_resultcode_implementation_failure;
295 goto exit;
296 }
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700297
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100298 /* sleep until info frame arrives */
299 wait_event_interruptible_timeout(hw->cmdq, hw->scanflag, timeout);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700300
301 msg->numbss.status = P80211ENUM_msgitem_status_data_ok;
302 if (hw->scanflag == -1)
303 hw->scanflag = 0;
304
305 msg->numbss.data = hw->scanflag;
306
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100307 hw->scanflag = 0;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700308
309 /* Disable port if we temporarily enabled it. */
310 if (istmpenable) {
311 result = hfa384x_drvr_disable(hw, 0);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100312 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100313 printk(KERN_ERR "drvr_disable(0) failed. "
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100314 "result=%d\n", result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700315 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100316 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700317 goto exit;
318 }
319 }
320
321 /* restore original roaming mode */
322 result = hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFROAMINGMODE,
323 roamingmode);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100324 if (result) {
325 printk(KERN_ERR "setconfig(ROAMMODE) failed. result=%d\n",
326 result);
327 msg->resultcode.data =
328 P80211ENUM_resultcode_implementation_failure;
329 goto exit;
330 }
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700331
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100332 result = 0;
333 msg->resultcode.data = P80211ENUM_resultcode_success;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700334
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100335exit:
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700336 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
337
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700338 return result;
339}
340
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700341/*----------------------------------------------------------------
342* prism2mgmt_scan_results
343*
344* Retrieve the BSS description for one of the BSSs identified in
345* a scan.
346*
347* Arguments:
348* wlandev wlan device structure
349* msgp ptr to msg buffer
350*
351* Returns:
352* 0 success and done
353* <0 success, but we're waiting for something to finish.
354* >0 an error occurred while handling the message.
355* Side effects:
356*
357* Call context:
358* process thread (usually)
359* interrupt
360----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +0530361int prism2mgmt_scan_results(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700362{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100363 int result = 0;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300364 struct p80211msg_dot11req_scan_results *req;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100365 hfa384x_t *hw = wlandev->priv;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700366 hfa384x_HScanResultSub_t *item = NULL;
367
368 int count;
369
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300370 req = (struct p80211msg_dot11req_scan_results *) msgp;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700371
372 req->resultcode.status = P80211ENUM_msgitem_status_data_ok;
373
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100374 if (!hw->scanresults) {
375 printk(KERN_ERR
376 "dot11req_scan_results can only be used after a successful dot11req_scan.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700377 result = 2;
378 req->resultcode.data = P80211ENUM_resultcode_invalid_parameters;
379 goto exit;
380 }
381
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100382 count = (hw->scanresults->framelen - 3) / 32;
Dan Carpenterbb46f132012-04-18 09:48:59 +0300383 if (count > HFA384x_SCANRESULT_MAX)
384 count = HFA384x_SCANRESULT_MAX;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700385
386 if (req->bssindex.data >= count) {
Moritz Muehlenhoffa7cf7ba2009-02-08 02:01:00 +0100387 pr_debug("requested index (%d) out of range (%d)\n",
Mithlesh Thukral75f49e02009-05-25 19:06:16 +0530388 req->bssindex.data, count);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700389 result = 2;
390 req->resultcode.data = P80211ENUM_resultcode_invalid_parameters;
391 goto exit;
392 }
393
394 item = &(hw->scanresults->info.hscanresult.result[req->bssindex.data]);
395 /* signal and noise */
396 req->signal.status = P80211ENUM_msgitem_status_data_ok;
397 req->noise.status = P80211ENUM_msgitem_status_data_ok;
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100398 req->signal.data = le16_to_cpu(item->sl);
399 req->noise.data = le16_to_cpu(item->anl);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700400
401 /* BSSID */
402 req->bssid.status = P80211ENUM_msgitem_status_data_ok;
403 req->bssid.data.len = WLAN_BSSID_LEN;
404 memcpy(req->bssid.data.data, item->bssid, WLAN_BSSID_LEN);
405
406 /* SSID */
407 req->ssid.status = P80211ENUM_msgitem_status_data_ok;
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100408 req->ssid.data.len = le16_to_cpu(item->ssid.len);
Tormod Volden811a37e2013-01-09 22:23:32 +0100409 req->ssid.data.len = min_t(u16, req->ssid.data.len, WLAN_SSID_MAXLEN);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700410 memcpy(req->ssid.data.data, item->ssid.data, req->ssid.data.len);
411
412 /* supported rates */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100413 for (count = 0; count < 10; count++)
414 if (item->supprates[count] == 0)
415 break;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700416
417#define REQBASICRATE(N) \
418 if ((count >= N) && DOT11_RATE5_ISBASIC_GET(item->supprates[(N)-1])) { \
419 req->basicrate ## N .data = item->supprates[(N)-1]; \
Johan Meiringf83dfd02010-11-06 18:23:44 +0200420 req->basicrate ## N .status = \
421 P80211ENUM_msgitem_status_data_ok; \
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700422 }
423
424 REQBASICRATE(1);
425 REQBASICRATE(2);
426 REQBASICRATE(3);
427 REQBASICRATE(4);
428 REQBASICRATE(5);
429 REQBASICRATE(6);
430 REQBASICRATE(7);
431 REQBASICRATE(8);
432
433#define REQSUPPRATE(N) \
434 if (count >= N) { \
435 req->supprate ## N .data = item->supprates[(N)-1]; \
Johan Meiringf83dfd02010-11-06 18:23:44 +0200436 req->supprate ## N .status = \
437 P80211ENUM_msgitem_status_data_ok; \
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700438 }
439
440 REQSUPPRATE(1);
441 REQSUPPRATE(2);
442 REQSUPPRATE(3);
443 REQSUPPRATE(4);
444 REQSUPPRATE(5);
445 REQSUPPRATE(6);
446 REQSUPPRATE(7);
447 REQSUPPRATE(8);
448
449 /* beacon period */
450 req->beaconperiod.status = P80211ENUM_msgitem_status_data_ok;
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100451 req->beaconperiod.data = le16_to_cpu(item->bcnint);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700452
453 /* timestamps */
454 req->timestamp.status = P80211ENUM_msgitem_status_data_ok;
455 req->timestamp.data = jiffies;
456 req->localtime.status = P80211ENUM_msgitem_status_data_ok;
457 req->localtime.data = jiffies;
458
459 /* atim window */
460 req->ibssatimwindow.status = P80211ENUM_msgitem_status_data_ok;
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100461 req->ibssatimwindow.data = le16_to_cpu(item->atim);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700462
463 /* Channel */
464 req->dschannel.status = P80211ENUM_msgitem_status_data_ok;
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100465 req->dschannel.data = le16_to_cpu(item->chid);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700466
467 /* capinfo bits */
Moritz Muehlenhoff18c7f792009-02-18 19:50:07 +0100468 count = le16_to_cpu(item->capinfo);
Karl Reltoncb3126e2010-06-03 23:04:06 +0100469 req->capinfo.status = P80211ENUM_msgitem_status_data_ok;
470 req->capinfo.data = count;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700471
472 /* privacy flag */
473 req->privacy.status = P80211ENUM_msgitem_status_data_ok;
474 req->privacy.data = WLAN_GET_MGMT_CAP_INFO_PRIVACY(count);
475
476 /* cfpollable */
477 req->cfpollable.status = P80211ENUM_msgitem_status_data_ok;
478 req->cfpollable.data = WLAN_GET_MGMT_CAP_INFO_CFPOLLABLE(count);
479
480 /* cfpollreq */
481 req->cfpollreq.status = P80211ENUM_msgitem_status_data_ok;
482 req->cfpollreq.data = WLAN_GET_MGMT_CAP_INFO_CFPOLLREQ(count);
483
484 /* bsstype */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100485 req->bsstype.status = P80211ENUM_msgitem_status_data_ok;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700486 req->bsstype.data = (WLAN_GET_MGMT_CAP_INFO_ESS(count)) ?
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100487 P80211ENUM_bsstype_infrastructure : P80211ENUM_bsstype_independent;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700488
489 result = 0;
490 req->resultcode.data = P80211ENUM_resultcode_success;
491
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100492exit:
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700493 return result;
494}
495
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700496/*----------------------------------------------------------------
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700497* prism2mgmt_start
498*
499* Start a BSS. Any station can do this for IBSS, only AP for ESS.
500*
501* Arguments:
502* wlandev wlan device structure
503* msgp ptr to msg buffer
504*
505* Returns:
506* 0 success and done
507* <0 success, but we're waiting for something to finish.
508* >0 an error occurred while handling the message.
509* Side effects:
510*
511* Call context:
512* process thread (usually)
513* interrupt
514----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +0530515int prism2mgmt_start(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700516{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100517 int result = 0;
518 hfa384x_t *hw = wlandev->priv;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300519 struct p80211msg_dot11req_start *msg = msgp;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700520
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100521 p80211pstrd_t *pstr;
522 u8 bytebuf[80];
523 hfa384x_bytestr_t *p2bytestr = (hfa384x_bytestr_t *) bytebuf;
524 u16 word;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700525
526 wlandev->macmode = WLAN_MACMODE_NONE;
527
528 /* Set the SSID */
529 memcpy(&wlandev->ssid, &msg->ssid.data, sizeof(msg->ssid.data));
530
Solomon Peachy5db8dcc2008-10-27 11:14:02 -0400531 /*** ADHOC IBSS ***/
532 /* see if current f/w is less than 8c3 */
533 if (HFA384x_FIRMWARE_VERSION(hw->ident_sta_fw.major,
534 hw->ident_sta_fw.minor,
535 hw->ident_sta_fw.variant) <
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100536 HFA384x_FIRMWARE_VERSION(0, 8, 3)) {
Solomon Peachy5db8dcc2008-10-27 11:14:02 -0400537 /* Ad-Hoc not quite supported on Prism2 */
538 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
539 msg->resultcode.data = P80211ENUM_resultcode_not_supported;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700540 goto done;
541 }
542
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700543 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
544
Solomon Peachy5db8dcc2008-10-27 11:14:02 -0400545 /*** STATION ***/
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700546 /* Set the REQUIRED config items */
547 /* SSID */
Andrew Elwellef1a0ed2010-02-18 23:56:12 +0100548 pstr = (p80211pstrd_t *) &(msg->ssid.data);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700549 prism2mgmt_pstr2bytestr(p2bytestr, pstr);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100550 result = hfa384x_drvr_setconfig(hw, HFA384x_RID_CNFOWNSSID,
551 bytebuf, HFA384x_RID_CNFOWNSSID_LEN);
552 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100553 printk(KERN_ERR "Failed to set CnfOwnSSID\n");
Solomon Peachy5db8dcc2008-10-27 11:14:02 -0400554 goto failed;
555 }
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100556 result = hfa384x_drvr_setconfig(hw, HFA384x_RID_CNFDESIREDSSID,
557 bytebuf,
558 HFA384x_RID_CNFDESIREDSSID_LEN);
559 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100560 printk(KERN_ERR "Failed to set CnfDesiredSSID\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700561 goto failed;
562 }
563
564 /* bsstype - we use the default in the ap firmware */
Solomon Peachy5db8dcc2008-10-27 11:14:02 -0400565 /* IBSS port */
566 hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFPORTTYPE, 0);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700567
568 /* beacon period */
569 word = msg->beaconperiod.data;
Solomon Peachyaaad4302008-10-29 10:42:53 -0400570 result = hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFAPBCNint, word);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100571 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100572 printk(KERN_ERR "Failed to set beacon period=%d.\n", word);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700573 goto failed;
574 }
575
576 /* dschannel */
577 word = msg->dschannel.data;
578 result = hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFOWNCHANNEL, word);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100579 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100580 printk(KERN_ERR "Failed to set channel=%d.\n", word);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700581 goto failed;
582 }
583 /* Basic rates */
584 word = p80211rate_to_p2bit(msg->basicrate1.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100585 if (msg->basicrate2.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700586 word |= p80211rate_to_p2bit(msg->basicrate2.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100587
588 if (msg->basicrate3.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700589 word |= p80211rate_to_p2bit(msg->basicrate3.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100590
591 if (msg->basicrate4.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700592 word |= p80211rate_to_p2bit(msg->basicrate4.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100593
594 if (msg->basicrate5.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700595 word |= p80211rate_to_p2bit(msg->basicrate5.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100596
597 if (msg->basicrate6.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700598 word |= p80211rate_to_p2bit(msg->basicrate6.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100599
600 if (msg->basicrate7.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700601 word |= p80211rate_to_p2bit(msg->basicrate7.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100602
603 if (msg->basicrate8.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700604 word |= p80211rate_to_p2bit(msg->basicrate8.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100605
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700606 result = hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFBASICRATES, word);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100607 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100608 printk(KERN_ERR "Failed to set basicrates=%d.\n", word);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700609 goto failed;
610 }
611
612 /* Operational rates (supprates and txratecontrol) */
613 word = p80211rate_to_p2bit(msg->operationalrate1.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100614 if (msg->operationalrate2.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700615 word |= p80211rate_to_p2bit(msg->operationalrate2.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100616
617 if (msg->operationalrate3.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700618 word |= p80211rate_to_p2bit(msg->operationalrate3.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100619
620 if (msg->operationalrate4.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700621 word |= p80211rate_to_p2bit(msg->operationalrate4.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100622
623 if (msg->operationalrate5.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700624 word |= p80211rate_to_p2bit(msg->operationalrate5.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100625
626 if (msg->operationalrate6.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700627 word |= p80211rate_to_p2bit(msg->operationalrate6.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100628
629 if (msg->operationalrate7.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700630 word |= p80211rate_to_p2bit(msg->operationalrate7.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100631
632 if (msg->operationalrate8.status == P80211ENUM_msgitem_status_data_ok)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700633 word |= p80211rate_to_p2bit(msg->operationalrate8.data);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100634
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700635 result = hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFSUPPRATES, word);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100636 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100637 printk(KERN_ERR "Failed to set supprates=%d.\n", word);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700638 goto failed;
639 }
Solomon Peachy5db8dcc2008-10-27 11:14:02 -0400640
641 result = hfa384x_drvr_setconfig16(hw, HFA384x_RID_TXRATECNTL, word);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100642 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100643 printk(KERN_ERR "Failed to set txrates=%d.\n", word);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700644 goto failed;
645 }
646
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700647 /* Set the macmode so the frame setup code knows what to do */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100648 if (msg->bsstype.data == P80211ENUM_bsstype_independent) {
Solomon Peachy5db8dcc2008-10-27 11:14:02 -0400649 wlandev->macmode = WLAN_MACMODE_IBSS_STA;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700650 /* lets extend the data length a bit */
651 hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFMAXDATALEN, 2304);
652 }
653
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700654 /* Enable the Port */
655 result = hfa384x_drvr_enable(hw, 0);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100656 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100657 printk(KERN_ERR "Enable macport failed, result=%d.\n", result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700658 goto failed;
659 }
660
661 msg->resultcode.data = P80211ENUM_resultcode_success;
662
663 goto done;
664failed:
Moritz Muehlenhoffa7cf7ba2009-02-08 02:01:00 +0100665 pr_debug("Failed to set a config option, result=%d\n", result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700666 msg->resultcode.data = P80211ENUM_resultcode_invalid_parameters;
667
668done:
669 result = 0;
670
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700671 return result;
672}
673
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700674/*----------------------------------------------------------------
675* prism2mgmt_readpda
676*
677* Collect the PDA data and put it in the message.
678*
679* Arguments:
680* wlandev wlan device structure
681* msgp ptr to msg buffer
682*
683* Returns:
684* 0 success and done
685* <0 success, but we're waiting for something to finish.
686* >0 an error occurred while handling the message.
687* Side effects:
688*
689* Call context:
690* process thread (usually)
691----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +0530692int prism2mgmt_readpda(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700693{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100694 hfa384x_t *hw = wlandev->priv;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300695 struct p80211msg_p2req_readpda *msg = msgp;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100696 int result;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700697
698 /* We only support collecting the PDA when in the FWLOAD
699 * state.
700 */
701 if (wlandev->msdstate != WLAN_MSD_FWLOAD) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100702 printk(KERN_ERR
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100703 "PDA may only be read " "in the fwload state.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700704 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100705 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700706 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
707 } else {
708 /* Call drvr_readpda(), it handles the auxport enable
709 * and validating the returned PDA.
710 */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100711 result = hfa384x_drvr_readpda(hw,
712 msg->pda.data,
713 HFA384x_PDA_LEN_MAX);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700714 if (result) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100715 printk(KERN_ERR
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100716 "hfa384x_drvr_readpda() failed, "
717 "result=%d\n", result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700718
719 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100720 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700721 msg->resultcode.status =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100722 P80211ENUM_msgitem_status_data_ok;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700723 return 0;
724 }
725 msg->pda.status = P80211ENUM_msgitem_status_data_ok;
726 msg->resultcode.data = P80211ENUM_resultcode_success;
727 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
728 }
729
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700730 return 0;
731}
732
733/*----------------------------------------------------------------
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700734* prism2mgmt_ramdl_state
735*
736* Establishes the beginning/end of a card RAM download session.
737*
738* It is expected that the ramdl_write() function will be called
739* one or more times between the 'enable' and 'disable' calls to
740* this function.
741*
742* Note: This function should not be called when a mac comm port
743* is active.
744*
745* Arguments:
746* wlandev wlan device structure
747* msgp ptr to msg buffer
748*
749* Returns:
750* 0 success and done
751* <0 success, but we're waiting for something to finish.
752* >0 an error occurred while handling the message.
753* Side effects:
754*
755* Call context:
756* process thread (usually)
757----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +0530758int prism2mgmt_ramdl_state(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700759{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100760 hfa384x_t *hw = wlandev->priv;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300761 struct p80211msg_p2req_ramdl_state *msg = msgp;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700762
763 if (wlandev->msdstate != WLAN_MSD_FWLOAD) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100764 printk(KERN_ERR
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100765 "ramdl_state(): may only be called "
766 "in the fwload state.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700767 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100768 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700769 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700770 return 0;
771 }
772
773 /*
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100774 ** Note: Interrupts are locked out if this is an AP and are NOT
775 ** locked out if this is a station.
776 */
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700777
778 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100779 if (msg->enable.data == P80211ENUM_truth_true) {
780 if (hfa384x_drvr_ramdl_enable(hw, msg->exeaddr.data)) {
781 msg->resultcode.data =
782 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700783 } else {
784 msg->resultcode.data = P80211ENUM_resultcode_success;
785 }
786 } else {
787 hfa384x_drvr_ramdl_disable(hw);
788 msg->resultcode.data = P80211ENUM_resultcode_success;
789 }
790
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700791 return 0;
792}
793
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700794/*----------------------------------------------------------------
795* prism2mgmt_ramdl_write
796*
797* Writes a buffer to the card RAM using the download state. This
798* is for writing code to card RAM. To just read or write raw data
799* use the aux functions.
800*
801* Arguments:
802* wlandev wlan device structure
803* msgp ptr to msg buffer
804*
805* Returns:
806* 0 success and done
807* <0 success, but we're waiting for something to finish.
808* >0 an error occurred while handling the message.
809* Side effects:
810*
811* Call context:
812* process thread (usually)
813----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +0530814int prism2mgmt_ramdl_write(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700815{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100816 hfa384x_t *hw = wlandev->priv;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300817 struct p80211msg_p2req_ramdl_write *msg = msgp;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100818 u32 addr;
819 u32 len;
820 u8 *buf;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700821
822 if (wlandev->msdstate != WLAN_MSD_FWLOAD) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100823 printk(KERN_ERR
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100824 "ramdl_write(): may only be called "
825 "in the fwload state.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700826 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100827 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700828 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700829 return 0;
830 }
831
832 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
833 /* first validate the length */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100834 if (msg->len.data > sizeof(msg->data.data)) {
835 msg->resultcode.status =
836 P80211ENUM_resultcode_invalid_parameters;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700837 return 0;
838 }
839 /* call the hfa384x function to do the write */
840 addr = msg->addr.data;
841 len = msg->len.data;
842 buf = msg->data.data;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100843 if (hfa384x_drvr_ramdl_write(hw, addr, buf, len))
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700844 msg->resultcode.data = P80211ENUM_resultcode_refused;
845
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700846 msg->resultcode.data = P80211ENUM_resultcode_success;
847
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700848 return 0;
849}
850
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700851/*----------------------------------------------------------------
852* prism2mgmt_flashdl_state
853*
854* Establishes the beginning/end of a card Flash download session.
855*
856* It is expected that the flashdl_write() function will be called
857* one or more times between the 'enable' and 'disable' calls to
858* this function.
859*
860* Note: This function should not be called when a mac comm port
861* is active.
862*
863* Arguments:
864* wlandev wlan device structure
865* msgp ptr to msg buffer
866*
867* Returns:
868* 0 success and done
869* <0 success, but we're waiting for something to finish.
870* >0 an error occurred while handling the message.
871* Side effects:
872*
873* Call context:
874* process thread (usually)
875----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +0530876int prism2mgmt_flashdl_state(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700877{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100878 int result = 0;
879 hfa384x_t *hw = wlandev->priv;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300880 struct p80211msg_p2req_flashdl_state *msg = msgp;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700881
882 if (wlandev->msdstate != WLAN_MSD_FWLOAD) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100883 printk(KERN_ERR
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100884 "flashdl_state(): may only be called "
885 "in the fwload state.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700886 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100887 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700888 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700889 return 0;
890 }
891
892 /*
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100893 ** Note: Interrupts are locked out if this is an AP and are NOT
894 ** locked out if this is a station.
895 */
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700896
897 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100898 if (msg->enable.data == P80211ENUM_truth_true) {
899 if (hfa384x_drvr_flashdl_enable(hw)) {
900 msg->resultcode.data =
901 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700902 } else {
903 msg->resultcode.data = P80211ENUM_resultcode_success;
904 }
905 } else {
906 hfa384x_drvr_flashdl_disable(hw);
907 msg->resultcode.data = P80211ENUM_resultcode_success;
908 /* NOTE: At this point, the MAC is in the post-reset
909 * state and the driver is in the fwload state.
910 * We need to get the MAC back into the fwload
911 * state. To do this, we set the nsdstate to HWPRESENT
912 * and then call the ifstate function to redo everything
913 * that got us into the fwload state.
914 */
915 wlandev->msdstate = WLAN_MSD_HWPRESENT;
916 result = prism2sta_ifstate(wlandev, P80211ENUM_ifstate_fwload);
917 if (result != P80211ENUM_resultcode_success) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100918 printk(KERN_ERR "prism2sta_ifstate(fwload) failed,"
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100919 "P80211ENUM_resultcode=%d\n", result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700920 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100921 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700922 result = -1;
923 }
924 }
925
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700926 return 0;
927}
928
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700929/*----------------------------------------------------------------
930* prism2mgmt_flashdl_write
931*
932*
933*
934* Arguments:
935* wlandev wlan device structure
936* msgp ptr to msg buffer
937*
938* Returns:
939* 0 success and done
940* <0 success, but we're waiting for something to finish.
941* >0 an error occurred while handling the message.
942* Side effects:
943*
944* Call context:
945* process thread (usually)
946----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +0530947int prism2mgmt_flashdl_write(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700948{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100949 hfa384x_t *hw = wlandev->priv;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -0300950 struct p80211msg_p2req_flashdl_write *msg = msgp;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100951 u32 addr;
952 u32 len;
953 u8 *buf;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700954
955 if (wlandev->msdstate != WLAN_MSD_FWLOAD) {
Moritz Muehlenhoffedbd6062009-01-25 21:55:00 +0100956 printk(KERN_ERR
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100957 "flashdl_write(): may only be called "
958 "in the fwload state.\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700959 msg->resultcode.data =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100960 P80211ENUM_resultcode_implementation_failure;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700961 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700962 return 0;
963 }
964
965 /*
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100966 ** Note: Interrupts are locked out if this is an AP and are NOT
967 ** locked out if this is a station.
968 */
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700969
970 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
971 /* first validate the length */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100972 if (msg->len.data > sizeof(msg->data.data)) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700973 msg->resultcode.status =
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100974 P80211ENUM_resultcode_invalid_parameters;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700975 return 0;
976 }
977 /* call the hfa384x function to do the write */
978 addr = msg->addr.data;
979 len = msg->len.data;
980 buf = msg->data.data;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +0100981 if (hfa384x_drvr_flashdl_write(hw, addr, buf, len))
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700982 msg->resultcode.data = P80211ENUM_resultcode_refused;
983
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700984 msg->resultcode.data = P80211ENUM_resultcode_success;
985
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700986 return 0;
987}
988
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700989/*----------------------------------------------------------------
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -0700990* prism2mgmt_autojoin
991*
992* Associate with an ESS.
993*
994* Arguments:
995* wlandev wlan device structure
996* msgp ptr to msg buffer
997*
998* Returns:
999* 0 success and done
1000* <0 success, but we're waiting for something to finish.
1001* >0 an error occurred while handling the message.
1002* Side effects:
1003*
1004* Call context:
1005* process thread (usually)
1006* interrupt
1007----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +05301008int prism2mgmt_autojoin(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001009{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001010 hfa384x_t *hw = wlandev->priv;
1011 int result = 0;
1012 u16 reg;
1013 u16 port_type;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -03001014 struct p80211msg_lnxreq_autojoin *msg = msgp;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001015 p80211pstrd_t *pstr;
1016 u8 bytebuf[256];
1017 hfa384x_bytestr_t *p2bytestr = (hfa384x_bytestr_t *) bytebuf;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001018
1019 wlandev->macmode = WLAN_MACMODE_NONE;
1020
1021 /* Set the SSID */
1022 memcpy(&wlandev->ssid, &msg->ssid.data, sizeof(msg->ssid.data));
1023
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001024 /* Disable the Port */
1025 hfa384x_drvr_disable(hw, 0);
1026
1027 /*** STATION ***/
1028 /* Set the TxRates */
1029 hfa384x_drvr_setconfig16(hw, HFA384x_RID_TXRATECNTL, 0x000f);
1030
1031 /* Set the auth type */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001032 if (msg->authtype.data == P80211ENUM_authalg_sharedkey)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001033 reg = HFA384x_CNFAUTHENTICATION_SHAREDKEY;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001034 else
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001035 reg = HFA384x_CNFAUTHENTICATION_OPENSYSTEM;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001036
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001037 hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFAUTHENTICATION, reg);
1038
1039 /* Set the ssid */
1040 memset(bytebuf, 0, 256);
Andrew Elwellef1a0ed2010-02-18 23:56:12 +01001041 pstr = (p80211pstrd_t *) &(msg->ssid.data);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001042 prism2mgmt_pstr2bytestr(p2bytestr, pstr);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001043 result = hfa384x_drvr_setconfig(hw, HFA384x_RID_CNFDESIREDSSID,
1044 bytebuf,
1045 HFA384x_RID_CNFDESIREDSSID_LEN);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001046 port_type = HFA384x_PORTTYPE_BSS;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001047 /* Set the PortType */
1048 hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFPORTTYPE, port_type);
1049
1050 /* Enable the Port */
1051 hfa384x_drvr_enable(hw, 0);
1052
1053 /* Set the resultcode */
1054 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
1055 msg->resultcode.data = P80211ENUM_resultcode_success;
1056
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001057 return result;
1058}
1059
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001060/*----------------------------------------------------------------
1061* prism2mgmt_wlansniff
1062*
1063* Start or stop sniffing.
1064*
1065* Arguments:
1066* wlandev wlan device structure
1067* msgp ptr to msg buffer
1068*
1069* Returns:
1070* 0 success and done
1071* <0 success, but we're waiting for something to finish.
1072* >0 an error occurred while handling the message.
1073* Side effects:
1074*
1075* Call context:
1076* process thread (usually)
1077* interrupt
1078----------------------------------------------------------------*/
Mithlesh Thukral297f06c2009-06-10 19:36:11 +05301079int prism2mgmt_wlansniff(wlandevice_t *wlandev, void *msgp)
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001080{
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001081 int result = 0;
Edgardo Hamesb6bb56e2010-08-02 16:20:39 -03001082 struct p80211msg_lnxreq_wlansniff *msg = msgp;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001083
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001084 hfa384x_t *hw = wlandev->priv;
1085 u16 word;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001086
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001087 msg->resultcode.status = P80211ENUM_msgitem_status_data_ok;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001088 switch (msg->enable.data) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001089 case P80211ENUM_truth_false:
1090 /* Confirm that we're in monitor mode */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001091 if (wlandev->netdev->type == ARPHRD_ETHER) {
1092 msg->resultcode.data =
1093 P80211ENUM_resultcode_invalid_parameters;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001094 result = 0;
1095 goto exit;
1096 }
1097 /* Disable monitor mode */
1098 result = hfa384x_cmd_monitor(hw, HFA384x_MONITOR_DISABLE);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001099 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301100 pr_debug("failed to disable monitor mode, result=%d\n",
1101 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001102 goto failed;
1103 }
1104 /* Disable port 0 */
1105 result = hfa384x_drvr_disable(hw, 0);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001106 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301107 pr_debug
Johan Meiringf83dfd02010-11-06 18:23:44 +02001108 ("failed to disable port 0 after sniffing, result=%d\n",
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301109 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001110 goto failed;
1111 }
1112 /* Clear the driver state */
1113 wlandev->netdev->type = ARPHRD_ETHER;
1114
1115 /* Restore the wepflags */
1116 result = hfa384x_drvr_setconfig16(hw,
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001117 HFA384x_RID_CNFWEPFLAGS,
1118 hw->presniff_wepflags);
1119 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301120 pr_debug
1121 ("failed to restore wepflags=0x%04x, result=%d\n",
1122 hw->presniff_wepflags, result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001123 goto failed;
1124 }
1125
1126 /* Set the port to its prior type and enable (if necessary) */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001127 if (hw->presniff_port_type != 0) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001128 word = hw->presniff_port_type;
1129 result = hfa384x_drvr_setconfig16(hw,
Andrew Elwellef1a0ed2010-02-18 23:56:12 +01001130 HFA384x_RID_CNFPORTTYPE,
1131 word);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001132 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301133 pr_debug
1134 ("failed to restore porttype, result=%d\n",
1135 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001136 goto failed;
1137 }
1138
1139 /* Enable the port */
1140 result = hfa384x_drvr_enable(hw, 0);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001141 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301142 pr_debug
Johan Meiringf83dfd02010-11-06 18:23:44 +02001143 ("failed to enable port to presniff setting, result=%d\n",
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301144 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001145 goto failed;
1146 }
1147 } else {
1148 result = hfa384x_drvr_disable(hw, 0);
1149
1150 }
1151
Moritz Muehlenhoff350f2f4b2009-01-25 21:54:57 +01001152 printk(KERN_INFO "monitor mode disabled\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001153 msg->resultcode.data = P80211ENUM_resultcode_success;
1154 result = 0;
1155 goto exit;
1156 break;
1157 case P80211ENUM_truth_true:
1158 /* Disable the port (if enabled), only check Port 0 */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001159 if (hw->port_enabled[0]) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001160 if (wlandev->netdev->type == ARPHRD_ETHER) {
1161 /* Save macport 0 state */
1162 result = hfa384x_drvr_getconfig16(hw,
Andrew Elwellef1a0ed2010-02-18 23:56:12 +01001163 HFA384x_RID_CNFPORTTYPE,
1164 &(hw->presniff_port_type));
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001165 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301166 pr_debug
Johan Meiringf83dfd02010-11-06 18:23:44 +02001167 ("failed to read porttype, result=%d\n",
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301168 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001169 goto failed;
1170 }
1171 /* Save the wepflags state */
1172 result = hfa384x_drvr_getconfig16(hw,
Andrew Elwellef1a0ed2010-02-18 23:56:12 +01001173 HFA384x_RID_CNFWEPFLAGS,
1174 &(hw->presniff_wepflags));
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001175 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301176 pr_debug
Johan Meiringf83dfd02010-11-06 18:23:44 +02001177 ("failed to read wepflags, result=%d\n",
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301178 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001179 goto failed;
1180 }
1181 hfa384x_drvr_stop(hw);
1182 result = hfa384x_drvr_start(hw);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001183 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301184 pr_debug
1185 ("failed to restart the card for sniffing, result=%d\n",
1186 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001187 goto failed;
1188 }
1189 } else {
1190 /* Disable the port */
1191 result = hfa384x_drvr_disable(hw, 0);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001192 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301193 pr_debug
1194 ("failed to enable port for sniffing, result=%d\n",
1195 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001196 goto failed;
1197 }
1198 }
1199 } else {
1200 hw->presniff_port_type = 0;
1201 }
1202
1203 /* Set the channel we wish to sniff */
1204 word = msg->channel.data;
1205 result = hfa384x_drvr_setconfig16(hw,
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001206 HFA384x_RID_CNFOWNCHANNEL,
1207 word);
1208 hw->sniff_channel = word;
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001209
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001210 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301211 pr_debug("failed to set channel %d, result=%d\n",
1212 word, result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001213 goto failed;
1214 }
1215
1216 /* Now if we're already sniffing, we can skip the rest */
1217 if (wlandev->netdev->type != ARPHRD_ETHER) {
1218 /* Set the port type to pIbss */
1219 word = HFA384x_PORTTYPE_PSUEDOIBSS;
1220 result = hfa384x_drvr_setconfig16(hw,
Andrew Elwellef1a0ed2010-02-18 23:56:12 +01001221 HFA384x_RID_CNFPORTTYPE,
1222 word);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001223 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301224 pr_debug
1225 ("failed to set porttype %d, result=%d\n",
1226 word, result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001227 goto failed;
1228 }
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001229 if ((msg->keepwepflags.status ==
1230 P80211ENUM_msgitem_status_data_ok)
1231 && (msg->keepwepflags.data !=
1232 P80211ENUM_truth_true)) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001233 /* Set the wepflags for no decryption */
1234 word = HFA384x_WEPFLAGS_DISABLE_TXCRYPT |
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001235 HFA384x_WEPFLAGS_DISABLE_RXCRYPT;
1236 result =
1237 hfa384x_drvr_setconfig16(hw,
Andrew Elwellef1a0ed2010-02-18 23:56:12 +01001238 HFA384x_RID_CNFWEPFLAGS,
1239 word);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001240 }
1241
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001242 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301243 pr_debug
Johan Meiringf83dfd02010-11-06 18:23:44 +02001244 ("failed to set wepflags=0x%04x, result=%d\n",
1245 word, result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001246 goto failed;
1247 }
1248 }
1249
1250 /* Do we want to strip the FCS in monitor mode? */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001251 if ((msg->stripfcs.status == P80211ENUM_msgitem_status_data_ok)
1252 && (msg->stripfcs.data == P80211ENUM_truth_true)) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001253 hw->sniff_fcs = 0;
1254 } else {
1255 hw->sniff_fcs = 1;
1256 }
1257
1258 /* Do we want to truncate the packets? */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001259 if (msg->packet_trunc.status ==
1260 P80211ENUM_msgitem_status_data_ok) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001261 hw->sniff_truncate = msg->packet_trunc.data;
1262 } else {
1263 hw->sniff_truncate = 0;
1264 }
1265
1266 /* Enable the port */
1267 result = hfa384x_drvr_enable(hw, 0);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001268 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301269 pr_debug
1270 ("failed to enable port for sniffing, result=%d\n",
1271 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001272 goto failed;
1273 }
1274 /* Enable monitor mode */
1275 result = hfa384x_cmd_monitor(hw, HFA384x_MONITOR_ENABLE);
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001276 if (result) {
Mithlesh Thukral75f49e02009-05-25 19:06:16 +05301277 pr_debug("failed to enable monitor mode, result=%d\n",
1278 result);
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001279 goto failed;
1280 }
1281
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001282 if (wlandev->netdev->type == ARPHRD_ETHER)
Moritz Muehlenhoff350f2f4b2009-01-25 21:54:57 +01001283 printk(KERN_INFO "monitor mode enabled\n");
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001284
1285 /* Set the driver state */
1286 /* Do we want the prism2 header? */
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001287 if ((msg->prismheader.status ==
1288 P80211ENUM_msgitem_status_data_ok)
1289 && (msg->prismheader.data == P80211ENUM_truth_true)) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001290 hw->sniffhdr = 0;
1291 wlandev->netdev->type = ARPHRD_IEEE80211_PRISM;
Moritz Muehlenhoff450238e2009-02-08 02:20:48 +01001292 } else
1293 if ((msg->wlanheader.status ==
1294 P80211ENUM_msgitem_status_data_ok)
1295 && (msg->wlanheader.data == P80211ENUM_truth_true)) {
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001296 hw->sniffhdr = 1;
1297 wlandev->netdev->type = ARPHRD_IEEE80211_PRISM;
1298 } else {
1299 wlandev->netdev->type = ARPHRD_IEEE80211;
1300 }
1301
1302 msg->resultcode.data = P80211ENUM_resultcode_success;
1303 result = 0;
1304 goto exit;
1305 break;
1306 default:
1307 msg->resultcode.data = P80211ENUM_resultcode_invalid_parameters;
1308 result = 0;
1309 goto exit;
1310 break;
1311 }
1312
1313failed:
1314 msg->resultcode.data = P80211ENUM_resultcode_refused;
1315 result = 0;
1316exit:
Greg Kroah-Hartman00b3ed12008-10-02 11:29:28 -07001317 return result;
1318}