1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (c) 2012 - 2018 Microchip Technology Inc., and its subsidiaries.
4  * All rights reserved.
5  */
6 
7 #include "cfg80211.h"
8 
9 #define GO_NEG_REQ			0x00
10 #define GO_NEG_RSP			0x01
11 #define GO_NEG_CONF			0x02
12 #define P2P_INV_REQ			0x03
13 #define P2P_INV_RSP			0x04
14 
15 #define WILC_INVALID_CHANNEL		0
16 
17 /* Operation at 2.4 GHz with channels 1-13 */
18 #define WILC_WLAN_OPERATING_CLASS_2_4GHZ		0x51
19 
20 static const struct ieee80211_txrx_stypes
21 	wilc_wfi_cfg80211_mgmt_types[NUM_NL80211_IFTYPES] = {
22 	[NL80211_IFTYPE_STATION] = {
23 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
24 			BIT(IEEE80211_STYPE_AUTH >> 4),
25 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
26 			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
27 			BIT(IEEE80211_STYPE_AUTH >> 4)
28 	},
29 	[NL80211_IFTYPE_AP] = {
30 		.tx = 0xffff,
31 		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
32 			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
33 			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
34 			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
35 			BIT(IEEE80211_STYPE_AUTH >> 4) |
36 			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
37 			BIT(IEEE80211_STYPE_ACTION >> 4)
38 	},
39 	[NL80211_IFTYPE_P2P_CLIENT] = {
40 		.tx = 0xffff,
41 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
42 			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
43 			BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
44 			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
45 			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
46 			BIT(IEEE80211_STYPE_AUTH >> 4) |
47 			BIT(IEEE80211_STYPE_DEAUTH >> 4)
48 	}
49 };
50 
51 #ifdef CONFIG_PM
52 static const struct wiphy_wowlan_support wowlan_support = {
53 	.flags = WIPHY_WOWLAN_ANY
54 };
55 #endif
56 
57 struct wilc_p2p_mgmt_data {
58 	int size;
59 	u8 *buff;
60 };
61 
62 struct wilc_p2p_pub_act_frame {
63 	u8 category;
64 	u8 action;
65 	u8 oui[3];
66 	u8 oui_type;
67 	u8 oui_subtype;
68 	u8 dialog_token;
69 	u8 elem[];
70 } __packed;
71 
72 struct wilc_vendor_specific_ie {
73 	u8 tag_number;
74 	u8 tag_len;
75 	u8 oui[3];
76 	u8 oui_type;
77 	u8 attr[];
78 } __packed;
79 
80 struct wilc_attr_entry {
81 	u8  attr_type;
82 	__le16 attr_len;
83 	u8 val[];
84 } __packed;
85 
86 struct wilc_attr_oper_ch {
87 	u8 attr_type;
88 	__le16 attr_len;
89 	u8 country_code[IEEE80211_COUNTRY_STRING_LEN];
90 	u8 op_class;
91 	u8 op_channel;
92 } __packed;
93 
94 struct wilc_attr_ch_list {
95 	u8 attr_type;
96 	__le16 attr_len;
97 	u8 country_code[IEEE80211_COUNTRY_STRING_LEN];
98 	u8 elem[];
99 } __packed;
100 
101 struct wilc_ch_list_elem {
102 	u8 op_class;
103 	u8 no_of_channels;
104 	u8 ch_list[];
105 } __packed;
106 
cfg_scan_result(enum scan_event scan_event,struct wilc_rcvd_net_info * info,void * user_void)107 static void cfg_scan_result(enum scan_event scan_event,
108 			    struct wilc_rcvd_net_info *info, void *user_void)
109 {
110 	struct wilc_priv *priv = user_void;
111 
112 	if (!priv->cfg_scanning)
113 		return;
114 
115 	if (scan_event == SCAN_EVENT_NETWORK_FOUND) {
116 		s32 freq;
117 		struct ieee80211_channel *channel;
118 		struct cfg80211_bss *bss;
119 		struct wiphy *wiphy = priv->dev->ieee80211_ptr->wiphy;
120 
121 		if (!wiphy || !info)
122 			return;
123 
124 		freq = ieee80211_channel_to_frequency((s32)info->ch,
125 						      NL80211_BAND_2GHZ);
126 		channel = ieee80211_get_channel(wiphy, freq);
127 		if (!channel)
128 			return;
129 
130 		bss = cfg80211_inform_bss_frame(wiphy, channel, info->mgmt,
131 						info->frame_len,
132 						(s32)info->rssi * 100,
133 						GFP_KERNEL);
134 		cfg80211_put_bss(wiphy, bss);
135 	} else if (scan_event == SCAN_EVENT_DONE) {
136 		mutex_lock(&priv->scan_req_lock);
137 
138 		if (priv->scan_req) {
139 			struct cfg80211_scan_info info = {
140 				.aborted = false,
141 			};
142 
143 			cfg80211_scan_done(priv->scan_req, &info);
144 			priv->cfg_scanning = false;
145 			priv->scan_req = NULL;
146 		}
147 		mutex_unlock(&priv->scan_req_lock);
148 	} else if (scan_event == SCAN_EVENT_ABORTED) {
149 		mutex_lock(&priv->scan_req_lock);
150 
151 		if (priv->scan_req) {
152 			struct cfg80211_scan_info info = {
153 				.aborted = false,
154 			};
155 
156 			cfg80211_scan_done(priv->scan_req, &info);
157 			priv->cfg_scanning = false;
158 			priv->scan_req = NULL;
159 		}
160 		mutex_unlock(&priv->scan_req_lock);
161 	}
162 }
163 
cfg_connect_result(enum conn_event conn_disconn_evt,u8 mac_status,void * priv_data)164 static void cfg_connect_result(enum conn_event conn_disconn_evt, u8 mac_status,
165 			       void *priv_data)
166 {
167 	struct wilc_priv *priv = priv_data;
168 	struct net_device *dev = priv->dev;
169 	struct wilc_vif *vif = netdev_priv(dev);
170 	struct wilc *wl = vif->wilc;
171 	struct host_if_drv *wfi_drv = priv->hif_drv;
172 	struct wilc_conn_info *conn_info = &wfi_drv->conn_info;
173 	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
174 
175 	vif->connecting = false;
176 
177 	if (conn_disconn_evt == CONN_DISCONN_EVENT_CONN_RESP) {
178 		u16 connect_status = conn_info->status;
179 
180 		if (mac_status == WILC_MAC_STATUS_DISCONNECTED &&
181 		    connect_status == WLAN_STATUS_SUCCESS) {
182 			connect_status = WLAN_STATUS_UNSPECIFIED_FAILURE;
183 			wilc_wlan_set_bssid(priv->dev, NULL, WILC_STATION_MODE);
184 
185 			if (vif->iftype != WILC_CLIENT_MODE)
186 				wl->sta_ch = WILC_INVALID_CHANNEL;
187 
188 			netdev_err(dev, "Unspecified failure\n");
189 		}
190 
191 		if (connect_status == WLAN_STATUS_SUCCESS)
192 			memcpy(priv->associated_bss, conn_info->bssid,
193 			       ETH_ALEN);
194 
195 		cfg80211_ref_bss(wiphy, vif->bss);
196 		cfg80211_connect_bss(dev, conn_info->bssid, vif->bss,
197 				     conn_info->req_ies,
198 				     conn_info->req_ies_len,
199 				     conn_info->resp_ies,
200 				     conn_info->resp_ies_len,
201 				     connect_status, GFP_KERNEL,
202 				     NL80211_TIMEOUT_UNSPECIFIED);
203 
204 		vif->bss = NULL;
205 	} else if (conn_disconn_evt == CONN_DISCONN_EVENT_DISCONN_NOTIF) {
206 		u16 reason = 0;
207 
208 		eth_zero_addr(priv->associated_bss);
209 		wilc_wlan_set_bssid(priv->dev, NULL, WILC_STATION_MODE);
210 
211 		if (vif->iftype != WILC_CLIENT_MODE) {
212 			wl->sta_ch = WILC_INVALID_CHANNEL;
213 		} else {
214 			if (wfi_drv->ifc_up)
215 				reason = 3;
216 			else
217 				reason = 1;
218 		}
219 
220 		cfg80211_disconnected(dev, reason, NULL, 0, false, GFP_KERNEL);
221 	}
222 }
223 
wilc_get_wl_to_vif(struct wilc * wl)224 struct wilc_vif *wilc_get_wl_to_vif(struct wilc *wl)
225 {
226 	struct wilc_vif *vif;
227 
228 	vif = list_first_or_null_rcu(&wl->vif_list, typeof(*vif), list);
229 	if (!vif)
230 		return ERR_PTR(-EINVAL);
231 
232 	return vif;
233 }
234 
set_channel(struct wiphy * wiphy,struct cfg80211_chan_def * chandef)235 static int set_channel(struct wiphy *wiphy,
236 		       struct cfg80211_chan_def *chandef)
237 {
238 	struct wilc *wl = wiphy_priv(wiphy);
239 	struct wilc_vif *vif;
240 	u32 channelnum;
241 	int result;
242 	int srcu_idx;
243 
244 	srcu_idx = srcu_read_lock(&wl->srcu);
245 	vif = wilc_get_wl_to_vif(wl);
246 	if (IS_ERR(vif)) {
247 		srcu_read_unlock(&wl->srcu, srcu_idx);
248 		return PTR_ERR(vif);
249 	}
250 
251 	channelnum = ieee80211_frequency_to_channel(chandef->chan->center_freq);
252 
253 	wl->op_ch = channelnum;
254 	result = wilc_set_mac_chnl_num(vif, channelnum);
255 	if (result)
256 		netdev_err(vif->ndev, "Error in setting channel\n");
257 
258 	srcu_read_unlock(&wl->srcu, srcu_idx);
259 	return result;
260 }
261 
scan(struct wiphy * wiphy,struct cfg80211_scan_request * request)262 static int scan(struct wiphy *wiphy, struct cfg80211_scan_request *request)
263 {
264 	struct wilc_vif *vif = netdev_priv(request->wdev->netdev);
265 	struct wilc_priv *priv = &vif->priv;
266 	u32 i;
267 	int ret = 0;
268 	u8 scan_ch_list[WILC_MAX_NUM_SCANNED_CH];
269 	u8 scan_type;
270 
271 	if (request->n_channels > WILC_MAX_NUM_SCANNED_CH) {
272 		netdev_err(vif->ndev, "Requested scanned channels over\n");
273 		return -EINVAL;
274 	}
275 
276 	priv->scan_req = request;
277 	priv->cfg_scanning = true;
278 	for (i = 0; i < request->n_channels; i++) {
279 		u16 freq = request->channels[i]->center_freq;
280 
281 		scan_ch_list[i] = ieee80211_frequency_to_channel(freq);
282 	}
283 
284 	if (request->n_ssids)
285 		scan_type = WILC_FW_ACTIVE_SCAN;
286 	else
287 		scan_type = WILC_FW_PASSIVE_SCAN;
288 
289 	ret = wilc_scan(vif, WILC_FW_USER_SCAN, scan_type, scan_ch_list,
290 			request->n_channels, cfg_scan_result, (void *)priv,
291 			request);
292 
293 	if (ret) {
294 		priv->scan_req = NULL;
295 		priv->cfg_scanning = false;
296 	}
297 
298 	return ret;
299 }
300 
connect(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_connect_params * sme)301 static int connect(struct wiphy *wiphy, struct net_device *dev,
302 		   struct cfg80211_connect_params *sme)
303 {
304 	struct wilc_vif *vif = netdev_priv(dev);
305 	struct wilc_priv *priv = &vif->priv;
306 	struct host_if_drv *wfi_drv = priv->hif_drv;
307 	int ret;
308 	u32 i;
309 	u8 security = WILC_FW_SEC_NO;
310 	enum mfptype mfp_type = WILC_FW_MFP_NONE;
311 	enum authtype auth_type = WILC_FW_AUTH_ANY;
312 	u32 cipher_group;
313 	struct cfg80211_bss *bss;
314 	void *join_params;
315 	u8 ch;
316 
317 	vif->connecting = true;
318 
319 	cipher_group = sme->crypto.cipher_group;
320 	if (cipher_group != 0) {
321 		if (sme->crypto.wpa_versions & NL80211_WPA_VERSION_2) {
322 			if (cipher_group == WLAN_CIPHER_SUITE_TKIP)
323 				security = WILC_FW_SEC_WPA2_TKIP;
324 			else
325 				security = WILC_FW_SEC_WPA2_AES;
326 		} else if (sme->crypto.wpa_versions & NL80211_WPA_VERSION_1) {
327 			if (cipher_group == WLAN_CIPHER_SUITE_TKIP)
328 				security = WILC_FW_SEC_WPA_TKIP;
329 			else
330 				security = WILC_FW_SEC_WPA_AES;
331 		} else {
332 			ret = -ENOTSUPP;
333 			netdev_err(dev, "%s: Unsupported cipher\n",
334 				   __func__);
335 			goto out_error;
336 		}
337 	}
338 
339 	if ((sme->crypto.wpa_versions & NL80211_WPA_VERSION_1) ||
340 	    (sme->crypto.wpa_versions & NL80211_WPA_VERSION_2)) {
341 		for (i = 0; i < sme->crypto.n_ciphers_pairwise; i++) {
342 			u32 ciphers_pairwise = sme->crypto.ciphers_pairwise[i];
343 
344 			if (ciphers_pairwise == WLAN_CIPHER_SUITE_TKIP)
345 				security |= WILC_FW_TKIP;
346 			else
347 				security |= WILC_FW_AES;
348 		}
349 	}
350 
351 	switch (sme->auth_type) {
352 	case NL80211_AUTHTYPE_OPEN_SYSTEM:
353 		auth_type = WILC_FW_AUTH_OPEN_SYSTEM;
354 		break;
355 
356 	case NL80211_AUTHTYPE_SAE:
357 		auth_type = WILC_FW_AUTH_SAE;
358 		if (sme->ssid_len) {
359 			memcpy(vif->auth.ssid.ssid, sme->ssid, sme->ssid_len);
360 			vif->auth.ssid.ssid_len = sme->ssid_len;
361 		}
362 		vif->auth.key_mgmt_suite = cpu_to_be32(sme->crypto.akm_suites[0]);
363 		ether_addr_copy(vif->auth.bssid, sme->bssid);
364 		break;
365 
366 	default:
367 		break;
368 	}
369 
370 	if (sme->crypto.n_akm_suites) {
371 		if (sme->crypto.akm_suites[0] == WLAN_AKM_SUITE_8021X)
372 			auth_type = WILC_FW_AUTH_IEEE8021;
373 		else if (sme->crypto.akm_suites[0] == WLAN_AKM_SUITE_PSK_SHA256)
374 			auth_type = WILC_FW_AUTH_OPEN_SYSTEM_SHA256;
375 		else if (sme->crypto.akm_suites[0] == WLAN_AKM_SUITE_8021X_SHA256)
376 			auth_type = WILC_FW_AUTH_IEE8021X_SHA256;
377 	}
378 
379 	if (wfi_drv->usr_scan_req.scan_result) {
380 		netdev_err(vif->ndev, "%s: Scan in progress\n", __func__);
381 		ret = -EBUSY;
382 		goto out_error;
383 	}
384 
385 	bss = cfg80211_get_bss(wiphy, sme->channel, sme->bssid, sme->ssid,
386 			       sme->ssid_len, IEEE80211_BSS_TYPE_ANY,
387 			       IEEE80211_PRIVACY(sme->privacy));
388 	if (!bss) {
389 		ret = -EINVAL;
390 		goto out_error;
391 	}
392 
393 	if (ether_addr_equal_unaligned(vif->bssid, bss->bssid)) {
394 		ret = -EALREADY;
395 		goto out_put_bss;
396 	}
397 
398 	join_params = wilc_parse_join_bss_param(bss, &sme->crypto);
399 	if (!join_params) {
400 		netdev_err(dev, "%s: failed to construct join param\n",
401 			   __func__);
402 		ret = -EINVAL;
403 		goto out_put_bss;
404 	}
405 
406 	ch = ieee80211_frequency_to_channel(bss->channel->center_freq);
407 	vif->wilc->op_ch = ch;
408 	if (vif->iftype != WILC_CLIENT_MODE)
409 		vif->wilc->sta_ch = ch;
410 
411 	wilc_wlan_set_bssid(dev, bss->bssid, WILC_STATION_MODE);
412 
413 	wfi_drv->conn_info.security = security;
414 	wfi_drv->conn_info.auth_type = auth_type;
415 	wfi_drv->conn_info.ch = ch;
416 	wfi_drv->conn_info.conn_result = cfg_connect_result;
417 	wfi_drv->conn_info.arg = priv;
418 	wfi_drv->conn_info.param = join_params;
419 
420 	if (sme->mfp == NL80211_MFP_OPTIONAL)
421 		mfp_type = WILC_FW_MFP_OPTIONAL;
422 	else if (sme->mfp == NL80211_MFP_REQUIRED)
423 		mfp_type = WILC_FW_MFP_REQUIRED;
424 
425 	wfi_drv->conn_info.mfp_type = mfp_type;
426 
427 	ret = wilc_set_join_req(vif, bss->bssid, sme->ie, sme->ie_len);
428 	if (ret) {
429 		netdev_err(dev, "wilc_set_join_req(): Error\n");
430 		ret = -ENOENT;
431 		if (vif->iftype != WILC_CLIENT_MODE)
432 			vif->wilc->sta_ch = WILC_INVALID_CHANNEL;
433 		wilc_wlan_set_bssid(dev, NULL, WILC_STATION_MODE);
434 		wfi_drv->conn_info.conn_result = NULL;
435 		kfree(join_params);
436 		goto out_put_bss;
437 	}
438 	kfree(join_params);
439 	vif->bss = bss;
440 	cfg80211_put_bss(wiphy, bss);
441 	return 0;
442 
443 out_put_bss:
444 	cfg80211_put_bss(wiphy, bss);
445 
446 out_error:
447 	vif->connecting = false;
448 	return ret;
449 }
450 
disconnect(struct wiphy * wiphy,struct net_device * dev,u16 reason_code)451 static int disconnect(struct wiphy *wiphy, struct net_device *dev,
452 		      u16 reason_code)
453 {
454 	struct wilc_vif *vif = netdev_priv(dev);
455 	struct wilc_priv *priv = &vif->priv;
456 	struct wilc *wilc = vif->wilc;
457 	int ret;
458 
459 	vif->connecting = false;
460 
461 	if (!wilc)
462 		return -EIO;
463 
464 	if (wilc->close) {
465 		/* already disconnected done */
466 		cfg80211_disconnected(dev, 0, NULL, 0, true, GFP_KERNEL);
467 		return 0;
468 	}
469 
470 	if (vif->iftype != WILC_CLIENT_MODE)
471 		wilc->sta_ch = WILC_INVALID_CHANNEL;
472 	wilc_wlan_set_bssid(priv->dev, NULL, WILC_STATION_MODE);
473 
474 	priv->hif_drv->p2p_timeout = 0;
475 
476 	ret = wilc_disconnect(vif);
477 	if (ret != 0) {
478 		netdev_err(priv->dev, "Error in disconnecting\n");
479 		ret = -EINVAL;
480 	}
481 
482 	vif->bss = NULL;
483 
484 	return ret;
485 }
486 
wilc_wfi_cfg_allocate_wpa_entry(struct wilc_priv * priv,u8 idx)487 static int wilc_wfi_cfg_allocate_wpa_entry(struct wilc_priv *priv, u8 idx)
488 {
489 	if (!priv->wilc_gtk[idx]) {
490 		priv->wilc_gtk[idx] = kzalloc(sizeof(*priv->wilc_gtk[idx]),
491 					      GFP_KERNEL);
492 		if (!priv->wilc_gtk[idx])
493 			return -ENOMEM;
494 	}
495 
496 	if (!priv->wilc_ptk[idx]) {
497 		priv->wilc_ptk[idx] = kzalloc(sizeof(*priv->wilc_ptk[idx]),
498 					      GFP_KERNEL);
499 		if (!priv->wilc_ptk[idx])
500 			return -ENOMEM;
501 	}
502 
503 	return 0;
504 }
505 
wilc_wfi_cfg_allocate_wpa_igtk_entry(struct wilc_priv * priv,u8 idx)506 static int wilc_wfi_cfg_allocate_wpa_igtk_entry(struct wilc_priv *priv, u8 idx)
507 {
508 	idx -= 4;
509 	if (!priv->wilc_igtk[idx]) {
510 		priv->wilc_igtk[idx] = kzalloc(sizeof(*priv->wilc_igtk[idx]),
511 					       GFP_KERNEL);
512 		if (!priv->wilc_igtk[idx])
513 			return -ENOMEM;
514 	}
515 	return 0;
516 }
517 
wilc_wfi_cfg_copy_wpa_info(struct wilc_wfi_key * key_info,struct key_params * params)518 static int wilc_wfi_cfg_copy_wpa_info(struct wilc_wfi_key *key_info,
519 				      struct key_params *params)
520 {
521 	kfree(key_info->key);
522 
523 	key_info->key = kmemdup(params->key, params->key_len, GFP_KERNEL);
524 	if (!key_info->key)
525 		return -ENOMEM;
526 
527 	kfree(key_info->seq);
528 
529 	if (params->seq_len > 0) {
530 		key_info->seq = kmemdup(params->seq, params->seq_len,
531 					GFP_KERNEL);
532 		if (!key_info->seq)
533 			return -ENOMEM;
534 	}
535 
536 	key_info->cipher = params->cipher;
537 	key_info->key_len = params->key_len;
538 	key_info->seq_len = params->seq_len;
539 
540 	return 0;
541 }
542 
add_key(struct wiphy * wiphy,struct net_device * netdev,int link_id,u8 key_index,bool pairwise,const u8 * mac_addr,struct key_params * params)543 static int add_key(struct wiphy *wiphy, struct net_device *netdev, int link_id,
544 		   u8 key_index, bool pairwise, const u8 *mac_addr,
545 		   struct key_params *params)
546 
547 {
548 	int ret = 0, keylen = params->key_len;
549 	const u8 *rx_mic = NULL;
550 	const u8 *tx_mic = NULL;
551 	u8 mode = WILC_FW_SEC_NO;
552 	u8 op_mode;
553 	struct wilc_vif *vif = netdev_priv(netdev);
554 	struct wilc_priv *priv = &vif->priv;
555 	struct wilc_wfi_key *key;
556 
557 	switch (params->cipher) {
558 	case WLAN_CIPHER_SUITE_TKIP:
559 	case WLAN_CIPHER_SUITE_CCMP:
560 		if (priv->wdev.iftype == NL80211_IFTYPE_AP ||
561 		    priv->wdev.iftype == NL80211_IFTYPE_P2P_GO) {
562 			struct wilc_wfi_key *key;
563 
564 			ret = wilc_wfi_cfg_allocate_wpa_entry(priv, key_index);
565 			if (ret)
566 				return -ENOMEM;
567 
568 			if (params->key_len > 16 &&
569 			    params->cipher == WLAN_CIPHER_SUITE_TKIP) {
570 				tx_mic = params->key + 24;
571 				rx_mic = params->key + 16;
572 				keylen = params->key_len - 16;
573 			}
574 
575 			if (!pairwise) {
576 				if (params->cipher == WLAN_CIPHER_SUITE_TKIP)
577 					mode = WILC_FW_SEC_WPA_TKIP;
578 				else
579 					mode = WILC_FW_SEC_WPA2_AES;
580 
581 				priv->wilc_groupkey = mode;
582 
583 				key = priv->wilc_gtk[key_index];
584 			} else {
585 				if (params->cipher == WLAN_CIPHER_SUITE_TKIP)
586 					mode = WILC_FW_SEC_WPA_TKIP;
587 				else
588 					mode = priv->wilc_groupkey | WILC_FW_AES;
589 
590 				key = priv->wilc_ptk[key_index];
591 			}
592 			ret = wilc_wfi_cfg_copy_wpa_info(key, params);
593 			if (ret)
594 				return -ENOMEM;
595 
596 			op_mode = WILC_AP_MODE;
597 		} else {
598 			if (params->key_len > 16 &&
599 			    params->cipher == WLAN_CIPHER_SUITE_TKIP) {
600 				rx_mic = params->key + 24;
601 				tx_mic = params->key + 16;
602 				keylen = params->key_len - 16;
603 			}
604 
605 			op_mode = WILC_STATION_MODE;
606 		}
607 
608 		if (!pairwise)
609 			ret = wilc_add_rx_gtk(vif, params->key, keylen,
610 					      key_index, params->seq_len,
611 					      params->seq, rx_mic, tx_mic,
612 					      op_mode, mode);
613 		else
614 			ret = wilc_add_ptk(vif, params->key, keylen, mac_addr,
615 					   rx_mic, tx_mic, op_mode, mode,
616 					   key_index);
617 
618 		break;
619 	case WLAN_CIPHER_SUITE_AES_CMAC:
620 		ret = wilc_wfi_cfg_allocate_wpa_igtk_entry(priv, key_index);
621 		if (ret)
622 			return -ENOMEM;
623 
624 		key = priv->wilc_igtk[key_index - 4];
625 		ret = wilc_wfi_cfg_copy_wpa_info(key, params);
626 		if (ret)
627 			return -ENOMEM;
628 
629 		if (priv->wdev.iftype == NL80211_IFTYPE_AP ||
630 		    priv->wdev.iftype == NL80211_IFTYPE_P2P_GO)
631 			op_mode = WILC_AP_MODE;
632 		else
633 			op_mode = WILC_STATION_MODE;
634 
635 		ret = wilc_add_igtk(vif, params->key, keylen, params->seq,
636 				    params->seq_len, mac_addr, op_mode,
637 				    key_index);
638 		break;
639 
640 	default:
641 		netdev_err(netdev, "%s: Unsupported cipher\n", __func__);
642 		ret = -ENOTSUPP;
643 	}
644 
645 	return ret;
646 }
647 
del_key(struct wiphy * wiphy,struct net_device * netdev,int link_id,u8 key_index,bool pairwise,const u8 * mac_addr)648 static int del_key(struct wiphy *wiphy, struct net_device *netdev, int link_id,
649 		   u8 key_index,
650 		   bool pairwise,
651 		   const u8 *mac_addr)
652 {
653 	struct wilc_vif *vif = netdev_priv(netdev);
654 	struct wilc_priv *priv = &vif->priv;
655 
656 	if (!pairwise && (key_index == 4 || key_index == 5)) {
657 		key_index -= 4;
658 		if (priv->wilc_igtk[key_index]) {
659 			kfree(priv->wilc_igtk[key_index]->key);
660 			priv->wilc_igtk[key_index]->key = NULL;
661 			kfree(priv->wilc_igtk[key_index]->seq);
662 			priv->wilc_igtk[key_index]->seq = NULL;
663 			kfree(priv->wilc_igtk[key_index]);
664 			priv->wilc_igtk[key_index] = NULL;
665 		}
666 	} else {
667 		if (priv->wilc_gtk[key_index]) {
668 			kfree(priv->wilc_gtk[key_index]->key);
669 			priv->wilc_gtk[key_index]->key = NULL;
670 			kfree(priv->wilc_gtk[key_index]->seq);
671 			priv->wilc_gtk[key_index]->seq = NULL;
672 
673 			kfree(priv->wilc_gtk[key_index]);
674 			priv->wilc_gtk[key_index] = NULL;
675 		}
676 		if (priv->wilc_ptk[key_index]) {
677 			kfree(priv->wilc_ptk[key_index]->key);
678 			priv->wilc_ptk[key_index]->key = NULL;
679 			kfree(priv->wilc_ptk[key_index]->seq);
680 			priv->wilc_ptk[key_index]->seq = NULL;
681 			kfree(priv->wilc_ptk[key_index]);
682 			priv->wilc_ptk[key_index] = NULL;
683 		}
684 	}
685 
686 	return 0;
687 }
688 
get_key(struct wiphy * wiphy,struct net_device * netdev,int link_id,u8 key_index,bool pairwise,const u8 * mac_addr,void * cookie,void (* callback)(void * cookie,struct key_params *))689 static int get_key(struct wiphy *wiphy, struct net_device *netdev, int link_id,
690 		   u8 key_index, bool pairwise, const u8 *mac_addr,
691 		   void *cookie,
692 		   void (*callback)(void *cookie, struct key_params *))
693 {
694 	struct wilc_vif *vif = netdev_priv(netdev);
695 	struct wilc_priv *priv = &vif->priv;
696 	struct  key_params key_params;
697 
698 	if (!pairwise) {
699 		if (key_index == 4 || key_index == 5) {
700 			key_index -= 4;
701 			key_params.key = priv->wilc_igtk[key_index]->key;
702 			key_params.cipher = priv->wilc_igtk[key_index]->cipher;
703 			key_params.key_len = priv->wilc_igtk[key_index]->key_len;
704 			key_params.seq = priv->wilc_igtk[key_index]->seq;
705 			key_params.seq_len = priv->wilc_igtk[key_index]->seq_len;
706 		} else {
707 			key_params.key = priv->wilc_gtk[key_index]->key;
708 			key_params.cipher = priv->wilc_gtk[key_index]->cipher;
709 			key_params.key_len = priv->wilc_gtk[key_index]->key_len;
710 			key_params.seq = priv->wilc_gtk[key_index]->seq;
711 			key_params.seq_len = priv->wilc_gtk[key_index]->seq_len;
712 		}
713 	} else {
714 		key_params.key = priv->wilc_ptk[key_index]->key;
715 		key_params.cipher = priv->wilc_ptk[key_index]->cipher;
716 		key_params.key_len = priv->wilc_ptk[key_index]->key_len;
717 		key_params.seq = priv->wilc_ptk[key_index]->seq;
718 		key_params.seq_len = priv->wilc_ptk[key_index]->seq_len;
719 	}
720 
721 	callback(cookie, &key_params);
722 
723 	return 0;
724 }
725 
726 /* wiphy_new_nm() will WARNON if not present */
set_default_key(struct wiphy * wiphy,struct net_device * netdev,int link_id,u8 key_index,bool unicast,bool multicast)727 static int set_default_key(struct wiphy *wiphy, struct net_device *netdev,
728 			   int link_id, u8 key_index, bool unicast,
729 			   bool multicast)
730 {
731 	return 0;
732 }
733 
set_default_mgmt_key(struct wiphy * wiphy,struct net_device * netdev,int link_id,u8 key_index)734 static int set_default_mgmt_key(struct wiphy *wiphy, struct net_device *netdev,
735 				int link_id, u8 key_index)
736 {
737 	struct wilc_vif *vif = netdev_priv(netdev);
738 
739 	return wilc_set_default_mgmt_key_index(vif, key_index);
740 }
741 
get_station(struct wiphy * wiphy,struct net_device * dev,const u8 * mac,struct station_info * sinfo)742 static int get_station(struct wiphy *wiphy, struct net_device *dev,
743 		       const u8 *mac, struct station_info *sinfo)
744 {
745 	struct wilc_vif *vif = netdev_priv(dev);
746 	struct wilc_priv *priv = &vif->priv;
747 	struct wilc *wilc = vif->wilc;
748 	u32 i = 0;
749 	u32 associatedsta = ~0;
750 	u32 inactive_time = 0;
751 
752 	if (vif->iftype == WILC_AP_MODE || vif->iftype == WILC_GO_MODE) {
753 		for (i = 0; i < NUM_STA_ASSOCIATED; i++) {
754 			if (!(memcmp(mac,
755 				     priv->assoc_stainfo.sta_associated_bss[i],
756 				     ETH_ALEN))) {
757 				associatedsta = i;
758 				break;
759 			}
760 		}
761 
762 		if (associatedsta == ~0) {
763 			netdev_err(dev, "sta required is not associated\n");
764 			return -ENOENT;
765 		}
766 
767 		sinfo->filled |= BIT_ULL(NL80211_STA_INFO_INACTIVE_TIME);
768 
769 		wilc_get_inactive_time(vif, mac, &inactive_time);
770 		sinfo->inactive_time = 1000 * inactive_time;
771 	} else if (vif->iftype == WILC_STATION_MODE) {
772 		struct rf_info stats;
773 
774 		if (!wilc->initialized)
775 			return -EBUSY;
776 
777 		wilc_get_statistics(vif, &stats);
778 
779 		sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL) |
780 				 BIT_ULL(NL80211_STA_INFO_RX_PACKETS) |
781 				 BIT_ULL(NL80211_STA_INFO_TX_PACKETS) |
782 				 BIT_ULL(NL80211_STA_INFO_TX_FAILED) |
783 				 BIT_ULL(NL80211_STA_INFO_TX_BITRATE);
784 
785 		sinfo->signal = stats.rssi;
786 		sinfo->rx_packets = stats.rx_cnt;
787 		sinfo->tx_packets = stats.tx_cnt + stats.tx_fail_cnt;
788 		sinfo->tx_failed = stats.tx_fail_cnt;
789 		sinfo->txrate.legacy = stats.link_speed * 10;
790 
791 		if (stats.link_speed > TCP_ACK_FILTER_LINK_SPEED_THRESH &&
792 		    stats.link_speed != DEFAULT_LINK_SPEED)
793 			wilc_enable_tcp_ack_filter(vif, true);
794 		else if (stats.link_speed != DEFAULT_LINK_SPEED)
795 			wilc_enable_tcp_ack_filter(vif, false);
796 	}
797 	return 0;
798 }
799 
change_bss(struct wiphy * wiphy,struct net_device * dev,struct bss_parameters * params)800 static int change_bss(struct wiphy *wiphy, struct net_device *dev,
801 		      struct bss_parameters *params)
802 {
803 	return 0;
804 }
805 
set_wiphy_params(struct wiphy * wiphy,u32 changed)806 static int set_wiphy_params(struct wiphy *wiphy, u32 changed)
807 {
808 	int ret = -EINVAL;
809 	struct cfg_param_attr cfg_param_val;
810 	struct wilc *wl = wiphy_priv(wiphy);
811 	struct wilc_vif *vif;
812 	struct wilc_priv *priv;
813 	int srcu_idx;
814 
815 	srcu_idx = srcu_read_lock(&wl->srcu);
816 	vif = wilc_get_wl_to_vif(wl);
817 	if (IS_ERR(vif))
818 		goto out;
819 
820 	priv = &vif->priv;
821 	cfg_param_val.flag = 0;
822 
823 	if (changed & WIPHY_PARAM_RETRY_SHORT) {
824 		netdev_dbg(vif->ndev,
825 			   "Setting WIPHY_PARAM_RETRY_SHORT %d\n",
826 			   wiphy->retry_short);
827 		cfg_param_val.flag  |= WILC_CFG_PARAM_RETRY_SHORT;
828 		cfg_param_val.short_retry_limit = wiphy->retry_short;
829 	}
830 	if (changed & WIPHY_PARAM_RETRY_LONG) {
831 		netdev_dbg(vif->ndev,
832 			   "Setting WIPHY_PARAM_RETRY_LONG %d\n",
833 			   wiphy->retry_long);
834 		cfg_param_val.flag |= WILC_CFG_PARAM_RETRY_LONG;
835 		cfg_param_val.long_retry_limit = wiphy->retry_long;
836 	}
837 	if (changed & WIPHY_PARAM_FRAG_THRESHOLD) {
838 		if (wiphy->frag_threshold > 255 &&
839 		    wiphy->frag_threshold < 7937) {
840 			netdev_dbg(vif->ndev,
841 				   "Setting WIPHY_PARAM_FRAG_THRESHOLD %d\n",
842 				   wiphy->frag_threshold);
843 			cfg_param_val.flag |= WILC_CFG_PARAM_FRAG_THRESHOLD;
844 			cfg_param_val.frag_threshold = wiphy->frag_threshold;
845 		} else {
846 			netdev_err(vif->ndev,
847 				   "Fragmentation threshold out of range\n");
848 			goto out;
849 		}
850 	}
851 
852 	if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
853 		if (wiphy->rts_threshold > 255) {
854 			netdev_dbg(vif->ndev,
855 				   "Setting WIPHY_PARAM_RTS_THRESHOLD %d\n",
856 				   wiphy->rts_threshold);
857 			cfg_param_val.flag |= WILC_CFG_PARAM_RTS_THRESHOLD;
858 			cfg_param_val.rts_threshold = wiphy->rts_threshold;
859 		} else {
860 			netdev_err(vif->ndev, "RTS threshold out of range\n");
861 			goto out;
862 		}
863 	}
864 
865 	ret = wilc_hif_set_cfg(vif, &cfg_param_val);
866 	if (ret)
867 		netdev_err(priv->dev, "Error in setting WIPHY PARAMS\n");
868 
869 out:
870 	srcu_read_unlock(&wl->srcu, srcu_idx);
871 	return ret;
872 }
873 
set_pmksa(struct wiphy * wiphy,struct net_device * netdev,struct cfg80211_pmksa * pmksa)874 static int set_pmksa(struct wiphy *wiphy, struct net_device *netdev,
875 		     struct cfg80211_pmksa *pmksa)
876 {
877 	struct wilc_vif *vif = netdev_priv(netdev);
878 	struct wilc_priv *priv = &vif->priv;
879 	u32 i;
880 	int ret = 0;
881 	u8 flag = 0;
882 
883 	for (i = 0; i < priv->pmkid_list.numpmkid; i++)	{
884 		if (!memcmp(pmksa->bssid, priv->pmkid_list.pmkidlist[i].bssid,
885 			    ETH_ALEN)) {
886 			flag = PMKID_FOUND;
887 			break;
888 		}
889 	}
890 	if (i < WILC_MAX_NUM_PMKIDS) {
891 		memcpy(priv->pmkid_list.pmkidlist[i].bssid, pmksa->bssid,
892 		       ETH_ALEN);
893 		memcpy(priv->pmkid_list.pmkidlist[i].pmkid, pmksa->pmkid,
894 		       WLAN_PMKID_LEN);
895 		if (!(flag == PMKID_FOUND))
896 			priv->pmkid_list.numpmkid++;
897 	} else {
898 		netdev_err(netdev, "Invalid PMKID index\n");
899 		ret = -EINVAL;
900 	}
901 
902 	if (!ret)
903 		ret = wilc_set_pmkid_info(vif, &priv->pmkid_list);
904 
905 	return ret;
906 }
907 
del_pmksa(struct wiphy * wiphy,struct net_device * netdev,struct cfg80211_pmksa * pmksa)908 static int del_pmksa(struct wiphy *wiphy, struct net_device *netdev,
909 		     struct cfg80211_pmksa *pmksa)
910 {
911 	u32 i;
912 	struct wilc_vif *vif = netdev_priv(netdev);
913 	struct wilc_priv *priv = &vif->priv;
914 
915 	for (i = 0; i < priv->pmkid_list.numpmkid; i++)	{
916 		if (!memcmp(pmksa->bssid, priv->pmkid_list.pmkidlist[i].bssid,
917 			    ETH_ALEN)) {
918 			memset(&priv->pmkid_list.pmkidlist[i], 0,
919 			       sizeof(struct wilc_pmkid));
920 			break;
921 		}
922 	}
923 
924 	if (i == priv->pmkid_list.numpmkid)
925 		return -EINVAL;
926 
927 	for (; i < (priv->pmkid_list.numpmkid - 1); i++) {
928 		memcpy(priv->pmkid_list.pmkidlist[i].bssid,
929 		       priv->pmkid_list.pmkidlist[i + 1].bssid,
930 		       ETH_ALEN);
931 		memcpy(priv->pmkid_list.pmkidlist[i].pmkid,
932 		       priv->pmkid_list.pmkidlist[i + 1].pmkid,
933 		       WLAN_PMKID_LEN);
934 	}
935 	priv->pmkid_list.numpmkid--;
936 
937 	return 0;
938 }
939 
flush_pmksa(struct wiphy * wiphy,struct net_device * netdev)940 static int flush_pmksa(struct wiphy *wiphy, struct net_device *netdev)
941 {
942 	struct wilc_vif *vif = netdev_priv(netdev);
943 
944 	memset(&vif->priv.pmkid_list, 0, sizeof(struct wilc_pmkid_attr));
945 
946 	return 0;
947 }
948 
wilc_wfi_cfg_parse_ch_attr(u8 * buf,u32 len,u8 sta_ch)949 static inline void wilc_wfi_cfg_parse_ch_attr(u8 *buf, u32 len, u8 sta_ch)
950 {
951 	struct wilc_attr_entry *e;
952 	struct wilc_attr_ch_list *ch_list;
953 	struct wilc_attr_oper_ch *op_ch;
954 	u32 index = 0;
955 	u8 ch_list_idx = 0;
956 	u8 op_ch_idx = 0;
957 
958 	if (sta_ch == WILC_INVALID_CHANNEL)
959 		return;
960 
961 	while (index + sizeof(*e) <= len) {
962 		u16 attr_size;
963 
964 		e = (struct wilc_attr_entry *)&buf[index];
965 		attr_size = le16_to_cpu(e->attr_len);
966 
967 		if (index + sizeof(*e) + attr_size > len)
968 			return;
969 
970 		if (e->attr_type == IEEE80211_P2P_ATTR_CHANNEL_LIST &&
971 		    attr_size >= (sizeof(struct wilc_attr_ch_list) - sizeof(*e)))
972 			ch_list_idx = index;
973 		else if (e->attr_type == IEEE80211_P2P_ATTR_OPER_CHANNEL &&
974 			 attr_size == (sizeof(struct wilc_attr_oper_ch) - sizeof(*e)))
975 			op_ch_idx = index;
976 
977 		if (ch_list_idx && op_ch_idx)
978 			break;
979 
980 		index += sizeof(*e) + attr_size;
981 	}
982 
983 	if (ch_list_idx) {
984 		u16 elem_size;
985 
986 		ch_list = (struct wilc_attr_ch_list *)&buf[ch_list_idx];
987 		/* the number of bytes following the final 'elem' member */
988 		elem_size = le16_to_cpu(ch_list->attr_len) -
989 			(sizeof(*ch_list) - sizeof(struct wilc_attr_entry));
990 		for (unsigned int i = 0; i < elem_size;) {
991 			struct wilc_ch_list_elem *e;
992 
993 			e = (struct wilc_ch_list_elem *)(ch_list->elem + i);
994 
995 			i += sizeof(*e);
996 			if (i > elem_size)
997 				break;
998 
999 			i += e->no_of_channels;
1000 			if (i > elem_size)
1001 				break;
1002 
1003 			if (e->op_class == WILC_WLAN_OPERATING_CLASS_2_4GHZ) {
1004 				memset(e->ch_list, sta_ch, e->no_of_channels);
1005 				break;
1006 			}
1007 		}
1008 	}
1009 
1010 	if (op_ch_idx) {
1011 		op_ch = (struct wilc_attr_oper_ch *)&buf[op_ch_idx];
1012 		op_ch->op_class = WILC_WLAN_OPERATING_CLASS_2_4GHZ;
1013 		op_ch->op_channel = sta_ch;
1014 	}
1015 }
1016 
wilc_wfi_mgmt_frame_rx(struct wilc_vif * vif,u8 * buff,u32 size)1017 bool wilc_wfi_mgmt_frame_rx(struct wilc_vif *vif, u8 *buff, u32 size)
1018 {
1019 	struct wilc *wl = vif->wilc;
1020 	struct wilc_priv *priv = &vif->priv;
1021 	int freq;
1022 
1023 	freq = ieee80211_channel_to_frequency(wl->op_ch, NL80211_BAND_2GHZ);
1024 
1025 	return cfg80211_rx_mgmt(&priv->wdev, freq, 0, buff, size, 0);
1026 }
1027 
wilc_wfi_p2p_rx(struct wilc_vif * vif,u8 * buff,u32 size)1028 void wilc_wfi_p2p_rx(struct wilc_vif *vif, u8 *buff, u32 size)
1029 {
1030 	struct wilc *wl = vif->wilc;
1031 	struct wilc_priv *priv = &vif->priv;
1032 	struct host_if_drv *wfi_drv = priv->hif_drv;
1033 	struct ieee80211_mgmt *mgmt;
1034 	struct wilc_vendor_specific_ie *p;
1035 	struct wilc_p2p_pub_act_frame *d;
1036 	int ie_offset = offsetof(struct ieee80211_mgmt, u) + sizeof(*d);
1037 	const u8 *vendor_ie;
1038 	u32 header, pkt_offset;
1039 	s32 freq;
1040 
1041 	header = get_unaligned_le32(buff - HOST_HDR_OFFSET);
1042 	pkt_offset = FIELD_GET(WILC_PKT_HDR_OFFSET_FIELD, header);
1043 
1044 	if (pkt_offset & IS_MANAGMEMENT_CALLBACK) {
1045 		bool ack = false;
1046 		struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)buff;
1047 
1048 		if (ieee80211_is_probe_resp(hdr->frame_control) ||
1049 		    pkt_offset & IS_MGMT_STATUS_SUCCES)
1050 			ack = true;
1051 
1052 		cfg80211_mgmt_tx_status(&priv->wdev, priv->tx_cookie, buff,
1053 					size, ack, GFP_KERNEL);
1054 		return;
1055 	}
1056 
1057 	freq = ieee80211_channel_to_frequency(wl->op_ch, NL80211_BAND_2GHZ);
1058 
1059 	mgmt = (struct ieee80211_mgmt *)buff;
1060 	if (!ieee80211_is_action(mgmt->frame_control))
1061 		goto out_rx_mgmt;
1062 
1063 	if (priv->cfg_scanning &&
1064 	    time_after_eq(jiffies, (unsigned long)wfi_drv->p2p_timeout)) {
1065 		netdev_dbg(vif->ndev, "Receiving action wrong ch\n");
1066 		return;
1067 	}
1068 
1069 	if (!ieee80211_is_public_action((struct ieee80211_hdr *)buff, size))
1070 		goto out_rx_mgmt;
1071 
1072 	d = (struct wilc_p2p_pub_act_frame *)(&mgmt->u.action);
1073 	if (d->oui_subtype != GO_NEG_REQ && d->oui_subtype != GO_NEG_RSP &&
1074 	    d->oui_subtype != P2P_INV_REQ && d->oui_subtype != P2P_INV_RSP)
1075 		goto out_rx_mgmt;
1076 
1077 	vendor_ie = cfg80211_find_vendor_ie(WLAN_OUI_WFA, WLAN_OUI_TYPE_WFA_P2P,
1078 					    buff + ie_offset, size - ie_offset);
1079 	if (!vendor_ie)
1080 		goto out_rx_mgmt;
1081 
1082 	p = (struct wilc_vendor_specific_ie *)vendor_ie;
1083 	wilc_wfi_cfg_parse_ch_attr(p->attr, p->tag_len - 4, vif->wilc->sta_ch);
1084 
1085 out_rx_mgmt:
1086 	cfg80211_rx_mgmt(&priv->wdev, freq, 0, buff, size, 0);
1087 }
1088 
wilc_wfi_mgmt_tx_complete(void * priv,int status)1089 static void wilc_wfi_mgmt_tx_complete(void *priv, int status)
1090 {
1091 	struct wilc_p2p_mgmt_data *pv_data = priv;
1092 
1093 	kfree(pv_data->buff);
1094 	kfree(pv_data);
1095 }
1096 
wilc_wfi_remain_on_channel_expired(void * data,u64 cookie)1097 static void wilc_wfi_remain_on_channel_expired(void *data, u64 cookie)
1098 {
1099 	struct wilc_vif *vif = data;
1100 	struct wilc_priv *priv = &vif->priv;
1101 	struct wilc_wfi_p2p_listen_params *params = &priv->remain_on_ch_params;
1102 
1103 	if (cookie != params->listen_cookie)
1104 		return;
1105 
1106 	priv->p2p_listen_state = false;
1107 
1108 	cfg80211_remain_on_channel_expired(&priv->wdev, params->listen_cookie,
1109 					   params->listen_ch, GFP_KERNEL);
1110 }
1111 
remain_on_channel(struct wiphy * wiphy,struct wireless_dev * wdev,struct ieee80211_channel * chan,unsigned int duration,u64 * cookie)1112 static int remain_on_channel(struct wiphy *wiphy,
1113 			     struct wireless_dev *wdev,
1114 			     struct ieee80211_channel *chan,
1115 			     unsigned int duration, u64 *cookie)
1116 {
1117 	int ret = 0;
1118 	struct wilc_vif *vif = netdev_priv(wdev->netdev);
1119 	struct wilc_priv *priv = &vif->priv;
1120 	u64 id;
1121 
1122 	if (wdev->iftype == NL80211_IFTYPE_AP) {
1123 		netdev_dbg(vif->ndev, "Required while in AP mode\n");
1124 		return ret;
1125 	}
1126 
1127 	id = ++priv->inc_roc_cookie;
1128 	if (id == 0)
1129 		id = ++priv->inc_roc_cookie;
1130 
1131 	ret = wilc_remain_on_channel(vif, id, duration, chan->hw_value,
1132 				     wilc_wfi_remain_on_channel_expired,
1133 				     (void *)vif);
1134 	if (ret)
1135 		return ret;
1136 
1137 	vif->wilc->op_ch = chan->hw_value;
1138 
1139 	priv->remain_on_ch_params.listen_ch = chan;
1140 	priv->remain_on_ch_params.listen_cookie = id;
1141 	*cookie = id;
1142 	priv->p2p_listen_state = true;
1143 	priv->remain_on_ch_params.listen_duration = duration;
1144 
1145 	cfg80211_ready_on_channel(wdev, *cookie, chan, duration, GFP_KERNEL);
1146 	mod_timer(&vif->hif_drv->remain_on_ch_timer,
1147 		  jiffies + msecs_to_jiffies(duration + 1000));
1148 
1149 	return ret;
1150 }
1151 
cancel_remain_on_channel(struct wiphy * wiphy,struct wireless_dev * wdev,u64 cookie)1152 static int cancel_remain_on_channel(struct wiphy *wiphy,
1153 				    struct wireless_dev *wdev,
1154 				    u64 cookie)
1155 {
1156 	struct wilc_vif *vif = netdev_priv(wdev->netdev);
1157 	struct wilc_priv *priv = &vif->priv;
1158 
1159 	if (cookie != priv->remain_on_ch_params.listen_cookie)
1160 		return -ENOENT;
1161 
1162 	return wilc_listen_state_expired(vif, cookie);
1163 }
1164 
mgmt_tx(struct wiphy * wiphy,struct wireless_dev * wdev,struct cfg80211_mgmt_tx_params * params,u64 * cookie)1165 static int mgmt_tx(struct wiphy *wiphy,
1166 		   struct wireless_dev *wdev,
1167 		   struct cfg80211_mgmt_tx_params *params,
1168 		   u64 *cookie)
1169 {
1170 	struct ieee80211_channel *chan = params->chan;
1171 	unsigned int wait = params->wait;
1172 	const u8 *buf = params->buf;
1173 	size_t len = params->len;
1174 	const struct ieee80211_mgmt *mgmt;
1175 	struct wilc_p2p_mgmt_data *mgmt_tx;
1176 	struct wilc_vif *vif = netdev_priv(wdev->netdev);
1177 	struct wilc_priv *priv = &vif->priv;
1178 	struct host_if_drv *wfi_drv = priv->hif_drv;
1179 	struct wilc_vendor_specific_ie *p;
1180 	struct wilc_p2p_pub_act_frame *d;
1181 	int ie_offset = offsetof(struct ieee80211_mgmt, u) + sizeof(*d);
1182 	const u8 *vendor_ie;
1183 	int ret = 0;
1184 
1185 	*cookie = get_random_u32();
1186 	priv->tx_cookie = *cookie;
1187 	mgmt = (const struct ieee80211_mgmt *)buf;
1188 
1189 	if (!ieee80211_is_mgmt(mgmt->frame_control))
1190 		goto out;
1191 
1192 	mgmt_tx = kmalloc(sizeof(*mgmt_tx), GFP_KERNEL);
1193 	if (!mgmt_tx) {
1194 		ret = -ENOMEM;
1195 		goto out;
1196 	}
1197 
1198 	mgmt_tx->buff = kmemdup(buf, len, GFP_KERNEL);
1199 	if (!mgmt_tx->buff) {
1200 		ret = -ENOMEM;
1201 		kfree(mgmt_tx);
1202 		goto out;
1203 	}
1204 
1205 	mgmt_tx->size = len;
1206 
1207 	if (ieee80211_is_probe_resp(mgmt->frame_control)) {
1208 		wilc_set_mac_chnl_num(vif, chan->hw_value);
1209 		vif->wilc->op_ch = chan->hw_value;
1210 		goto out_txq_add_pkt;
1211 	}
1212 
1213 	if (!ieee80211_is_public_action((struct ieee80211_hdr *)buf, len)) {
1214 		if (chan)
1215 			wilc_set_mac_chnl_num(vif, chan->hw_value);
1216 		else
1217 			wilc_set_mac_chnl_num(vif, vif->wilc->op_ch);
1218 
1219 		goto out_set_timeout;
1220 	}
1221 
1222 	d = (struct wilc_p2p_pub_act_frame *)(&mgmt->u.action);
1223 	if (d->oui_type != WLAN_OUI_TYPE_WFA_P2P ||
1224 	    d->oui_subtype != GO_NEG_CONF) {
1225 		wilc_set_mac_chnl_num(vif, chan->hw_value);
1226 		vif->wilc->op_ch = chan->hw_value;
1227 	}
1228 
1229 	if (d->oui_subtype != P2P_INV_REQ && d->oui_subtype != P2P_INV_RSP)
1230 		goto out_set_timeout;
1231 
1232 	vendor_ie = cfg80211_find_vendor_ie(WLAN_OUI_WFA, WLAN_OUI_TYPE_WFA_P2P,
1233 					    mgmt_tx->buff + ie_offset,
1234 					    len - ie_offset);
1235 	if (!vendor_ie)
1236 		goto out_set_timeout;
1237 
1238 	p = (struct wilc_vendor_specific_ie *)vendor_ie;
1239 	wilc_wfi_cfg_parse_ch_attr(p->attr, p->tag_len - 4, vif->wilc->sta_ch);
1240 
1241 out_set_timeout:
1242 	wfi_drv->p2p_timeout = (jiffies + msecs_to_jiffies(wait));
1243 
1244 out_txq_add_pkt:
1245 
1246 	wilc_wlan_txq_add_mgmt_pkt(wdev->netdev, mgmt_tx,
1247 				   mgmt_tx->buff, mgmt_tx->size,
1248 				   wilc_wfi_mgmt_tx_complete);
1249 
1250 out:
1251 
1252 	return ret;
1253 }
1254 
mgmt_tx_cancel_wait(struct wiphy * wiphy,struct wireless_dev * wdev,u64 cookie)1255 static int mgmt_tx_cancel_wait(struct wiphy *wiphy,
1256 			       struct wireless_dev *wdev,
1257 			       u64 cookie)
1258 {
1259 	struct wilc_vif *vif = netdev_priv(wdev->netdev);
1260 	struct wilc_priv *priv = &vif->priv;
1261 	struct host_if_drv *wfi_drv = priv->hif_drv;
1262 
1263 	wfi_drv->p2p_timeout = jiffies;
1264 
1265 	if (!priv->p2p_listen_state) {
1266 		struct wilc_wfi_p2p_listen_params *params;
1267 
1268 		params = &priv->remain_on_ch_params;
1269 
1270 		cfg80211_remain_on_channel_expired(wdev,
1271 						   params->listen_cookie,
1272 						   params->listen_ch,
1273 						   GFP_KERNEL);
1274 	}
1275 
1276 	return 0;
1277 }
1278 
wilc_update_mgmt_frame_registrations(struct wiphy * wiphy,struct wireless_dev * wdev,struct mgmt_frame_regs * upd)1279 void wilc_update_mgmt_frame_registrations(struct wiphy *wiphy,
1280 					  struct wireless_dev *wdev,
1281 					  struct mgmt_frame_regs *upd)
1282 {
1283 	struct wilc *wl = wiphy_priv(wiphy);
1284 	struct wilc_vif *vif = netdev_priv(wdev->netdev);
1285 	u32 presp_bit = BIT(IEEE80211_STYPE_PROBE_REQ >> 4);
1286 	u32 action_bit = BIT(IEEE80211_STYPE_ACTION >> 4);
1287 	u32 pauth_bit = BIT(IEEE80211_STYPE_AUTH >> 4);
1288 
1289 	if (wl->initialized) {
1290 		bool prev = vif->mgmt_reg_stypes & presp_bit;
1291 		bool now = upd->interface_stypes & presp_bit;
1292 
1293 		if (now != prev)
1294 			wilc_frame_register(vif, IEEE80211_STYPE_PROBE_REQ, now);
1295 
1296 		prev = vif->mgmt_reg_stypes & action_bit;
1297 		now = upd->interface_stypes & action_bit;
1298 
1299 		if (now != prev)
1300 			wilc_frame_register(vif, IEEE80211_STYPE_ACTION, now);
1301 
1302 		prev = vif->mgmt_reg_stypes & pauth_bit;
1303 		now = upd->interface_stypes & pauth_bit;
1304 		if (now != prev)
1305 			wilc_frame_register(vif, IEEE80211_STYPE_AUTH, now);
1306 	}
1307 
1308 	vif->mgmt_reg_stypes =
1309 		upd->interface_stypes & (presp_bit | action_bit | pauth_bit);
1310 }
1311 
external_auth(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_external_auth_params * auth)1312 static int external_auth(struct wiphy *wiphy, struct net_device *dev,
1313 			 struct cfg80211_external_auth_params *auth)
1314 {
1315 	struct wilc_vif *vif = netdev_priv(dev);
1316 
1317 	if (auth->status == WLAN_STATUS_SUCCESS)
1318 		wilc_set_external_auth_param(vif, auth);
1319 
1320 	return 0;
1321 }
1322 
set_cqm_rssi_config(struct wiphy * wiphy,struct net_device * dev,s32 rssi_thold,u32 rssi_hyst)1323 static int set_cqm_rssi_config(struct wiphy *wiphy, struct net_device *dev,
1324 			       s32 rssi_thold, u32 rssi_hyst)
1325 {
1326 	return 0;
1327 }
1328 
dump_station(struct wiphy * wiphy,struct net_device * dev,int idx,u8 * mac,struct station_info * sinfo)1329 static int dump_station(struct wiphy *wiphy, struct net_device *dev,
1330 			int idx, u8 *mac, struct station_info *sinfo)
1331 {
1332 	struct wilc_vif *vif = netdev_priv(dev);
1333 	int ret;
1334 
1335 	if (idx != 0)
1336 		return -ENOENT;
1337 
1338 	ret = wilc_get_rssi(vif, &sinfo->signal);
1339 	if (ret)
1340 		return ret;
1341 
1342 	sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL);
1343 	memcpy(mac, vif->priv.associated_bss, ETH_ALEN);
1344 	return 0;
1345 }
1346 
set_power_mgmt(struct wiphy * wiphy,struct net_device * dev,bool enabled,int timeout)1347 static int set_power_mgmt(struct wiphy *wiphy, struct net_device *dev,
1348 			  bool enabled, int timeout)
1349 {
1350 	struct wilc_vif *vif = netdev_priv(dev);
1351 	struct wilc_priv *priv = &vif->priv;
1352 
1353 	if (!priv->hif_drv)
1354 		return -EIO;
1355 
1356 	wilc_set_power_mgmt(vif, enabled, timeout);
1357 
1358 	return 0;
1359 }
1360 
change_virtual_intf(struct wiphy * wiphy,struct net_device * dev,enum nl80211_iftype type,struct vif_params * params)1361 static int change_virtual_intf(struct wiphy *wiphy, struct net_device *dev,
1362 			       enum nl80211_iftype type,
1363 			       struct vif_params *params)
1364 {
1365 	struct wilc *wl = wiphy_priv(wiphy);
1366 	struct wilc_vif *vif = netdev_priv(dev);
1367 	struct wilc_priv *priv = &vif->priv;
1368 
1369 	switch (type) {
1370 	case NL80211_IFTYPE_STATION:
1371 		vif->connecting = false;
1372 		dev->ieee80211_ptr->iftype = type;
1373 		priv->wdev.iftype = type;
1374 		vif->monitor_flag = 0;
1375 		if (vif->iftype == WILC_AP_MODE || vif->iftype == WILC_GO_MODE)
1376 			wilc_wfi_deinit_mon_interface(wl, true);
1377 		vif->iftype = WILC_STATION_MODE;
1378 
1379 		if (wl->initialized)
1380 			wilc_set_operation_mode(vif, wilc_get_vif_idx(vif),
1381 						WILC_STATION_MODE, vif->idx);
1382 
1383 		memset(priv->assoc_stainfo.sta_associated_bss, 0,
1384 		       WILC_MAX_NUM_STA * ETH_ALEN);
1385 		break;
1386 
1387 	case NL80211_IFTYPE_P2P_CLIENT:
1388 		vif->connecting = false;
1389 		dev->ieee80211_ptr->iftype = type;
1390 		priv->wdev.iftype = type;
1391 		vif->monitor_flag = 0;
1392 		vif->iftype = WILC_CLIENT_MODE;
1393 
1394 		if (wl->initialized)
1395 			wilc_set_operation_mode(vif, wilc_get_vif_idx(vif),
1396 						WILC_STATION_MODE, vif->idx);
1397 		break;
1398 
1399 	case NL80211_IFTYPE_AP:
1400 		dev->ieee80211_ptr->iftype = type;
1401 		priv->wdev.iftype = type;
1402 		vif->iftype = WILC_AP_MODE;
1403 
1404 		if (wl->initialized)
1405 			wilc_set_operation_mode(vif, wilc_get_vif_idx(vif),
1406 						WILC_AP_MODE, vif->idx);
1407 		break;
1408 
1409 	case NL80211_IFTYPE_P2P_GO:
1410 		dev->ieee80211_ptr->iftype = type;
1411 		priv->wdev.iftype = type;
1412 		vif->iftype = WILC_GO_MODE;
1413 
1414 		if (wl->initialized)
1415 			wilc_set_operation_mode(vif, wilc_get_vif_idx(vif),
1416 						WILC_AP_MODE, vif->idx);
1417 		break;
1418 
1419 	default:
1420 		netdev_err(dev, "Unknown interface type= %d\n", type);
1421 		return -EINVAL;
1422 	}
1423 
1424 	return 0;
1425 }
1426 
start_ap(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_ap_settings * settings)1427 static int start_ap(struct wiphy *wiphy, struct net_device *dev,
1428 		    struct cfg80211_ap_settings *settings)
1429 {
1430 	struct wilc_vif *vif = netdev_priv(dev);
1431 	int ret;
1432 
1433 	ret = set_channel(wiphy, &settings->chandef);
1434 	if (ret != 0)
1435 		netdev_err(dev, "Error in setting channel\n");
1436 
1437 	wilc_wlan_set_bssid(dev, dev->dev_addr, WILC_AP_MODE);
1438 
1439 	return wilc_add_beacon(vif, settings->beacon_interval,
1440 				   settings->dtim_period, &settings->beacon);
1441 }
1442 
change_beacon(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_beacon_data * beacon)1443 static int change_beacon(struct wiphy *wiphy, struct net_device *dev,
1444 			 struct cfg80211_beacon_data *beacon)
1445 {
1446 	struct wilc_vif *vif = netdev_priv(dev);
1447 
1448 	return wilc_add_beacon(vif, 0, 0, beacon);
1449 }
1450 
stop_ap(struct wiphy * wiphy,struct net_device * dev,unsigned int link_id)1451 static int stop_ap(struct wiphy *wiphy, struct net_device *dev,
1452 		   unsigned int link_id)
1453 {
1454 	int ret;
1455 	struct wilc_vif *vif = netdev_priv(dev);
1456 
1457 	wilc_wlan_set_bssid(dev, NULL, WILC_AP_MODE);
1458 
1459 	ret = wilc_del_beacon(vif);
1460 
1461 	if (ret)
1462 		netdev_err(dev, "Host delete beacon fail\n");
1463 
1464 	return ret;
1465 }
1466 
add_station(struct wiphy * wiphy,struct net_device * dev,const u8 * mac,struct station_parameters * params)1467 static int add_station(struct wiphy *wiphy, struct net_device *dev,
1468 		       const u8 *mac, struct station_parameters *params)
1469 {
1470 	int ret = 0;
1471 	struct wilc_vif *vif = netdev_priv(dev);
1472 	struct wilc_priv *priv = &vif->priv;
1473 
1474 	if (vif->iftype == WILC_AP_MODE || vif->iftype == WILC_GO_MODE) {
1475 		memcpy(priv->assoc_stainfo.sta_associated_bss[params->aid], mac,
1476 		       ETH_ALEN);
1477 
1478 		ret = wilc_add_station(vif, mac, params);
1479 		if (ret)
1480 			netdev_err(dev, "Host add station fail\n");
1481 	}
1482 
1483 	return ret;
1484 }
1485 
del_station(struct wiphy * wiphy,struct net_device * dev,struct station_del_parameters * params)1486 static int del_station(struct wiphy *wiphy, struct net_device *dev,
1487 		       struct station_del_parameters *params)
1488 {
1489 	const u8 *mac = params->mac;
1490 	int ret = 0;
1491 	struct wilc_vif *vif = netdev_priv(dev);
1492 	struct wilc_priv *priv = &vif->priv;
1493 	struct sta_info *info;
1494 
1495 	if (!(vif->iftype == WILC_AP_MODE || vif->iftype == WILC_GO_MODE))
1496 		return ret;
1497 
1498 	info = &priv->assoc_stainfo;
1499 
1500 	if (!mac)
1501 		ret = wilc_del_allstation(vif, info->sta_associated_bss);
1502 
1503 	ret = wilc_del_station(vif, mac);
1504 	if (ret)
1505 		netdev_err(dev, "Host delete station fail\n");
1506 	return ret;
1507 }
1508 
change_station(struct wiphy * wiphy,struct net_device * dev,const u8 * mac,struct station_parameters * params)1509 static int change_station(struct wiphy *wiphy, struct net_device *dev,
1510 			  const u8 *mac, struct station_parameters *params)
1511 {
1512 	int ret = 0;
1513 	struct wilc_vif *vif = netdev_priv(dev);
1514 
1515 	if (vif->iftype == WILC_AP_MODE || vif->iftype == WILC_GO_MODE) {
1516 		ret = wilc_edit_station(vif, mac, params);
1517 		if (ret)
1518 			netdev_err(dev, "Host edit station fail\n");
1519 	}
1520 	return ret;
1521 }
1522 
wilc_get_vif_from_type(struct wilc * wl,int type)1523 static struct wilc_vif *wilc_get_vif_from_type(struct wilc *wl, int type)
1524 {
1525 	struct wilc_vif *vif;
1526 
1527 	list_for_each_entry_rcu(vif, &wl->vif_list, list) {
1528 		if (vif->iftype == type)
1529 			return vif;
1530 	}
1531 
1532 	return NULL;
1533 }
1534 
add_virtual_intf(struct wiphy * wiphy,const char * name,unsigned char name_assign_type,enum nl80211_iftype type,struct vif_params * params)1535 static struct wireless_dev *add_virtual_intf(struct wiphy *wiphy,
1536 					     const char *name,
1537 					     unsigned char name_assign_type,
1538 					     enum nl80211_iftype type,
1539 					     struct vif_params *params)
1540 {
1541 	struct wilc *wl = wiphy_priv(wiphy);
1542 	struct wilc_vif *vif;
1543 	struct wireless_dev *wdev;
1544 	int iftype;
1545 
1546 	if (type == NL80211_IFTYPE_MONITOR) {
1547 		struct net_device *ndev;
1548 		int srcu_idx;
1549 
1550 		srcu_idx = srcu_read_lock(&wl->srcu);
1551 		vif = wilc_get_vif_from_type(wl, WILC_AP_MODE);
1552 		if (!vif) {
1553 			vif = wilc_get_vif_from_type(wl, WILC_GO_MODE);
1554 			if (!vif) {
1555 				srcu_read_unlock(&wl->srcu, srcu_idx);
1556 				goto validate_interface;
1557 			}
1558 		}
1559 
1560 		if (vif->monitor_flag) {
1561 			srcu_read_unlock(&wl->srcu, srcu_idx);
1562 			goto validate_interface;
1563 		}
1564 
1565 		ndev = wilc_wfi_init_mon_interface(wl, name, vif->ndev);
1566 		if (ndev) {
1567 			vif->monitor_flag = 1;
1568 		} else {
1569 			srcu_read_unlock(&wl->srcu, srcu_idx);
1570 			return ERR_PTR(-EINVAL);
1571 		}
1572 
1573 		wdev = &vif->priv.wdev;
1574 		srcu_read_unlock(&wl->srcu, srcu_idx);
1575 		return wdev;
1576 	}
1577 
1578 validate_interface:
1579 	mutex_lock(&wl->vif_mutex);
1580 	if (wl->vif_num == WILC_NUM_CONCURRENT_IFC) {
1581 		pr_err("Reached maximum number of interface\n");
1582 		mutex_unlock(&wl->vif_mutex);
1583 		return ERR_PTR(-EINVAL);
1584 	}
1585 	mutex_unlock(&wl->vif_mutex);
1586 
1587 	switch (type) {
1588 	case NL80211_IFTYPE_STATION:
1589 		iftype = WILC_STATION_MODE;
1590 		break;
1591 	case NL80211_IFTYPE_AP:
1592 		iftype = WILC_AP_MODE;
1593 		break;
1594 	default:
1595 		return ERR_PTR(-EOPNOTSUPP);
1596 	}
1597 
1598 	vif = wilc_netdev_ifc_init(wl, name, iftype, type, true);
1599 	if (IS_ERR(vif))
1600 		return ERR_CAST(vif);
1601 
1602 	return &vif->priv.wdev;
1603 }
1604 
del_virtual_intf(struct wiphy * wiphy,struct wireless_dev * wdev)1605 static int del_virtual_intf(struct wiphy *wiphy, struct wireless_dev *wdev)
1606 {
1607 	struct wilc *wl = wiphy_priv(wiphy);
1608 	struct wilc_vif *vif;
1609 
1610 	if (wdev->iftype == NL80211_IFTYPE_AP ||
1611 	    wdev->iftype == NL80211_IFTYPE_P2P_GO)
1612 		wilc_wfi_deinit_mon_interface(wl, true);
1613 	vif = netdev_priv(wdev->netdev);
1614 	cfg80211_stop_iface(wiphy, wdev, GFP_KERNEL);
1615 	cfg80211_unregister_netdevice(vif->ndev);
1616 	vif->monitor_flag = 0;
1617 
1618 	mutex_lock(&wl->vif_mutex);
1619 	list_del_rcu(&vif->list);
1620 	wl->vif_num--;
1621 	mutex_unlock(&wl->vif_mutex);
1622 	synchronize_srcu(&wl->srcu);
1623 	return 0;
1624 }
1625 
wilc_suspend(struct wiphy * wiphy,struct cfg80211_wowlan * wow)1626 static int wilc_suspend(struct wiphy *wiphy, struct cfg80211_wowlan *wow)
1627 {
1628 	struct wilc *wl = wiphy_priv(wiphy);
1629 
1630 	if (!wow && wilc_wlan_get_num_conn_ifcs(wl))
1631 		wl->suspend_event = true;
1632 	else
1633 		wl->suspend_event = false;
1634 
1635 	return 0;
1636 }
1637 
wilc_resume(struct wiphy * wiphy)1638 static int wilc_resume(struct wiphy *wiphy)
1639 {
1640 	return 0;
1641 }
1642 
wilc_set_wakeup(struct wiphy * wiphy,bool enabled)1643 static void wilc_set_wakeup(struct wiphy *wiphy, bool enabled)
1644 {
1645 	struct wilc *wl = wiphy_priv(wiphy);
1646 	struct wilc_vif *vif;
1647 	int srcu_idx;
1648 
1649 	srcu_idx = srcu_read_lock(&wl->srcu);
1650 	vif = wilc_get_wl_to_vif(wl);
1651 	if (IS_ERR(vif)) {
1652 		srcu_read_unlock(&wl->srcu, srcu_idx);
1653 		return;
1654 	}
1655 
1656 	netdev_info(vif->ndev, "cfg set wake up = %d\n", enabled);
1657 	wilc_set_wowlan_trigger(vif, enabled);
1658 	srcu_read_unlock(&wl->srcu, srcu_idx);
1659 }
1660 
set_tx_power(struct wiphy * wiphy,struct wireless_dev * wdev,enum nl80211_tx_power_setting type,int mbm)1661 static int set_tx_power(struct wiphy *wiphy, struct wireless_dev *wdev,
1662 			enum nl80211_tx_power_setting type, int mbm)
1663 {
1664 	int ret;
1665 	int srcu_idx;
1666 	s32 tx_power = MBM_TO_DBM(mbm);
1667 	struct wilc *wl = wiphy_priv(wiphy);
1668 	struct wilc_vif *vif;
1669 
1670 	if (!wl->initialized)
1671 		return -EIO;
1672 
1673 	srcu_idx = srcu_read_lock(&wl->srcu);
1674 	vif = wilc_get_wl_to_vif(wl);
1675 	if (IS_ERR(vif)) {
1676 		srcu_read_unlock(&wl->srcu, srcu_idx);
1677 		return -EINVAL;
1678 	}
1679 
1680 	netdev_info(vif->ndev, "Setting tx power %d\n", tx_power);
1681 	if (tx_power < 0)
1682 		tx_power = 0;
1683 	else if (tx_power > 18)
1684 		tx_power = 18;
1685 	ret = wilc_set_tx_power(vif, tx_power);
1686 	if (ret)
1687 		netdev_err(vif->ndev, "Failed to set tx power\n");
1688 	srcu_read_unlock(&wl->srcu, srcu_idx);
1689 
1690 	return ret;
1691 }
1692 
get_tx_power(struct wiphy * wiphy,struct wireless_dev * wdev,int * dbm)1693 static int get_tx_power(struct wiphy *wiphy, struct wireless_dev *wdev,
1694 			int *dbm)
1695 {
1696 	int ret;
1697 	struct wilc_vif *vif = netdev_priv(wdev->netdev);
1698 	struct wilc *wl = vif->wilc;
1699 
1700 	/* If firmware is not started, return. */
1701 	if (!wl->initialized)
1702 		return -EIO;
1703 
1704 	ret = wilc_get_tx_power(vif, (u8 *)dbm);
1705 	if (ret)
1706 		netdev_err(vif->ndev, "Failed to get tx power\n");
1707 
1708 	return ret;
1709 }
1710 
1711 static const struct cfg80211_ops wilc_cfg80211_ops = {
1712 	.set_monitor_channel = set_channel,
1713 	.scan = scan,
1714 	.connect = connect,
1715 	.disconnect = disconnect,
1716 	.add_key = add_key,
1717 	.del_key = del_key,
1718 	.get_key = get_key,
1719 	.set_default_key = set_default_key,
1720 	.set_default_mgmt_key = set_default_mgmt_key,
1721 	.add_virtual_intf = add_virtual_intf,
1722 	.del_virtual_intf = del_virtual_intf,
1723 	.change_virtual_intf = change_virtual_intf,
1724 
1725 	.start_ap = start_ap,
1726 	.change_beacon = change_beacon,
1727 	.stop_ap = stop_ap,
1728 	.add_station = add_station,
1729 	.del_station = del_station,
1730 	.change_station = change_station,
1731 	.get_station = get_station,
1732 	.dump_station = dump_station,
1733 	.change_bss = change_bss,
1734 	.set_wiphy_params = set_wiphy_params,
1735 
1736 	.external_auth = external_auth,
1737 	.set_pmksa = set_pmksa,
1738 	.del_pmksa = del_pmksa,
1739 	.flush_pmksa = flush_pmksa,
1740 	.remain_on_channel = remain_on_channel,
1741 	.cancel_remain_on_channel = cancel_remain_on_channel,
1742 	.mgmt_tx_cancel_wait = mgmt_tx_cancel_wait,
1743 	.mgmt_tx = mgmt_tx,
1744 	.update_mgmt_frame_registrations = wilc_update_mgmt_frame_registrations,
1745 	.set_power_mgmt = set_power_mgmt,
1746 	.set_cqm_rssi_config = set_cqm_rssi_config,
1747 
1748 	.suspend = wilc_suspend,
1749 	.resume = wilc_resume,
1750 	.set_wakeup = wilc_set_wakeup,
1751 	.set_tx_power = set_tx_power,
1752 	.get_tx_power = get_tx_power,
1753 
1754 };
1755 
wlan_init_locks(struct wilc * wl)1756 static void wlan_init_locks(struct wilc *wl)
1757 {
1758 	mutex_init(&wl->hif_cs);
1759 	mutex_init(&wl->rxq_cs);
1760 	mutex_init(&wl->cfg_cmd_lock);
1761 	mutex_init(&wl->vif_mutex);
1762 	mutex_init(&wl->deinit_lock);
1763 
1764 	spin_lock_init(&wl->txq_spinlock);
1765 	mutex_init(&wl->txq_add_to_head_cs);
1766 
1767 	init_completion(&wl->txq_event);
1768 	init_completion(&wl->cfg_event);
1769 	init_completion(&wl->sync_event);
1770 	init_completion(&wl->txq_thread_started);
1771 	init_srcu_struct(&wl->srcu);
1772 }
1773 
wlan_deinit_locks(struct wilc * wilc)1774 void wlan_deinit_locks(struct wilc *wilc)
1775 {
1776 	mutex_destroy(&wilc->hif_cs);
1777 	mutex_destroy(&wilc->rxq_cs);
1778 	mutex_destroy(&wilc->cfg_cmd_lock);
1779 	mutex_destroy(&wilc->txq_add_to_head_cs);
1780 	mutex_destroy(&wilc->vif_mutex);
1781 	mutex_destroy(&wilc->deinit_lock);
1782 	cleanup_srcu_struct(&wilc->srcu);
1783 }
1784 
wilc_cfg80211_init(struct wilc ** wilc,struct device * dev,int io_type,const struct wilc_hif_func * ops)1785 int wilc_cfg80211_init(struct wilc **wilc, struct device *dev, int io_type,
1786 		       const struct wilc_hif_func *ops)
1787 {
1788 	struct wilc *wl;
1789 	struct wilc_vif *vif;
1790 	int ret, i;
1791 
1792 	wl = wilc_create_wiphy(dev);
1793 	if (!wl)
1794 		return -EINVAL;
1795 
1796 	wlan_init_locks(wl);
1797 
1798 	ret = wilc_wlan_cfg_init(wl);
1799 	if (ret)
1800 		goto free_wl;
1801 
1802 	*wilc = wl;
1803 	wl->io_type = io_type;
1804 	wl->hif_func = ops;
1805 
1806 	for (i = 0; i < NQUEUES; i++)
1807 		INIT_LIST_HEAD(&wl->txq[i].txq_head.list);
1808 
1809 	INIT_LIST_HEAD(&wl->rxq_head.list);
1810 	INIT_LIST_HEAD(&wl->vif_list);
1811 
1812 	wl->hif_workqueue = alloc_ordered_workqueue("%s", WQ_MEM_RECLAIM,
1813 						    wiphy_name(wl->wiphy));
1814 	if (!wl->hif_workqueue) {
1815 		ret = -ENOMEM;
1816 		goto free_cfg;
1817 	}
1818 	vif = wilc_netdev_ifc_init(wl, "wlan%d", WILC_STATION_MODE,
1819 				   NL80211_IFTYPE_STATION, false);
1820 	if (IS_ERR(vif)) {
1821 		ret = PTR_ERR(vif);
1822 		goto free_hq;
1823 	}
1824 
1825 	return 0;
1826 
1827 free_hq:
1828 	destroy_workqueue(wl->hif_workqueue);
1829 
1830 free_cfg:
1831 	wilc_wlan_cfg_deinit(wl);
1832 
1833 free_wl:
1834 	wlan_deinit_locks(wl);
1835 	wiphy_unregister(wl->wiphy);
1836 	wiphy_free(wl->wiphy);
1837 	return ret;
1838 }
1839 EXPORT_SYMBOL_GPL(wilc_cfg80211_init);
1840 
wilc_create_wiphy(struct device * dev)1841 struct wilc *wilc_create_wiphy(struct device *dev)
1842 {
1843 	struct wiphy *wiphy;
1844 	struct wilc *wl;
1845 	int ret;
1846 
1847 	wiphy = wiphy_new(&wilc_cfg80211_ops, sizeof(*wl));
1848 	if (!wiphy)
1849 		return NULL;
1850 
1851 	wl = wiphy_priv(wiphy);
1852 
1853 	memcpy(wl->bitrates, wilc_bitrates, sizeof(wilc_bitrates));
1854 	memcpy(wl->channels, wilc_2ghz_channels, sizeof(wilc_2ghz_channels));
1855 	wl->band.bitrates = wl->bitrates;
1856 	wl->band.n_bitrates = ARRAY_SIZE(wl->bitrates);
1857 	wl->band.channels = wl->channels;
1858 	wl->band.n_channels = ARRAY_SIZE(wilc_2ghz_channels);
1859 
1860 	wl->band.ht_cap.ht_supported = 1;
1861 	wl->band.ht_cap.cap |= (1 << IEEE80211_HT_CAP_RX_STBC_SHIFT);
1862 	wl->band.ht_cap.mcs.rx_mask[0] = 0xff;
1863 	wl->band.ht_cap.ampdu_factor = IEEE80211_HT_MAX_AMPDU_8K;
1864 	wl->band.ht_cap.ampdu_density = IEEE80211_HT_MPDU_DENSITY_NONE;
1865 
1866 	wiphy->bands[NL80211_BAND_2GHZ] = &wl->band;
1867 
1868 	wiphy->max_scan_ssids = WILC_MAX_NUM_PROBED_SSID;
1869 #ifdef CONFIG_PM
1870 	wiphy->wowlan = &wowlan_support;
1871 #endif
1872 	wiphy->max_num_pmkids = WILC_MAX_NUM_PMKIDS;
1873 	wiphy->max_scan_ie_len = 1000;
1874 	wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
1875 	memcpy(wl->cipher_suites, wilc_cipher_suites,
1876 	       sizeof(wilc_cipher_suites));
1877 	wiphy->cipher_suites = wl->cipher_suites;
1878 	wiphy->n_cipher_suites = ARRAY_SIZE(wilc_cipher_suites);
1879 	wiphy->mgmt_stypes = wilc_wfi_cfg80211_mgmt_types;
1880 
1881 	wiphy->max_remain_on_channel_duration = 500;
1882 	wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
1883 				BIT(NL80211_IFTYPE_AP) |
1884 				BIT(NL80211_IFTYPE_MONITOR) |
1885 				BIT(NL80211_IFTYPE_P2P_GO) |
1886 				BIT(NL80211_IFTYPE_P2P_CLIENT);
1887 	wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL;
1888 	wiphy->features |= NL80211_FEATURE_SAE;
1889 	set_wiphy_dev(wiphy, dev);
1890 	wl->wiphy = wiphy;
1891 	ret = wiphy_register(wiphy);
1892 	if (ret) {
1893 		wiphy_free(wiphy);
1894 		return NULL;
1895 	}
1896 	return wl;
1897 }
1898 
wilc_init_host_int(struct net_device * net)1899 int wilc_init_host_int(struct net_device *net)
1900 {
1901 	int ret;
1902 	struct wilc_vif *vif = netdev_priv(net);
1903 	struct wilc_priv *priv = &vif->priv;
1904 
1905 	priv->p2p_listen_state = false;
1906 
1907 	mutex_init(&priv->scan_req_lock);
1908 	ret = wilc_init(net, &priv->hif_drv);
1909 	if (ret)
1910 		netdev_err(net, "Error while initializing hostinterface\n");
1911 
1912 	return ret;
1913 }
1914 
wilc_deinit_host_int(struct net_device * net)1915 void wilc_deinit_host_int(struct net_device *net)
1916 {
1917 	int ret;
1918 	struct wilc_vif *vif = netdev_priv(net);
1919 	struct wilc_priv *priv = &vif->priv;
1920 
1921 	priv->p2p_listen_state = false;
1922 
1923 	flush_workqueue(vif->wilc->hif_workqueue);
1924 	mutex_destroy(&priv->scan_req_lock);
1925 	ret = wilc_deinit(vif);
1926 
1927 	if (ret)
1928 		netdev_err(net, "Error while deinitializing host interface\n");
1929 }
1930 
1931