?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
interconnect: qcom: Fix Kconfig indentation
[linux/fpc-iii.git] / drivers / staging / wilc1000 / netdev.c
blobd2c0b0f7cf6335640e7c4b68b67cc783debb3bfa
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 <linux/irq.h>
8 #include <linux/kthread.h>
9 #include <linux/firmware.h>
10 #include <linux/netdevice.h>
11 #include <linux/inetdevice.h>
12
13 #include "cfg80211.h"
14 #include "wlan_cfg.h"
15
16 #define WILC_MULTICAST_TABLE_SIZE 8
17
18 static irqreturn_t isr_uh_routine(int irq, void *user_data)
19 {
20 struct net_device *dev = user_data;
21 struct wilc_vif *vif = netdev_priv(dev);
22 struct wilc *wilc = vif->wilc;
23
24 if (wilc->close) {
25 netdev_err(dev, "Can't handle UH interrupt\n");
26 return IRQ_HANDLED;
27 }
28 return IRQ_WAKE_THREAD;
29 }
30
31 static irqreturn_t isr_bh_routine(int irq, void *userdata)
32 {
33 struct net_device *dev = userdata;
34 struct wilc_vif *vif = netdev_priv(userdata);
35 struct wilc *wilc = vif->wilc;
36
37 if (wilc->close) {
38 netdev_err(dev, "Can't handle BH interrupt\n");
39 return IRQ_HANDLED;
40 }
41
42 wilc_handle_isr(wilc);
43
44 return IRQ_HANDLED;
45 }
46
47 static int init_irq(struct net_device *dev)
48 {
49 int ret = 0;
50 struct wilc_vif *vif = netdev_priv(dev);
51 struct wilc *wl = vif->wilc;
52
53 ret = gpiod_direction_input(wl->gpio_irq);
54 if (ret) {
55 netdev_err(dev, "could not obtain gpio for WILC_INTR\n");
56 return ret;
57 }
58
59 wl->dev_irq_num = gpiod_to_irq(wl->gpio_irq);
60
61 ret = request_threaded_irq(wl->dev_irq_num, isr_uh_routine,
62 isr_bh_routine,
63 IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
64 "WILC_IRQ", dev);
65 if (ret < 0)
66 netdev_err(dev, "Failed to request IRQ\n");
67 else
68 netdev_dbg(dev, "IRQ request succeeded IRQ-NUM= %d\n",
69 wl->dev_irq_num);
70
71 return ret;
72 }
73
74 static void deinit_irq(struct net_device *dev)
75 {
76 struct wilc_vif *vif = netdev_priv(dev);
77 struct wilc *wilc = vif->wilc;
78
79 /* Deinitialize IRQ */
80 if (wilc->dev_irq_num)
81 free_irq(wilc->dev_irq_num, wilc);
82 }
83
84 void wilc_mac_indicate(struct wilc *wilc)
85 {
86 s8 status;
87
88 wilc_wlan_cfg_get_val(wilc, WID_STATUS, &status, 1);
89 if (wilc->mac_status == WILC_MAC_STATUS_INIT) {
90 wilc->mac_status = status;
91 complete(&wilc->sync_event);
92 } else {
93 wilc->mac_status = status;
94 }
95 }
96
97 static struct net_device *get_if_handler(struct wilc *wilc, u8 *mac_header)
98 {
99 u8 *bssid, *bssid1;
100 struct net_device *ndev = NULL;
101 struct wilc_vif *vif;
102
103 bssid = mac_header + 10;
104 bssid1 = mac_header + 4;
105
106 list_for_each_entry_rcu(vif, &wilc->vif_list, list) {
107 if (vif->mode == WILC_STATION_MODE)
108 if (ether_addr_equal_unaligned(bssid, vif->bssid)) {
109 ndev = vif->ndev;
110 goto out;
111 }
112 if (vif->mode == WILC_AP_MODE)
113 if (ether_addr_equal_unaligned(bssid1, vif->bssid)) {
114 ndev = vif->ndev;
115 goto out;
116 }
117 }
118 out:
119 return ndev;
120 }
121
122 void wilc_wlan_set_bssid(struct net_device *wilc_netdev, u8 *bssid, u8 mode)
123 {
124 struct wilc_vif *vif = netdev_priv(wilc_netdev);
125
126 if (bssid)
127 ether_addr_copy(vif->bssid, bssid);
128 else
129 eth_zero_addr(vif->bssid);
130
131 vif->mode = mode;
132 }
133
134 int wilc_wlan_get_num_conn_ifcs(struct wilc *wilc)
135 {
136 int srcu_idx;
137 u8 ret_val = 0;
138 struct wilc_vif *vif;
139
140 srcu_idx = srcu_read_lock(&wilc->srcu);
141 list_for_each_entry_rcu(vif, &wilc->vif_list, list) {
142 if (!is_zero_ether_addr(vif->bssid))
143 ret_val++;
144 }
145 srcu_read_unlock(&wilc->srcu, srcu_idx);
146 return ret_val;
147 }
148
149 static int wilc_txq_task(void *vp)
150 {
151 int ret;
152 u32 txq_count;
153 struct wilc *wl = vp;
154
155 complete(&wl->txq_thread_started);
156 while (1) {
157 wait_for_completion(&wl->txq_event);
158
159 if (wl->close) {
160 complete(&wl->txq_thread_started);
161
162 while (!kthread_should_stop())
163 schedule();
164 break;
165 }
166 do {
167 ret = wilc_wlan_handle_txq(wl, &txq_count);
168 if (txq_count < FLOW_CONTROL_LOWER_THRESHOLD) {
169 int srcu_idx;
170 struct wilc_vif *ifc;
171
172 srcu_idx = srcu_read_lock(&wl->srcu);
173 list_for_each_entry_rcu(ifc, &wl->vif_list,
174 list) {
175 if (ifc->mac_opened && ifc->ndev)
176 netif_wake_queue(ifc->ndev);
177 }
178 srcu_read_unlock(&wl->srcu, srcu_idx);
179 }
180 } while (ret == -ENOBUFS && !wl->close);
181 }
182 return 0;
183 }
184
185 static int wilc_wlan_get_firmware(struct net_device *dev)
186 {
187 struct wilc_vif *vif = netdev_priv(dev);
188 struct wilc *wilc = vif->wilc;
189 int chip_id, ret = 0;
190 const struct firmware *wilc_firmware;
191 char *firmware;
192
193 chip_id = wilc_get_chipid(wilc, false);
194
195 if (chip_id < 0x1003a0)
196 firmware = FIRMWARE_1002;
197 else
198 firmware = FIRMWARE_1003;
199
200 netdev_info(dev, "loading firmware %s\n", firmware);
201
202 if (request_firmware(&wilc_firmware, firmware, wilc->dev) != 0) {
203 netdev_err(dev, "%s - firmware not available\n", firmware);
204 ret = -1;
205 goto fail;
206 }
207 wilc->firmware = wilc_firmware;
208
209 fail:
210
211 return ret;
212 }
213
214 static int wilc_start_firmware(struct net_device *dev)
215 {
216 struct wilc_vif *vif = netdev_priv(dev);
217 struct wilc *wilc = vif->wilc;
218 int ret = 0;
219
220 ret = wilc_wlan_start(wilc);
221 if (ret < 0)
222 return ret;
223
224 if (!wait_for_completion_timeout(&wilc->sync_event,
225 msecs_to_jiffies(5000)))
226 return -ETIME;
227
228 return 0;
229 }
230
231 static int wilc1000_firmware_download(struct net_device *dev)
232 {
233 struct wilc_vif *vif = netdev_priv(dev);
234 struct wilc *wilc = vif->wilc;
235 int ret = 0;
236
237 if (!wilc->firmware) {
238 netdev_err(dev, "Firmware buffer is NULL\n");
239 return -ENOBUFS;
240 }
241
242 ret = wilc_wlan_firmware_download(wilc, wilc->firmware->data,
243 wilc->firmware->size);
244 if (ret < 0)
245 return ret;
246
247 release_firmware(wilc->firmware);
248 wilc->firmware = NULL;
249
250 netdev_dbg(dev, "Download Succeeded\n");
251
252 return 0;
253 }
254
255 static int wilc_init_fw_config(struct net_device *dev, struct wilc_vif *vif)
256 {
257 struct wilc_priv *priv = &vif->priv;
258 struct host_if_drv *hif_drv;
259 u8 b;
260 u16 hw;
261 u32 w;
262
263 netdev_dbg(dev, "Start configuring Firmware\n");
264 hif_drv = (struct host_if_drv *)priv->hif_drv;
265 netdev_dbg(dev, "Host = %p\n", hif_drv);
266
267 w = vif->iftype;
268 cpu_to_le32s(&w);
269 if (!wilc_wlan_cfg_set(vif, 1, WID_SET_OPERATION_MODE, (u8 *)&w, 4,
270 0, 0))
271 goto fail;
272
273 b = WILC_FW_BSS_TYPE_INFRA;
274 if (!wilc_wlan_cfg_set(vif, 0, WID_BSS_TYPE, &b, 1, 0, 0))
275 goto fail;
276
277 b = WILC_FW_TX_RATE_AUTO;
278 if (!wilc_wlan_cfg_set(vif, 0, WID_CURRENT_TX_RATE, &b, 1, 0, 0))
279 goto fail;
280
281 b = WILC_FW_OPER_MODE_G_MIXED_11B_2;
282 if (!wilc_wlan_cfg_set(vif, 0, WID_11G_OPERATING_MODE, &b, 1, 0, 0))
283 goto fail;
284
285 b = WILC_FW_PREAMBLE_SHORT;
286 if (!wilc_wlan_cfg_set(vif, 0, WID_PREAMBLE, &b, 1, 0, 0))
287 goto fail;
288
289 b = WILC_FW_11N_PROT_AUTO;
290 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_PROT_MECH, &b, 1, 0, 0))
291 goto fail;
292
293 b = WILC_FW_ACTIVE_SCAN;
294 if (!wilc_wlan_cfg_set(vif, 0, WID_SCAN_TYPE, &b, 1, 0, 0))
295 goto fail;
296
297 b = WILC_FW_SITE_SURVEY_OFF;
298 if (!wilc_wlan_cfg_set(vif, 0, WID_SITE_SURVEY, &b, 1, 0, 0))
299 goto fail;
300
301 hw = 0xffff;
302 cpu_to_le16s(&hw);
303 if (!wilc_wlan_cfg_set(vif, 0, WID_RTS_THRESHOLD, (u8 *)&hw, 2, 0, 0))
304 goto fail;
305
306 hw = 2346;
307 cpu_to_le16s(&hw);
308 if (!wilc_wlan_cfg_set(vif, 0, WID_FRAG_THRESHOLD, (u8 *)&hw, 2, 0, 0))
309 goto fail;
310
311 b = 0;
312 if (!wilc_wlan_cfg_set(vif, 0, WID_BCAST_SSID, &b, 1, 0, 0))
313 goto fail;
314
315 b = 1;
316 if (!wilc_wlan_cfg_set(vif, 0, WID_QOS_ENABLE, &b, 1, 0, 0))
317 goto fail;
318
319 b = WILC_FW_NO_POWERSAVE;
320 if (!wilc_wlan_cfg_set(vif, 0, WID_POWER_MANAGEMENT, &b, 1, 0, 0))
321 goto fail;
322
323 b = WILC_FW_SEC_NO;
324 if (!wilc_wlan_cfg_set(vif, 0, WID_11I_MODE, &b, 1, 0, 0))
325 goto fail;
326
327 b = WILC_FW_AUTH_OPEN_SYSTEM;
328 if (!wilc_wlan_cfg_set(vif, 0, WID_AUTH_TYPE, &b, 1, 0, 0))
329 goto fail;
330
331 b = 3;
332 if (!wilc_wlan_cfg_set(vif, 0, WID_LISTEN_INTERVAL, &b, 1, 0, 0))
333 goto fail;
334
335 b = 3;
336 if (!wilc_wlan_cfg_set(vif, 0, WID_DTIM_PERIOD, &b, 1, 0, 0))
337 goto fail;
338
339 b = WILC_FW_ACK_POLICY_NORMAL;
340 if (!wilc_wlan_cfg_set(vif, 0, WID_ACK_POLICY, &b, 1, 0, 0))
341 goto fail;
342
343 b = 0;
344 if (!wilc_wlan_cfg_set(vif, 0, WID_USER_CONTROL_ON_TX_POWER, &b, 1,
345 0, 0))
346 goto fail;
347
348 b = 48;
349 if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11A, &b, 1, 0, 0))
350 goto fail;
351
352 b = 28;
353 if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11B, &b, 1, 0, 0))
354 goto fail;
355
356 hw = 100;
357 cpu_to_le16s(&hw);
358 if (!wilc_wlan_cfg_set(vif, 0, WID_BEACON_INTERVAL, (u8 *)&hw, 2, 0, 0))
359 goto fail;
360
361 b = WILC_FW_REKEY_POLICY_DISABLE;
362 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_POLICY, &b, 1, 0, 0))
363 goto fail;
364
365 w = 84600;
366 cpu_to_le32s(&w);
367 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PERIOD, (u8 *)&w, 4, 0, 0))
368 goto fail;
369
370 w = 500;
371 cpu_to_le32s(&w);
372 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PACKET_COUNT, (u8 *)&w, 4, 0,
373 0))
374 goto fail;
375
376 b = 1;
377 if (!wilc_wlan_cfg_set(vif, 0, WID_SHORT_SLOT_ALLOWED, &b, 1, 0,
378 0))
379 goto fail;
380
381 b = WILC_FW_ERP_PROT_SELF_CTS;
382 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ERP_PROT_TYPE, &b, 1, 0, 0))
383 goto fail;
384
385 b = 1;
386 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ENABLE, &b, 1, 0, 0))
387 goto fail;
388
389 b = WILC_FW_11N_OP_MODE_HT_MIXED;
390 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OPERATING_MODE, &b, 1, 0, 0))
391 goto fail;
392
393 b = 1;
394 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_TXOP_PROT_DISABLE, &b, 1, 0, 0))
395 goto fail;
396
397 b = WILC_FW_OBBS_NONHT_DETECT_PROTECT_REPORT;
398 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OBSS_NONHT_DETECTION, &b, 1,
399 0, 0))
400 goto fail;
401
402 b = WILC_FW_HT_PROT_RTS_CTS_NONHT;
403 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_HT_PROT_TYPE, &b, 1, 0, 0))
404 goto fail;
405
406 b = 0;
407 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_RIFS_PROT_ENABLE, &b, 1, 0,
408 0))
409 goto fail;
410
411 b = 7;
412 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_CURRENT_TX_MCS, &b, 1, 0, 0))
413 goto fail;
414
415 b = 1;
416 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_IMMEDIATE_BA_ENABLED, &b, 1,
417 1, 1))
418 goto fail;
419
420 return 0;
421
422 fail:
423 return -1;
424 }
425
426 static void wlan_deinitialize_threads(struct net_device *dev)
427 {
428 struct wilc_vif *vif = netdev_priv(dev);
429 struct wilc *wl = vif->wilc;
430
431 wl->close = 1;
432
433 complete(&wl->txq_event);
434
435 if (wl->txq_thread) {
436 kthread_stop(wl->txq_thread);
437 wl->txq_thread = NULL;
438 }
439 }
440
441 static void wilc_wlan_deinitialize(struct net_device *dev)
442 {
443 struct wilc_vif *vif = netdev_priv(dev);
444 struct wilc *wl = vif->wilc;
445
446 if (!wl) {
447 netdev_err(dev, "wl is NULL\n");
448 return;
449 }
450
451 if (wl->initialized) {
452 netdev_info(dev, "Deinitializing wilc1000...\n");
453
454 if (!wl->dev_irq_num &&
455 wl->hif_func->disable_interrupt) {
456 mutex_lock(&wl->hif_cs);
457 wl->hif_func->disable_interrupt(wl);
458 mutex_unlock(&wl->hif_cs);
459 }
460 complete(&wl->txq_event);
461
462 wlan_deinitialize_threads(dev);
463 deinit_irq(dev);
464
465 wilc_wlan_stop(wl, vif);
466 wilc_wlan_cleanup(dev);
467
468 wl->initialized = false;
469
470 netdev_dbg(dev, "wilc1000 deinitialization Done\n");
471 } else {
472 netdev_dbg(dev, "wilc1000 is not initialized\n");
473 }
474 }
475
476 static int wlan_initialize_threads(struct net_device *dev)
477 {
478 struct wilc_vif *vif = netdev_priv(dev);
479 struct wilc *wilc = vif->wilc;
480
481 wilc->txq_thread = kthread_run(wilc_txq_task, (void *)wilc,
482 "K_TXQ_TASK");
483 if (IS_ERR(wilc->txq_thread)) {
484 netdev_err(dev, "couldn't create TXQ thread\n");
485 wilc->close = 0;
486 return PTR_ERR(wilc->txq_thread);
487 }
488 wait_for_completion(&wilc->txq_thread_started);
489
490 return 0;
491 }
492
493 static int wilc_wlan_initialize(struct net_device *dev, struct wilc_vif *vif)
494 {
495 int ret = 0;
496 struct wilc *wl = vif->wilc;
497
498 if (!wl->initialized) {
499 wl->mac_status = WILC_MAC_STATUS_INIT;
500 wl->close = 0;
501
502 ret = wilc_wlan_init(dev);
503 if (ret < 0)
504 return -EIO;
505
506 ret = wlan_initialize_threads(dev);
507 if (ret < 0) {
508 ret = -EIO;
509 goto fail_wilc_wlan;
510 }
511
512 if (wl->gpio_irq && init_irq(dev)) {
513 ret = -EIO;
514 goto fail_threads;
515 }
516
517 if (!wl->dev_irq_num &&
518 wl->hif_func->enable_interrupt &&
519 wl->hif_func->enable_interrupt(wl)) {
520 ret = -EIO;
521 goto fail_irq_init;
522 }
523
524 if (wilc_wlan_get_firmware(dev)) {
525 ret = -EIO;
526 goto fail_irq_enable;
527 }
528
529 ret = wilc1000_firmware_download(dev);
530 if (ret < 0) {
531 ret = -EIO;
532 goto fail_irq_enable;
533 }
534
535 ret = wilc_start_firmware(dev);
536 if (ret < 0) {
537 ret = -EIO;
538 goto fail_irq_enable;
539 }
540
541 if (wilc_wlan_cfg_get(vif, 1, WID_FIRMWARE_VERSION, 1, 0)) {
542 int size;
543 char firmware_ver[20];
544
545 size = wilc_wlan_cfg_get_val(wl, WID_FIRMWARE_VERSION,
546 firmware_ver,
547 sizeof(firmware_ver));
548 firmware_ver[size] = '\0';
549 netdev_dbg(dev, "Firmware Ver = %s\n", firmware_ver);
550 }
551 ret = wilc_init_fw_config(dev, vif);
552
553 if (ret < 0) {
554 netdev_err(dev, "Failed to configure firmware\n");
555 ret = -EIO;
556 goto fail_fw_start;
557 }
558 wl->initialized = true;
559 return 0;
560
561 fail_fw_start:
562 wilc_wlan_stop(wl, vif);
563
564 fail_irq_enable:
565 if (!wl->dev_irq_num &&
566 wl->hif_func->disable_interrupt)
567 wl->hif_func->disable_interrupt(wl);
568 fail_irq_init:
569 if (wl->dev_irq_num)
570 deinit_irq(dev);
571 fail_threads:
572 wlan_deinitialize_threads(dev);
573 fail_wilc_wlan:
574 wilc_wlan_cleanup(dev);
575 netdev_err(dev, "WLAN initialization FAILED\n");
576 } else {
577 netdev_dbg(dev, "wilc1000 already initialized\n");
578 }
579 return ret;
580 }
581
582 static int mac_init_fn(struct net_device *ndev)
583 {
584 netif_start_queue(ndev);
585 netif_stop_queue(ndev);
586
587 return 0;
588 }
589
590 static int wilc_mac_open(struct net_device *ndev)
591 {
592 struct wilc_vif *vif = netdev_priv(ndev);
593 struct wilc *wl = vif->wilc;
594 struct wilc_priv *priv = wdev_priv(vif->ndev->ieee80211_ptr);
595 unsigned char mac_add[ETH_ALEN] = {0};
596 int ret = 0;
597
598 if (!wl || !wl->dev) {
599 netdev_err(ndev, "device not ready\n");
600 return -ENODEV;
601 }
602
603 netdev_dbg(ndev, "MAC OPEN[%p]\n", ndev);
604
605 ret = wilc_init_host_int(ndev);
606 if (ret < 0)
607 return ret;
608
609 ret = wilc_wlan_initialize(ndev, vif);
610 if (ret < 0) {
611 wilc_deinit_host_int(ndev);
612 return ret;
613 }
614
615 wilc_set_operation_mode(vif, wilc_get_vif_idx(vif), vif->iftype,
616 vif->idx);
617 wilc_get_mac_address(vif, mac_add);
618 netdev_dbg(ndev, "Mac address: %pM\n", mac_add);
619 ether_addr_copy(ndev->dev_addr, mac_add);
620
621 if (!is_valid_ether_addr(ndev->dev_addr)) {
622 netdev_err(ndev, "Wrong MAC address\n");
623 wilc_deinit_host_int(ndev);
624 wilc_wlan_deinitialize(ndev);
625 return -EINVAL;
626 }
627
628 wilc_mgmt_frame_register(vif->ndev->ieee80211_ptr->wiphy,
629 vif->ndev->ieee80211_ptr,
630 vif->frame_reg[0].type,
631 vif->frame_reg[0].reg);
632 wilc_mgmt_frame_register(vif->ndev->ieee80211_ptr->wiphy,
633 vif->ndev->ieee80211_ptr,
634 vif->frame_reg[1].type,
635 vif->frame_reg[1].reg);
636 netif_wake_queue(ndev);
637 wl->open_ifcs++;
638 priv->p2p.local_random = 0x01;
639 vif->mac_opened = 1;
640 return 0;
641 }
642
643 static struct net_device_stats *mac_stats(struct net_device *dev)
644 {
645 struct wilc_vif *vif = netdev_priv(dev);
646
647 return &vif->netstats;
648 }
649
650 static void wilc_set_multicast_list(struct net_device *dev)
651 {
652 struct netdev_hw_addr *ha;
653 struct wilc_vif *vif = netdev_priv(dev);
654 int i;
655 u8 *mc_list;
656 u8 *cur_mc;
657
658 if (dev->flags & IFF_PROMISC)
659 return;
660
661 if (dev->flags & IFF_ALLMULTI ||
662 dev->mc.count > WILC_MULTICAST_TABLE_SIZE) {
663 wilc_setup_multicast_filter(vif, 0, 0, NULL);
664 return;
665 }
666
667 if (dev->mc.count == 0) {
668 wilc_setup_multicast_filter(vif, 1, 0, NULL);
669 return;
670 }
671
672 mc_list = kmalloc_array(dev->mc.count, ETH_ALEN, GFP_ATOMIC);
673 if (!mc_list)
674 return;
675
676 cur_mc = mc_list;
677 i = 0;
678 netdev_for_each_mc_addr(ha, dev) {
679 memcpy(cur_mc, ha->addr, ETH_ALEN);
680 netdev_dbg(dev, "Entry[%d]: %pM\n", i, cur_mc);
681 i++;
682 cur_mc += ETH_ALEN;
683 }
684
685 if (wilc_setup_multicast_filter(vif, 1, dev->mc.count, mc_list))
686 kfree(mc_list);
687 }
688
689 static void wilc_tx_complete(void *priv, int status)
690 {
691 struct tx_complete_data *pv_data = priv;
692
693 dev_kfree_skb(pv_data->skb);
694 kfree(pv_data);
695 }
696
697 netdev_tx_t wilc_mac_xmit(struct sk_buff *skb, struct net_device *ndev)
698 {
699 struct wilc_vif *vif = netdev_priv(ndev);
700 struct wilc *wilc = vif->wilc;
701 struct tx_complete_data *tx_data = NULL;
702 int queue_count;
703
704 if (skb->dev != ndev) {
705 netdev_err(ndev, "Packet not destined to this device\n");
706 return 0;
707 }
708
709 tx_data = kmalloc(sizeof(*tx_data), GFP_ATOMIC);
710 if (!tx_data) {
711 dev_kfree_skb(skb);
712 netif_wake_queue(ndev);
713 return 0;
714 }
715
716 tx_data->buff = skb->data;
717 tx_data->size = skb->len;
718 tx_data->skb = skb;
719
720 vif->netstats.tx_packets++;
721 vif->netstats.tx_bytes += tx_data->size;
722 queue_count = wilc_wlan_txq_add_net_pkt(ndev, (void *)tx_data,
723 tx_data->buff, tx_data->size,
724 wilc_tx_complete);
725
726 if (queue_count > FLOW_CONTROL_UPPER_THRESHOLD) {
727 int srcu_idx;
728 struct wilc_vif *vif;
729
730 srcu_idx = srcu_read_lock(&wilc->srcu);
731 list_for_each_entry_rcu(vif, &wilc->vif_list, list) {
732 if (vif->mac_opened)
733 netif_stop_queue(vif->ndev);
734 }
735 srcu_read_unlock(&wilc->srcu, srcu_idx);
736 }
737
738 return 0;
739 }
740
741 static int wilc_mac_close(struct net_device *ndev)
742 {
743 struct wilc_vif *vif = netdev_priv(ndev);
744 struct wilc *wl = vif->wilc;
745
746 netdev_dbg(ndev, "Mac close\n");
747
748 if (wl->open_ifcs > 0)
749 wl->open_ifcs--;
750 else
751 return 0;
752
753 if (vif->ndev) {
754 netif_stop_queue(vif->ndev);
755
756 wilc_deinit_host_int(vif->ndev);
757 }
758
759 if (wl->open_ifcs == 0) {
760 netdev_dbg(ndev, "Deinitializing wilc1000\n");
761 wl->close = 1;
762 wilc_wlan_deinitialize(ndev);
763 }
764
765 vif->mac_opened = 0;
766
767 return 0;
768 }
769
770 void wilc_frmw_to_host(struct wilc *wilc, u8 *buff, u32 size,
771 u32 pkt_offset)
772 {
773 unsigned int frame_len = 0;
774 int stats;
775 unsigned char *buff_to_send = NULL;
776 struct sk_buff *skb;
777 struct net_device *wilc_netdev;
778 struct wilc_vif *vif;
779
780 if (!wilc)
781 return;
782
783 wilc_netdev = get_if_handler(wilc, buff);
784 if (!wilc_netdev)
785 return;
786
787 buff += pkt_offset;
788 vif = netdev_priv(wilc_netdev);
789
790 if (size > 0) {
791 frame_len = size;
792 buff_to_send = buff;
793
794 skb = dev_alloc_skb(frame_len);
795 if (!skb)
796 return;
797
798 skb->dev = wilc_netdev;
799
800 skb_put_data(skb, buff_to_send, frame_len);
801
802 skb->protocol = eth_type_trans(skb, wilc_netdev);
803 vif->netstats.rx_packets++;
804 vif->netstats.rx_bytes += frame_len;
805 skb->ip_summed = CHECKSUM_UNNECESSARY;
806 stats = netif_rx(skb);
807 netdev_dbg(wilc_netdev, "netif_rx ret value is: %d\n", stats);
808 }
809 }
810
811 void wilc_wfi_mgmt_rx(struct wilc *wilc, u8 *buff, u32 size)
812 {
813 int srcu_idx;
814 struct wilc_vif *vif;
815
816 srcu_idx = srcu_read_lock(&wilc->srcu);
817 list_for_each_entry_rcu(vif, &wilc->vif_list, list) {
818 u16 type = le16_to_cpup((__le16 *)buff);
819
820 if (vif->priv.p2p_listen_state &&
821 ((type == vif->frame_reg[0].type && vif->frame_reg[0].reg) ||
822 (type == vif->frame_reg[1].type && vif->frame_reg[1].reg)))
823 wilc_wfi_p2p_rx(vif, buff, size);
824
825 if (vif->monitor_flag)
826 wilc_wfi_monitor_rx(wilc->monitor_dev, buff, size);
827 }
828 srcu_read_unlock(&wilc->srcu, srcu_idx);
829 }
830
831 static const struct net_device_ops wilc_netdev_ops = {
832 .ndo_init = mac_init_fn,
833 .ndo_open = wilc_mac_open,
834 .ndo_stop = wilc_mac_close,
835 .ndo_start_xmit = wilc_mac_xmit,
836 .ndo_get_stats = mac_stats,
837 .ndo_set_rx_mode = wilc_set_multicast_list,
838 };
839
840 void wilc_netdev_cleanup(struct wilc *wilc)
841 {
842 struct wilc_vif *vif;
843 int srcu_idx;
844
845 if (!wilc)
846 return;
847
848 if (wilc->firmware) {
849 release_firmware(wilc->firmware);
850 wilc->firmware = NULL;
851 }
852
853 srcu_idx = srcu_read_lock(&wilc->srcu);
854 list_for_each_entry_rcu(vif, &wilc->vif_list, list) {
855 if (vif->ndev)
856 unregister_netdev(vif->ndev);
857 }
858 srcu_read_unlock(&wilc->srcu, srcu_idx);
859
860 wilc_wfi_deinit_mon_interface(wilc, false);
861 flush_workqueue(wilc->hif_workqueue);
862 destroy_workqueue(wilc->hif_workqueue);
863
864 do {
865 mutex_lock(&wilc->vif_mutex);
866 if (wilc->vif_num <= 0) {
867 mutex_unlock(&wilc->vif_mutex);
868 break;
869 }
870 vif = wilc_get_wl_to_vif(wilc);
871 if (!IS_ERR(vif))
872 list_del_rcu(&vif->list);
873
874 wilc->vif_num--;
875 mutex_unlock(&wilc->vif_mutex);
876 synchronize_srcu(&wilc->srcu);
877 } while (1);
878
879 wilc_wlan_cfg_deinit(wilc);
880 wlan_deinit_locks(wilc);
881 kfree(wilc->bus_data);
882 wiphy_unregister(wilc->wiphy);
883 wiphy_free(wilc->wiphy);
884 }
885 EXPORT_SYMBOL_GPL(wilc_netdev_cleanup);
886
887 static u8 wilc_get_available_idx(struct wilc *wl)
888 {
889 int idx = 0;
890 struct wilc_vif *vif;
891 int srcu_idx;
892
893 srcu_idx = srcu_read_lock(&wl->srcu);
894 list_for_each_entry_rcu(vif, &wl->vif_list, list) {
895 if (vif->idx == 0)
896 idx = 1;
897 else
898 idx = 0;
899 }
900 srcu_read_unlock(&wl->srcu, srcu_idx);
901 return idx;
902 }
903
904 struct wilc_vif *wilc_netdev_ifc_init(struct wilc *wl, const char *name,
905 int vif_type, enum nl80211_iftype type,
906 bool rtnl_locked)
907 {
908 struct net_device *ndev;
909 struct wilc_vif *vif;
910 int ret;
911
912 ndev = alloc_etherdev(sizeof(*vif));
913 if (!ndev)
914 return ERR_PTR(-ENOMEM);
915
916 vif = netdev_priv(ndev);
917 ndev->ieee80211_ptr = &vif->priv.wdev;
918 strcpy(ndev->name, name);
919 vif->wilc = wl;
920 vif->ndev = ndev;
921 ndev->ml_priv = vif;
922
923 ndev->netdev_ops = &wilc_netdev_ops;
924
925 SET_NETDEV_DEV(ndev, wiphy_dev(wl->wiphy));
926
927 vif->priv.wdev.wiphy = wl->wiphy;
928 vif->priv.wdev.netdev = ndev;
929 vif->priv.wdev.iftype = type;
930 vif->priv.dev = ndev;
931
932 if (rtnl_locked)
933 ret = register_netdevice(ndev);
934 else
935 ret = register_netdev(ndev);
936
937 if (ret) {
938 free_netdev(ndev);
939 return ERR_PTR(-EFAULT);
940 }
941
942 ndev->needs_free_netdev = true;
943 vif->iftype = vif_type;
944 vif->idx = wilc_get_available_idx(wl);
945 vif->mac_opened = 0;
946 mutex_lock(&wl->vif_mutex);
947 list_add_tail_rcu(&vif->list, &wl->vif_list);
948 wl->vif_num += 1;
949 mutex_unlock(&wl->vif_mutex);
950 synchronize_srcu(&wl->srcu);
951
952 return vif;
953 }
954
955 MODULE_LICENSE("GPL");
Linux with added FPC-III support