• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0
2 /* cfg80211 Interface for prism2_usb module */
3 #include "hfa384x.h"
4 #include "prism2mgmt.h"
5 
6 /* Prism2 channel/frequency/bitrate declarations */
7 static const struct ieee80211_channel prism2_channels[] = {
8 	{ .center_freq = 2412 },
9 	{ .center_freq = 2417 },
10 	{ .center_freq = 2422 },
11 	{ .center_freq = 2427 },
12 	{ .center_freq = 2432 },
13 	{ .center_freq = 2437 },
14 	{ .center_freq = 2442 },
15 	{ .center_freq = 2447 },
16 	{ .center_freq = 2452 },
17 	{ .center_freq = 2457 },
18 	{ .center_freq = 2462 },
19 	{ .center_freq = 2467 },
20 	{ .center_freq = 2472 },
21 	{ .center_freq = 2484 },
22 };
23 
24 static const struct ieee80211_rate prism2_rates[] = {
25 	{ .bitrate = 10 },
26 	{ .bitrate = 20 },
27 	{ .bitrate = 55 },
28 	{ .bitrate = 110 }
29 };
30 
31 #define PRISM2_NUM_CIPHER_SUITES 2
32 static const u32 prism2_cipher_suites[PRISM2_NUM_CIPHER_SUITES] = {
33 	WLAN_CIPHER_SUITE_WEP40,
34 	WLAN_CIPHER_SUITE_WEP104
35 };
36 
37 /* prism2 device private data */
38 struct prism2_wiphy_private {
39 	struct wlandevice *wlandev;
40 
41 	struct ieee80211_supported_band band;
42 	struct ieee80211_channel channels[ARRAY_SIZE(prism2_channels)];
43 	struct ieee80211_rate rates[ARRAY_SIZE(prism2_rates)];
44 
45 	struct cfg80211_scan_request *scan_request;
46 };
47 
48 static const void * const prism2_wiphy_privid = &prism2_wiphy_privid;
49 
50 /* Helper Functions */
prism2_result2err(int prism2_result)51 static int prism2_result2err(int prism2_result)
52 {
53 	int err = 0;
54 
55 	switch (prism2_result) {
56 	case P80211ENUM_resultcode_invalid_parameters:
57 		err = -EINVAL;
58 		break;
59 	case P80211ENUM_resultcode_implementation_failure:
60 		err = -EIO;
61 		break;
62 	case P80211ENUM_resultcode_not_supported:
63 		err = -EOPNOTSUPP;
64 		break;
65 	default:
66 		err = 0;
67 		break;
68 	}
69 
70 	return err;
71 }
72 
prism2_domibset_uint32(struct wlandevice * wlandev,u32 did,u32 data)73 static int prism2_domibset_uint32(struct wlandevice *wlandev, u32 did, u32 data)
74 {
75 	struct p80211msg_dot11req_mibset msg;
76 	struct p80211item_uint32 *mibitem =
77 			(struct p80211item_uint32 *)&msg.mibattribute.data;
78 
79 	msg.msgcode = DIDmsg_dot11req_mibset;
80 	mibitem->did = did;
81 	mibitem->data = data;
82 
83 	return p80211req_dorequest(wlandev, (u8 *)&msg);
84 }
85 
prism2_domibset_pstr32(struct wlandevice * wlandev,u32 did,u8 len,const u8 * data)86 static int prism2_domibset_pstr32(struct wlandevice *wlandev,
87 				  u32 did, u8 len, const u8 *data)
88 {
89 	struct p80211msg_dot11req_mibset msg;
90 	struct p80211item_pstr32 *mibitem =
91 			(struct p80211item_pstr32 *)&msg.mibattribute.data;
92 
93 	msg.msgcode = DIDmsg_dot11req_mibset;
94 	mibitem->did = did;
95 	mibitem->data.len = len;
96 	memcpy(mibitem->data.data, data, len);
97 
98 	return p80211req_dorequest(wlandev, (u8 *)&msg);
99 }
100 
101 /* The interface functions, called by the cfg80211 layer */
prism2_change_virtual_intf(struct wiphy * wiphy,struct net_device * dev,enum nl80211_iftype type,struct vif_params * params)102 static int prism2_change_virtual_intf(struct wiphy *wiphy,
103 				      struct net_device *dev,
104 				      enum nl80211_iftype type,
105 				      struct vif_params *params)
106 {
107 	struct wlandevice *wlandev = dev->ml_priv;
108 	u32 data;
109 	int result;
110 	int err = 0;
111 
112 	switch (type) {
113 	case NL80211_IFTYPE_ADHOC:
114 		if (wlandev->macmode == WLAN_MACMODE_IBSS_STA)
115 			goto exit;
116 		wlandev->macmode = WLAN_MACMODE_IBSS_STA;
117 		data = 0;
118 		break;
119 	case NL80211_IFTYPE_STATION:
120 		if (wlandev->macmode == WLAN_MACMODE_ESS_STA)
121 			goto exit;
122 		wlandev->macmode = WLAN_MACMODE_ESS_STA;
123 		data = 1;
124 		break;
125 	default:
126 		netdev_warn(dev, "Operation mode: %d not support\n", type);
127 		return -EOPNOTSUPP;
128 	}
129 
130 	/* Set Operation mode to the PORT TYPE RID */
131 	result = prism2_domibset_uint32(wlandev,
132 					DIDmib_p2_p2Static_p2CnfPortType,
133 					data);
134 
135 	if (result)
136 		err = -EFAULT;
137 
138 	dev->ieee80211_ptr->iftype = type;
139 
140 exit:
141 	return err;
142 }
143 
prism2_add_key(struct wiphy * wiphy,struct net_device * dev,u8 key_index,bool pairwise,const u8 * mac_addr,struct key_params * params)144 static int prism2_add_key(struct wiphy *wiphy, struct net_device *dev,
145 			  u8 key_index, bool pairwise, const u8 *mac_addr,
146 			  struct key_params *params)
147 {
148 	struct wlandevice *wlandev = dev->ml_priv;
149 	u32 did;
150 
151 	int err = 0;
152 	int result = 0;
153 
154 	if (key_index >= NUM_WEPKEYS)
155 		return -EINVAL;
156 
157 	switch (params->cipher) {
158 	case WLAN_CIPHER_SUITE_WEP40:
159 	case WLAN_CIPHER_SUITE_WEP104:
160 		result = prism2_domibset_uint32(wlandev,
161 						DIDmib_dot11smt_dot11PrivacyTable_dot11WEPDefaultKeyID,
162 						key_index);
163 		if (result)
164 			goto exit;
165 
166 		/* send key to driver */
167 		did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_key(key_index + 1);
168 
169 		result = prism2_domibset_pstr32(wlandev, did,
170 						params->key_len, params->key);
171 		if (result)
172 			goto exit;
173 		break;
174 
175 	default:
176 		pr_debug("Unsupported cipher suite\n");
177 		result = 1;
178 	}
179 
180 exit:
181 	if (result)
182 		err = -EFAULT;
183 
184 	return err;
185 }
186 
prism2_get_key(struct wiphy * wiphy,struct net_device * dev,u8 key_index,bool pairwise,const u8 * mac_addr,void * cookie,void (* callback)(void * cookie,struct key_params *))187 static int prism2_get_key(struct wiphy *wiphy, struct net_device *dev,
188 			  u8 key_index, bool pairwise,
189 			  const u8 *mac_addr, void *cookie,
190 			  void (*callback)(void *cookie, struct key_params*))
191 {
192 	struct wlandevice *wlandev = dev->ml_priv;
193 	struct key_params params;
194 	int len;
195 
196 	if (key_index >= NUM_WEPKEYS)
197 		return -EINVAL;
198 
199 	len = wlandev->wep_keylens[key_index];
200 	memset(&params, 0, sizeof(params));
201 
202 	if (len == 13)
203 		params.cipher = WLAN_CIPHER_SUITE_WEP104;
204 	else if (len == 5)
205 		params.cipher = WLAN_CIPHER_SUITE_WEP104;
206 	else
207 		return -ENOENT;
208 	params.key_len = len;
209 	params.key = wlandev->wep_keys[key_index];
210 	params.seq_len = 0;
211 
212 	callback(cookie, &params);
213 
214 	return 0;
215 }
216 
prism2_del_key(struct wiphy * wiphy,struct net_device * dev,u8 key_index,bool pairwise,const u8 * mac_addr)217 static int prism2_del_key(struct wiphy *wiphy, struct net_device *dev,
218 			  u8 key_index, bool pairwise, const u8 *mac_addr)
219 {
220 	struct wlandevice *wlandev = dev->ml_priv;
221 	u32 did;
222 	int err = 0;
223 	int result = 0;
224 
225 	/* There is no direct way in the hardware (AFAIK) of removing
226 	 * a key, so we will cheat by setting the key to a bogus value
227 	 */
228 
229 	if (key_index >= NUM_WEPKEYS)
230 		return -EINVAL;
231 
232 	/* send key to driver */
233 	did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_key(key_index + 1);
234 	result = prism2_domibset_pstr32(wlandev, did, 13, "0000000000000");
235 
236 	if (result)
237 		err = -EFAULT;
238 
239 	return err;
240 }
241 
prism2_set_default_key(struct wiphy * wiphy,struct net_device * dev,u8 key_index,bool unicast,bool multicast)242 static int prism2_set_default_key(struct wiphy *wiphy, struct net_device *dev,
243 				  u8 key_index, bool unicast, bool multicast)
244 {
245 	struct wlandevice *wlandev = dev->ml_priv;
246 
247 	int err = 0;
248 	int result = 0;
249 
250 	result = prism2_domibset_uint32(wlandev,
251 		DIDmib_dot11smt_dot11PrivacyTable_dot11WEPDefaultKeyID,
252 		key_index);
253 
254 	if (result)
255 		err = -EFAULT;
256 
257 	return err;
258 }
259 
prism2_get_station(struct wiphy * wiphy,struct net_device * dev,const u8 * mac,struct station_info * sinfo)260 static int prism2_get_station(struct wiphy *wiphy, struct net_device *dev,
261 			      const u8 *mac, struct station_info *sinfo)
262 {
263 	struct wlandevice *wlandev = dev->ml_priv;
264 	struct p80211msg_lnxreq_commsquality quality;
265 	int result;
266 
267 	memset(sinfo, 0, sizeof(*sinfo));
268 
269 	if (!wlandev || (wlandev->msdstate != WLAN_MSD_RUNNING))
270 		return -EOPNOTSUPP;
271 
272 	/* build request message */
273 	quality.msgcode = DIDmsg_lnxreq_commsquality;
274 	quality.dbm.data = P80211ENUM_truth_true;
275 	quality.dbm.status = P80211ENUM_msgitem_status_data_ok;
276 
277 	/* send message to nsd */
278 	if (!wlandev->mlmerequest)
279 		return -EOPNOTSUPP;
280 
281 	result = wlandev->mlmerequest(wlandev, (struct p80211msg *)&quality);
282 
283 	if (result == 0) {
284 		sinfo->txrate.legacy = quality.txrate.data;
285 		sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE);
286 		sinfo->signal = quality.level.data;
287 		sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL);
288 	}
289 
290 	return result;
291 }
292 
prism2_scan(struct wiphy * wiphy,struct cfg80211_scan_request * request)293 static int prism2_scan(struct wiphy *wiphy,
294 		       struct cfg80211_scan_request *request)
295 {
296 	struct net_device *dev;
297 	struct prism2_wiphy_private *priv = wiphy_priv(wiphy);
298 	struct wlandevice *wlandev;
299 	struct p80211msg_dot11req_scan msg1;
300 	struct p80211msg_dot11req_scan_results msg2;
301 	struct cfg80211_bss *bss;
302 	struct cfg80211_scan_info info = {};
303 
304 	int result;
305 	int err = 0;
306 	int numbss = 0;
307 	int i = 0;
308 	u8 ie_buf[46];
309 	int ie_len;
310 
311 	if (!request)
312 		return -EINVAL;
313 
314 	dev = request->wdev->netdev;
315 	wlandev = dev->ml_priv;
316 
317 	if (priv->scan_request && priv->scan_request != request)
318 		return -EBUSY;
319 
320 	if (wlandev->macmode == WLAN_MACMODE_ESS_AP) {
321 		netdev_err(dev, "Can't scan in AP mode\n");
322 		return -EOPNOTSUPP;
323 	}
324 
325 	priv->scan_request = request;
326 
327 	memset(&msg1, 0x00, sizeof(msg1));
328 	msg1.msgcode = DIDmsg_dot11req_scan;
329 	msg1.bsstype.data = P80211ENUM_bsstype_any;
330 
331 	memset(&msg1.bssid.data.data, 0xFF, sizeof(msg1.bssid.data.data));
332 	msg1.bssid.data.len = 6;
333 
334 	if (request->n_ssids > 0) {
335 		msg1.scantype.data = P80211ENUM_scantype_active;
336 		msg1.ssid.data.len = request->ssids->ssid_len;
337 		memcpy(msg1.ssid.data.data,
338 		       request->ssids->ssid, request->ssids->ssid_len);
339 	} else {
340 		msg1.scantype.data = 0;
341 	}
342 	msg1.probedelay.data = 0;
343 
344 	for (i = 0;
345 		(i < request->n_channels) && i < ARRAY_SIZE(prism2_channels);
346 		i++)
347 		msg1.channellist.data.data[i] =
348 			ieee80211_frequency_to_channel(
349 				request->channels[i]->center_freq);
350 	msg1.channellist.data.len = request->n_channels;
351 
352 	msg1.maxchanneltime.data = 250;
353 	msg1.minchanneltime.data = 200;
354 
355 	result = p80211req_dorequest(wlandev, (u8 *)&msg1);
356 	if (result) {
357 		err = prism2_result2err(msg1.resultcode.data);
358 		goto exit;
359 	}
360 	/* Now retrieve scan results */
361 	numbss = msg1.numbss.data;
362 
363 	for (i = 0; i < numbss; i++) {
364 		int freq;
365 
366 		memset(&msg2, 0, sizeof(msg2));
367 		msg2.msgcode = DIDmsg_dot11req_scan_results;
368 		msg2.bssindex.data = i;
369 
370 		result = p80211req_dorequest(wlandev, (u8 *)&msg2);
371 		if ((result != 0) ||
372 		    (msg2.resultcode.data != P80211ENUM_resultcode_success)) {
373 			break;
374 		}
375 
376 		ie_buf[0] = WLAN_EID_SSID;
377 		ie_buf[1] = msg2.ssid.data.len;
378 		ie_len = ie_buf[1] + 2;
379 		memcpy(&ie_buf[2], &msg2.ssid.data.data, msg2.ssid.data.len);
380 		freq = ieee80211_channel_to_frequency(msg2.dschannel.data,
381 						      NL80211_BAND_2GHZ);
382 		bss = cfg80211_inform_bss(wiphy,
383 			ieee80211_get_channel(wiphy, freq),
384 			CFG80211_BSS_FTYPE_UNKNOWN,
385 			(const u8 *)&msg2.bssid.data.data,
386 			msg2.timestamp.data, msg2.capinfo.data,
387 			msg2.beaconperiod.data,
388 			ie_buf,
389 			ie_len,
390 			(msg2.signal.data - 65536) * 100, /* Conversion to signed type */
391 			GFP_KERNEL
392 		);
393 
394 		if (!bss) {
395 			err = -ENOMEM;
396 			goto exit;
397 		}
398 
399 		cfg80211_put_bss(wiphy, bss);
400 	}
401 
402 	if (result)
403 		err = prism2_result2err(msg2.resultcode.data);
404 
405 exit:
406 	info.aborted = !!(err);
407 	cfg80211_scan_done(request, &info);
408 	priv->scan_request = NULL;
409 	return err;
410 }
411 
prism2_set_wiphy_params(struct wiphy * wiphy,u32 changed)412 static int prism2_set_wiphy_params(struct wiphy *wiphy, u32 changed)
413 {
414 	struct prism2_wiphy_private *priv = wiphy_priv(wiphy);
415 	struct wlandevice *wlandev = priv->wlandev;
416 	u32 data;
417 	int result;
418 	int err = 0;
419 
420 	if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
421 		if (wiphy->rts_threshold == -1)
422 			data = 2347;
423 		else
424 			data = wiphy->rts_threshold;
425 
426 		result = prism2_domibset_uint32(wlandev,
427 						DIDmib_dot11mac_dot11OperationTable_dot11RTSThreshold,
428 						data);
429 		if (result) {
430 			err = -EFAULT;
431 			goto exit;
432 		}
433 	}
434 
435 	if (changed & WIPHY_PARAM_FRAG_THRESHOLD) {
436 		if (wiphy->frag_threshold == -1)
437 			data = 2346;
438 		else
439 			data = wiphy->frag_threshold;
440 
441 		result = prism2_domibset_uint32(wlandev,
442 						DIDmib_dot11mac_dot11OperationTable_dot11FragmentationThreshold,
443 						data);
444 		if (result) {
445 			err = -EFAULT;
446 			goto exit;
447 		}
448 	}
449 
450 exit:
451 	return err;
452 }
453 
prism2_connect(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_connect_params * sme)454 static int prism2_connect(struct wiphy *wiphy, struct net_device *dev,
455 			  struct cfg80211_connect_params *sme)
456 {
457 	struct wlandevice *wlandev = dev->ml_priv;
458 	struct ieee80211_channel *channel = sme->channel;
459 	struct p80211msg_lnxreq_autojoin msg_join;
460 	u32 did;
461 	int length = sme->ssid_len;
462 	int chan = -1;
463 	int is_wep = (sme->crypto.cipher_group == WLAN_CIPHER_SUITE_WEP40) ||
464 	    (sme->crypto.cipher_group == WLAN_CIPHER_SUITE_WEP104);
465 	int result;
466 	int err = 0;
467 
468 	/* Set the channel */
469 	if (channel) {
470 		chan = ieee80211_frequency_to_channel(channel->center_freq);
471 		result = prism2_domibset_uint32(wlandev,
472 						DIDmib_dot11phy_dot11PhyDSSSTable_dot11CurrentChannel,
473 						chan);
474 		if (result)
475 			goto exit;
476 	}
477 
478 	/* Set the authorization */
479 	if ((sme->auth_type == NL80211_AUTHTYPE_OPEN_SYSTEM) ||
480 	    ((sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC) && !is_wep))
481 		msg_join.authtype.data = P80211ENUM_authalg_opensystem;
482 	else if ((sme->auth_type == NL80211_AUTHTYPE_SHARED_KEY) ||
483 		 ((sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC) && is_wep))
484 		msg_join.authtype.data = P80211ENUM_authalg_sharedkey;
485 	else
486 		netdev_warn(dev,
487 			    "Unhandled authorisation type for connect (%d)\n",
488 			    sme->auth_type);
489 
490 	/* Set the encryption - we only support wep */
491 	if (is_wep) {
492 		if (sme->key) {
493 			if (sme->key_idx >= NUM_WEPKEYS)
494 				return -EINVAL;
495 
496 			result = prism2_domibset_uint32(wlandev,
497 				DIDmib_dot11smt_dot11PrivacyTable_dot11WEPDefaultKeyID,
498 				sme->key_idx);
499 			if (result)
500 				goto exit;
501 
502 			/* send key to driver */
503 			did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_key(
504 					sme->key_idx + 1);
505 			result = prism2_domibset_pstr32(wlandev,
506 							did, sme->key_len,
507 							(u8 *)sme->key);
508 			if (result)
509 				goto exit;
510 		}
511 
512 		/* Assume we should set privacy invoked and exclude unencrypted
513 		 * We could possible use sme->privacy here, but the assumption
514 		 * seems reasonable anyways
515 		 */
516 		result = prism2_domibset_uint32(wlandev,
517 						DIDmib_dot11smt_dot11PrivacyTable_dot11PrivacyInvoked,
518 						P80211ENUM_truth_true);
519 		if (result)
520 			goto exit;
521 
522 		result = prism2_domibset_uint32(wlandev,
523 						DIDmib_dot11smt_dot11PrivacyTable_dot11ExcludeUnencrypted,
524 						P80211ENUM_truth_true);
525 		if (result)
526 			goto exit;
527 
528 	} else {
529 		/* Assume we should unset privacy invoked
530 		 * and exclude unencrypted
531 		 */
532 		result = prism2_domibset_uint32(wlandev,
533 						DIDmib_dot11smt_dot11PrivacyTable_dot11PrivacyInvoked,
534 						P80211ENUM_truth_false);
535 		if (result)
536 			goto exit;
537 
538 		result = prism2_domibset_uint32(wlandev,
539 						DIDmib_dot11smt_dot11PrivacyTable_dot11ExcludeUnencrypted,
540 						P80211ENUM_truth_false);
541 		if (result)
542 			goto exit;
543 	}
544 
545 	/* Now do the actual join. Note there is no way that I can
546 	 * see to request a specific bssid
547 	 */
548 	msg_join.msgcode = DIDmsg_lnxreq_autojoin;
549 
550 	memcpy(msg_join.ssid.data.data, sme->ssid, length);
551 	msg_join.ssid.data.len = length;
552 
553 	result = p80211req_dorequest(wlandev, (u8 *)&msg_join);
554 
555 exit:
556 	if (result)
557 		err = -EFAULT;
558 
559 	return err;
560 }
561 
prism2_disconnect(struct wiphy * wiphy,struct net_device * dev,u16 reason_code)562 static int prism2_disconnect(struct wiphy *wiphy, struct net_device *dev,
563 			     u16 reason_code)
564 {
565 	struct wlandevice *wlandev = dev->ml_priv;
566 	struct p80211msg_lnxreq_autojoin msg_join;
567 	int result;
568 	int err = 0;
569 
570 	/* Do a join, with a bogus ssid. Thats the only way I can think of */
571 	msg_join.msgcode = DIDmsg_lnxreq_autojoin;
572 
573 	memcpy(msg_join.ssid.data.data, "---", 3);
574 	msg_join.ssid.data.len = 3;
575 
576 	result = p80211req_dorequest(wlandev, (u8 *)&msg_join);
577 
578 	if (result)
579 		err = -EFAULT;
580 
581 	return err;
582 }
583 
prism2_join_ibss(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_ibss_params * params)584 static int prism2_join_ibss(struct wiphy *wiphy, struct net_device *dev,
585 			    struct cfg80211_ibss_params *params)
586 {
587 	return -EOPNOTSUPP;
588 }
589 
prism2_leave_ibss(struct wiphy * wiphy,struct net_device * dev)590 static int prism2_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
591 {
592 	return -EOPNOTSUPP;
593 }
594 
prism2_set_tx_power(struct wiphy * wiphy,struct wireless_dev * wdev,enum nl80211_tx_power_setting type,int mbm)595 static int prism2_set_tx_power(struct wiphy *wiphy, struct wireless_dev *wdev,
596 			       enum nl80211_tx_power_setting type, int mbm)
597 {
598 	struct prism2_wiphy_private *priv = wiphy_priv(wiphy);
599 	struct wlandevice *wlandev = priv->wlandev;
600 	u32 data;
601 	int result;
602 	int err = 0;
603 
604 	if (type == NL80211_TX_POWER_AUTOMATIC)
605 		data = 30;
606 	else
607 		data = MBM_TO_DBM(mbm);
608 
609 	result = prism2_domibset_uint32(wlandev,
610 		DIDmib_dot11phy_dot11PhyTxPowerTable_dot11CurrentTxPowerLevel,
611 		data);
612 
613 	if (result) {
614 		err = -EFAULT;
615 		goto exit;
616 	}
617 
618 exit:
619 	return err;
620 }
621 
prism2_get_tx_power(struct wiphy * wiphy,struct wireless_dev * wdev,int * dbm)622 static int prism2_get_tx_power(struct wiphy *wiphy, struct wireless_dev *wdev,
623 			       int *dbm)
624 {
625 	struct prism2_wiphy_private *priv = wiphy_priv(wiphy);
626 	struct wlandevice *wlandev = priv->wlandev;
627 	struct p80211msg_dot11req_mibget msg;
628 	struct p80211item_uint32 *mibitem;
629 	int result;
630 	int err = 0;
631 
632 	mibitem = (struct p80211item_uint32 *)&msg.mibattribute.data;
633 	msg.msgcode = DIDmsg_dot11req_mibget;
634 	mibitem->did =
635 	    DIDmib_dot11phy_dot11PhyTxPowerTable_dot11CurrentTxPowerLevel;
636 
637 	result = p80211req_dorequest(wlandev, (u8 *)&msg);
638 
639 	if (result) {
640 		err = -EFAULT;
641 		goto exit;
642 	}
643 
644 	*dbm = mibitem->data;
645 
646 exit:
647 	return err;
648 }
649 
650 /* Interface callback functions, passing data back up to the cfg80211 layer */
prism2_connect_result(struct wlandevice * wlandev,u8 failed)651 void prism2_connect_result(struct wlandevice *wlandev, u8 failed)
652 {
653 	u16 status = failed ?
654 		     WLAN_STATUS_UNSPECIFIED_FAILURE : WLAN_STATUS_SUCCESS;
655 
656 	cfg80211_connect_result(wlandev->netdev, wlandev->bssid,
657 				NULL, 0, NULL, 0, status, GFP_KERNEL);
658 }
659 
prism2_disconnected(struct wlandevice * wlandev)660 void prism2_disconnected(struct wlandevice *wlandev)
661 {
662 	cfg80211_disconnected(wlandev->netdev, 0, NULL,
663 			      0, false, GFP_KERNEL);
664 }
665 
prism2_roamed(struct wlandevice * wlandev)666 void prism2_roamed(struct wlandevice *wlandev)
667 {
668 	struct cfg80211_roam_info roam_info = {
669 		.bssid = wlandev->bssid,
670 	};
671 
672 	cfg80211_roamed(wlandev->netdev, &roam_info, GFP_KERNEL);
673 }
674 
675 /* Structures for declaring wiphy interface */
676 static const struct cfg80211_ops prism2_usb_cfg_ops = {
677 	.change_virtual_intf = prism2_change_virtual_intf,
678 	.add_key = prism2_add_key,
679 	.get_key = prism2_get_key,
680 	.del_key = prism2_del_key,
681 	.set_default_key = prism2_set_default_key,
682 	.get_station = prism2_get_station,
683 	.scan = prism2_scan,
684 	.set_wiphy_params = prism2_set_wiphy_params,
685 	.connect = prism2_connect,
686 	.disconnect = prism2_disconnect,
687 	.join_ibss = prism2_join_ibss,
688 	.leave_ibss = prism2_leave_ibss,
689 	.set_tx_power = prism2_set_tx_power,
690 	.get_tx_power = prism2_get_tx_power,
691 };
692 
693 /* Functions to create/free wiphy interface */
wlan_create_wiphy(struct device * dev,struct wlandevice * wlandev)694 static struct wiphy *wlan_create_wiphy(struct device *dev, struct wlandevice *wlandev)
695 {
696 	struct wiphy *wiphy;
697 	struct prism2_wiphy_private *priv;
698 
699 	wiphy = wiphy_new(&prism2_usb_cfg_ops, sizeof(*priv));
700 	if (!wiphy)
701 		return NULL;
702 
703 	priv = wiphy_priv(wiphy);
704 	priv->wlandev = wlandev;
705 	memcpy(priv->channels, prism2_channels, sizeof(prism2_channels));
706 	memcpy(priv->rates, prism2_rates, sizeof(prism2_rates));
707 	priv->band.channels = priv->channels;
708 	priv->band.n_channels = ARRAY_SIZE(prism2_channels);
709 	priv->band.bitrates = priv->rates;
710 	priv->band.n_bitrates = ARRAY_SIZE(prism2_rates);
711 	priv->band.band = NL80211_BAND_2GHZ;
712 	priv->band.ht_cap.ht_supported = false;
713 	wiphy->bands[NL80211_BAND_2GHZ] = &priv->band;
714 
715 	set_wiphy_dev(wiphy, dev);
716 	wiphy->privid = prism2_wiphy_privid;
717 	wiphy->max_scan_ssids = 1;
718 	wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION)
719 				 | BIT(NL80211_IFTYPE_ADHOC);
720 	wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
721 	wiphy->n_cipher_suites = PRISM2_NUM_CIPHER_SUITES;
722 	wiphy->cipher_suites = prism2_cipher_suites;
723 
724 	if (wiphy_register(wiphy) < 0) {
725 		wiphy_free(wiphy);
726 		return NULL;
727 	}
728 
729 	return wiphy;
730 }
731 
wlan_free_wiphy(struct wiphy * wiphy)732 static void wlan_free_wiphy(struct wiphy *wiphy)
733 {
734 	wiphy_unregister(wiphy);
735 	wiphy_free(wiphy);
736 }
737