1 #include "wilc_wfi_cfgoperations.h"
2 #include "wilc_wlan_if.h"
5 #include <linux/slab.h>
6 #include <linux/sched.h>
7 #include <linux/delay.h>
8 #include <linux/workqueue.h>
9 #include <linux/interrupt.h>
10 #include <linux/irq.h>
11 #include <linux/gpio.h>
13 #include <linux/kthread.h>
14 #include <linux/firmware.h>
16 #include <linux/init.h>
17 #include <linux/netdevice.h>
18 #include <linux/inetdevice.h>
19 #include <linux/etherdevice.h>
20 #include <linux/module.h>
21 #include <linux/kernel.h>
22 #include <linux/skbuff.h>
23 #include <linux/mutex.h>
24 #include <linux/completion.h>
26 static int dev_state_ev_handler(struct notifier_block *this,
27 unsigned long event, void *ptr);
29 static struct notifier_block g_dev_notifier = {
30 .notifier_call = dev_state_ev_handler
33 static int wlan_deinit_locks(struct net_device *dev);
34 static void wlan_deinitialize_threads(struct net_device *dev);
36 static void linux_wlan_tx_complete(void *priv, int status);
37 static int mac_init_fn(struct net_device *ndev);
38 static struct net_device_stats *mac_stats(struct net_device *dev);
39 static int mac_ioctl(struct net_device *ndev, struct ifreq *req, int cmd);
40 static void wilc_set_multicast_list(struct net_device *dev);
42 bool wilc_enable_ps = true;
44 static const struct net_device_ops wilc_netdev_ops = {
45 .ndo_init = mac_init_fn,
46 .ndo_open = wilc_mac_open,
47 .ndo_stop = wilc_mac_close,
48 .ndo_start_xmit = wilc_mac_xmit,
49 .ndo_do_ioctl = mac_ioctl,
50 .ndo_get_stats = mac_stats,
51 .ndo_set_rx_mode = wilc_set_multicast_list,
55 static int dev_state_ev_handler(struct notifier_block *this,
56 unsigned long event, void *ptr)
58 struct in_ifaddr *dev_iface = ptr;
59 struct wilc_priv *priv;
60 struct host_if_drv *hif_drv;
61 struct net_device *dev;
65 char wlan_dev_name[5] = "wlan0";
67 if (!dev_iface || !dev_iface->ifa_dev || !dev_iface->ifa_dev->dev)
70 if (memcmp(dev_iface->ifa_label, "wlan0", 5) &&
71 memcmp(dev_iface->ifa_label, "p2p0", 4))
74 dev = (struct net_device *)dev_iface->ifa_dev->dev;
75 if (!dev->ieee80211_ptr || !dev->ieee80211_ptr->wiphy)
78 priv = wiphy_priv(dev->ieee80211_ptr->wiphy);
82 hif_drv = (struct host_if_drv *)priv->hif_drv;
83 vif = netdev_priv(dev);
89 if (vif->iftype == STATION_MODE || vif->iftype == CLIENT_MODE) {
91 wilc_optaining_ip = false;
92 del_timer(&wilc_during_ip_timer);
96 wilc_set_power_mgmt(vif, 1, 0);
98 netdev_dbg(dev, "[%s] Up IP\n", dev_iface->ifa_label);
100 ip_addr_buf = (char *)&dev_iface->ifa_address;
101 netdev_dbg(dev, "IP add=%d:%d:%d:%d\n",
102 ip_addr_buf[0], ip_addr_buf[1],
103 ip_addr_buf[2], ip_addr_buf[3]);
104 wilc_setup_ipaddress(vif, ip_addr_buf, vif->idx);
109 if (vif->iftype == STATION_MODE || vif->iftype == CLIENT_MODE) {
111 wilc_optaining_ip = false;
114 if (memcmp(dev_iface->ifa_label, wlan_dev_name, 5) == 0)
115 wilc_set_power_mgmt(vif, 0, 0);
117 wilc_resolve_disconnect_aberration(vif);
119 netdev_dbg(dev, "[%s] Down IP\n", dev_iface->ifa_label);
121 ip_addr_buf = null_ip;
122 netdev_dbg(dev, "IP add=%d:%d:%d:%d\n",
123 ip_addr_buf[0], ip_addr_buf[1],
124 ip_addr_buf[2], ip_addr_buf[3]);
126 wilc_setup_ipaddress(vif, ip_addr_buf, vif->idx);
137 static irqreturn_t isr_uh_routine(int irq, void *user_data)
139 struct wilc_vif *vif;
141 struct net_device *dev = user_data;
143 vif = netdev_priv(dev);
147 netdev_err(dev, "Can't handle UH interrupt\n");
150 return IRQ_WAKE_THREAD;
153 static irqreturn_t isr_bh_routine(int irq, void *userdata)
155 struct wilc_vif *vif;
157 struct net_device *dev = userdata;
159 vif = netdev_priv(userdata);
163 netdev_err(dev, "Can't handle BH interrupt\n");
167 wilc_handle_isr(wilc);
172 static int init_irq(struct net_device *dev)
175 struct wilc_vif *vif;
178 vif = netdev_priv(dev);
181 if ((gpio_request(wl->gpio, "WILC_INTR") == 0) &&
182 (gpio_direction_input(wl->gpio) == 0)) {
183 wl->dev_irq_num = gpio_to_irq(wl->gpio);
186 netdev_err(dev, "could not obtain gpio for WILC_INTR\n");
189 if (ret != -1 && request_threaded_irq(wl->dev_irq_num,
192 IRQF_TRIGGER_LOW | IRQF_ONESHOT,
193 "WILC_IRQ", dev) < 0) {
194 netdev_err(dev, "Failed to request IRQ GPIO: %d\n", wl->gpio);
199 "IRQ request succeeded IRQ-NUM= %d on GPIO: %d\n",
200 wl->dev_irq_num, wl->gpio);
206 static void deinit_irq(struct net_device *dev)
208 struct wilc_vif *vif;
211 vif = netdev_priv(dev);
214 /* Deintialize IRQ */
215 if (wilc->dev_irq_num) {
216 free_irq(wilc->dev_irq_num, wilc);
217 gpio_free(wilc->gpio);
221 int wilc_lock_timeout(struct wilc *nic, void *vp, u32 timeout)
223 /* FIXME: replace with mutex_lock or wait_for_completion */
227 error = down_timeout(vp,
228 msecs_to_jiffies(timeout));
232 void wilc_mac_indicate(struct wilc *wilc, int flag)
236 if (flag == WILC_MAC_INDICATE_STATUS) {
237 wilc_wlan_cfg_get_val(WID_STATUS,
238 (unsigned char *)&status, 4);
239 if (wilc->mac_status == WILC_MAC_STATUS_INIT) {
240 wilc->mac_status = status;
241 complete(&wilc->sync_event);
243 wilc->mac_status = status;
248 static struct net_device *get_if_handler(struct wilc *wilc, u8 *mac_header)
253 bssid = mac_header + 10;
254 bssid1 = mac_header + 4;
256 for (i = 0; i < wilc->vif_num; i++) {
257 if (wilc->vif[i]->mode == STATION_MODE)
258 if (ether_addr_equal_unaligned(bssid,
259 wilc->vif[i]->bssid))
260 return wilc->vif[i]->ndev;
261 if (wilc->vif[i]->mode == AP_MODE)
262 if (ether_addr_equal_unaligned(bssid1,
263 wilc->vif[i]->bssid))
264 return wilc->vif[i]->ndev;
270 int wilc_wlan_set_bssid(struct net_device *wilc_netdev, u8 *bssid, u8 mode)
272 struct wilc_vif *vif = netdev_priv(wilc_netdev);
274 memcpy(vif->bssid, bssid, 6);
280 int wilc_wlan_get_num_conn_ifcs(struct wilc *wilc)
283 u8 null_bssid[6] = {0};
286 for (i = 0; i < wilc->vif_num; i++)
287 if (memcmp(wilc->vif[i]->bssid, null_bssid, 6))
293 static int linux_wlan_txq_task(void *vp)
296 struct wilc_vif *vif;
298 struct net_device *dev = vp;
300 vif = netdev_priv(dev);
303 complete(&wl->txq_thread_started);
305 wait_for_completion(&wl->txq_event);
308 complete(&wl->txq_thread_started);
310 while (!kthread_should_stop())
315 ret = wilc_wlan_handle_txq(dev, &txq_count);
316 if (txq_count < FLOW_CONTROL_LOWER_THRESHOLD) {
317 if (netif_queue_stopped(wl->vif[0]->ndev))
318 netif_wake_queue(wl->vif[0]->ndev);
319 if (netif_queue_stopped(wl->vif[1]->ndev))
320 netif_wake_queue(wl->vif[1]->ndev);
322 } while (ret == WILC_TX_ERR_NO_BUF && !wl->close);
327 int wilc_wlan_get_firmware(struct net_device *dev)
329 struct wilc_vif *vif;
331 int chip_id, ret = 0;
332 const struct firmware *wilc_firmware;
335 vif = netdev_priv(dev);
338 chip_id = wilc_get_chipid(wilc, false);
340 if (chip_id < 0x1003a0)
341 firmware = FIRMWARE_1002;
343 firmware = FIRMWARE_1003;
345 netdev_info(dev, "loading firmware %s\n", firmware);
347 if (!(&vif->ndev->dev))
350 if (reject_firmware(&wilc_firmware, firmware, wilc->dev) != 0) {
351 netdev_err(dev, "%s - firmware not available\n", firmware);
355 wilc->firmware = wilc_firmware;
362 static int linux_wlan_start_firmware(struct net_device *dev)
364 struct wilc_vif *vif;
368 vif = netdev_priv(dev);
371 ret = wilc_wlan_start(wilc);
375 if (!wait_for_completion_timeout(&wilc->sync_event,
376 msecs_to_jiffies(5000)))
382 static int wilc1000_firmware_download(struct net_device *dev)
384 struct wilc_vif *vif;
388 vif = netdev_priv(dev);
391 if (!wilc->firmware) {
392 netdev_err(dev, "Firmware buffer is NULL\n");
396 ret = wilc_wlan_firmware_download(wilc, wilc->firmware->data,
397 wilc->firmware->size);
401 release_firmware(wilc->firmware);
402 wilc->firmware = NULL;
404 netdev_dbg(dev, "Download Succeeded\n");
409 static int linux_wlan_init_test_config(struct net_device *dev,
410 struct wilc_vif *vif)
412 unsigned char c_val[64];
413 struct wilc *wilc = vif->wilc;
414 struct wilc_priv *priv;
415 struct host_if_drv *hif_drv;
417 netdev_dbg(dev, "Start configuring Firmware\n");
418 priv = wiphy_priv(dev->ieee80211_ptr->wiphy);
419 hif_drv = (struct host_if_drv *)priv->hif_drv;
420 netdev_dbg(dev, "Host = %p\n", hif_drv);
421 wilc_get_chipid(wilc, false);
425 if (!wilc_wlan_cfg_set(vif, 1, WID_SET_DRV_HANDLER, c_val, 4, 0, 0))
429 if (!wilc_wlan_cfg_set(vif, 0, WID_PC_TEST_MODE, c_val, 1, 0, 0))
432 c_val[0] = INFRASTRUCTURE;
433 if (!wilc_wlan_cfg_set(vif, 0, WID_BSS_TYPE, c_val, 1, 0, 0))
436 c_val[0] = RATE_AUTO;
437 if (!wilc_wlan_cfg_set(vif, 0, WID_CURRENT_TX_RATE, c_val, 1, 0, 0))
440 c_val[0] = G_MIXED_11B_2_MODE;
441 if (!wilc_wlan_cfg_set(vif, 0, WID_11G_OPERATING_MODE, c_val, 1, 0,
446 if (!wilc_wlan_cfg_set(vif, 0, WID_CURRENT_CHANNEL, c_val, 1, 0, 0))
449 c_val[0] = G_SHORT_PREAMBLE;
450 if (!wilc_wlan_cfg_set(vif, 0, WID_PREAMBLE, c_val, 1, 0, 0))
453 c_val[0] = AUTO_PROT;
454 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_PROT_MECH, c_val, 1, 0, 0))
457 c_val[0] = ACTIVE_SCAN;
458 if (!wilc_wlan_cfg_set(vif, 0, WID_SCAN_TYPE, c_val, 1, 0, 0))
461 c_val[0] = SITE_SURVEY_OFF;
462 if (!wilc_wlan_cfg_set(vif, 0, WID_SITE_SURVEY, c_val, 1, 0, 0))
465 *((int *)c_val) = 0xffff;
466 if (!wilc_wlan_cfg_set(vif, 0, WID_RTS_THRESHOLD, c_val, 2, 0, 0))
469 *((int *)c_val) = 2346;
470 if (!wilc_wlan_cfg_set(vif, 0, WID_FRAG_THRESHOLD, c_val, 2, 0, 0))
474 if (!wilc_wlan_cfg_set(vif, 0, WID_BCAST_SSID, c_val, 1, 0, 0))
478 if (!wilc_wlan_cfg_set(vif, 0, WID_QOS_ENABLE, c_val, 1, 0, 0))
481 c_val[0] = NO_POWERSAVE;
482 if (!wilc_wlan_cfg_set(vif, 0, WID_POWER_MANAGEMENT, c_val, 1, 0, 0))
485 c_val[0] = NO_SECURITY; /* NO_ENCRYPT, 0x79 */
486 if (!wilc_wlan_cfg_set(vif, 0, WID_11I_MODE, c_val, 1, 0, 0))
489 c_val[0] = OPEN_SYSTEM;
490 if (!wilc_wlan_cfg_set(vif, 0, WID_AUTH_TYPE, c_val, 1, 0, 0))
493 strcpy(c_val, "123456790abcdef1234567890");
494 if (!wilc_wlan_cfg_set(vif, 0, WID_WEP_KEY_VALUE, c_val,
495 (strlen(c_val) + 1), 0, 0))
498 strcpy(c_val, "12345678");
499 if (!wilc_wlan_cfg_set(vif, 0, WID_11I_PSK, c_val, (strlen(c_val)), 0,
503 strcpy(c_val, "password");
504 if (!wilc_wlan_cfg_set(vif, 0, WID_1X_KEY, c_val, (strlen(c_val) + 1),
512 if (!wilc_wlan_cfg_set(vif, 0, WID_1X_SERV_ADDR, c_val, 4, 0, 0))
516 if (!wilc_wlan_cfg_set(vif, 0, WID_LISTEN_INTERVAL, c_val, 1, 0, 0))
520 if (!wilc_wlan_cfg_set(vif, 0, WID_DTIM_PERIOD, c_val, 1, 0, 0))
523 c_val[0] = NORMAL_ACK;
524 if (!wilc_wlan_cfg_set(vif, 0, WID_ACK_POLICY, c_val, 1, 0, 0))
528 if (!wilc_wlan_cfg_set(vif, 0, WID_USER_CONTROL_ON_TX_POWER, c_val, 1,
533 if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11A, c_val, 1, 0,
538 if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11B, c_val, 1, 0,
542 *((int *)c_val) = 100;
543 if (!wilc_wlan_cfg_set(vif, 0, WID_BEACON_INTERVAL, c_val, 2, 0, 0))
546 c_val[0] = REKEY_DISABLE;
547 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_POLICY, c_val, 1, 0, 0))
550 *((int *)c_val) = 84600;
551 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PERIOD, c_val, 4, 0, 0))
554 *((int *)c_val) = 500;
555 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PACKET_COUNT, c_val, 4, 0,
560 if (!wilc_wlan_cfg_set(vif, 0, WID_SHORT_SLOT_ALLOWED, c_val, 1, 0,
564 c_val[0] = G_SELF_CTS_PROT;
565 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ERP_PROT_TYPE, c_val, 1, 0, 0))
569 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ENABLE, c_val, 1, 0, 0))
572 c_val[0] = HT_MIXED_MODE;
573 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OPERATING_MODE, c_val, 1, 0,
578 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_TXOP_PROT_DISABLE, c_val, 1, 0,
582 c_val[0] = DETECT_PROTECT_REPORT;
583 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OBSS_NONHT_DETECTION, c_val, 1,
587 c_val[0] = RTS_CTS_NONHT_PROT;
588 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_HT_PROT_TYPE, c_val, 1, 0, 0))
592 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_RIFS_PROT_ENABLE, c_val, 1, 0,
596 c_val[0] = MIMO_MODE;
597 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_SMPS_MODE, c_val, 1, 0, 0))
601 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_CURRENT_TX_MCS, c_val, 1, 0,
606 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_IMMEDIATE_BA_ENABLED, c_val, 1,
616 void wilc1000_wlan_deinit(struct net_device *dev)
618 struct wilc_vif *vif;
621 vif = netdev_priv(dev);
625 netdev_err(dev, "wl is NULL\n");
629 if (wl->initialized) {
630 netdev_info(dev, "Deinitializing wilc1000...\n");
632 if (!wl->dev_irq_num &&
633 wl->hif_func->disable_interrupt) {
634 mutex_lock(&wl->hif_cs);
635 wl->hif_func->disable_interrupt(wl);
636 mutex_unlock(&wl->hif_cs);
639 complete(&wl->txq_event);
641 wlan_deinitialize_threads(dev);
645 wilc_wlan_cleanup(dev);
646 wlan_deinit_locks(dev);
648 wl->initialized = false;
650 netdev_dbg(dev, "wilc1000 deinitialization Done\n");
652 netdev_dbg(dev, "wilc1000 is not initialized\n");
656 static int wlan_init_locks(struct net_device *dev)
658 struct wilc_vif *vif;
661 vif = netdev_priv(dev);
664 mutex_init(&wl->hif_cs);
665 mutex_init(&wl->rxq_cs);
667 spin_lock_init(&wl->txq_spinlock);
668 mutex_init(&wl->txq_add_to_head_cs);
670 init_completion(&wl->txq_event);
672 init_completion(&wl->cfg_event);
673 init_completion(&wl->sync_event);
674 init_completion(&wl->txq_thread_started);
679 static int wlan_deinit_locks(struct net_device *dev)
681 struct wilc_vif *vif;
684 vif = netdev_priv(dev);
688 mutex_destroy(&wilc->hif_cs);
691 mutex_destroy(&wilc->rxq_cs);
696 static int wlan_initialize_threads(struct net_device *dev)
698 struct wilc_vif *vif;
701 vif = netdev_priv(dev);
704 wilc->txq_thread = kthread_run(linux_wlan_txq_task, (void *)dev,
706 if (IS_ERR(wilc->txq_thread)) {
707 netdev_err(dev, "couldn't create TXQ thread\n");
709 return PTR_ERR(wilc->txq_thread);
711 wait_for_completion(&wilc->txq_thread_started);
716 static void wlan_deinitialize_threads(struct net_device *dev)
718 struct wilc_vif *vif;
721 vif = netdev_priv(dev);
727 complete(&wl->txq_event);
729 if (wl->txq_thread) {
730 kthread_stop(wl->txq_thread);
731 wl->txq_thread = NULL;
735 int wilc1000_wlan_init(struct net_device *dev, struct wilc_vif *vif)
738 struct wilc *wl = vif->wilc;
740 if (!wl->initialized) {
741 wl->mac_status = WILC_MAC_STATUS_INIT;
744 wlan_init_locks(dev);
746 ret = wilc_wlan_init(dev);
752 if (wl->gpio >= 0 && init_irq(dev)) {
757 ret = wlan_initialize_threads(dev);
760 goto _fail_wilc_wlan_;
763 if (!wl->dev_irq_num &&
764 wl->hif_func->enable_interrupt &&
765 wl->hif_func->enable_interrupt(wl)) {
767 goto _fail_irq_init_;
770 if (wilc_wlan_get_firmware(dev)) {
772 goto _fail_irq_enable_;
775 ret = wilc1000_firmware_download(dev);
778 goto _fail_irq_enable_;
781 ret = linux_wlan_start_firmware(dev);
784 goto _fail_irq_enable_;
787 if (wilc_wlan_cfg_get(vif, 1, WID_FIRMWARE_VERSION, 1, 0)) {
789 char firmware_ver[20];
791 size = wilc_wlan_cfg_get_val(WID_FIRMWARE_VERSION,
793 sizeof(firmware_ver));
794 firmware_ver[size] = '\0';
795 netdev_dbg(dev, "Firmware Ver = %s\n", firmware_ver);
797 ret = linux_wlan_init_test_config(dev, vif);
800 netdev_err(dev, "Failed to configure firmware\n");
802 goto _fail_fw_start_;
805 wl->initialized = true;
812 if (!wl->dev_irq_num &&
813 wl->hif_func->disable_interrupt)
814 wl->hif_func->disable_interrupt(wl);
819 wlan_deinitialize_threads(dev);
821 wilc_wlan_cleanup(dev);
823 wlan_deinit_locks(dev);
824 netdev_err(dev, "WLAN Iinitialization FAILED\n");
826 netdev_dbg(dev, "wilc1000 already initialized\n");
831 static int mac_init_fn(struct net_device *ndev)
833 netif_start_queue(ndev);
834 netif_stop_queue(ndev);
839 int wilc_mac_open(struct net_device *ndev)
841 struct wilc_vif *vif;
843 unsigned char mac_add[ETH_ALEN] = {0};
848 vif = netdev_priv(ndev);
851 if (!wl || !wl->dev) {
852 netdev_err(ndev, "device not ready\n");
856 netdev_dbg(ndev, "MAC OPEN[%p]\n", ndev);
858 ret = wilc_init_host_int(ndev);
862 ret = wilc1000_wlan_init(ndev, vif);
864 wilc_deinit_host_int(ndev);
868 for (i = 0; i < wl->vif_num; i++) {
869 if (ndev == wl->vif[i]->ndev) {
870 if (vif->iftype == AP_MODE) {
871 wilc_set_wfi_drv_handler(vif,
872 wilc_get_vif_idx(vif),
874 } else if (!wilc_wlan_get_num_conn_ifcs(wl)) {
875 wilc_set_wfi_drv_handler(vif,
876 wilc_get_vif_idx(vif),
879 if (memcmp(wl->vif[i ^ 1]->bssid,
880 wl->vif[i ^ 1]->src_addr, 6))
881 wilc_set_wfi_drv_handler(vif,
882 wilc_get_vif_idx(vif),
885 wilc_set_wfi_drv_handler(vif,
886 wilc_get_vif_idx(vif),
889 wilc_set_operation_mode(vif, vif->iftype);
891 wilc_get_mac_address(vif, mac_add);
892 netdev_dbg(ndev, "Mac address: %pM\n", mac_add);
893 memcpy(wl->vif[i]->src_addr, mac_add, ETH_ALEN);
899 memcpy(ndev->dev_addr, wl->vif[i]->src_addr, ETH_ALEN);
901 if (!is_valid_ether_addr(ndev->dev_addr)) {
902 netdev_err(ndev, "Wrong MAC address\n");
903 wilc_deinit_host_int(ndev);
904 wilc1000_wlan_deinit(ndev);
908 wilc_mgmt_frame_register(vif->ndev->ieee80211_ptr->wiphy,
909 vif->ndev->ieee80211_ptr,
910 vif->frame_reg[0].type,
911 vif->frame_reg[0].reg);
912 wilc_mgmt_frame_register(vif->ndev->ieee80211_ptr->wiphy,
913 vif->ndev->ieee80211_ptr,
914 vif->frame_reg[1].type,
915 vif->frame_reg[1].reg);
916 netif_wake_queue(ndev);
922 static struct net_device_stats *mac_stats(struct net_device *dev)
924 struct wilc_vif *vif = netdev_priv(dev);
926 return &vif->netstats;
929 static void wilc_set_multicast_list(struct net_device *dev)
931 struct netdev_hw_addr *ha;
932 struct wilc_vif *vif;
935 vif = netdev_priv(dev);
937 if (dev->flags & IFF_PROMISC)
940 if ((dev->flags & IFF_ALLMULTI) ||
941 (dev->mc.count) > WILC_MULTICAST_TABLE_SIZE) {
942 wilc_setup_multicast_filter(vif, false, 0);
946 if ((dev->mc.count) == 0) {
947 wilc_setup_multicast_filter(vif, true, 0);
951 netdev_for_each_mc_addr(ha, dev) {
952 memcpy(wilc_multicast_mac_addr_list[i], ha->addr, ETH_ALEN);
953 netdev_dbg(dev, "Entry[%d]: %x:%x:%x:%x:%x:%x\n", i,
954 wilc_multicast_mac_addr_list[i][0],
955 wilc_multicast_mac_addr_list[i][1],
956 wilc_multicast_mac_addr_list[i][2],
957 wilc_multicast_mac_addr_list[i][3],
958 wilc_multicast_mac_addr_list[i][4],
959 wilc_multicast_mac_addr_list[i][5]);
963 wilc_setup_multicast_filter(vif, true, (dev->mc.count));
966 static void linux_wlan_tx_complete(void *priv, int status)
968 struct tx_complete_data *pv_data = priv;
970 dev_kfree_skb(pv_data->skb);
974 int wilc_mac_xmit(struct sk_buff *skb, struct net_device *ndev)
976 struct wilc_vif *vif;
977 struct tx_complete_data *tx_data = NULL;
981 struct ethhdr *eth_h;
984 vif = netdev_priv(ndev);
987 if (skb->dev != ndev) {
988 netdev_err(ndev, "Packet not destined to this device\n");
992 tx_data = kmalloc(sizeof(*tx_data), GFP_ATOMIC);
995 netif_wake_queue(ndev);
999 tx_data->buff = skb->data;
1000 tx_data->size = skb->len;
1003 eth_h = (struct ethhdr *)(skb->data);
1004 if (eth_h->h_proto == cpu_to_be16(0x8e88))
1005 netdev_dbg(ndev, "EAPOL transmitted\n");
1007 ih = (struct iphdr *)(skb->data + sizeof(struct ethhdr));
1009 udp_buf = (char *)ih + sizeof(struct iphdr);
1010 if ((udp_buf[1] == 68 && udp_buf[3] == 67) ||
1011 (udp_buf[1] == 67 && udp_buf[3] == 68))
1012 netdev_dbg(ndev, "DHCP Message transmitted, type:%x %x %x\n",
1013 udp_buf[248], udp_buf[249], udp_buf[250]);
1015 vif->netstats.tx_packets++;
1016 vif->netstats.tx_bytes += tx_data->size;
1017 tx_data->bssid = wilc->vif[vif->idx]->bssid;
1018 queue_count = wilc_wlan_txq_add_net_pkt(ndev, (void *)tx_data,
1019 tx_data->buff, tx_data->size,
1020 linux_wlan_tx_complete);
1022 if (queue_count > FLOW_CONTROL_UPPER_THRESHOLD) {
1023 netif_stop_queue(wilc->vif[0]->ndev);
1024 netif_stop_queue(wilc->vif[1]->ndev);
1030 int wilc_mac_close(struct net_device *ndev)
1032 struct wilc_priv *priv;
1033 struct wilc_vif *vif;
1034 struct host_if_drv *hif_drv;
1037 vif = netdev_priv(ndev);
1039 if (!vif || !vif->ndev || !vif->ndev->ieee80211_ptr ||
1040 !vif->ndev->ieee80211_ptr->wiphy)
1043 priv = wiphy_priv(vif->ndev->ieee80211_ptr->wiphy);
1049 hif_drv = (struct host_if_drv *)priv->hif_drv;
1051 netdev_dbg(ndev, "Mac close\n");
1059 if ((wl->open_ifcs) > 0)
1065 netif_stop_queue(vif->ndev);
1067 wilc_deinit_host_int(vif->ndev);
1070 if (wl->open_ifcs == 0) {
1071 netdev_dbg(ndev, "Deinitializing wilc1000\n");
1073 wilc1000_wlan_deinit(ndev);
1074 WILC_WFI_deinit_mon_interface();
1077 vif->mac_opened = 0;
1082 static int mac_ioctl(struct net_device *ndev, struct ifreq *req, int cmd)
1086 u32 size = 0, length = 0;
1087 struct wilc_vif *vif;
1091 vif = netdev_priv(ndev);
1094 if (!wilc->initialized)
1100 struct iwreq *wrq = (struct iwreq *)req;
1102 size = wrq->u.data.length;
1104 if (size && wrq->u.data.pointer) {
1105 buff = memdup_user(wrq->u.data.pointer,
1106 wrq->u.data.length);
1108 return PTR_ERR(buff);
1110 if (strncasecmp(buff, "RSSI", length) == 0) {
1111 ret = wilc_get_rssi(vif, &rssi);
1112 netdev_info(ndev, "RSSI :%d\n", rssi);
1116 snprintf(buff, size, "rssi %d", rssi);
1118 if (copy_to_user(wrq->u.data.pointer, buff, size)) {
1119 netdev_err(ndev, "failed to copy\n");
1130 netdev_info(ndev, "Command - %d - has been received\n", cmd);
1143 void wilc_frmw_to_linux(struct wilc *wilc, u8 *buff, u32 size, u32 pkt_offset)
1145 unsigned int frame_len = 0;
1147 unsigned char *buff_to_send = NULL;
1148 struct sk_buff *skb;
1149 struct net_device *wilc_netdev;
1150 struct wilc_vif *vif;
1155 wilc_netdev = get_if_handler(wilc, buff);
1160 vif = netdev_priv(wilc_netdev);
1164 buff_to_send = buff;
1166 skb = dev_alloc_skb(frame_len);
1170 skb->dev = wilc_netdev;
1172 memcpy(skb_put(skb, frame_len), buff_to_send, frame_len);
1174 skb->protocol = eth_type_trans(skb, wilc_netdev);
1175 vif->netstats.rx_packets++;
1176 vif->netstats.rx_bytes += frame_len;
1177 skb->ip_summed = CHECKSUM_UNNECESSARY;
1178 stats = netif_rx(skb);
1179 netdev_dbg(wilc_netdev, "netif_rx ret value is: %d\n", stats);
1183 void WILC_WFI_mgmt_rx(struct wilc *wilc, u8 *buff, u32 size)
1186 struct wilc_vif *vif;
1188 for (i = 0; i < wilc->vif_num; i++) {
1189 vif = netdev_priv(wilc->vif[i]->ndev);
1190 if (vif->monitor_flag) {
1191 WILC_WFI_monitor_rx(buff, size);
1196 vif = netdev_priv(wilc->vif[1]->ndev);
1197 if ((buff[0] == vif->frame_reg[0].type && vif->frame_reg[0].reg) ||
1198 (buff[0] == vif->frame_reg[1].type && vif->frame_reg[1].reg))
1199 WILC_WFI_p2p_rx(wilc->vif[1]->ndev, buff, size);
1202 void wilc_netdev_cleanup(struct wilc *wilc)
1206 if (wilc && (wilc->vif[0]->ndev || wilc->vif[1]->ndev))
1207 unregister_inetaddr_notifier(&g_dev_notifier);
1209 if (wilc && wilc->firmware) {
1210 release_firmware(wilc->firmware);
1211 wilc->firmware = NULL;
1214 if (wilc && (wilc->vif[0]->ndev || wilc->vif[1]->ndev)) {
1215 for (i = 0; i < NUM_CONCURRENT_IFC; i++)
1216 if (wilc->vif[i]->ndev)
1217 if (wilc->vif[i]->mac_opened)
1218 wilc_mac_close(wilc->vif[i]->ndev);
1220 for (i = 0; i < NUM_CONCURRENT_IFC; i++) {
1221 unregister_netdev(wilc->vif[i]->ndev);
1222 wilc_free_wiphy(wilc->vif[i]->ndev);
1223 free_netdev(wilc->vif[i]->ndev);
1229 EXPORT_SYMBOL_GPL(wilc_netdev_cleanup);
1231 int wilc_netdev_init(struct wilc **wilc, struct device *dev, int io_type,
1232 int gpio, const struct wilc_hif_func *ops)
1235 struct wilc_vif *vif;
1236 struct net_device *ndev;
1239 wl = kzalloc(sizeof(*wl), GFP_KERNEL);
1244 wl->io_type = io_type;
1248 register_inetaddr_notifier(&g_dev_notifier);
1250 for (i = 0; i < NUM_CONCURRENT_IFC; i++) {
1251 ndev = alloc_etherdev(sizeof(struct wilc_vif));
1255 vif = netdev_priv(ndev);
1256 memset(vif, 0, sizeof(struct wilc_vif));
1259 strcpy(ndev->name, "wlan%d");
1261 strcpy(ndev->name, "p2p%d");
1266 wl->vif_num = i + 1;
1269 ndev->netdev_ops = &wilc_netdev_ops;
1272 struct wireless_dev *wdev;
1274 wdev = wilc_create_wiphy(ndev, dev);
1277 SET_NETDEV_DEV(ndev, dev);
1280 netdev_err(ndev, "Can't register WILC Wiphy\n");
1284 vif->ndev->ieee80211_ptr = wdev;
1285 vif->ndev->ml_priv = vif;
1286 wdev->netdev = vif->ndev;
1287 vif->netstats.rx_packets = 0;
1288 vif->netstats.tx_packets = 0;
1289 vif->netstats.rx_bytes = 0;
1290 vif->netstats.tx_bytes = 0;
1293 ret = register_netdev(ndev);
1297 vif->iftype = STATION_MODE;
1298 vif->mac_opened = 0;
1303 EXPORT_SYMBOL_GPL(wilc_netdev_init);
1305 MODULE_LICENSE("GPL");