drivers/staging/wilc1000/linux_wlan.c

   1 #include "wilc_wfi_cfgoperations.h"
   2 #include "linux_wlan_common.h"
   3 #include "wilc_wlan_if.h"
   4 #include "wilc_wlan.h"
   5 #ifdef USE_WIRELESS
   6 #include "wilc_wfi_cfgoperations.h"
   7 #endif
   8
   9 #include "linux_wlan_common.h"
  10
  11 #include <linux/slab.h>
  12 #include <linux/sched.h>
  13 #include <linux/delay.h>
  14 #include <linux/workqueue.h>
  15 #include <linux/interrupt.h>
  16 #include <linux/irq.h>
  17 #include <linux/gpio.h>
  18
  19 #include <linux/kthread.h>
  20 #include <linux/firmware.h>
  21 #include <linux/delay.h>
  22
  23 #include <linux/init.h>
  24 #include <linux/netdevice.h>
  25 #ifdef DISABLE_PWRSAVE_AND_SCAN_DURING_IP
  26 #include <linux/inetdevice.h>
  27 #endif
  28 #include <linux/etherdevice.h>
  29 #include <linux/module.h>
  30 #include <linux/kernel.h>
  31 #include <linux/skbuff.h>
  32
  33 #include <linux/version.h>
  34 #include <linux/semaphore.h>
  35
  36 #ifdef WILC_SDIO
  37 #include "linux_wlan_sdio.h"
  38 #else
  39 #include "linux_wlan_spi.h"
  40 #endif
  41
  42 #ifdef WILC_FULLY_HOSTING_AP
  43 #include "wilc_host_ap.h"
  44 #endif
  45
  46 #ifdef STATIC_MACADDRESS /* brandy_0724 [[ */
  47 #include <linux/vmalloc.h>
  48 #include <linux/fs.h>
  49 struct task_struct *wilc_mac_thread;
  50 unsigned char mac_add[] = {0x00, 0x80, 0xC2, 0x5E, 0xa2, 0xb2};
  51 #endif /* brandy_0724 ]] */
  52
  53 #if defined(CUSTOMER_PLATFORM)
  54 /*
  55  TODO : Write power control functions as customer platform.
  56  */
  57 #else
  58
  59  #define _linux_wlan_device_power_on()          {}
  60  #define _linux_wlan_device_power_off()         {}
  61
  62  #define _linux_wlan_device_detection()         {}
  63  #define _linux_wlan_device_removal()           {}
  64 #endif
  65
  66 #ifdef DISABLE_PWRSAVE_AND_SCAN_DURING_IP
  67 extern bool g_obtainingIP;
  68 #endif
  69 extern u16 Set_machw_change_vir_if(bool bValue);
  70 extern void resolve_disconnect_aberration(void *drvHandler);
  71 extern u8 gau8MulticastMacAddrList[WILC_MULTICAST_TABLE_SIZE][ETH_ALEN];
  72 void wilc1000_wlan_deinit(linux_wlan_t *nic);
  73 #ifdef DISABLE_PWRSAVE_AND_SCAN_DURING_IP
  74 extern struct timer_list hDuringIpTimer;
  75 #endif
  76
  77 static int linux_wlan_device_power(int on_off)
  78 {
  79         PRINT_D(INIT_DBG, "linux_wlan_device_power.. (%d)\n", on_off);
  80
  81         if (on_off) {
  82                 _linux_wlan_device_power_on();
  83         } else {
  84                 _linux_wlan_device_power_off();
  85         }
  86
  87         return 0;
  88 }
  89
  90 static int linux_wlan_device_detection(int on_off)
  91 {
  92         PRINT_D(INIT_DBG, "linux_wlan_device_detection.. (%d)\n", on_off);
  93
  94 #ifdef WILC_SDIO
  95         if (on_off) {
  96                 _linux_wlan_device_detection();
  97         } else {
  98                 _linux_wlan_device_removal();
  99         }
 100 #endif
 101
 102         return 0;
 103 }
 104
 105 #ifdef DISABLE_PWRSAVE_AND_SCAN_DURING_IP
 106 static int dev_state_ev_handler(struct notifier_block *this, unsigned long event, void *ptr);
 107
 108 static struct notifier_block g_dev_notifier = {
 109         .notifier_call = dev_state_ev_handler
 110 };
 111 #endif
 112
 113 #define wilc_wlan_deinit(nic)   { if (&g_linux_wlan->oup != NULL)        \
 114                 if (g_linux_wlan->oup.wlan_cleanup != NULL) \
 115                         g_linux_wlan->oup.wlan_cleanup(); }
 116
 117 #ifndef STA_FIRMWARE
 118 #define STA_FIRMWARE    "wifi_firmware.bin"
 119 #endif
 120
 121 #ifndef AP_FIRMWARE
 122 #define AP_FIRMWARE             "wifi_firmware_ap.bin"
 123 #endif
 124
 125 #ifndef P2P_CONCURRENCY_FIRMWARE
 126 #define P2P_CONCURRENCY_FIRMWARE        "wifi_firmware_p2p_concurrency.bin"
 127 #endif
 128
 129 typedef struct android_wifi_priv_cmd {
 130         char *buf;
 131         int used_len;
 132         int total_len;
 133 } android_wifi_priv_cmd;
 134
 135 #define IRQ_WAIT        1
 136 #define IRQ_NO_WAIT     0
 137 /*
 138  *      to sync between mac_close and module exit.
 139  *      don't initialize or de-initialize from init/deinitlocks
 140  *      to be initialized from module wilc_netdev_init and
 141  *      deinitialized from mdoule_exit
 142  */
 143 static struct semaphore close_exit_sync;
 144 unsigned int int_rcvdU;
 145 unsigned int int_rcvdB;
 146 unsigned int int_clrd;
 147
 148 static int wlan_deinit_locks(linux_wlan_t *nic);
 149 static void wlan_deinitialize_threads(linux_wlan_t *nic);
 150 static void linux_wlan_lock(void *vp);
 151 void linux_wlan_unlock(void *vp);
 152 extern void WILC_WFI_monitor_rx(uint8_t *buff, uint32_t size);
 153 extern void WILC_WFI_p2p_rx(struct net_device *dev, uint8_t *buff, uint32_t size);
 154
 155 static void *internal_alloc(uint32_t size, uint32_t flag);
 156 static void linux_wlan_tx_complete(void *priv, int status);
 157 void frmw_to_linux(uint8_t *buff, uint32_t size, uint32_t pkt_offset);
 158 static int  mac_init_fn(struct net_device *ndev);
 159 int  mac_xmit(struct sk_buff *skb, struct net_device *dev);
 160 int  mac_open(struct net_device *ndev);
 161 int  mac_close(struct net_device *ndev);
 162 static struct net_device_stats *mac_stats(struct net_device *dev);
 163 static int  mac_ioctl(struct net_device *ndev, struct ifreq *req, int cmd);
 164 static void wilc_set_multicast_list(struct net_device *dev);
 165
 166 /*
 167  * for now - in frmw_to_linux there should be private data to be passed to it
 168  * and this data should be pointer to net device
 169  */
 170 linux_wlan_t *g_linux_wlan;
 171 wilc_wlan_oup_t *gpstrWlanOps;
 172 bool bEnablePS = true;
 173
 174 static const struct net_device_ops wilc_netdev_ops = {
 175         .ndo_init = mac_init_fn,
 176         .ndo_open = mac_open,
 177         .ndo_stop = mac_close,
 178         .ndo_start_xmit = mac_xmit,
 179         .ndo_do_ioctl = mac_ioctl,
 180         .ndo_get_stats = mac_stats,
 181         .ndo_set_rx_mode  = wilc_set_multicast_list,
 182
 183 };
 184
 185 #ifdef DEBUG_MODE
 186
 187 extern volatile int timeNo;
 188
 189 #define DEGUG_BUFFER_LENGTH 1000
 190 volatile int WatchDogdebuggerCounter;
 191 char DebugBuffer[DEGUG_BUFFER_LENGTH + 20] = {0};
 192 static char *ps8current = DebugBuffer;
 193
 194 void printk_later(const char *format, ...)
 195 {
 196         va_list args;
 197         va_start(args, format);
 198         ps8current += vsprintf(ps8current, format, args);
 199         va_end(args);
 200         if ((ps8current - DebugBuffer) > DEGUG_BUFFER_LENGTH)
 201                 ps8current = DebugBuffer;
 202
 203 }
 204
 205 void dump_logs(void)
 206 {
 207         if (DebugBuffer[0]) {
 208                 DebugBuffer[DEGUG_BUFFER_LENGTH] = 0;
 209                 PRINT_INFO(GENERIC_DBG, "early printed\n");
 210                 PRINT_D(GENERIC_DBG, ps8current + 1);
 211                 ps8current[1] = 0;
 212                 PRINT_INFO(GENERIC_DBG, "latest printed\n");
 213                 PRINT_D(GENERIC_DBG, DebugBuffer);
 214                 DebugBuffer[0] = 0;
 215                 ps8current = DebugBuffer;
 216         }
 217 }
 218
 219 void Reset_WatchDogdebugger(void)
 220 {
 221         WatchDogdebuggerCounter = 0;
 222 }
 223
 224 static int DebuggingThreadTask(void *vp)
 225 {
 226         while (1) {
 227                 while (!WatchDogdebuggerCounter) {
 228                         PRINT_D(GENERIC_DBG, "Debug Thread Running %d\n", timeNo);
 229                         WatchDogdebuggerCounter = 1;
 230                         msleep(10000);
 231                 }
 232                 dump_logs();
 233                 WatchDogdebuggerCounter = 0;
 234         }
 235 }
 236 #endif
 237
 238 #ifdef DISABLE_PWRSAVE_AND_SCAN_DURING_IP
 239 static int dev_state_ev_handler(struct notifier_block *this, unsigned long event, void *ptr)
 240 {
 241         struct in_ifaddr *dev_iface = (struct in_ifaddr *)ptr;
 242         struct WILC_WFI_priv *priv;
 243         tstrWILC_WFIDrv *pstrWFIDrv;
 244         struct net_device *dev;
 245         u8 *pIP_Add_buff;
 246         perInterface_wlan_t *nic;
 247         u8 null_ip[4] = {0};
 248         char wlan_dev_name[5] = "wlan0";
 249
 250         if (dev_iface == NULL || dev_iface->ifa_dev == NULL || dev_iface->ifa_dev->dev == NULL) {
 251                 PRINT_D(GENERIC_DBG, "dev_iface = NULL\n");
 252                 return NOTIFY_DONE;
 253         }
 254
 255         if ((memcmp(dev_iface->ifa_label, "wlan0", 5)) && (memcmp(dev_iface->ifa_label, "p2p0", 4))) {
 256                 PRINT_D(GENERIC_DBG, "Interface is neither WLAN0 nor P2P0\n");
 257                 return NOTIFY_DONE;
 258         }
 259
 260         dev  = (struct net_device *)dev_iface->ifa_dev->dev;
 261         if (dev->ieee80211_ptr == NULL || dev->ieee80211_ptr->wiphy == NULL) {
 262                 PRINT_D(GENERIC_DBG, "No Wireless registerd\n");
 263                 return NOTIFY_DONE;
 264         }
 265         priv = wiphy_priv(dev->ieee80211_ptr->wiphy);
 266         if (priv == NULL) {
 267                 PRINT_D(GENERIC_DBG, "No Wireless Priv\n");
 268                 return NOTIFY_DONE;
 269         }
 270         pstrWFIDrv = (tstrWILC_WFIDrv *)priv->hWILCWFIDrv;
 271         nic = netdev_priv(dev);
 272         if (nic == NULL || pstrWFIDrv == NULL) {
 273                 PRINT_D(GENERIC_DBG, "No Wireless Priv\n");
 274                 return NOTIFY_DONE;
 275         }
 276
 277         PRINT_INFO(GENERIC_DBG, "dev_state_ev_handler +++\n"); /* tony */
 278
 279         switch (event) {
 280         case NETDEV_UP:
 281                 PRINT_D(GENERIC_DBG, "dev_state_ev_handler event=NETDEV_UP %p\n", dev);       /* tony */
 282
 283                 PRINT_INFO(GENERIC_DBG, "\n ============== IP Address Obtained ===============\n\n");
 284
 285                 /*If we are in station mode or client mode*/
 286                 if (nic->iftype == STATION_MODE || nic->iftype == CLIENT_MODE) {
 287                         pstrWFIDrv->IFC_UP = 1;
 288                         g_obtainingIP = false;
 289                         del_timer(&hDuringIpTimer);
 290                         PRINT_D(GENERIC_DBG, "IP obtained , enable scan\n");
 291                 }
 292
 293                 if (bEnablePS)
 294                         host_int_set_power_mgmt(pstrWFIDrv, 1, 0);
 295
 296                 PRINT_D(GENERIC_DBG, "[%s] Up IP\n", dev_iface->ifa_label);
 297
 298                 pIP_Add_buff = (char *) (&(dev_iface->ifa_address));
 299                 PRINT_D(GENERIC_DBG, "IP add=%d:%d:%d:%d\n", pIP_Add_buff[0], pIP_Add_buff[1], pIP_Add_buff[2], pIP_Add_buff[3]);
 300                 host_int_setup_ipaddress(pstrWFIDrv, pIP_Add_buff, nic->u8IfIdx);
 301
 302                 break;
 303
 304         case NETDEV_DOWN:
 305                 PRINT_D(GENERIC_DBG, "dev_state_ev_handler event=NETDEV_DOWN %p\n", dev);               /* tony */
 306
 307                 PRINT_INFO(GENERIC_DBG, "\n ============== IP Address Released ===============\n\n");
 308                 if (nic->iftype == STATION_MODE || nic->iftype == CLIENT_MODE) {
 309                         pstrWFIDrv->IFC_UP = 0;
 310                         g_obtainingIP = false;
 311                 }
 312
 313                 if (memcmp(dev_iface->ifa_label, wlan_dev_name, 5) == 0)
 314                         host_int_set_power_mgmt(pstrWFIDrv, 0, 0);
 315
 316                 resolve_disconnect_aberration(pstrWFIDrv);
 317
 318                 PRINT_D(GENERIC_DBG, "[%s] Down IP\n", dev_iface->ifa_label);
 319
 320                 pIP_Add_buff = null_ip;
 321                 PRINT_D(GENERIC_DBG, "IP add=%d:%d:%d:%d\n", pIP_Add_buff[0], pIP_Add_buff[1], pIP_Add_buff[2], pIP_Add_buff[3]);
 322
 323                 host_int_setup_ipaddress(pstrWFIDrv, pIP_Add_buff, nic->u8IfIdx);
 324
 325                 break;
 326
 327         default:
 328                 PRINT_INFO(GENERIC_DBG, "dev_state_ev_handler event=default\n");        /* tony */
 329                 PRINT_INFO(GENERIC_DBG, "[%s] unknown dev event: %lu\n", dev_iface->ifa_label, event);
 330
 331                 break;
 332         }
 333
 334         return NOTIFY_DONE;
 335
 336 }
 337 #endif
 338
 339 /*
 340  *      Interrupt initialization and handling functions
 341  */
 342
 343 void linux_wlan_enable_irq(void)
 344 {
 345
 346 #if (RX_BH_TYPE != RX_BH_THREADED_IRQ)
 347 #if (defined WILC_SPI) || (defined WILC_SDIO_IRQ_GPIO)
 348         PRINT_D(INT_DBG, "Enabling IRQ ...\n");
 349         enable_irq(g_linux_wlan->dev_irq_num);
 350 #endif
 351 #endif
 352 }
 353
 354 void linux_wlan_disable_irq(int wait)
 355 {
 356 #if (defined WILC_SPI) || (defined WILC_SDIO_IRQ_GPIO)
 357         if (wait) {
 358                 PRINT_D(INT_DBG, "Disabling IRQ ...\n");
 359                 disable_irq(g_linux_wlan->dev_irq_num);
 360         } else {
 361                 PRINT_D(INT_DBG, "Disabling IRQ ...\n");
 362                 disable_irq_nosync(g_linux_wlan->dev_irq_num);
 363         }
 364 #endif
 365 }
 366
 367 #if (defined WILC_SPI) || (defined WILC_SDIO_IRQ_GPIO)
 368 static irqreturn_t isr_uh_routine(int irq, void *user_data)
 369 {
 370         int_rcvdU++;
 371 #if (RX_BH_TYPE != RX_BH_THREADED_IRQ)
 372         linux_wlan_disable_irq(IRQ_NO_WAIT);
 373 #endif
 374         PRINT_D(INT_DBG, "Interrupt received UH\n");
 375
 376         /*While mac is closing cacncel the handling of any interrupts received*/
 377         if (g_linux_wlan->close) {
 378                 PRINT_ER("Driver is CLOSING: Can't handle UH interrupt\n");
 379         #if (RX_BH_TYPE == RX_BH_THREADED_IRQ)
 380                 return IRQ_HANDLED;
 381         #else
 382                 return IRQ_NONE;
 383         #endif
 384
 385         }
 386 #if (RX_BH_TYPE == RX_BH_WORK_QUEUE)
 387         schedule_work(&g_linux_wlan->rx_work_queue);
 388         return IRQ_HANDLED;
 389 #elif (RX_BH_TYPE == RX_BH_KTHREAD)
 390         linux_wlan_unlock(&g_linux_wlan->rx_sem);
 391         return IRQ_HANDLED;
 392 #elif (RX_BH_TYPE == RX_BH_THREADED_IRQ)
 393         return IRQ_WAKE_THREAD;
 394 #endif
 395
 396 }
 397 #endif
 398
 399 #if (RX_BH_TYPE == RX_BH_WORK_QUEUE || RX_BH_TYPE == RX_BH_THREADED_IRQ)
 400
 401 #if (RX_BH_TYPE == RX_BH_THREADED_IRQ)
 402 irqreturn_t isr_bh_routine(int irq, void *userdata)
 403 {
 404         linux_wlan_t *nic;
 405         nic = (linux_wlan_t *)userdata;
 406 #else
 407 static void isr_bh_routine(struct work_struct *work)
 408 {
 409         perInterface_wlan_t *nic;
 410         nic = (perInterface_wlan_t *)container_of(work, linux_wlan_t, rx_work_queue);
 411 #endif
 412
 413         /*While mac is closing cacncel the handling of any interrupts received*/
 414         if (g_linux_wlan->close) {
 415                 PRINT_ER("Driver is CLOSING: Can't handle BH interrupt\n");
 416         #if (RX_BH_TYPE == RX_BH_THREADED_IRQ)
 417                 return IRQ_HANDLED;
 418         #else
 419                 return;
 420         #endif
 421         }
 422
 423         int_rcvdB++;
 424         PRINT_D(INT_DBG, "Interrupt received BH\n");
 425         if (g_linux_wlan->oup.wlan_handle_rx_isr != 0)
 426                 g_linux_wlan->oup.wlan_handle_rx_isr();
 427         else
 428                 PRINT_ER("wlan_handle_rx_isr() hasn't been initialized\n");
 429
 430 #if (RX_BH_TYPE == RX_BH_THREADED_IRQ)
 431         return IRQ_HANDLED;
 432 #endif
 433 }
 434 #elif (RX_BH_TYPE == RX_BH_KTHREAD)
 435 static int isr_bh_routine(void *vp)
 436 {
 437         linux_wlan_t *nic;
 438
 439         nic = (linux_wlan_t *)vp;
 440
 441         while (1) {
 442                 linux_wlan_lock(&nic->rx_sem);
 443                 if (g_linux_wlan->close) {
 444
 445                         while (!kthread_should_stop())
 446                                 schedule();
 447
 448                         break;
 449                 }
 450                 int_rcvdB++;
 451                 PRINT_D(INT_DBG, "Interrupt received BH\n");
 452                 if (g_linux_wlan->oup.wlan_handle_rx_isr != 0)
 453                         g_linux_wlan->oup.wlan_handle_rx_isr();
 454                 else
 455                         PRINT_ER("wlan_handle_rx_isr() hasn't been initialized\n");
 456         }
 457
 458         return 0;
 459 }
 460 #endif
 461
 462 #if (defined WILC_SPI) || (defined WILC_SDIO_IRQ_GPIO)
 463 static int init_irq(linux_wlan_t *p_nic)
 464 {
 465         int ret = 0;
 466         linux_wlan_t *nic = p_nic;
 467
 468         /*initialize GPIO and register IRQ num*/
 469         /*GPIO request*/
 470         if ((gpio_request(GPIO_NUM, "WILC_INTR") == 0) &&
 471             (gpio_direction_input(GPIO_NUM) == 0)) {
 472 #if defined(CUSTOMER_PLATFORM)
 473 /*
 474  TODO : save the registerd irq number to the private wilc context in kernel.
 475  *
 476  * ex) nic->dev_irq_num = gpio_to_irq(GPIO_NUM);
 477  */
 478 #elif defined(NM73131_0_BOARD)
 479                 nic->dev_irq_num = IRQ_WILC1000;
 480 #elif defined(PANDA_BOARD)
 481                 gpio_export(GPIO_NUM, 1);
 482                 nic->dev_irq_num = OMAP_GPIO_IRQ(GPIO_NUM);
 483                 irq_set_irq_type(nic->dev_irq_num, IRQ_TYPE_LEVEL_LOW);
 484 #else
 485                 nic->dev_irq_num = gpio_to_irq(GPIO_NUM);
 486 #endif
 487         } else {
 488                 ret = -1;
 489                 PRINT_ER("could not obtain gpio for WILC_INTR\n");
 490         }
 491
 492 #if (RX_BH_TYPE == RX_BH_THREADED_IRQ)
 493         if ((ret != -1) && (request_threaded_irq(nic->dev_irq_num, isr_uh_routine, isr_bh_routine,
 494                                                   IRQF_TRIGGER_LOW | IRQF_ONESHOT,               /*Without IRQF_ONESHOT the uh will remain kicked in and dont gave a chance to bh*/
 495                                                   "WILC_IRQ", nic)) < 0) {
 496
 497 #else
 498         /*Request IRQ*/
 499         if ((ret != -1) && (request_irq(nic->dev_irq_num, isr_uh_routine,
 500                                         IRQF_TRIGGER_LOW, "WILC_IRQ", nic) < 0)) {
 501
 502 #endif
 503                 PRINT_ER("Failed to request IRQ for GPIO: %d\n", GPIO_NUM);
 504                 ret = -1;
 505         } else {
 506
 507                 PRINT_D(INIT_DBG, "IRQ request succeeded IRQ-NUM= %d on GPIO: %d\n",
 508                         nic->dev_irq_num, GPIO_NUM);
 509         }
 510
 511         return ret;
 512 }
 513 #endif
 514
 515 static void deinit_irq(linux_wlan_t *nic)
 516 {
 517 #if (defined WILC_SPI) || (defined WILC_SDIO_IRQ_GPIO)
 518         /* Deintialize IRQ */
 519         if (&nic->dev_irq_num != 0) {
 520                 free_irq(nic->dev_irq_num, g_linux_wlan);
 521
 522                 gpio_free(GPIO_NUM);
 523         }
 524 #endif
 525 }
 526
 527 /*
 528  *      OS functions
 529  */
 530 static void linux_wlan_msleep(uint32_t msc)
 531 {
 532         if (msc <= 4000000) {
 533                 u32 u32Temp = msc * 1000;
 534                 usleep_range(u32Temp, u32Temp);
 535         } else {
 536                 msleep(msc);
 537         }
 538 }
 539
 540 static void linux_wlan_atomic_msleep(uint32_t msc)
 541 {
 542         mdelay(msc);
 543 }
 544 static void linux_wlan_dbg(uint8_t *buff)
 545 {
 546         PRINT_D(INIT_DBG, "%d\n", *buff);
 547 }
 548
 549 static void *linux_wlan_malloc_atomic(uint32_t sz)
 550 {
 551         char *pntr = NULL;
 552         pntr = kmalloc(sz, GFP_ATOMIC);
 553         PRINT_D(MEM_DBG, "Allocating %d bytes at address %p\n", sz, pntr);
 554         return (void *)pntr;
 555
 556 }
 557 static void *linux_wlan_malloc(uint32_t sz)
 558 {
 559         char *pntr = NULL;
 560         pntr = kmalloc(sz, GFP_KERNEL);
 561         PRINT_D(MEM_DBG, "Allocating %d bytes at address %p\n", sz, pntr);
 562         return (void *)pntr;
 563 }
 564
 565 void linux_wlan_free(void *vp)
 566 {
 567         if (vp != NULL) {
 568                 PRINT_D(MEM_DBG, "Freeing %p\n", vp);
 569                 kfree(vp);
 570         }
 571 }
 572
 573 static void *internal_alloc(uint32_t size, uint32_t flag)
 574 {
 575         char *pntr = NULL;
 576         pntr = kmalloc(size, flag);
 577         PRINT_D(MEM_DBG, "Allocating %d bytes at address %p\n", size, pntr);
 578         return (void *)pntr;
 579 }
 580
 581 static void linux_wlan_init_lock(char *lockName, void *plock, int count)
 582 {
 583         sema_init((struct semaphore *)plock, count);
 584         PRINT_D(LOCK_DBG, "Initializing [%s][%p]\n", lockName, plock);
 585
 586 }
 587
 588 static void linux_wlan_deinit_lock(void *plock)
 589 {
 590         /* mutex_destroy((struct mutex*)plock); */
 591 }
 592
 593 static void linux_wlan_lock(void *vp)
 594 {
 595         PRINT_D(LOCK_DBG, "Locking %p\n", vp);
 596         if (vp != NULL) {
 597                 while (down_interruptible((struct semaphore *) vp))
 598                         ;
 599         } else {
 600                 PRINT_ER("Failed, mutex is NULL\n");
 601         }
 602 }
 603
 604 static int linux_wlan_lock_timeout(void *vp, u32 timeout)
 605 {
 606         int error = -1;
 607         PRINT_D(LOCK_DBG, "Locking %p\n", vp);
 608         if (vp != NULL)
 609                 error = down_timeout((struct semaphore *)vp, msecs_to_jiffies(timeout));
 610         else
 611                 PRINT_ER("Failed, mutex is NULL\n");
 612         return error;
 613 }
 614
 615 void linux_wlan_unlock(void *vp)
 616 {
 617         PRINT_D(LOCK_DBG, "Unlocking %p\n", vp);
 618         if (vp != NULL)
 619                 up((struct semaphore *)vp);
 620         else
 621                 PRINT_ER("Failed, mutex is NULL\n");
 622 }
 623
 624 static void linux_wlan_init_mutex(char *lockName, void *plock, int count)
 625 {
 626         mutex_init((struct mutex *)plock);
 627         PRINT_D(LOCK_DBG, "Initializing mutex [%s][%p]\n", lockName, plock);
 628
 629 }
 630
 631 static void linux_wlan_deinit_mutex(void *plock)
 632 {
 633         mutex_destroy((struct mutex *)plock);
 634 }
 635
 636 static void linux_wlan_lock_mutex(void *vp)
 637 {
 638         PRINT_D(LOCK_DBG, "Locking mutex %p\n", vp);
 639         if (vp != NULL) {
 640                 /*
 641                  *      if(mutex_is_locked((struct mutex*)vp))
 642                  *      {
 643                  *              //PRINT_ER("Mutex already locked - %p \n",vp);
 644                  *      }
 645                  */
 646                 mutex_lock((struct mutex *)vp);
 647
 648         } else {
 649                 PRINT_ER("Failed, mutex is NULL\n");
 650         }
 651 }
 652
 653 static void linux_wlan_unlock_mutex(void *vp)
 654 {
 655         PRINT_D(LOCK_DBG, "Unlocking mutex %p\n", vp);
 656         if (vp != NULL) {
 657
 658                 if (mutex_is_locked((struct mutex *)vp)) {
 659                         mutex_unlock((struct mutex *)vp);
 660                 } else {
 661                         /* PRINT_ER("Mutex already unlocked  - %p\n",vp); */
 662                 }
 663
 664         } else {
 665                 PRINT_ER("Failed, mutex is NULL\n");
 666         }
 667 }
 668
 669 /*Added by Amr - BugID_4720*/
 670 static void linux_wlan_init_spin_lock(char *lockName, void *plock, int count)
 671 {
 672         spin_lock_init((spinlock_t *)plock);
 673         PRINT_D(SPIN_DEBUG, "Initializing mutex [%s][%p]\n", lockName, plock);
 674
 675 }
 676
 677 static void linux_wlan_deinit_spin_lock(void *plock)
 678 {
 679
 680 }
 681 static void linux_wlan_spin_lock(void *vp, unsigned long *flags)
 682 {
 683         unsigned long lflags;
 684         PRINT_D(SPIN_DEBUG, "Lock spin %p\n", vp);
 685         if (vp != NULL) {
 686                 spin_lock_irqsave((spinlock_t *)vp, lflags);
 687                 *flags = lflags;
 688         } else {
 689                 PRINT_ER("Failed, spin lock is NULL\n");
 690         }
 691 }
 692 static void linux_wlan_spin_unlock(void *vp, unsigned long *flags)
 693 {
 694         unsigned long lflags = *flags;
 695         PRINT_D(SPIN_DEBUG, "Unlock spin %p\n", vp);
 696         if (vp != NULL) {
 697                 spin_unlock_irqrestore((spinlock_t *)vp, lflags);
 698                 *flags = lflags;
 699         } else {
 700                 PRINT_ER("Failed, spin lock is NULL\n");
 701         }
 702 }
 703
 704 static void linux_wlan_mac_indicate(int flag)
 705 {
 706         /*I have to do it that way becuase there is no mean to encapsulate device pointer
 707          * as a parameter
 708          */
 709         linux_wlan_t *pd = g_linux_wlan;
 710         int status;
 711
 712         if (flag == WILC_MAC_INDICATE_STATUS) {
 713                 pd->oup.wlan_cfg_get_value(WID_STATUS, (unsigned char *)&status, 4);
 714                 if (pd->mac_status == WILC_MAC_STATUS_INIT) {
 715                         pd->mac_status = status;
 716                         linux_wlan_unlock(&pd->sync_event);
 717                 } else {
 718                         pd->mac_status = status;
 719                 }
 720
 721                 if (pd->mac_status == WILC_MAC_STATUS_CONNECT) {        /* Connect */
 722                 }
 723
 724         } else if (flag == WILC_MAC_INDICATE_SCAN) {
 725                 PRINT_D(GENERIC_DBG, "Scanning ...\n");
 726
 727         }
 728
 729 }
 730
 731 struct net_device *GetIfHandler(uint8_t *pMacHeader)
 732 {
 733         uint8_t *Bssid, *Bssid1;
 734         int i = 0;
 735
 736         Bssid  = pMacHeader + 10;
 737         Bssid1 = pMacHeader + 4;
 738
 739         for (i = 0; i < g_linux_wlan->u8NoIfcs; i++) {
 740                 if (!memcmp(Bssid1, g_linux_wlan->strInterfaceInfo[i].aBSSID, ETH_ALEN) ||
 741                     !memcmp(Bssid, g_linux_wlan->strInterfaceInfo[i].aBSSID, ETH_ALEN)) {
 742                         return g_linux_wlan->strInterfaceInfo[i].wilc_netdev;
 743                 }
 744         }
 745         PRINT_INFO(INIT_DBG, "Invalide handle\n");
 746         for (i = 0; i < 25; i++)
 747                 PRINT_D(INIT_DBG, "%02x ", pMacHeader[i]);
 748         Bssid  = pMacHeader + 18;
 749         Bssid1 = pMacHeader + 12;
 750         for (i = 0; i < g_linux_wlan->u8NoIfcs; i++) {
 751                 if (!memcmp(Bssid1, g_linux_wlan->strInterfaceInfo[i].aBSSID, ETH_ALEN) ||
 752                     !memcmp(Bssid, g_linux_wlan->strInterfaceInfo[i].aBSSID, ETH_ALEN)) {
 753                         PRINT_D(INIT_DBG, "Ctx [%p]\n", g_linux_wlan->strInterfaceInfo[i].wilc_netdev);
 754                         return g_linux_wlan->strInterfaceInfo[i].wilc_netdev;
 755                 }
 756         }
 757         PRINT_INFO(INIT_DBG, "\n");
 758         return NULL;
 759 }
 760
 761 int linux_wlan_set_bssid(struct net_device *wilc_netdev, uint8_t *pBSSID)
 762 {
 763         int i = 0;
 764         int ret = -1;
 765
 766         PRINT_D(INIT_DBG, "set bssid on[%p]\n", wilc_netdev);
 767         for (i = 0; i < g_linux_wlan->u8NoIfcs; i++) {
 768                 if (g_linux_wlan->strInterfaceInfo[i].wilc_netdev == wilc_netdev) {
 769                         PRINT_D(INIT_DBG, "set bssid [%x][%x][%x]\n", pBSSID[0], pBSSID[1], pBSSID[2]);
 770                         memcpy(g_linux_wlan->strInterfaceInfo[i].aBSSID, pBSSID, 6);
 771                         ret = 0;
 772                         break;
 773                 }
 774         }
 775         return ret;
 776 }
 777
 778 /*BugID_5213*/
 779 /*Function to get number of connected interfaces*/
 780 int linux_wlan_get_num_conn_ifcs(void)
 781 {
 782         uint8_t i = 0;
 783         uint8_t null_bssid[6] = {0};
 784         uint8_t ret_val = 0;
 785
 786         for (i = 0; i < g_linux_wlan->u8NoIfcs; i++) {
 787                 if (memcmp(g_linux_wlan->strInterfaceInfo[i].aBSSID, null_bssid, 6))
 788                         ret_val++;
 789         }
 790         return ret_val;
 791 }
 792
 793 static int linux_wlan_rxq_task(void *vp)
 794 {
 795
 796         /* inform wilc1000_wlan_init that RXQ task is started. */
 797         linux_wlan_unlock(&g_linux_wlan->rxq_thread_started);
 798         while (1) {
 799                 linux_wlan_lock(&g_linux_wlan->rxq_event);
 800                 /* wait_for_completion(&g_linux_wlan->rxq_event); */
 801
 802                 if (g_linux_wlan->close) {
 803                         /*Unlock the mutex in the mac_close function to indicate the exiting of the RX thread */
 804                         linux_wlan_unlock(&g_linux_wlan->rxq_thread_started);
 805
 806                         while (!kthread_should_stop())
 807                                 schedule();
 808
 809                         PRINT_D(RX_DBG, " RX thread stopped\n");
 810                         break;
 811                 }
 812                 PRINT_D(RX_DBG, "Calling wlan_handle_rx_que()\n");
 813
 814                 g_linux_wlan->oup.wlan_handle_rx_que();
 815         }
 816         return 0;
 817 }
 818
 819 #define USE_TX_BACKOFF_DELAY_IF_NO_BUFFERS
 820
 821 static int linux_wlan_txq_task(void *vp)
 822 {
 823         int ret, txq_count;
 824
 825 #if defined USE_TX_BACKOFF_DELAY_IF_NO_BUFFERS
 826 #define TX_BACKOFF_WEIGHT_INCR_STEP (1)
 827 #define TX_BACKOFF_WEIGHT_DECR_STEP (1)
 828 #define TX_BACKOFF_WEIGHT_MAX (7)
 829 #define TX_BACKOFF_WEIGHT_MIN (0)
 830 #define TX_BACKOFF_WEIGHT_UNIT_MS (10)
 831         int backoff_weight = TX_BACKOFF_WEIGHT_MIN;
 832 #endif
 833
 834         /* inform wilc1000_wlan_init that TXQ task is started. */
 835         linux_wlan_unlock(&g_linux_wlan->txq_thread_started);
 836         while (1) {
 837
 838                 PRINT_D(TX_DBG, "txq_task Taking a nap :)\n");
 839                 linux_wlan_lock(&g_linux_wlan->txq_event);
 840                 /* wait_for_completion(&pd->txq_event); */
 841                 PRINT_D(TX_DBG, "txq_task Who waked me up :$\n");
 842
 843                 if (g_linux_wlan->close) {
 844                         /*Unlock the mutex in the mac_close function to indicate the exiting of the TX thread */
 845                         linux_wlan_unlock(&g_linux_wlan->txq_thread_started);
 846
 847                         while (!kthread_should_stop())
 848                                 schedule();
 849
 850                         PRINT_D(TX_DBG, "TX thread stopped\n");
 851                         break;
 852                 }
 853                 PRINT_D(TX_DBG, "txq_task handle the sending packet and let me go to sleep.\n");
 854 #if !defined USE_TX_BACKOFF_DELAY_IF_NO_BUFFERS
 855                 g_linux_wlan->oup.wlan_handle_tx_que();
 856 #else
 857                 do {
 858                         ret = g_linux_wlan->oup.wlan_handle_tx_que(&txq_count);
 859                         if (txq_count < FLOW_CONTROL_LOWER_THRESHOLD /* && netif_queue_stopped(pd->wilc_netdev)*/) {
 860                                 PRINT_D(TX_DBG, "Waking up queue\n");
 861                                 /* netif_wake_queue(pd->wilc_netdev); */
 862                                 if (netif_queue_stopped(g_linux_wlan->strInterfaceInfo[0].wilc_netdev))
 863                                         netif_wake_queue(g_linux_wlan->strInterfaceInfo[0].wilc_netdev);
 864                                 if (netif_queue_stopped(g_linux_wlan->strInterfaceInfo[1].wilc_netdev))
 865                                         netif_wake_queue(g_linux_wlan->strInterfaceInfo[1].wilc_netdev);
 866                         }
 867
 868                         if (ret == WILC_TX_ERR_NO_BUF) { /* failed to allocate buffers in chip. */
 869                                 do {
 870                                         /* Back off from sending packets for some time. */
 871                                         /* schedule_timeout will allow RX task to run and free buffers.*/
 872                                         /* set_current_state(TASK_UNINTERRUPTIBLE); */
 873                                         /* timeout = schedule_timeout(timeout); */
 874                                         msleep(TX_BACKOFF_WEIGHT_UNIT_MS << backoff_weight);
 875                                 } while (/*timeout*/ 0);
 876                                 backoff_weight += TX_BACKOFF_WEIGHT_INCR_STEP;
 877                                 if (backoff_weight > TX_BACKOFF_WEIGHT_MAX)
 878                                         backoff_weight = TX_BACKOFF_WEIGHT_MAX;
 879                         } else {
 880                                 if (backoff_weight > TX_BACKOFF_WEIGHT_MIN) {
 881                                         backoff_weight -= TX_BACKOFF_WEIGHT_DECR_STEP;
 882                                         if (backoff_weight < TX_BACKOFF_WEIGHT_MIN)
 883                                                 backoff_weight = TX_BACKOFF_WEIGHT_MIN;
 884                                 }
 885                         }
 886                         /*TODO: drop packets after a certain time/number of retry count. */
 887                 } while (ret == WILC_TX_ERR_NO_BUF && !g_linux_wlan->close); /* retry sending packets if no more buffers in chip. */
 888 #endif
 889         }
 890         return 0;
 891 }
 892
 893 static void linux_wlan_rx_complete(void)
 894 {
 895         PRINT_D(RX_DBG, "RX completed\n");
 896 }
 897
 898 int linux_wlan_get_firmware(perInterface_wlan_t *p_nic)
 899 {
 900
 901         perInterface_wlan_t *nic = p_nic;
 902         int ret = 0;
 903         const struct firmware *wilc_firmware;
 904         char *firmware;
 905
 906         if (nic->iftype == AP_MODE)
 907                 firmware = AP_FIRMWARE;
 908         else if (nic->iftype == STATION_MODE)
 909                 firmware = STA_FIRMWARE;
 910
 911         /*BugID_5137*/
 912         else {
 913                 PRINT_D(INIT_DBG, "Get P2P_CONCURRENCY_FIRMWARE\n");
 914                 firmware = P2P_CONCURRENCY_FIRMWARE;
 915         }
 916
 917         if (nic == NULL) {
 918                 PRINT_ER("NIC is NULL\n");
 919                 goto _fail_;
 920         }
 921
 922         if (&nic->wilc_netdev->dev == NULL) {
 923                 PRINT_ER("&nic->wilc_netdev->dev  is NULL\n");
 924                 goto _fail_;
 925         }
 926
 927         /*      the firmare should be located in /lib/firmware in
 928          *      root file system with the name specified above */
 929
 930 #ifdef WILC_SDIO
 931         if (request_firmware(&wilc_firmware, firmware, &g_linux_wlan->wilc_sdio_func->dev) != 0) {
 932                 PRINT_ER("%s - firmare not available\n", firmware);
 933                 ret = -1;
 934                 goto _fail_;
 935         }
 936 #else
 937         if (request_firmware(&wilc_firmware, firmware, &g_linux_wlan->wilc_spidev->dev) != 0) {
 938                 PRINT_ER("%s - firmare not available\n", firmware);
 939                 ret = -1;
 940                 goto _fail_;
 941         }
 942 #endif
 943         g_linux_wlan->wilc_firmware = wilc_firmware; /* Bug 4703 */
 944
 945 _fail_:
 946
 947         return ret;
 948
 949 }
 950
 951 #ifdef COMPLEMENT_BOOT
 952 int repeat_power_cycle(perInterface_wlan_t *nic);
 953 #endif
 954
 955 static int linux_wlan_start_firmware(perInterface_wlan_t *nic)
 956 {
 957
 958         int ret = 0;
 959         /* start firmware */
 960         PRINT_D(INIT_DBG, "Starting Firmware ...\n");
 961         ret = g_linux_wlan->oup.wlan_start();
 962         if (ret < 0) {
 963                 PRINT_ER("Failed to start Firmware\n");
 964                 goto _fail_;
 965         }
 966
 967         /* wait for mac ready */
 968         PRINT_D(INIT_DBG, "Waiting for Firmware to get ready ...\n");
 969         ret = linux_wlan_lock_timeout(&g_linux_wlan->sync_event, 5000);
 970         if (ret) {
 971 #ifdef COMPLEMENT_BOOT
 972                 static int timeout = 5;
 973
 974                 if (timeout--) {
 975                         PRINT_D(INIT_DBG, "repeat power cycle[%d]", timeout);
 976                         ret = repeat_power_cycle(nic);
 977                 } else {
 978                         timeout = 5;
 979                         ret = -1;
 980                         goto _fail_;
 981                 }
 982 #endif
 983                 PRINT_D(INIT_DBG, "Firmware start timed out");
 984                 goto _fail_;
 985         }
 986         /*
 987          *      TODO: Driver shouoldn't wait forever for firmware to get started -
 988          *      in case of timeout this should be handled properly
 989          */
 990         PRINT_D(INIT_DBG, "Firmware successfully started\n");
 991
 992 _fail_:
 993         return ret;
 994 }
 995 static int linux_wlan_firmware_download(linux_wlan_t *p_nic)
 996 {
 997
 998         int ret = 0;
 999
1000         if (g_linux_wlan->wilc_firmware == NULL) {
1001                 PRINT_ER("Firmware buffer is NULL\n");
1002                 ret = -ENOBUFS;
1003                 goto _FAIL_;
1004         }
1005         /**
1006          *      do the firmware download
1007          **/
1008         PRINT_D(INIT_DBG, "Downloading Firmware ...\n");
1009         ret = g_linux_wlan->oup.wlan_firmware_download(g_linux_wlan->wilc_firmware->data, g_linux_wlan->wilc_firmware->size);
1010         if (ret < 0)
1011                 goto _FAIL_;
1012
1013         /* Freeing FW buffer */
1014         PRINT_D(INIT_DBG, "Freeing FW buffer ...\n");
1015         PRINT_D(INIT_DBG, "Releasing firmware\n");
1016         release_firmware(g_linux_wlan->wilc_firmware);
1017         g_linux_wlan->wilc_firmware = NULL;
1018
1019         PRINT_D(INIT_DBG, "Download Succeeded\n");
1020
1021 _FAIL_:
1022         return ret;
1023 }
1024
1025 /* startup configuration - could be changed later using iconfig*/
1026 static int linux_wlan_init_test_config(struct net_device *dev, linux_wlan_t *p_nic)
1027 {
1028
1029         unsigned char c_val[64];
1030         #ifndef STATIC_MACADDRESS
1031         unsigned char mac_add[] = {0x00, 0x80, 0xC2, 0x5E, 0xa2, 0xff};
1032         #endif
1033
1034         /*BugID_5077*/
1035         struct WILC_WFI_priv *priv;
1036         tstrWILC_WFIDrv *pstrWFIDrv;
1037
1038         PRINT_D(TX_DBG, "Start configuring Firmware\n");
1039         #ifndef STATIC_MACADDRESS
1040         get_random_bytes(&mac_add[5], 1);
1041         get_random_bytes(&mac_add[4], 1);
1042         #endif
1043         priv = wiphy_priv(dev->ieee80211_ptr->wiphy);
1044         pstrWFIDrv = (tstrWILC_WFIDrv *)priv->hWILCWFIDrv;
1045         PRINT_D(INIT_DBG, "Host = %p\n", pstrWFIDrv);
1046
1047         PRINT_D(INIT_DBG, "MAC address is : %02x-%02x-%02x-%02x-%02x-%02x\n", mac_add[0], mac_add[1], mac_add[2], mac_add[3], mac_add[4], mac_add[5]);
1048         wilc_get_chipid(0);
1049
1050         if (g_linux_wlan->oup.wlan_cfg_set == NULL) {
1051                 PRINT_D(INIT_DBG, "Null p[ointer\n");
1052                 goto _fail_;
1053         }
1054
1055         *(int *)c_val = (u32)pstrWFIDrv;
1056
1057         if (!g_linux_wlan->oup.wlan_cfg_set(1, WID_SET_DRV_HANDLER, c_val, 4, 0, 0))
1058                 goto _fail_;
1059
1060         /*to tell fw that we are going to use PC test - WILC specific*/
1061         c_val[0] = 0;
1062         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_PC_TEST_MODE, c_val, 1, 0, 0))
1063                 goto _fail_;
1064
1065         c_val[0] = INFRASTRUCTURE;
1066         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_BSS_TYPE, c_val, 1, 0, 0))
1067                 goto _fail_;
1068
1069         /* c_val[0] = RATE_AUTO; / * bug 4275: Enable autorate and limit it to 24Mbps * / */
1070         c_val[0] = RATE_AUTO;
1071         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_CURRENT_TX_RATE, c_val, 1, 0, 0))
1072                 goto _fail_;
1073
1074         c_val[0] = G_MIXED_11B_2_MODE;
1075         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11G_OPERATING_MODE, c_val, 1, 0, 0))
1076                 goto _fail_;
1077
1078         c_val[0] = 1;
1079         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_CURRENT_CHANNEL, c_val, 1, 0, 0))
1080                 goto _fail_;
1081
1082         c_val[0] = G_SHORT_PREAMBLE;
1083         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_PREAMBLE, c_val, 1, 0, 0))
1084                 goto _fail_;
1085
1086         c_val[0] = AUTO_PROT;
1087         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_PROT_MECH, c_val, 1, 0, 0))
1088                 goto _fail_;
1089
1090 #ifdef SWITCH_LOG_TERMINAL
1091         c_val[0] = AUTO_PROT;
1092         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_LOGTerminal_Switch, c_val, 1, 0, 0))
1093                 goto _fail_;
1094 #endif
1095
1096         c_val[0] = ACTIVE_SCAN;
1097         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_SCAN_TYPE, c_val, 1, 0, 0))
1098                 goto _fail_;
1099
1100         c_val[0] = SITE_SURVEY_OFF;
1101         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_SITE_SURVEY, c_val, 1, 0, 0))
1102                 goto _fail_;
1103
1104         *((int *)c_val) = 0xffff; /* Never use RTS-CTS */
1105         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_RTS_THRESHOLD, c_val, 2, 0, 0))
1106                 goto _fail_;
1107
1108         *((int *)c_val) = 2346;
1109         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_FRAG_THRESHOLD, c_val, 2, 0, 0))
1110                 goto _fail_;
1111
1112         /*  SSID                                                                 */
1113         /*  --------------------------------------------------------------       */
1114         /*  Configuration :   String with length less than 32 bytes              */
1115         /*  Values to set :   Any string with length less than 32 bytes          */
1116         /*                    ( In BSS Station Set SSID to "" (null string)      */
1117         /*                      to enable Broadcast SSID suppport )              */
1118         /*  --------------------------------------------------------------       */
1119 #ifndef USE_WIRELESS
1120         strcpy(c_val, "nwifi");
1121         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_SSID, c_val, (strlen(c_val) + 1), 0, 0))
1122                 goto _fail_;
1123 #endif
1124
1125         c_val[0] = 0;
1126         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_BCAST_SSID, c_val, 1, 0, 0))
1127                 goto _fail_;
1128
1129         c_val[0] = 1;
1130         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_QOS_ENABLE, c_val, 1, 0, 0))
1131                 goto _fail_;
1132
1133         c_val[0] = NO_POWERSAVE;
1134         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_POWER_MANAGEMENT, c_val, 1, 0, 0))
1135                 goto _fail_;
1136
1137         c_val[0] = NO_ENCRYPT; /* NO_ENCRYPT, 0x79 */
1138         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11I_MODE, c_val, 1, 0, 0))
1139                 goto _fail_;
1140
1141         c_val[0] = OPEN_SYSTEM;
1142         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_AUTH_TYPE, c_val, 1, 0, 0))
1143                 goto _fail_;
1144
1145         /*  WEP/802 11I Configuration                                            */
1146         /*  ------------------------------------------------------------------   */
1147         /*  Configuration : WEP Key                                              */
1148         /*  Values (0x)   : 5 byte for WEP40 and 13 bytes for WEP104             */
1149         /*                  In case more than 5 bytes are passed on for WEP 40   */
1150         /*                  only first 5 bytes will be used as the key           */
1151         /*  ------------------------------------------------------------------   */
1152
1153         strcpy(c_val, "123456790abcdef1234567890");
1154         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_WEP_KEY_VALUE, c_val, (strlen(c_val) + 1), 0, 0))
1155                 goto _fail_;
1156
1157         /*  WEP/802 11I Configuration                                            */
1158         /*  ------------------------------------------------------------------   */
1159         /*  Configuration : AES/TKIP WPA/RSNA Pre-Shared Key                     */
1160         /*  Values to set : Any string with length greater than equal to 8 bytes */
1161         /*                  and less than 64 bytes                               */
1162         /*  ------------------------------------------------------------------   */
1163         strcpy(c_val, "12345678");
1164         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11I_PSK, c_val, (strlen(c_val)), 0, 0))
1165                 goto _fail_;
1166
1167         /*  IEEE802.1X Key Configuration                                         */
1168         /*  ------------------------------------------------------------------   */
1169         /*  Configuration : Radius Server Access Secret Key                      */
1170         /*  Values to set : Any string with length greater than equal to 8 bytes */
1171         /*                  and less than 65 bytes                               */
1172         /*  ------------------------------------------------------------------   */
1173         strcpy(c_val, "password");
1174         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_1X_KEY, c_val, (strlen(c_val) + 1), 0, 0))
1175                 goto _fail_;
1176
1177         /*   IEEE802.1X Server Address Configuration                             */
1178         /*  ------------------------------------------------------------------   */
1179         /*  Configuration : Radius Server IP Address                             */
1180         /*  Values to set : Any valid IP Address                                 */
1181         /*  ------------------------------------------------------------------   */
1182         c_val[0] = 192;
1183         c_val[1] = 168;
1184         c_val[2] = 1;
1185         c_val[3] = 112;
1186         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_1X_SERV_ADDR, c_val, 4, 0, 0))
1187                 goto _fail_;
1188
1189         c_val[0] = 3;
1190         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_LISTEN_INTERVAL, c_val, 1, 0, 0))
1191                 goto _fail_;
1192
1193         c_val[0] = 3;
1194         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_DTIM_PERIOD, c_val, 1, 0, 0))
1195                 goto _fail_;
1196
1197         c_val[0] = NORMAL_ACK;
1198         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_ACK_POLICY, c_val, 1, 0, 0))
1199                 goto _fail_;
1200
1201         c_val[0] = 0;
1202         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_USER_CONTROL_ON_TX_POWER, c_val, 1, 0, 0))
1203                 goto _fail_;
1204
1205         c_val[0] = 48;
1206         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_TX_POWER_LEVEL_11A, c_val, 1, 0, 0))
1207                 goto _fail_;
1208
1209         c_val[0] = 28;
1210         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_TX_POWER_LEVEL_11B, c_val, 1, 0, 0))
1211                 goto _fail_;
1212
1213         /*  Beacon Interval                                                      */
1214         /*  -------------------------------------------------------------------- */
1215         /*  Configuration : Sets the beacon interval value                       */
1216         /*  Values to set : Any 16-bit value                                     */
1217         /*  -------------------------------------------------------------------- */
1218
1219         *((int *)c_val) = 100;
1220         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_BEACON_INTERVAL, c_val, 2, 0, 0))
1221                 goto _fail_;
1222
1223         c_val[0] = REKEY_DISABLE;
1224         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_REKEY_POLICY, c_val, 1, 0, 0))
1225                 goto _fail_;
1226
1227         /*  Rekey Time (s) (Used only when the Rekey policy is 2 or 4)           */
1228         /*  -------------------------------------------------------------------- */
1229         /*  Configuration : Sets the Rekey Time (s)                              */
1230         /*  Values to set : 32-bit value                                         */
1231         /*  -------------------------------------------------------------------- */
1232         *((int *)c_val) = 84600;
1233         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_REKEY_PERIOD, c_val, 4, 0, 0))
1234                 goto _fail_;
1235
1236         /*  Rekey Packet Count (in 1000s; used when Rekey Policy is 3)           */
1237         /*  -------------------------------------------------------------------- */
1238         /*  Configuration : Sets Rekey Group Packet count                        */
1239         /*  Values to set : 32-bit Value                                         */
1240         /*  -------------------------------------------------------------------- */
1241         *((int *)c_val) = 500;
1242         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_REKEY_PACKET_COUNT, c_val, 4, 0, 0))
1243                 goto _fail_;
1244
1245         c_val[0] = 1;
1246         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_SHORT_SLOT_ALLOWED, c_val, 1, 0, 0))
1247                 goto _fail_;
1248
1249         c_val[0] = G_SELF_CTS_PROT;
1250         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_ERP_PROT_TYPE, c_val, 1, 0, 0))
1251                 goto _fail_;
1252
1253         c_val[0] = 1;  /* Enable N */
1254         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_ENABLE, c_val, 1, 0, 0))
1255                 goto _fail_;
1256
1257         c_val[0] = HT_MIXED_MODE;
1258         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_OPERATING_MODE, c_val, 1, 0, 0))
1259                 goto _fail_;
1260
1261         c_val[0] = 1;   /* TXOP Prot disable in N mode: No RTS-CTS on TX A-MPDUs to save air-time. */
1262         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_TXOP_PROT_DISABLE, c_val, 1, 0, 0))
1263                 goto _fail_;
1264
1265         memcpy(c_val, mac_add, 6);
1266
1267         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_MAC_ADDR, c_val, 6, 0, 0))
1268                 goto _fail_;
1269
1270         /**
1271          *      AP only
1272          **/
1273         c_val[0] = DETECT_PROTECT_REPORT;
1274         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_OBSS_NONHT_DETECTION, c_val, 1, 0, 0))
1275                 goto _fail_;
1276
1277         c_val[0] = RTS_CTS_NONHT_PROT;
1278         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_HT_PROT_TYPE, c_val, 1, 0, 0))
1279                 goto _fail_;
1280
1281         c_val[0] = 0;
1282         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_RIFS_PROT_ENABLE, c_val, 1, 0, 0))
1283                 goto _fail_;
1284
1285         c_val[0] = MIMO_MODE;
1286         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_SMPS_MODE, c_val, 1, 0, 0))
1287                 goto _fail_;
1288
1289         c_val[0] = 7;
1290         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_CURRENT_TX_MCS, c_val, 1, 0, 0))
1291                 goto _fail_;
1292
1293         c_val[0] = 1; /* Enable N with immediate block ack. */
1294         if (!g_linux_wlan->oup.wlan_cfg_set(0, WID_11N_IMMEDIATE_BA_ENABLED, c_val, 1, 1, (u32)pstrWFIDrv))
1295                 goto _fail_;
1296
1297         return 0;
1298
1299 _fail_:
1300         return -1;
1301 }
1302
1303 /**************************/
1304 void wilc1000_wlan_deinit(linux_wlan_t *nic)
1305 {
1306
1307         if (g_linux_wlan->wilc1000_initialized) {
1308
1309                 printk("Deinitializing wilc1000  ...\n");
1310
1311                 if (nic == NULL) {
1312                         PRINT_ER("nic is NULL\n");
1313                         return;
1314                 }
1315
1316 #if defined(PLAT_ALLWINNER_A20) || defined(PLAT_ALLWINNER_A23) || defined(PLAT_ALLWINNER_A31)
1317                 /* johnny : remove */
1318                 PRINT_D(INIT_DBG, "skip wilc_bus_set_default_speed\n");
1319 #else
1320                 wilc_bus_set_default_speed();
1321 #endif
1322
1323                 PRINT_D(INIT_DBG, "Disabling IRQ\n");
1324                 #if (!defined WILC_SDIO) || (defined WILC_SDIO_IRQ_GPIO)
1325                 linux_wlan_disable_irq(IRQ_WAIT);
1326                 #else
1327                   #if defined(PLAT_ALLWINNER_A20) || defined(PLAT_ALLWINNER_A23) || defined(PLAT_ALLWINNER_A31)
1328
1329                   #else
1330                 linux_wlan_lock_mutex((void *)&g_linux_wlan->hif_cs);
1331                 disable_sdio_interrupt();
1332                 linux_wlan_unlock_mutex((void *)&g_linux_wlan->hif_cs);
1333                   #endif
1334                 #endif
1335
1336                 /* not sure if the following unlocks are needed or not*/
1337                 if (&g_linux_wlan->rxq_event != NULL)
1338                         linux_wlan_unlock(&g_linux_wlan->rxq_event);
1339
1340                 if (&g_linux_wlan->txq_event != NULL)
1341                         linux_wlan_unlock(&g_linux_wlan->txq_event);
1342
1343         #if (RX_BH_TYPE == RX_BH_WORK_QUEUE)
1344                 /*Removing the work struct from the linux kernel workqueue*/
1345                 if (&g_linux_wlan->rx_work_queue != NULL)
1346                         flush_work(&g_linux_wlan->rx_work_queue);
1347
1348         #elif (RX_BH_TYPE == RX_BH_KTHREAD)
1349                 /* if(&nic->rx_sem != NULL) */
1350                 /* linux_wlan_unlock(&nic->rx_sem); */
1351         #endif
1352
1353                 PRINT_D(INIT_DBG, "Deinitializing Threads\n");
1354                 wlan_deinitialize_threads(nic);
1355
1356                 PRINT_D(INIT_DBG, "Deinitializing IRQ\n");
1357                 deinit_irq(g_linux_wlan);
1358
1359                 if (&g_linux_wlan->oup != NULL) {
1360                         if (g_linux_wlan->oup.wlan_stop != NULL)
1361                                 g_linux_wlan->oup.wlan_stop();
1362                 }
1363
1364                 PRINT_D(INIT_DBG, "Deinitializing WILC Wlan\n");
1365                 wilc_wlan_deinit(nic);
1366 #if (defined WILC_SDIO) && (!defined WILC_SDIO_IRQ_GPIO)
1367   #if defined(PLAT_ALLWINNER_A20) || defined(PLAT_ALLWINNER_A23) || defined(PLAT_ALLWINNER_A31)
1368                 PRINT_D(INIT_DBG, "Disabling IRQ 2\n");
1369
1370                 linux_wlan_lock_mutex((void *)&g_linux_wlan->hif_cs);
1371                 disable_sdio_interrupt();
1372                 linux_wlan_unlock_mutex((void *)&g_linux_wlan->hif_cs);
1373   #endif
1374 #endif
1375
1376                 /*De-Initialize locks*/
1377                 PRINT_D(INIT_DBG, "Deinitializing Locks\n");
1378                 wlan_deinit_locks(g_linux_wlan);
1379
1380                 /* announce that wilc1000 is not initialized */
1381                 g_linux_wlan->wilc1000_initialized = 0;
1382
1383                 PRINT_D(INIT_DBG, "wilc1000 deinitialization Done\n");
1384
1385         } else {
1386                 PRINT_D(INIT_DBG, "wilc1000 is not initialized\n");
1387         }
1388 }
1389
1390 int wlan_init_locks(linux_wlan_t *p_nic)
1391 {
1392
1393         PRINT_D(INIT_DBG, "Initializing Locks ...\n");
1394
1395         /*initialize mutexes*/
1396         linux_wlan_init_mutex("hif_lock/hif_cs", &g_linux_wlan->hif_cs, 1);
1397         linux_wlan_init_mutex("rxq_lock/rxq_cs", &g_linux_wlan->rxq_cs, 1);
1398         linux_wlan_init_mutex("txq_lock/txq_cs", &g_linux_wlan->txq_cs, 1);
1399
1400         /*Added by Amr - BugID_4720*/
1401         linux_wlan_init_spin_lock("txq_spin_lock/txq_cs", &g_linux_wlan->txq_spinlock, 1);
1402
1403         /*Added by Amr - BugID_4720*/
1404         linux_wlan_init_lock("txq_add_to_head_lock/txq_cs", &g_linux_wlan->txq_add_to_head_cs, 1);
1405
1406         linux_wlan_init_lock("txq_wait/txq_event", &g_linux_wlan->txq_event, 0);
1407         linux_wlan_init_lock("rxq_wait/rxq_event", &g_linux_wlan->rxq_event, 0);
1408
1409         linux_wlan_init_lock("cfg_wait/cfg_event", &g_linux_wlan->cfg_event, 0);
1410         linux_wlan_init_lock("sync_event", &g_linux_wlan->sync_event, 0);
1411
1412         linux_wlan_init_lock("rxq_lock/rxq_started", &g_linux_wlan->rxq_thread_started, 0);
1413         linux_wlan_init_lock("rxq_lock/txq_started", &g_linux_wlan->txq_thread_started, 0);
1414
1415         #if (RX_BH_TYPE == RX_BH_KTHREAD)
1416         linux_wlan_init_lock("BH_SEM", &g_linux_wlan->rx_sem, 0);
1417         #endif
1418
1419         return 0;
1420 }
1421
1422 static int wlan_deinit_locks(linux_wlan_t *nic)
1423 {
1424         PRINT_D(INIT_DBG, "De-Initializing Locks\n");
1425
1426         if (&g_linux_wlan->hif_cs != NULL)
1427                 linux_wlan_deinit_mutex(&g_linux_wlan->hif_cs);
1428
1429         if (&g_linux_wlan->rxq_cs != NULL)
1430                 linux_wlan_deinit_mutex(&g_linux_wlan->rxq_cs);
1431
1432         if (&g_linux_wlan->txq_cs != NULL)
1433                 linux_wlan_deinit_mutex(&g_linux_wlan->txq_cs);
1434
1435         /*Added by Amr - BugID_4720*/
1436         if (&g_linux_wlan->txq_spinlock != NULL)
1437                 linux_wlan_deinit_spin_lock(&g_linux_wlan->txq_spinlock);
1438
1439         if (&g_linux_wlan->rxq_event != NULL)
1440                 linux_wlan_deinit_lock(&g_linux_wlan->rxq_event);
1441
1442         if (&g_linux_wlan->txq_event != NULL)
1443                 linux_wlan_deinit_lock(&g_linux_wlan->txq_event);
1444
1445         /*Added by Amr - BugID_4720*/
1446         if (&g_linux_wlan->txq_add_to_head_cs != NULL)
1447                 linux_wlan_deinit_lock(&g_linux_wlan->txq_add_to_head_cs);
1448
1449         if (&g_linux_wlan->rxq_thread_started != NULL)
1450                 linux_wlan_deinit_lock(&g_linux_wlan->rxq_thread_started);
1451
1452         if (&g_linux_wlan->txq_thread_started != NULL)
1453                 linux_wlan_deinit_lock(&g_linux_wlan->txq_thread_started);
1454
1455         if (&g_linux_wlan->cfg_event != NULL)
1456                 linux_wlan_deinit_lock(&g_linux_wlan->cfg_event);
1457
1458         if (&g_linux_wlan->sync_event != NULL)
1459                 linux_wlan_deinit_lock(&g_linux_wlan->sync_event);
1460
1461         return 0;
1462 }
1463 void linux_to_wlan(wilc_wlan_inp_t *nwi, linux_wlan_t *nic)
1464 {
1465
1466         PRINT_D(INIT_DBG, "Linux to Wlan services ...\n");
1467
1468         nwi->os_context.hif_critical_section = (void *)&g_linux_wlan->hif_cs;
1469         nwi->os_context.os_private = (void *)nic;
1470         nwi->os_context.tx_buffer_size = LINUX_TX_SIZE;
1471         nwi->os_context.txq_critical_section = (void *)&g_linux_wlan->txq_cs;
1472
1473         /*Added by Amr - BugID_4720*/
1474         nwi->os_context.txq_add_to_head_critical_section = (void *)&g_linux_wlan->txq_add_to_head_cs;
1475
1476         /*Added by Amr - BugID_4720*/
1477         nwi->os_context.txq_spin_lock = (void *)&g_linux_wlan->txq_spinlock;
1478
1479         nwi->os_context.txq_wait_event = (void *)&g_linux_wlan->txq_event;
1480
1481 #if defined(MEMORY_STATIC)
1482         nwi->os_context.rx_buffer_size = LINUX_RX_SIZE;
1483 #endif
1484         nwi->os_context.rxq_critical_section = (void *)&g_linux_wlan->rxq_cs;
1485         nwi->os_context.rxq_wait_event = (void *)&g_linux_wlan->rxq_event;
1486         nwi->os_context.cfg_wait_event = (void *)&g_linux_wlan->cfg_event;
1487
1488         nwi->os_func.os_sleep = linux_wlan_msleep;
1489         nwi->os_func.os_atomic_sleep = linux_wlan_atomic_msleep;
1490         nwi->os_func.os_debug = linux_wlan_dbg;
1491         nwi->os_func.os_malloc = linux_wlan_malloc;
1492         nwi->os_func.os_malloc_atomic = linux_wlan_malloc_atomic;
1493         nwi->os_func.os_free = linux_wlan_free;
1494         nwi->os_func.os_lock = linux_wlan_lock;
1495         nwi->os_func.os_unlock = linux_wlan_unlock;
1496         nwi->os_func.os_wait = linux_wlan_lock_timeout;
1497         nwi->os_func.os_signal = linux_wlan_unlock;
1498         nwi->os_func.os_enter_cs = linux_wlan_lock_mutex;
1499         nwi->os_func.os_leave_cs = linux_wlan_unlock_mutex;
1500
1501         /*Added by Amr - BugID_4720*/
1502         nwi->os_func.os_spin_lock = linux_wlan_spin_lock;
1503         nwi->os_func.os_spin_unlock = linux_wlan_spin_unlock;
1504
1505 #ifdef WILC_SDIO
1506         nwi->io_func.io_type = HIF_SDIO;
1507         nwi->io_func.io_init = linux_sdio_init;
1508         nwi->io_func.io_deinit = linux_sdio_deinit;
1509         nwi->io_func.u.sdio.sdio_cmd52 = linux_sdio_cmd52;
1510         nwi->io_func.u.sdio.sdio_cmd53 = linux_sdio_cmd53;
1511         nwi->io_func.u.sdio.sdio_set_max_speed = linux_sdio_set_max_speed;
1512         nwi->io_func.u.sdio.sdio_set_default_speed = linux_sdio_set_default_speed;
1513 #else
1514         nwi->io_func.io_type = HIF_SPI;
1515         nwi->io_func.io_init = linux_spi_init;
1516         nwi->io_func.io_deinit = linux_spi_deinit;
1517         nwi->io_func.u.spi.spi_tx = linux_spi_write;
1518         nwi->io_func.u.spi.spi_rx = linux_spi_read;
1519         nwi->io_func.u.spi.spi_trx = linux_spi_write_read;
1520         nwi->io_func.u.spi.spi_max_speed = linux_spi_set_max_speed;
1521 #endif
1522
1523         /*for now - to be revised*/
1524         #ifdef WILC_FULLY_HOSTING_AP
1525         /* incase of Fully hosted AP, all non cfg pkts are processed here*/
1526         nwi->net_func.rx_indicate = WILC_Process_rx_frame;
1527         #else
1528         nwi->net_func.rx_indicate = frmw_to_linux;
1529         #endif
1530         nwi->net_func.rx_complete = linux_wlan_rx_complete;
1531         nwi->indicate_func.mac_indicate = linux_wlan_mac_indicate;
1532 }
1533
1534 int wlan_initialize_threads(perInterface_wlan_t *nic)
1535 {
1536
1537         int ret = 0;
1538         PRINT_D(INIT_DBG, "Initializing Threads ...\n");
1539
1540 #if (RX_BH_TYPE == RX_BH_WORK_QUEUE)
1541         /*Initialize rx work queue task*/
1542         INIT_WORK(&g_linux_wlan->rx_work_queue, isr_bh_routine);
1543 #elif (RX_BH_TYPE == RX_BH_KTHREAD)
1544         PRINT_D(INIT_DBG, "Creating kthread for Rxq BH\n");
1545         g_linux_wlan->rx_bh_thread = kthread_run(isr_bh_routine, (void *)g_linux_wlan, "K_RXQ_BH");
1546         if (g_linux_wlan->rx_bh_thread == 0) {
1547                 PRINT_ER("couldn't create RX BH thread\n");
1548                 ret = -ENOBUFS;
1549                 goto _fail_;
1550         }
1551 #endif
1552
1553 #ifndef TCP_ENHANCEMENTS
1554         /* create rx task */
1555         PRINT_D(INIT_DBG, "Creating kthread for reception\n");
1556         g_linux_wlan->rxq_thread = kthread_run(linux_wlan_rxq_task, (void *)g_linux_wlan, "K_RXQ_TASK");
1557         if (g_linux_wlan->rxq_thread == 0) {
1558                 PRINT_ER("couldn't create RXQ thread\n");
1559                 ret = -ENOBUFS;
1560                 goto _fail_1;
1561         }
1562
1563         /* wait for RXQ task to start. */
1564         linux_wlan_lock(&g_linux_wlan->rxq_thread_started);
1565
1566 #endif
1567
1568         /* create tx task */
1569         PRINT_D(INIT_DBG, "Creating kthread for transmission\n");
1570         g_linux_wlan->txq_thread = kthread_run(linux_wlan_txq_task, (void *)g_linux_wlan, "K_TXQ_TASK");
1571         if (g_linux_wlan->txq_thread == 0) {
1572                 PRINT_ER("couldn't create TXQ thread\n");
1573                 ret = -ENOBUFS;
1574                 goto _fail_2;
1575         }
1576 #ifdef DEBUG_MODE
1577         PRINT_D(INIT_DBG, "Creating kthread for Debugging\n");
1578         g_linux_wlan->txq_thread = kthread_run(DebuggingThreadTask, (void *)g_linux_wlan, "DebugThread");
1579         if (g_linux_wlan->txq_thread == 0) {
1580                 PRINT_ER("couldn't create TXQ thread\n");
1581                 ret = -ENOBUFS;
1582                 goto _fail_2;
1583         }
1584 #endif
1585         /* wait for TXQ task to start. */
1586         linux_wlan_lock(&g_linux_wlan->txq_thread_started);
1587
1588         return 0;
1589
1590 _fail_2:
1591         /*De-Initialize 2nd thread*/
1592         g_linux_wlan->close = 1;
1593         linux_wlan_unlock(&g_linux_wlan->rxq_event);
1594         kthread_stop(g_linux_wlan->rxq_thread);
1595
1596 #ifndef TCP_ENHANCEMENTS
1597 _fail_1:
1598 #endif
1599         #if (RX_BH_TYPE == RX_BH_KTHREAD)
1600         /*De-Initialize 1st thread*/
1601         g_linux_wlan->close = 1;
1602         linux_wlan_unlock(&g_linux_wlan->rx_sem);
1603         kthread_stop(g_linux_wlan->rx_bh_thread);
1604 _fail_:
1605         #endif
1606         g_linux_wlan->close = 0;
1607         return ret;
1608 }
1609
1610 static void wlan_deinitialize_threads(linux_wlan_t *nic)
1611 {
1612
1613         g_linux_wlan->close = 1;
1614         PRINT_D(INIT_DBG, "Deinitializing Threads\n");
1615         if (&g_linux_wlan->rxq_event != NULL)
1616                 linux_wlan_unlock(&g_linux_wlan->rxq_event);
1617
1618         if (g_linux_wlan->rxq_thread != NULL) {
1619                 kthread_stop(g_linux_wlan->rxq_thread);
1620                 g_linux_wlan->rxq_thread = NULL;
1621         }
1622
1623         if (&g_linux_wlan->txq_event != NULL)
1624                 linux_wlan_unlock(&g_linux_wlan->txq_event);
1625
1626         if (g_linux_wlan->txq_thread != NULL) {
1627                 kthread_stop(g_linux_wlan->txq_thread);
1628                 g_linux_wlan->txq_thread = NULL;
1629         }
1630
1631         #if (RX_BH_TYPE == RX_BH_KTHREAD)
1632         if (&g_linux_wlan->rx_sem != NULL)
1633                 linux_wlan_unlock(&g_linux_wlan->rx_sem);
1634
1635         if (g_linux_wlan->rx_bh_thread != NULL) {
1636                 kthread_stop(g_linux_wlan->rx_bh_thread);
1637                 g_linux_wlan->rx_bh_thread = NULL;
1638         }
1639         #endif
1640 }
1641
1642 #ifdef STATIC_MACADDRESS
1643 const char *path_string[] = {
1644         "/etc/wlan",
1645         "/data/wlan",
1646 };
1647
1648 static int linux_wlan_read_mac_addr(void *vp)
1649 {
1650         int ret = 0;
1651         struct file *fp = (struct file *)-ENOENT;
1652         mm_segment_t old_fs;
1653         loff_t pos = 0;
1654         int index;
1655         int array_size = ARRAY_SIZE(path_string);
1656
1657         /* change to KERNEL_DS address limit */
1658         old_fs = get_fs();
1659         set_fs(KERNEL_DS);
1660
1661         for (index = 0; index < array_size; index++) {
1662                 fp = filp_open(path_string[index], O_WRONLY, 0640);
1663                 if (!fp) {
1664                         ret = -1;
1665                         goto exit;
1666                 }
1667
1668                 /*No such file or directory */
1669                 if (IS_ERR(fp) || !fp->f_op) {
1670                         get_random_bytes(&mac_add[3], 3);
1671                         /* open file to write */
1672                         fp = filp_open(path_string[index], O_WRONLY | O_CREAT, 0640);
1673
1674                         if (!fp || IS_ERR(fp)) {
1675                                 ret = -1;
1676                                 continue;
1677                         } else {
1678                                 /* write buf to file */
1679                                 fp->f_op->write(fp, mac_add, 6, &pos);
1680                                 break;
1681                         }
1682                 } else {
1683                         /* read file to buf */
1684                         fp->f_op->read(fp, mac_add, 6, &pos);
1685                         break;
1686                 }
1687         }
1688
1689         if (index == array_size)
1690                 PRINT_ER("random MAC\n");
1691
1692 exit:
1693         if (fp && !IS_ERR(fp))
1694                 filp_close(fp, NULL);
1695
1696         set_fs(old_fs);
1697
1698         return ret;
1699 }
1700 #endif
1701
1702 #ifdef COMPLEMENT_BOOT
1703
1704 extern volatile int probe;
1705 extern uint8_t core_11b_ready(void);
1706
1707 #define READY_CHECK_THRESHOLD           30
1708 extern void wilc_wlan_global_reset(void);
1709 uint8_t wilc1000_prepare_11b_core(wilc_wlan_inp_t *nwi, wilc_wlan_oup_t *nwo, linux_wlan_t *nic)
1710 {
1711         uint8_t trials = 0;
1712         while ((core_11b_ready() && (READY_CHECK_THRESHOLD > (trials++)))) {
1713                 PRINT_D(INIT_DBG, "11b core not ready yet: %u\n", trials);
1714                 wilc_wlan_deinit(nic);
1715                 wilc_wlan_global_reset();
1716                 sdio_unregister_driver(&wilc_bus);
1717
1718                 linux_wlan_device_detection(0);
1719
1720                 mdelay(100);
1721
1722                 linux_wlan_device_detection(1);
1723
1724                 sdio_register_driver(&wilc_bus);
1725
1726                 while (!probe)
1727                         msleep(100);
1728                 probe = 0;
1729                 g_linux_wlan->wilc_sdio_func = local_sdio_func;
1730                 linux_to_wlan(nwi, nic);
1731                 wilc_wlan_init(nwi, nwo);
1732         }
1733
1734         if (READY_CHECK_THRESHOLD <= trials)
1735                 return 1;
1736         else
1737                 return 0;
1738
1739 }
1740
1741 int repeat_power_cycle(perInterface_wlan_t *nic)
1742 {
1743         int ret = 0;
1744         wilc_wlan_inp_t nwi;
1745         wilc_wlan_oup_t nwo;
1746         sdio_unregister_driver(&wilc_bus);
1747
1748         linux_wlan_device_detection(0);
1749         linux_wlan_device_power(0);
1750         msleep(100);
1751         linux_wlan_device_power(1);
1752         msleep(80);
1753         linux_wlan_device_detection(1);
1754         msleep(20);
1755
1756         sdio_register_driver(&wilc_bus);
1757
1758         /* msleep(1000); */
1759         while (!probe)
1760                 msleep(100);
1761         probe = 0;
1762         g_linux_wlan->wilc_sdio_func = local_sdio_func;
1763         linux_to_wlan(&nwi, g_linux_wlan);
1764         ret = wilc_wlan_init(&nwi, &nwo);
1765
1766         g_linux_wlan->mac_status = WILC_MAC_STATUS_INIT;
1767         #if (defined WILC_SDIO) && (!defined WILC_SDIO_IRQ_GPIO)
1768         enable_sdio_interrupt();
1769         #endif
1770
1771         if (linux_wlan_get_firmware(nic)) {
1772                 PRINT_ER("Can't get firmware\n");
1773                 ret = -1;
1774                 goto __fail__;
1775         }
1776
1777         /*Download firmware*/
1778         ret = linux_wlan_firmware_download(g_linux_wlan);
1779         if (ret < 0) {
1780                 PRINT_ER("Failed to download firmware\n");
1781                 goto __fail__;
1782         }
1783         /* Start firmware*/
1784         ret = linux_wlan_start_firmware(nic);
1785         if (ret < 0)
1786                 PRINT_ER("Failed to start firmware\n");
1787 __fail__:
1788         return ret;
1789 }
1790 #endif
1791
1792 int wilc1000_wlan_init(struct net_device *dev, perInterface_wlan_t *p_nic)
1793 {
1794         wilc_wlan_inp_t nwi;
1795         wilc_wlan_oup_t nwo;
1796         perInterface_wlan_t *nic = p_nic;
1797         int ret = 0;
1798
1799         if (!g_linux_wlan->wilc1000_initialized) {
1800                 g_linux_wlan->mac_status = WILC_MAC_STATUS_INIT;
1801                 g_linux_wlan->close = 0;
1802                 g_linux_wlan->wilc1000_initialized = 0;
1803
1804                 wlan_init_locks(g_linux_wlan);
1805
1806 #ifdef STATIC_MACADDRESS
1807                 wilc_mac_thread = kthread_run(linux_wlan_read_mac_addr, NULL, "wilc_mac_thread");
1808                 if (wilc_mac_thread < 0)
1809                         PRINT_ER("couldn't create Mac addr thread\n");
1810 #endif
1811
1812                 linux_to_wlan(&nwi, g_linux_wlan);
1813
1814                 ret = wilc_wlan_init(&nwi, &nwo);
1815                 if (ret < 0) {
1816                         PRINT_ER("Initializing WILC_Wlan FAILED\n");
1817                         ret = -EIO;
1818                         goto _fail_locks_;
1819                 }
1820                 memcpy(&g_linux_wlan->oup, &nwo, sizeof(wilc_wlan_oup_t));
1821
1822                 /*Save the oup structre into global pointer*/
1823                 gpstrWlanOps = &g_linux_wlan->oup;
1824
1825                 ret = wlan_initialize_threads(nic);
1826                 if (ret < 0) {
1827                         PRINT_ER("Initializing Threads FAILED\n");
1828                         ret = -EIO;
1829                         goto _fail_wilc_wlan_;
1830                 }
1831
1832 #if (defined WILC_SDIO) && (defined COMPLEMENT_BOOT)
1833                 if (wilc1000_prepare_11b_core(&nwi, &nwo, g_linux_wlan)) {
1834                         PRINT_ER("11b Core is not ready\n");
1835                         ret = -EIO;
1836                         goto _fail_threads_;
1837                 }
1838 #endif
1839
1840 #if (!defined WILC_SDIO) || (defined WILC_SDIO_IRQ_GPIO)
1841                 if (init_irq(g_linux_wlan)) {
1842                         PRINT_ER("couldn't initialize IRQ\n");
1843                         ret = -EIO;
1844                         goto _fail_threads_;
1845                 }
1846 #endif
1847
1848 #if (defined WILC_SDIO) && (!defined WILC_SDIO_IRQ_GPIO)
1849                 if (enable_sdio_interrupt()) {
1850                         PRINT_ER("couldn't initialize IRQ\n");
1851                         ret = -EIO;
1852                         goto _fail_irq_init_;
1853                 }
1854 #endif
1855
1856                 if (linux_wlan_get_firmware(nic)) {
1857                         PRINT_ER("Can't get firmware\n");
1858                         ret = -EIO;
1859                         goto _fail_irq_enable_;
1860                 }
1861
1862                 /*Download firmware*/
1863                 ret = linux_wlan_firmware_download(g_linux_wlan);
1864                 if (ret < 0) {
1865                         PRINT_ER("Failed to download firmware\n");
1866                         ret = -EIO;
1867                         goto _fail_irq_enable_;
1868                 }
1869
1870                 /* Start firmware*/
1871                 ret = linux_wlan_start_firmware(nic);
1872                 if (ret < 0) {
1873                         PRINT_ER("Failed to start firmware\n");
1874                         ret = -EIO;
1875                         goto _fail_irq_enable_;
1876                 }
1877
1878                 wilc_bus_set_max_speed();
1879
1880                 if (g_linux_wlan->oup.wlan_cfg_get(1, WID_FIRMWARE_VERSION, 1, 0)) {
1881                         int size;
1882                         char Firmware_ver[20];
1883                         size = g_linux_wlan->oup.wlan_cfg_get_value(
1884                                         WID_FIRMWARE_VERSION,
1885                                         Firmware_ver, sizeof(Firmware_ver));
1886                         Firmware_ver[size] = '\0';
1887                         PRINT_D(INIT_DBG, "***** Firmware Ver = %s  *******\n", Firmware_ver);
1888                 }
1889                 /* Initialize firmware with default configuration */
1890                 ret = linux_wlan_init_test_config(dev, g_linux_wlan);
1891
1892                 if (ret < 0) {
1893                         PRINT_ER("Failed to configure firmware\n");
1894                         ret = -EIO;
1895                         goto _fail_fw_start_;
1896                 }
1897
1898                 g_linux_wlan->wilc1000_initialized = 1;
1899                 return 0; /*success*/
1900
1901 _fail_fw_start_:
1902                 if (&g_linux_wlan->oup != NULL) {
1903                         if (g_linux_wlan->oup.wlan_stop != NULL)
1904                                 g_linux_wlan->oup.wlan_stop();
1905                 }
1906
1907 _fail_irq_enable_:
1908 #if (defined WILC_SDIO) && (!defined WILC_SDIO_IRQ_GPIO)
1909                 disable_sdio_interrupt();
1910 _fail_irq_init_:
1911 #endif
1912 #if (!defined WILC_SDIO) || (defined WILC_SDIO_IRQ_GPIO)
1913                 deinit_irq(g_linux_wlan);
1914
1915 #endif
1916 _fail_threads_:
1917                 wlan_deinitialize_threads(g_linux_wlan);
1918 _fail_wilc_wlan_:
1919                 wilc_wlan_deinit(g_linux_wlan);
1920 _fail_locks_:
1921                 wlan_deinit_locks(g_linux_wlan);
1922                 PRINT_ER("WLAN Iinitialization FAILED\n");
1923         } else {
1924                 PRINT_D(INIT_DBG, "wilc1000 already initialized\n");
1925         }
1926         return ret;
1927 }
1928
1929 /*
1930  *      - this function will be called automatically by OS when module inserted.
1931  */
1932
1933 #if !defined(NM73131_0_BOARD)
1934 int mac_init_fn(struct net_device *ndev)
1935 {
1936
1937         /*Why we do this !!!*/
1938         netif_start_queue(ndev); /* ma */
1939         netif_stop_queue(ndev); /* ma */
1940
1941         return 0;
1942 }
1943 #else
1944 int mac_init_fn(struct net_device *ndev)
1945 {
1946
1947         unsigned char mac_add[] = {0x00, 0x50, 0xc2, 0x5e, 0x10, 0x00};
1948         /* TODO: get MAC address whenever the source is EPROM - hardcoded and copy it to ndev*/
1949         memcpy(ndev->dev_addr, mac_add, 6);
1950
1951         if (!is_valid_ether_addr(ndev->dev_addr)) {
1952                 PRINT_ER("Error: Wrong MAC address\n");
1953                 return -EINVAL;
1954         }
1955
1956         return 0;
1957 }
1958 #endif
1959
1960 void    WILC_WFI_frame_register(struct wiphy *wiphy, struct net_device *dev,
1961                                 u16 frame_type, bool reg);
1962
1963 /* This fn is called, when this device is setup using ifconfig */
1964 #if !defined(NM73131_0_BOARD)
1965 int mac_open(struct net_device *ndev)
1966 {
1967         perInterface_wlan_t *nic;
1968
1969         /*BugID_5213*/
1970         /*No need for setting mac address here anymore,*/
1971         /*Just set it in init_test_config()*/
1972         unsigned char mac_add[ETH_ALEN] = {0};
1973         int ret = 0;
1974         int i = 0;
1975         struct WILC_WFI_priv *priv;
1976
1977         nic = netdev_priv(ndev);
1978         priv = wiphy_priv(nic->wilc_netdev->ieee80211_ptr->wiphy);
1979         PRINT_D(INIT_DBG, "MAC OPEN[%p]\n", ndev);
1980
1981         #ifdef USE_WIRELESS
1982         ret = WILC_WFI_InitHostInt(ndev);
1983         if (ret < 0) {
1984                 PRINT_ER("Failed to initialize host interface\n");
1985
1986                 return ret;
1987         }
1988         #endif
1989
1990         /*initialize platform*/
1991         PRINT_D(INIT_DBG, "*** re-init ***\n");
1992         ret = wilc1000_wlan_init(ndev, nic);
1993         if (ret < 0) {
1994                 PRINT_ER("Failed to initialize wilc1000\n");
1995                 WILC_WFI_DeInitHostInt(ndev);
1996                 return ret;
1997         }
1998
1999         Set_machw_change_vir_if(false);
2000
2001         host_int_get_MacAddress(priv->hWILCWFIDrv, mac_add);
2002         PRINT_D(INIT_DBG, "Mac address: %x:%x:%x:%x:%x:%x\n", mac_add[0], mac_add[1], mac_add[2],
2003                 mac_add[3], mac_add[4], mac_add[5]);
2004
2005         /* loop through the NUM of supported devices and set the MAC address */
2006         for (i = 0; i < g_linux_wlan->u8NoIfcs; i++) {
2007                 if (ndev == g_linux_wlan->strInterfaceInfo[i].wilc_netdev) {
2008                         memcpy(g_linux_wlan->strInterfaceInfo[i].aSrcAddress, mac_add, ETH_ALEN);
2009                         g_linux_wlan->strInterfaceInfo[i].drvHandler = priv->hWILCWFIDrv;
2010                         break;
2011                 }
2012         }
2013
2014         /* TODO: get MAC address whenever the source is EPROM - hardcoded and copy it to ndev*/
2015         memcpy(ndev->dev_addr, g_linux_wlan->strInterfaceInfo[i].aSrcAddress, ETH_ALEN);
2016
2017         if (!is_valid_ether_addr(ndev->dev_addr)) {
2018                 PRINT_ER("Error: Wrong MAC address\n");
2019                 ret = -EINVAL;
2020                 goto _err_;
2021         }
2022
2023         WILC_WFI_frame_register(nic->wilc_netdev->ieee80211_ptr->wiphy, nic->wilc_netdev,
2024                                 nic->g_struct_frame_reg[0].frame_type, nic->g_struct_frame_reg[0].reg);
2025         WILC_WFI_frame_register(nic->wilc_netdev->ieee80211_ptr->wiphy, nic->wilc_netdev,
2026                                 nic->g_struct_frame_reg[1].frame_type, nic->g_struct_frame_reg[1].reg);
2027         netif_wake_queue(ndev);
2028         g_linux_wlan->open_ifcs++;
2029         nic->mac_opened = 1;
2030         return 0;
2031
2032 _err_:
2033         WILC_WFI_DeInitHostInt(ndev);
2034         wilc1000_wlan_deinit(g_linux_wlan);
2035         return ret;
2036 }
2037 #else
2038 int mac_open(struct net_device *ndev)
2039 {
2040
2041         linux_wlan_t *nic;
2042         nic = netdev_priv(ndev);
2043
2044         /*initialize platform*/
2045         if (wilc1000_wlan_init(nic)) {
2046                 PRINT_ER("Failed to initialize platform\n");
2047                 return 1;
2048         }
2049         /* Start the network interface queue for this device */
2050         PRINT_D(INIT_DBG, "Starting netifQ\n");
2051         netif_start_queue(ndev);
2052 /*      linux_wlan_lock(&close_exit_sync); */
2053         return 0;
2054 }
2055 #endif
2056
2057 struct net_device_stats *mac_stats(struct net_device *dev)
2058 {
2059         perInterface_wlan_t *nic = netdev_priv(dev);
2060
2061         return &nic->netstats;
2062 }
2063
2064 /* Setup the multicast filter */
2065 static void wilc_set_multicast_list(struct net_device *dev)
2066 {
2067
2068         struct netdev_hw_addr *ha;
2069         struct WILC_WFI_priv *priv;
2070         tstrWILC_WFIDrv *pstrWFIDrv;
2071         int i = 0;
2072         priv = wiphy_priv(dev->ieee80211_ptr->wiphy);
2073         pstrWFIDrv = (tstrWILC_WFIDrv *)priv->hWILCWFIDrv;
2074
2075         if (!dev)
2076                 return;
2077
2078         PRINT_D(INIT_DBG, "Setting Multicast List with count = %d.\n", dev->mc.count);
2079
2080         if (dev->flags & IFF_PROMISC) {
2081                 /* Normally, we should configure the chip to retrive all packets
2082                  * but we don't wanna support this right now */
2083                 /* TODO: add promiscuous mode support */
2084                 PRINT_D(INIT_DBG, "Set promiscuous mode ON, retrive all packets\n");
2085                 return;
2086         }
2087
2088         /* If there's more addresses than we handle, get all multicast
2089          * packets and sort them out in software. */
2090         if ((dev->flags & IFF_ALLMULTI) || (dev->mc.count) > WILC_MULTICAST_TABLE_SIZE) {
2091                 PRINT_D(INIT_DBG, "Disable multicast filter, retrive all multicast packets\n");
2092                 /* get all multicast packets */
2093                 host_int_setup_multicast_filter(pstrWFIDrv, false, 0);
2094                 return;
2095         }
2096
2097         /* No multicast?  Just get our own stuff */
2098         if ((dev->mc.count) == 0) {
2099                 PRINT_D(INIT_DBG, "Enable multicast filter, retrive directed packets only.\n");
2100                 host_int_setup_multicast_filter(pstrWFIDrv, true, 0);
2101                 return;
2102         }
2103
2104         /* Store all of the multicast addresses in the hardware filter */
2105         netdev_for_each_mc_addr(ha, dev)
2106         {
2107                 memcpy(gau8MulticastMacAddrList[i], ha->addr, ETH_ALEN);
2108                 PRINT_D(INIT_DBG, "Entry[%d]: %x:%x:%x:%x:%x:%x\n", i,
2109                         gau8MulticastMacAddrList[i][0], gau8MulticastMacAddrList[i][1], gau8MulticastMacAddrList[i][2], gau8MulticastMacAddrList[i][3], gau8MulticastMacAddrList[i][4], gau8MulticastMacAddrList[i][5]);
2110                 i++;
2111         }
2112
2113         host_int_setup_multicast_filter(pstrWFIDrv, true, (dev->mc.count));
2114
2115         return;
2116
2117 }
2118
2119 static void linux_wlan_tx_complete(void *priv, int status)
2120 {
2121
2122         struct tx_complete_data *pv_data = (struct tx_complete_data *)priv;
2123         if (status == 1)
2124                 PRINT_D(TX_DBG, "Packet sent successfully - Size = %d - Address = %p - SKB = %p\n", pv_data->size, pv_data->buff, pv_data->skb);
2125         else
2126                 PRINT_D(TX_DBG, "Couldn't send packet - Size = %d - Address = %p - SKB = %p\n", pv_data->size, pv_data->buff, pv_data->skb);
2127         /* Free the SK Buffer, its work is done */
2128         dev_kfree_skb(pv_data->skb);
2129         linux_wlan_free(pv_data);
2130 }
2131
2132 int mac_xmit(struct sk_buff *skb, struct net_device *ndev)
2133 {
2134         perInterface_wlan_t *nic;
2135         struct tx_complete_data *tx_data = NULL;
2136         int QueueCount;
2137         char *pu8UdpBuffer;
2138         struct iphdr *ih;
2139         struct ethhdr *eth_h;
2140         nic = netdev_priv(ndev);
2141
2142         PRINT_D(INT_DBG, "\n========\n IntUH: %d - IntBH: %d - IntCld: %d\n========\n", int_rcvdU, int_rcvdB, int_clrd);
2143         PRINT_D(TX_DBG, "Sending packet just received from TCP/IP\n");
2144
2145         /* Stop the network interface queue */
2146         if (skb->dev != ndev) {
2147                 PRINT_ER("Packet not destined to this device\n");
2148                 return 0;
2149         }
2150
2151         tx_data = (struct tx_complete_data *)internal_alloc(sizeof(struct tx_complete_data), GFP_ATOMIC);
2152         if (tx_data == NULL) {
2153                 PRINT_ER("Failed to allocate memory for tx_data structure\n");
2154                 dev_kfree_skb(skb);
2155                 netif_wake_queue(ndev);
2156                 return 0;
2157         }
2158
2159         tx_data->buff = skb->data;
2160         tx_data->size = skb->len;
2161         tx_data->skb  = skb;
2162
2163         eth_h = (struct ethhdr *)(skb->data);
2164         if (eth_h->h_proto == 0x8e88)
2165                 PRINT_D(INIT_DBG, "EAPOL transmitted\n");
2166
2167         /*get source and dest ip addresses*/
2168         ih = (struct iphdr *)(skb->data + sizeof(struct ethhdr));
2169
2170         pu8UdpBuffer = (char *)ih + sizeof(struct iphdr);
2171         if ((pu8UdpBuffer[1] == 68 && pu8UdpBuffer[3] == 67) || (pu8UdpBuffer[1] == 67 && pu8UdpBuffer[3] == 68))
2172                 PRINT_D(GENERIC_DBG, "DHCP Message transmitted, type:%x %x %x\n", pu8UdpBuffer[248], pu8UdpBuffer[249], pu8UdpBuffer[250]);
2173
2174         PRINT_D(TX_DBG, "Sending packet - Size = %d - Address = %p - SKB = %p\n", tx_data->size, tx_data->buff, tx_data->skb);
2175
2176         /* Send packet to MAC HW - for now the tx_complete function will be just status
2177          * indicator. still not sure if I need to suspend host transmission till the tx_complete
2178          * function called or not?
2179          * allocated buffer will be freed in tx_complete function.
2180          */
2181         PRINT_D(TX_DBG, "Adding tx packet to TX Queue\n");
2182         nic->netstats.tx_packets++;
2183         nic->netstats.tx_bytes += tx_data->size;
2184         tx_data->pBssid = g_linux_wlan->strInterfaceInfo[nic->u8IfIdx].aBSSID;
2185         #ifndef WILC_FULLY_HOSTING_AP
2186         QueueCount = g_linux_wlan->oup.wlan_add_to_tx_que((void *)tx_data,
2187                                                           tx_data->buff,
2188                                                           tx_data->size,
2189                                                           linux_wlan_tx_complete);
2190         #else
2191         QueueCount = WILC_Xmit_data((void *)tx_data, HOST_TO_WLAN);
2192         #endif /* WILC_FULLY_HOSTING_AP */
2193
2194         if (QueueCount > FLOW_CONTROL_UPPER_THRESHOLD) {
2195                 netif_stop_queue(g_linux_wlan->strInterfaceInfo[0].wilc_netdev);
2196                 netif_stop_queue(g_linux_wlan->strInterfaceInfo[1].wilc_netdev);
2197         }
2198
2199         return 0;
2200 }
2201
2202 int mac_close(struct net_device *ndev)
2203 {
2204         struct WILC_WFI_priv *priv;
2205         perInterface_wlan_t *nic;
2206         tstrWILC_WFIDrv *pstrWFIDrv;
2207
2208         nic = netdev_priv(ndev);
2209
2210         if ((nic == NULL) || (nic->wilc_netdev == NULL) || (nic->wilc_netdev->ieee80211_ptr == NULL) || (nic->wilc_netdev->ieee80211_ptr->wiphy == NULL)) {
2211                 PRINT_ER("nic = NULL\n");
2212                 return 0;
2213         }
2214
2215         priv = wiphy_priv(nic->wilc_netdev->ieee80211_ptr->wiphy);
2216
2217         if (priv == NULL) {
2218                 PRINT_ER("priv = NULL\n");
2219                 return 0;
2220         }
2221
2222         pstrWFIDrv = (tstrWILC_WFIDrv *)priv->hWILCWFIDrv;
2223
2224         PRINT_D(GENERIC_DBG, "Mac close\n");
2225
2226         if (g_linux_wlan == NULL) {
2227                 PRINT_ER("g_linux_wlan = NULL\n");
2228                 return 0;
2229         }
2230
2231         if (pstrWFIDrv == NULL) {
2232                 PRINT_ER("pstrWFIDrv = NULL\n");
2233                 return 0;
2234         }
2235
2236         if ((g_linux_wlan->open_ifcs) > 0) {
2237                 g_linux_wlan->open_ifcs--;
2238         } else {
2239                 PRINT_ER("ERROR: MAC close called while number of opened interfaces is zero\n");
2240                 return 0;
2241         }
2242
2243         if (nic->wilc_netdev != NULL) {
2244                 /* Stop the network interface queue */
2245                 netif_stop_queue(nic->wilc_netdev);
2246
2247                 #ifdef USE_WIRELESS
2248                 WILC_WFI_DeInitHostInt(nic->wilc_netdev);
2249                 #endif
2250         }
2251
2252         if (g_linux_wlan->open_ifcs == 0) {
2253                 PRINT_D(GENERIC_DBG, "Deinitializing wilc1000\n");
2254                 g_linux_wlan->close = 1;
2255                 wilc1000_wlan_deinit(g_linux_wlan);
2256                 #ifdef USE_WIRELESS
2257                 #ifdef WILC_AP_EXTERNAL_MLME
2258                 WILC_WFI_deinit_mon_interface();
2259                 #endif
2260                 #endif
2261         }
2262
2263         linux_wlan_unlock(&close_exit_sync);
2264         nic->mac_opened = 0;
2265
2266         return 0;
2267 }
2268
2269 int mac_ioctl(struct net_device *ndev, struct ifreq *req, int cmd)
2270 {
2271
2272         u8 *buff = NULL;
2273         s8 rssi;
2274         u32 size = 0, length = 0;
2275         perInterface_wlan_t *nic;
2276         struct WILC_WFI_priv *priv;
2277         s32 s32Error = WILC_SUCCESS;
2278
2279         /* struct iwreq *wrq = (struct iwreq *) req;    // tony moved to case SIOCSIWPRIV */
2280         #ifdef USE_WIRELESS
2281         nic = netdev_priv(ndev);
2282
2283         if (!g_linux_wlan->wilc1000_initialized)
2284                 return 0;
2285
2286         #endif
2287
2288         switch (cmd) {
2289
2290         /* ]] 2013-06-24 */
2291         case SIOCSIWPRIV:
2292         {
2293                 struct iwreq *wrq = (struct iwreq *) req;               /* added by tony */
2294
2295                 size = wrq->u.data.length;
2296
2297                 if (size && wrq->u.data.pointer) {
2298
2299                         buff = memdup_user(wrq->u.data.pointer, wrq->u.data.length);
2300                         if (IS_ERR(buff)) {
2301                                 s32Error = PTR_ERR(buff);
2302                                 goto done;
2303                         }
2304
2305                         if (strncasecmp(buff, "RSSI", length) == 0) {
2306
2307                                         #ifdef USE_WIRELESS
2308                                 priv = wiphy_priv(nic->wilc_netdev->ieee80211_ptr->wiphy);
2309                                 s32Error = host_int_get_rssi(priv->hWILCWFIDrv, &(rssi));
2310                                 if (s32Error)
2311                                         PRINT_ER("Failed to send get rssi param's message queue ");
2312                                         #endif
2313                                 PRINT_INFO(GENERIC_DBG, "RSSI :%d\n", rssi);
2314
2315                                 /*Rounding up the rssi negative value*/
2316                                 rssi += 5;
2317
2318                                 snprintf(buff, size, "rssi %d", rssi);
2319
2320                                 if (copy_to_user(wrq->u.data.pointer, buff, size)) {
2321                                         PRINT_ER("%s: failed to copy data to user buffer\n", __func__);
2322                                         s32Error = -EFAULT;
2323                                         goto done;
2324                                 }
2325                         }
2326                 }
2327         }
2328         break;
2329
2330         default:
2331         {
2332                 PRINT_INFO(GENERIC_DBG, "Command - %d - has been received\n", cmd);
2333                 s32Error = -EOPNOTSUPP;
2334                 goto done;
2335         }
2336         }
2337
2338 done:
2339
2340         kfree(buff);
2341
2342         return s32Error;
2343 }
2344
2345 void frmw_to_linux(uint8_t *buff, uint32_t size, uint32_t pkt_offset)
2346 {
2347
2348         unsigned int frame_len = 0;
2349         int stats;
2350         unsigned char *buff_to_send = NULL;
2351         struct sk_buff *skb;
2352 #ifndef TCP_ENHANCEMENTS
2353         char *pu8UdpBuffer;
2354         struct iphdr *ih;
2355 #endif
2356         struct net_device *wilc_netdev;
2357         perInterface_wlan_t *nic;
2358
2359         wilc_netdev = GetIfHandler(buff);
2360         if (wilc_netdev == NULL)
2361                 return;
2362
2363         buff += pkt_offset;
2364         nic = netdev_priv(wilc_netdev);
2365
2366         if (size > 0) {
2367
2368                 frame_len = size;
2369                 buff_to_send = buff;
2370
2371                 /* Need to send the packet up to the host, allocate a skb buffer */
2372                 skb = dev_alloc_skb(frame_len);
2373                 if (skb == NULL) {
2374                         PRINT_ER("Low memory - packet droped\n");
2375                         return;
2376                 }
2377
2378                 skb_reserve(skb, (unsigned int)skb->data & 0x3);
2379
2380                 if (g_linux_wlan == NULL || wilc_netdev == NULL)
2381                         PRINT_ER("wilc_netdev in g_linux_wlan is NULL");
2382                 skb->dev = wilc_netdev;
2383
2384                 if (skb->dev == NULL)
2385                         PRINT_ER("skb->dev is NULL\n");
2386
2387                 /*
2388                  * for(i=0;i<40;i++)
2389                  * {
2390                  *      if(i<frame_len)
2391                  *              WILC_PRINTF("buff_to_send[%d]=%2x\n",i,buff_to_send[i]);
2392                  *
2393                  * }*/
2394
2395                 /* skb_put(skb, frame_len); */
2396                 memcpy(skb_put(skb, frame_len), buff_to_send, frame_len);
2397
2398                 /* WILC_PRINTF("After MEM_CPY\n"); */
2399
2400                 /* nic = netdev_priv(wilc_netdev); */
2401
2402 #ifdef USE_WIRELESS
2403                 /*      if(nic->monitor_flag)
2404                  *      {
2405                  *              WILC_WFI_monitor_rx(nic->wilc_netdev,skb);
2406                  *              return;
2407                  *      }*/
2408 #endif
2409                 skb->protocol = eth_type_trans(skb, wilc_netdev);
2410                         #ifndef TCP_ENHANCEMENTS
2411                 /*get source and dest ip addresses*/
2412                 ih = (struct iphdr *)(skb->data + sizeof(struct ethhdr));
2413
2414                 pu8UdpBuffer = (char *)ih + sizeof(struct iphdr);
2415                 if (buff_to_send[35] == 67 && buff_to_send[37] == 68)
2416                         PRINT_D(RX_DBG, "DHCP Message received\n");
2417                 if (buff_to_send[12] == 0x88 && buff_to_send[13] == 0x8e)
2418                         PRINT_D(GENERIC_DBG, "eapol received\n");
2419                         #endif
2420                 /* Send the packet to the stack by giving it to the bridge */
2421                 nic->netstats.rx_packets++;
2422                 nic->netstats.rx_bytes += frame_len;
2423                 skb->ip_summed = CHECKSUM_UNNECESSARY;
2424                 stats = netif_rx(skb);
2425                 PRINT_D(RX_DBG, "netif_rx ret value is: %d\n", stats);
2426         }
2427                 #ifndef TCP_ENHANCEMENTS
2428         else
2429                 PRINT_ER("Discard sending packet with len = %d\n", size);
2430                 #endif
2431 }
2432
2433 void WILC_WFI_mgmt_rx(uint8_t *buff, uint32_t size)
2434 {
2435         int i = 0;
2436         perInterface_wlan_t *nic;
2437
2438         /*BugID_5450*/
2439         /*Pass the frame on the monitor interface, if any.*/
2440         /*Otherwise, pass it on p2p0 netdev, if registered on it*/
2441         for (i = 0; i < g_linux_wlan->u8NoIfcs; i++) {
2442                 nic = netdev_priv(g_linux_wlan->strInterfaceInfo[i].wilc_netdev);
2443                 if (nic->monitor_flag) {
2444                         WILC_WFI_monitor_rx(buff, size);
2445                         return;
2446                 }
2447         }
2448
2449         #ifdef WILC_P2P
2450         nic = netdev_priv(g_linux_wlan->strInterfaceInfo[1].wilc_netdev); /* p2p0 */
2451         if ((buff[0] == nic->g_struct_frame_reg[0].frame_type && nic->g_struct_frame_reg[0].reg) ||
2452             (buff[0] == nic->g_struct_frame_reg[1].frame_type && nic->g_struct_frame_reg[1].reg))
2453                 WILC_WFI_p2p_rx(g_linux_wlan->strInterfaceInfo[1].wilc_netdev, buff, size);
2454         #endif
2455 }
2456
2457 int wilc_netdev_init(void)
2458 {
2459
2460         int i;
2461         perInterface_wlan_t *nic;
2462         struct net_device *ndev;
2463
2464         linux_wlan_init_lock("close_exit_sync", &close_exit_sync, 0);
2465
2466         /*create the common structure*/
2467         g_linux_wlan = WILC_MALLOC(sizeof(linux_wlan_t));
2468         memset(g_linux_wlan, 0, sizeof(linux_wlan_t));
2469
2470         /*Reset interrupt count debug*/
2471         int_rcvdU = 0;
2472         int_rcvdB = 0;
2473         int_clrd = 0;
2474         #ifdef DISABLE_PWRSAVE_AND_SCAN_DURING_IP
2475         register_inetaddr_notifier(&g_dev_notifier);
2476         #endif
2477
2478         for (i = 0; i < NUM_CONCURRENT_IFC; i++) {
2479                 /*allocate first ethernet device with perinterface_wlan_t as its private data*/
2480                 ndev = alloc_etherdev(sizeof(perInterface_wlan_t));
2481                 if (!ndev) {
2482                         PRINT_ER("Failed to allocate ethernet dev\n");
2483                         return -1;
2484                 }
2485
2486                 nic = netdev_priv(ndev);
2487                 memset(nic, 0, sizeof(perInterface_wlan_t));
2488
2489                 /*Name the Devices*/
2490                 if (i == 0) {
2491                 #if defined(NM73131)    /* tony, 2012-09-20 */
2492                         strcpy(ndev->name, "wilc_eth%d");
2493                 #elif defined(PLAT_CLM9722)                     /* rachel */
2494                         strcpy(ndev->name, "eth%d");
2495                 #else /* PANDA_BOARD, PLAT_ALLWINNER_A10, PLAT_ALLWINNER_A20, PLAT_ALLWINNER_A31, PLAT_AML8726_M3 or PLAT_WMS8304 */
2496                         strcpy(ndev->name, "wlan%d");
2497                 #endif
2498                 } else
2499                         strcpy(ndev->name, "p2p%d");
2500
2501                 nic->u8IfIdx = g_linux_wlan->u8NoIfcs;
2502                 nic->wilc_netdev = ndev;
2503                 g_linux_wlan->strInterfaceInfo[g_linux_wlan->u8NoIfcs].wilc_netdev = ndev;
2504                 g_linux_wlan->u8NoIfcs++;
2505                 ndev->netdev_ops = &wilc_netdev_ops;
2506
2507                 #ifdef USE_WIRELESS
2508                 {
2509                         struct wireless_dev *wdev;
2510                         /*Register WiFi*/
2511                         wdev = WILC_WFI_WiphyRegister(ndev);
2512
2513                         #ifdef WILC_SDIO
2514                         /* set netdev, tony */
2515                         SET_NETDEV_DEV(ndev, &local_sdio_func->dev);
2516                         #endif
2517
2518                         if (wdev == NULL) {
2519                                 PRINT_ER("Can't register WILC Wiphy\n");
2520                                 return -1;
2521                         }
2522
2523                         /*linking the wireless_dev structure with the netdevice*/
2524                         nic->wilc_netdev->ieee80211_ptr = wdev;
2525                         nic->wilc_netdev->ml_priv = nic;
2526                         wdev->netdev = nic->wilc_netdev;
2527                         nic->netstats.rx_packets = 0;
2528                         nic->netstats.tx_packets = 0;
2529                         nic->netstats.rx_bytes = 0;
2530                         nic->netstats.tx_bytes = 0;
2531
2532                 }
2533                 #endif
2534
2535                 if (register_netdev(ndev)) {
2536                         PRINT_ER("Device couldn't be registered - %s\n", ndev->name);
2537                         return -1; /* ERROR */
2538                 }
2539
2540                 nic->iftype = STATION_MODE;
2541                 nic->mac_opened = 0;
2542
2543         }
2544
2545         #ifndef WILC_SDIO
2546         if (!linux_spi_init(&g_linux_wlan->wilc_spidev)) {
2547                 PRINT_ER("Can't initialize SPI\n");
2548                 return -1; /* ERROR */
2549         }
2550         g_linux_wlan->wilc_spidev = wilc_spi_dev;
2551         #else
2552         g_linux_wlan->wilc_sdio_func = local_sdio_func;
2553         #endif
2554
2555         return 0;
2556 }
2557
2558 /*The 1st function called after module inserted*/
2559 static int __init init_wilc_driver(void)
2560 {
2561 #if defined(WILC_DEBUGFS)
2562         if (wilc_debugfs_init() < 0) {
2563                 PRINT_D(GENERIC_DBG, "fail to create debugfs for wilc driver\n");
2564                 return -1;
2565         }
2566 #endif
2567
2568         printk("IN INIT FUNCTION\n");
2569         printk("*** WILC1000 driver VERSION=[10.2] FW_VER=[10.2] ***\n");
2570
2571         linux_wlan_device_power(1);
2572         msleep(100);
2573         linux_wlan_device_detection(1);
2574
2575 #ifdef WILC_SDIO
2576         {
2577                 int ret;
2578
2579                 ret = sdio_register_driver(&wilc_bus);
2580                 if (ret < 0)
2581                         PRINT_D(INIT_DBG, "init_wilc_driver: Failed register sdio driver\n");
2582
2583                 return ret;
2584         }
2585 #else
2586         PRINT_D(INIT_DBG, "Initializing netdev\n");
2587         if (wilc_netdev_init())
2588                 PRINT_ER("Couldn't initialize netdev\n");
2589         return 0;
2590 #endif
2591 }
2592 late_initcall(init_wilc_driver);
2593
2594 static void __exit exit_wilc_driver(void)
2595 {
2596         int i = 0;
2597         perInterface_wlan_t *nic[NUM_CONCURRENT_IFC] = {NULL,};
2598         #define CLOSE_TIMEOUT (12 * 1000)
2599
2600         if ((g_linux_wlan != NULL) && (((g_linux_wlan->strInterfaceInfo[0].wilc_netdev) != NULL)
2601                                        || ((g_linux_wlan->strInterfaceInfo[1].wilc_netdev) != NULL))) {
2602         #ifdef DISABLE_PWRSAVE_AND_SCAN_DURING_IP
2603                 unregister_inetaddr_notifier(&g_dev_notifier);
2604         #endif
2605
2606                 for (i = 0; i < NUM_CONCURRENT_IFC; i++)
2607                         nic[i] = netdev_priv(g_linux_wlan->strInterfaceInfo[i].wilc_netdev);
2608         }
2609
2610         if ((g_linux_wlan != NULL) && g_linux_wlan->wilc_firmware != NULL) {
2611                 release_firmware(g_linux_wlan->wilc_firmware);
2612                 g_linux_wlan->wilc_firmware = NULL;
2613         }
2614
2615         if ((g_linux_wlan != NULL) && (((g_linux_wlan->strInterfaceInfo[0].wilc_netdev) != NULL)
2616                                        || ((g_linux_wlan->strInterfaceInfo[1].wilc_netdev) != NULL))) {
2617                 PRINT_D(INIT_DBG, "Waiting for mac_close ....\n");
2618
2619                 if (linux_wlan_lock_timeout(&close_exit_sync, CLOSE_TIMEOUT) < 0)
2620                         PRINT_D(INIT_DBG, "Closed TimedOUT\n");
2621                 else
2622                         PRINT_D(INIT_DBG, "mac_closed\n");
2623
2624                 for (i = 0; i < NUM_CONCURRENT_IFC; i++) {
2625                         /* close all opened interfaces */
2626                         if (g_linux_wlan->strInterfaceInfo[i].wilc_netdev != NULL) {
2627                                 if (nic[i]->mac_opened)
2628                                         mac_close(g_linux_wlan->strInterfaceInfo[i].wilc_netdev);
2629                         }
2630                 }
2631                 for (i = 0; i < NUM_CONCURRENT_IFC; i++) {
2632                         PRINT_D(INIT_DBG, "Unregistering netdev %p\n", g_linux_wlan->strInterfaceInfo[i].wilc_netdev);
2633                         unregister_netdev(g_linux_wlan->strInterfaceInfo[i].wilc_netdev);
2634                         #ifdef USE_WIRELESS
2635                         PRINT_D(INIT_DBG, "Freeing Wiphy...\n");
2636                         WILC_WFI_WiphyFree(g_linux_wlan->strInterfaceInfo[i].wilc_netdev);
2637                         #endif
2638                         PRINT_D(INIT_DBG, "Freeing netdev...\n");
2639                         free_netdev(g_linux_wlan->strInterfaceInfo[i].wilc_netdev);
2640                 }
2641         }
2642
2643 #ifdef USE_WIRELESS
2644 #ifdef WILC_AP_EXTERNAL_MLME
2645         /* Bug 4600 : WILC_WFI_deinit_mon_interface was already called at mac_close */
2646         /* WILC_WFI_deinit_mon_interface(); */
2647 #endif
2648 #endif
2649
2650         /* if(g_linux_wlan->open_ifcs==0) */
2651         {
2652         #ifndef WILC_SDIO
2653                 PRINT_D(INIT_DBG, "SPI unregsiter...\n");
2654                 spi_unregister_driver(&wilc_bus);
2655         #else
2656                 PRINT_D(INIT_DBG, "SDIO unregsiter...\n");
2657                 sdio_unregister_driver(&wilc_bus);
2658         #endif
2659
2660                 linux_wlan_deinit_lock(&close_exit_sync);
2661                 if (g_linux_wlan != NULL) {
2662                         kfree(g_linux_wlan);
2663                         g_linux_wlan = NULL;
2664                 }
2665                 printk("Module_exit Done.\n");
2666
2667 #if defined(WILC_DEBUGFS)
2668                 wilc_debugfs_remove();
2669 #endif
2670
2671                 linux_wlan_device_detection(0);
2672                 linux_wlan_device_power(0);
2673         }
2674 }
2675 module_exit(exit_wilc_driver);
2676
2677 MODULE_LICENSE("GPL");