drivers/staging/brcm80211/brcmfmac/dhd_common.c

   1 /*
   2  * Copyright (c) 2010 Broadcom Corporation
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  11  * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
  13  * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
  14  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16 #include <linux/kernel.h>
  17 #include <linux/string.h>
  18 #include <bcmdefs.h>
  19 #include <linux/netdevice.h>
  20 #include <osl.h>
  21 #include <bcmutils.h>
  22 #include <bcmendian.h>
  23 #include <dngl_stats.h>
  24 #include <dhd.h>
  25 #include <dhd_bus.h>
  26 #include <dhd_proto.h>
  27 #include <dhd_dbg.h>
  28 #include <msgtrace.h>
  29 #include <wlioctl.h>
  30
  31 int dhd_msg_level;
  32 char fw_path[MOD_PARAM_PATHLEN];
  33 char nv_path[MOD_PARAM_PATHLEN];
  34
  35 /* Last connection success/failure status */
  36 u32 dhd_conn_event;
  37 u32 dhd_conn_status;
  38 u32 dhd_conn_reason;
  39
  40 #define htod32(i) i
  41 #define htod16(i) i
  42 #define dtoh32(i) i
  43 #define dtoh16(i) i
  44
  45 extern int dhdcdc_set_ioctl(dhd_pub_t *dhd, int ifidx, uint cmd, void *buf,
  46                             uint len);
  47 extern void dhd_ind_scan_confirm(void *h, bool status);
  48 extern int dhd_wl_ioctl(dhd_pub_t *dhd, uint cmd, char *buf, uint buflen);
  49 void dhd_iscan_lock(void);
  50 void dhd_iscan_unlock(void);
  51
  52 /* Packet alignment for most efficient SDIO (can change based on platform) */
  53 #ifndef DHD_SDALIGN
  54 #define DHD_SDALIGN     32
  55 #endif
  56 #if !ISPOWEROF2(DHD_SDALIGN)
  57 #error DHD_SDALIGN is not a power of 2!
  58 #endif
  59
  60 #define EPI_VERSION_STR         "4.218.248.5"
  61 #ifdef DHD_DEBUG
  62 const char dhd_version[] =
  63 "Dongle Host Driver, version " EPI_VERSION_STR "\nCompiled on " __DATE__
  64 " at " __TIME__;
  65 #else
  66 const char dhd_version[] = "Dongle Host Driver, version " EPI_VERSION_STR;
  67 #endif
  68
  69 void dhd_set_timer(void *bus, uint wdtick);
  70
  71 /* IOVar table */
  72 enum {
  73         IOV_VERSION = 1,
  74         IOV_MSGLEVEL,
  75         IOV_BCMERRORSTR,
  76         IOV_BCMERROR,
  77         IOV_WDTICK,
  78         IOV_DUMP,
  79 #ifdef DHD_DEBUG
  80         IOV_CONS,
  81         IOV_DCONSOLE_POLL,
  82 #endif
  83         IOV_CLEARCOUNTS,
  84         IOV_LOGDUMP,
  85         IOV_LOGCAL,
  86         IOV_LOGSTAMP,
  87         IOV_GPIOOB,
  88         IOV_IOCTLTIMEOUT,
  89         IOV_LAST
  90 };
  91
  92 const bcm_iovar_t dhd_iovars[] = {
  93         {"version", IOV_VERSION, 0, IOVT_BUFFER, sizeof(dhd_version)}
  94         ,
  95 #ifdef DHD_DEBUG
  96         {"msglevel", IOV_MSGLEVEL, 0, IOVT_UINT32, 0}
  97         ,
  98 #endif                          /* DHD_DEBUG */
  99         {"bcmerrorstr", IOV_BCMERRORSTR, 0, IOVT_BUFFER, BCME_STRLEN}
 100         ,
 101         {"bcmerror", IOV_BCMERROR, 0, IOVT_INT8, 0}
 102         ,
 103         {"wdtick", IOV_WDTICK, 0, IOVT_UINT32, 0}
 104         ,
 105         {"dump", IOV_DUMP, 0, IOVT_BUFFER, DHD_IOCTL_MAXLEN}
 106         ,
 107 #ifdef DHD_DEBUG
 108         {"dconpoll", IOV_DCONSOLE_POLL, 0, IOVT_UINT32, 0}
 109         ,
 110         {"cons", IOV_CONS, 0, IOVT_BUFFER, 0}
 111         ,
 112 #endif
 113         {"clearcounts", IOV_CLEARCOUNTS, 0, IOVT_VOID, 0}
 114         ,
 115         {"gpioob", IOV_GPIOOB, 0, IOVT_UINT32, 0}
 116         ,
 117         {"ioctl_timeout", IOV_IOCTLTIMEOUT, 0, IOVT_UINT32, 0}
 118         ,
 119         {NULL, 0, 0, 0, 0}
 120 };
 121
 122 void dhd_common_init(void)
 123 {
 124         /* Init global variables at run-time, not as part of the declaration.
 125          * This is required to support init/de-init of the driver.
 126          * Initialization
 127          * of globals as part of the declaration results in non-deterministic
 128          * behaviour since the value of the globals may be different on the
 129          * first time that the driver is initialized vs subsequent
 130          * initializations.
 131          */
 132         dhd_msg_level = DHD_ERROR_VAL;
 133 #ifdef CONFIG_BCM4329_FW_PATH
 134         strncpy(fw_path, CONFIG_BCM4329_FW_PATH, MOD_PARAM_PATHLEN - 1);
 135 #else
 136         fw_path[0] = '\0';
 137 #endif
 138 #ifdef CONFIG_BCM4329_NVRAM_PATH
 139         strncpy(nv_path, CONFIG_BCM4329_NVRAM_PATH, MOD_PARAM_PATHLEN - 1);
 140 #else
 141         nv_path[0] = '\0';
 142 #endif
 143 }
 144
 145 static int dhd_dump(dhd_pub_t *dhdp, char *buf, int buflen)
 146 {
 147         struct bcmstrbuf b;
 148         struct bcmstrbuf *strbuf = &b;
 149
 150         bcm_binit(strbuf, buf, buflen);
 151
 152         /* Base DHD info */
 153         bcm_bprintf(strbuf, "%s\n", dhd_version);
 154         bcm_bprintf(strbuf, "\n");
 155         bcm_bprintf(strbuf, "pub.up %d pub.txoff %d pub.busstate %d\n",
 156                     dhdp->up, dhdp->txoff, dhdp->busstate);
 157         bcm_bprintf(strbuf, "pub.hdrlen %d pub.maxctl %d pub.rxsz %d\n",
 158                     dhdp->hdrlen, dhdp->maxctl, dhdp->rxsz);
 159         bcm_bprintf(strbuf, "pub.iswl %d pub.drv_version %ld pub.mac %pM\n",
 160                     dhdp->iswl, dhdp->drv_version, &dhdp->mac);
 161         bcm_bprintf(strbuf, "pub.bcmerror %d tickcnt %d\n", dhdp->bcmerror,
 162                     dhdp->tickcnt);
 163
 164         bcm_bprintf(strbuf, "dongle stats:\n");
 165         bcm_bprintf(strbuf,
 166                     "tx_packets %ld tx_bytes %ld tx_errors %ld tx_dropped %ld\n",
 167                     dhdp->dstats.tx_packets, dhdp->dstats.tx_bytes,
 168                     dhdp->dstats.tx_errors, dhdp->dstats.tx_dropped);
 169         bcm_bprintf(strbuf,
 170                     "rx_packets %ld rx_bytes %ld rx_errors %ld rx_dropped %ld\n",
 171                     dhdp->dstats.rx_packets, dhdp->dstats.rx_bytes,
 172                     dhdp->dstats.rx_errors, dhdp->dstats.rx_dropped);
 173         bcm_bprintf(strbuf, "multicast %ld\n", dhdp->dstats.multicast);
 174
 175         bcm_bprintf(strbuf, "bus stats:\n");
 176         bcm_bprintf(strbuf, "tx_packets %ld tx_multicast %ld tx_errors %ld\n",
 177                     dhdp->tx_packets, dhdp->tx_multicast, dhdp->tx_errors);
 178         bcm_bprintf(strbuf, "tx_ctlpkts %ld tx_ctlerrs %ld\n",
 179                     dhdp->tx_ctlpkts, dhdp->tx_ctlerrs);
 180         bcm_bprintf(strbuf, "rx_packets %ld rx_multicast %ld rx_errors %ld\n",
 181                     dhdp->rx_packets, dhdp->rx_multicast, dhdp->rx_errors);
 182         bcm_bprintf(strbuf,
 183                     "rx_ctlpkts %ld rx_ctlerrs %ld rx_dropped %ld rx_flushed %ld\n",
 184                     dhdp->rx_ctlpkts, dhdp->rx_ctlerrs, dhdp->rx_dropped,
 185                     dhdp->rx_flushed);
 186         bcm_bprintf(strbuf,
 187                     "rx_readahead_cnt %ld tx_realloc %ld fc_packets %ld\n",
 188                     dhdp->rx_readahead_cnt, dhdp->tx_realloc, dhdp->fc_packets);
 189         bcm_bprintf(strbuf, "wd_dpc_sched %ld\n", dhdp->wd_dpc_sched);
 190         bcm_bprintf(strbuf, "\n");
 191
 192         /* Add any prot info */
 193         dhd_prot_dump(dhdp, strbuf);
 194         bcm_bprintf(strbuf, "\n");
 195
 196         /* Add any bus info */
 197         dhd_bus_dump(dhdp, strbuf);
 198
 199         return !strbuf->size ? BCME_BUFTOOSHORT : 0;
 200 }
 201
 202 static int
 203 dhd_doiovar(dhd_pub_t *dhd_pub, const bcm_iovar_t *vi, u32 actionid,
 204             const char *name, void *params, int plen, void *arg, int len,
 205             int val_size)
 206 {
 207         int bcmerror = 0;
 208         s32 int_val = 0;
 209
 210         DHD_TRACE(("%s: Enter\n", __func__));
 211
 212         bcmerror = bcm_iovar_lencheck(vi, arg, len, IOV_ISSET(actionid));
 213         if (bcmerror != 0)
 214                 goto exit;
 215
 216         if (plen >= (int)sizeof(int_val))
 217                 memcpy(&int_val, params, sizeof(int_val));
 218
 219         switch (actionid) {
 220         case IOV_GVAL(IOV_VERSION):
 221                 /* Need to have checked buffer length */
 222                 strncpy((char *)arg, dhd_version, len);
 223                 break;
 224
 225         case IOV_GVAL(IOV_MSGLEVEL):
 226                 int_val = (s32) dhd_msg_level;
 227                 memcpy(arg, &int_val, val_size);
 228                 break;
 229
 230         case IOV_SVAL(IOV_MSGLEVEL):
 231                 dhd_msg_level = int_val;
 232                 break;
 233
 234         case IOV_GVAL(IOV_BCMERRORSTR):
 235                 strncpy((char *)arg, bcmerrorstr(dhd_pub->bcmerror),
 236                         BCME_STRLEN);
 237                 ((char *)arg)[BCME_STRLEN - 1] = 0x00;
 238                 break;
 239
 240         case IOV_GVAL(IOV_BCMERROR):
 241                 int_val = (s32) dhd_pub->bcmerror;
 242                 memcpy(arg, &int_val, val_size);
 243                 break;
 244
 245         case IOV_GVAL(IOV_WDTICK):
 246                 int_val = (s32) dhd_watchdog_ms;
 247                 memcpy(arg, &int_val, val_size);
 248                 break;
 249
 250         case IOV_SVAL(IOV_WDTICK):
 251                 if (!dhd_pub->up) {
 252                         bcmerror = BCME_NOTUP;
 253                         break;
 254                 }
 255                 dhd_os_wd_timer(dhd_pub, (uint) int_val);
 256                 break;
 257
 258         case IOV_GVAL(IOV_DUMP):
 259                 bcmerror = dhd_dump(dhd_pub, arg, len);
 260                 break;
 261
 262 #ifdef DHD_DEBUG
 263         case IOV_GVAL(IOV_DCONSOLE_POLL):
 264                 int_val = (s32) dhd_console_ms;
 265                 memcpy(arg, &int_val, val_size);
 266                 break;
 267
 268         case IOV_SVAL(IOV_DCONSOLE_POLL):
 269                 dhd_console_ms = (uint) int_val;
 270                 break;
 271
 272         case IOV_SVAL(IOV_CONS):
 273                 if (len > 0)
 274                         bcmerror = dhd_bus_console_in(dhd_pub, arg, len - 1);
 275                 break;
 276 #endif
 277
 278         case IOV_SVAL(IOV_CLEARCOUNTS):
 279                 dhd_pub->tx_packets = dhd_pub->rx_packets = 0;
 280                 dhd_pub->tx_errors = dhd_pub->rx_errors = 0;
 281                 dhd_pub->tx_ctlpkts = dhd_pub->rx_ctlpkts = 0;
 282                 dhd_pub->tx_ctlerrs = dhd_pub->rx_ctlerrs = 0;
 283                 dhd_pub->rx_dropped = 0;
 284                 dhd_pub->rx_readahead_cnt = 0;
 285                 dhd_pub->tx_realloc = 0;
 286                 dhd_pub->wd_dpc_sched = 0;
 287                 memset(&dhd_pub->dstats, 0, sizeof(dhd_pub->dstats));
 288                 dhd_bus_clearcounts(dhd_pub);
 289                 break;
 290
 291         case IOV_GVAL(IOV_IOCTLTIMEOUT):{
 292                         int_val = (s32) dhd_os_get_ioctl_resp_timeout();
 293                         memcpy(arg, &int_val, sizeof(int_val));
 294                         break;
 295                 }
 296
 297         case IOV_SVAL(IOV_IOCTLTIMEOUT):{
 298                         if (int_val <= 0)
 299                                 bcmerror = BCME_BADARG;
 300                         else
 301                                 dhd_os_set_ioctl_resp_timeout((unsigned int)
 302                                                               int_val);
 303                         break;
 304                 }
 305
 306         default:
 307                 bcmerror = BCME_UNSUPPORTED;
 308                 break;
 309         }
 310
 311 exit:
 312         return bcmerror;
 313 }
 314
 315 bool dhd_prec_enq(dhd_pub_t *dhdp, struct pktq *q, struct sk_buff *pkt,
 316                   int prec)
 317 {
 318         struct sk_buff *p;
 319         int eprec = -1;         /* precedence to evict from */
 320         bool discard_oldest;
 321
 322         /* Fast case, precedence queue is not full and we are also not
 323          * exceeding total queue length
 324          */
 325         if (!pktq_pfull(q, prec) && !pktq_full(q)) {
 326                 pktq_penq(q, prec, pkt);
 327                 return true;
 328         }
 329
 330         /* Determine precedence from which to evict packet, if any */
 331         if (pktq_pfull(q, prec))
 332                 eprec = prec;
 333         else if (pktq_full(q)) {
 334                 p = pktq_peek_tail(q, &eprec);
 335                 ASSERT(p);
 336                 if (eprec > prec)
 337                         return false;
 338         }
 339
 340         /* Evict if needed */
 341         if (eprec >= 0) {
 342                 /* Detect queueing to unconfigured precedence */
 343                 ASSERT(!pktq_pempty(q, eprec));
 344                 discard_oldest = AC_BITMAP_TST(dhdp->wme_dp, eprec);
 345                 if (eprec == prec && !discard_oldest)
 346                         return false;   /* refuse newer (incoming) packet */
 347                 /* Evict packet according to discard policy */
 348                 p = discard_oldest ? pktq_pdeq(q, eprec) : pktq_pdeq_tail(q,
 349                                                   eprec);
 350                 if (p == NULL) {
 351                         DHD_ERROR(("%s: pktq_penq() failed, oldest %d.",
 352                                    __func__, discard_oldest));
 353                         ASSERT(p);
 354                 }
 355
 356                 pkt_buf_free_skb(dhdp->osh, p, true);
 357         }
 358
 359         /* Enqueue */
 360         p = pktq_penq(q, prec, pkt);
 361         if (p == NULL) {
 362                 DHD_ERROR(("%s: pktq_penq() failed.", __func__));
 363                 ASSERT(p);
 364         }
 365
 366         return true;
 367 }
 368
 369 static int
 370 dhd_iovar_op(dhd_pub_t *dhd_pub, const char *name,
 371              void *params, int plen, void *arg, int len, bool set)
 372 {
 373         int bcmerror = 0;
 374         int val_size;
 375         const bcm_iovar_t *vi = NULL;
 376         u32 actionid;
 377
 378         DHD_TRACE(("%s: Enter\n", __func__));
 379
 380         ASSERT(name);
 381         ASSERT(len >= 0);
 382
 383         /* Get MUST have return space */
 384         ASSERT(set || (arg && len));
 385
 386         /* Set does NOT take qualifiers */
 387         ASSERT(!set || (!params && !plen));
 388
 389         vi = bcm_iovar_lookup(dhd_iovars, name);
 390         if (vi == NULL) {
 391                 bcmerror = BCME_UNSUPPORTED;
 392                 goto exit;
 393         }
 394
 395         DHD_CTL(("%s: %s %s, len %d plen %d\n", __func__,
 396                  name, (set ? "set" : "get"), len, plen));
 397
 398         /* set up 'params' pointer in case this is a set command so that
 399          * the convenience int and bool code can be common to set and get
 400          */
 401         if (params == NULL) {
 402                 params = arg;
 403                 plen = len;
 404         }
 405
 406         if (vi->type == IOVT_VOID)
 407                 val_size = 0;
 408         else if (vi->type == IOVT_BUFFER)
 409                 val_size = len;
 410         else
 411                 /* all other types are integer sized */
 412                 val_size = sizeof(int);
 413
 414         actionid = set ? IOV_SVAL(vi->varid) : IOV_GVAL(vi->varid);
 415         bcmerror =
 416             dhd_doiovar(dhd_pub, vi, actionid, name, params, plen, arg, len,
 417                         val_size);
 418
 419 exit:
 420         return bcmerror;
 421 }
 422
 423 int dhd_ioctl(dhd_pub_t *dhd_pub, dhd_ioctl_t *ioc, void *buf, uint buflen)
 424 {
 425         int bcmerror = 0;
 426
 427         DHD_TRACE(("%s: Enter\n", __func__));
 428
 429         if (!buf)
 430                 return BCME_BADARG;
 431
 432         switch (ioc->cmd) {
 433         case DHD_GET_MAGIC:
 434                 if (buflen < sizeof(int))
 435                         bcmerror = BCME_BUFTOOSHORT;
 436                 else
 437                         *(int *)buf = DHD_IOCTL_MAGIC;
 438                 break;
 439
 440         case DHD_GET_VERSION:
 441                 if (buflen < sizeof(int))
 442                         bcmerror = -BCME_BUFTOOSHORT;
 443                 else
 444                         *(int *)buf = DHD_IOCTL_VERSION;
 445                 break;
 446
 447         case DHD_GET_VAR:
 448         case DHD_SET_VAR:{
 449                         char *arg;
 450                         uint arglen;
 451
 452                         /* scan past the name to any arguments */
 453                         for (arg = buf, arglen = buflen; *arg && arglen;
 454                              arg++, arglen--)
 455                                 ;
 456
 457                         if (*arg) {
 458                                 bcmerror = BCME_BUFTOOSHORT;
 459                                 break;
 460                         }
 461
 462                         /* account for the NUL terminator */
 463                         arg++, arglen--;
 464
 465                         /* call with the appropriate arguments */
 466                         if (ioc->cmd == DHD_GET_VAR)
 467                                 bcmerror =
 468                                     dhd_iovar_op(dhd_pub, buf, arg, arglen, buf,
 469                                                  buflen, IOV_GET);
 470                         else
 471                                 bcmerror =
 472                                     dhd_iovar_op(dhd_pub, buf, NULL, 0, arg,
 473                                                  arglen, IOV_SET);
 474                         if (bcmerror != BCME_UNSUPPORTED)
 475                                 break;
 476
 477                         /* not in generic table, try protocol module */
 478                         if (ioc->cmd == DHD_GET_VAR)
 479                                 bcmerror = dhd_prot_iovar_op(dhd_pub, buf, arg,
 480                                                              arglen, buf,
 481                                                              buflen, IOV_GET);
 482                         else
 483                                 bcmerror = dhd_prot_iovar_op(dhd_pub, buf,
 484                                                              NULL, 0, arg,
 485                                                              arglen, IOV_SET);
 486                         if (bcmerror != BCME_UNSUPPORTED)
 487                                 break;
 488
 489                         /* if still not found, try bus module */
 490                         if (ioc->cmd == DHD_GET_VAR)
 491                                 bcmerror = dhd_bus_iovar_op(dhd_pub, buf,
 492                                                             arg, arglen, buf,
 493                                                             buflen, IOV_GET);
 494                         else
 495                                 bcmerror = dhd_bus_iovar_op(dhd_pub, buf,
 496                                                             NULL, 0, arg,
 497                                                             arglen, IOV_SET);
 498
 499                         break;
 500                 }
 501
 502         default:
 503                 bcmerror = BCME_UNSUPPORTED;
 504         }
 505
 506         return bcmerror;
 507 }
 508
 509 #ifdef SHOW_EVENTS
 510 static void wl_show_host_event(wl_event_msg_t *event, void *event_data)
 511 {
 512         uint i, status, reason;
 513         bool group = false, flush_txq = false, link = false;
 514         char *auth_str, *event_name;
 515         unsigned char *buf;
 516         char err_msg[256], eabuf[ETHER_ADDR_STR_LEN];
 517         static struct {
 518                 uint event;
 519                 char *event_name;
 520         } event_names[] = {
 521                 {
 522                 WLC_E_SET_SSID, "SET_SSID"}, {
 523                 WLC_E_JOIN, "JOIN"}, {
 524                 WLC_E_START, "START"}, {
 525                 WLC_E_AUTH, "AUTH"}, {
 526                 WLC_E_AUTH_IND, "AUTH_IND"}, {
 527                 WLC_E_DEAUTH, "DEAUTH"}, {
 528                 WLC_E_DEAUTH_IND, "DEAUTH_IND"}, {
 529                 WLC_E_ASSOC, "ASSOC"}, {
 530                 WLC_E_ASSOC_IND, "ASSOC_IND"}, {
 531                 WLC_E_REASSOC, "REASSOC"}, {
 532                 WLC_E_REASSOC_IND, "REASSOC_IND"}, {
 533                 WLC_E_DISASSOC, "DISASSOC"}, {
 534                 WLC_E_DISASSOC_IND, "DISASSOC_IND"}, {
 535                 WLC_E_QUIET_START, "START_QUIET"}, {
 536                 WLC_E_QUIET_END, "END_QUIET"}, {
 537                 WLC_E_BEACON_RX, "BEACON_RX"}, {
 538                 WLC_E_LINK, "LINK"}, {
 539                 WLC_E_MIC_ERROR, "MIC_ERROR"}, {
 540                 WLC_E_NDIS_LINK, "NDIS_LINK"}, {
 541                 WLC_E_ROAM, "ROAM"}, {
 542                 WLC_E_TXFAIL, "TXFAIL"}, {
 543                 WLC_E_PMKID_CACHE, "PMKID_CACHE"}, {
 544                 WLC_E_RETROGRADE_TSF, "RETROGRADE_TSF"}, {
 545                 WLC_E_PRUNE, "PRUNE"}, {
 546                 WLC_E_AUTOAUTH, "AUTOAUTH"}, {
 547                 WLC_E_EAPOL_MSG, "EAPOL_MSG"}, {
 548                 WLC_E_SCAN_COMPLETE, "SCAN_COMPLETE"}, {
 549                 WLC_E_ADDTS_IND, "ADDTS_IND"}, {
 550                 WLC_E_DELTS_IND, "DELTS_IND"}, {
 551                 WLC_E_BCNSENT_IND, "BCNSENT_IND"}, {
 552                 WLC_E_BCNRX_MSG, "BCNRX_MSG"}, {
 553                 WLC_E_BCNLOST_MSG, "BCNLOST_MSG"}, {
 554                 WLC_E_ROAM_PREP, "ROAM_PREP"}, {
 555                 WLC_E_PFN_NET_FOUND, "PNO_NET_FOUND"}, {
 556                 WLC_E_PFN_NET_LOST, "PNO_NET_LOST"}, {
 557                 WLC_E_RESET_COMPLETE, "RESET_COMPLETE"}, {
 558                 WLC_E_JOIN_START, "JOIN_START"}, {
 559                 WLC_E_ROAM_START, "ROAM_START"}, {
 560                 WLC_E_ASSOC_START, "ASSOC_START"}, {
 561                 WLC_E_IBSS_ASSOC, "IBSS_ASSOC"}, {
 562                 WLC_E_RADIO, "RADIO"}, {
 563                 WLC_E_PSM_WATCHDOG, "PSM_WATCHDOG"}, {
 564                 WLC_E_PROBREQ_MSG, "PROBREQ_MSG"}, {
 565                 WLC_E_SCAN_CONFIRM_IND, "SCAN_CONFIRM_IND"}, {
 566                 WLC_E_PSK_SUP, "PSK_SUP"}, {
 567                 WLC_E_COUNTRY_CODE_CHANGED, "COUNTRY_CODE_CHANGED"}, {
 568                 WLC_E_EXCEEDED_MEDIUM_TIME, "EXCEEDED_MEDIUM_TIME"}, {
 569                 WLC_E_ICV_ERROR, "ICV_ERROR"}, {
 570                 WLC_E_UNICAST_DECODE_ERROR, "UNICAST_DECODE_ERROR"}, {
 571                 WLC_E_MULTICAST_DECODE_ERROR, "MULTICAST_DECODE_ERROR"}, {
 572                 WLC_E_TRACE, "TRACE"}, {
 573                 WLC_E_ACTION_FRAME, "ACTION FRAME"}, {
 574                 WLC_E_ACTION_FRAME_COMPLETE, "ACTION FRAME TX COMPLETE"}, {
 575                 WLC_E_IF, "IF"}, {
 576                 WLC_E_RSSI, "RSSI"}, {
 577                 WLC_E_PFN_SCAN_COMPLETE, "SCAN_COMPLETE"}
 578         };
 579         uint event_type, flags, auth_type, datalen;
 580         event_type = be32_to_cpu(event->event_type);
 581         flags = be16_to_cpu(event->flags);
 582         status = be32_to_cpu(event->status);
 583         reason = be32_to_cpu(event->reason);
 584         auth_type = be32_to_cpu(event->auth_type);
 585         datalen = be32_to_cpu(event->datalen);
 586         /* debug dump of event messages */
 587         sprintf(eabuf, "%pM", event->addr);
 588
 589         event_name = "UNKNOWN";
 590         for (i = 0; i < ARRAY_SIZE(event_names); i++) {
 591                 if (event_names[i].event == event_type)
 592                         event_name = event_names[i].event_name;
 593         }
 594
 595         DHD_EVENT(("EVENT: %s, event ID = %d\n", event_name, event_type));
 596
 597         if (flags & WLC_EVENT_MSG_LINK)
 598                 link = true;
 599         if (flags & WLC_EVENT_MSG_GROUP)
 600                 group = true;
 601         if (flags & WLC_EVENT_MSG_FLUSHTXQ)
 602                 flush_txq = true;
 603
 604         switch (event_type) {
 605         case WLC_E_START:
 606         case WLC_E_DEAUTH:
 607         case WLC_E_DISASSOC:
 608                 DHD_EVENT(("MACEVENT: %s, MAC %s\n", event_name, eabuf));
 609                 break;
 610
 611         case WLC_E_ASSOC_IND:
 612         case WLC_E_REASSOC_IND:
 613                 DHD_EVENT(("MACEVENT: %s, MAC %s\n", event_name, eabuf));
 614                 break;
 615
 616         case WLC_E_ASSOC:
 617         case WLC_E_REASSOC:
 618                 if (status == WLC_E_STATUS_SUCCESS) {
 619                         DHD_EVENT(("MACEVENT: %s, MAC %s, SUCCESS\n",
 620                                    event_name, eabuf));
 621                 } else if (status == WLC_E_STATUS_TIMEOUT) {
 622                         DHD_EVENT(("MACEVENT: %s, MAC %s, TIMEOUT\n",
 623                                    event_name, eabuf));
 624                 } else if (status == WLC_E_STATUS_FAIL) {
 625                         DHD_EVENT(("MACEVENT: %s, MAC %s, FAILURE, reason %d\n",
 626                                    event_name, eabuf, (int)reason));
 627                 } else {
 628                         DHD_EVENT(("MACEVENT: %s, MAC %s, unexpected status "
 629                                 "%d\n", event_name, eabuf, (int)status));
 630                 }
 631                 break;
 632
 633         case WLC_E_DEAUTH_IND:
 634         case WLC_E_DISASSOC_IND:
 635                 DHD_EVENT(("MACEVENT: %s, MAC %s, reason %d\n", event_name,
 636                            eabuf, (int)reason));
 637                 break;
 638
 639         case WLC_E_AUTH:
 640         case WLC_E_AUTH_IND:
 641                 if (auth_type == DOT11_OPEN_SYSTEM)
 642                         auth_str = "Open System";
 643                 else if (auth_type == DOT11_SHARED_KEY)
 644                         auth_str = "Shared Key";
 645                 else {
 646                         sprintf(err_msg, "AUTH unknown: %d", (int)auth_type);
 647                         auth_str = err_msg;
 648                 }
 649                 if (event_type == WLC_E_AUTH_IND) {
 650                         DHD_EVENT(("MACEVENT: %s, MAC %s, %s\n", event_name,
 651                                    eabuf, auth_str));
 652                 } else if (status == WLC_E_STATUS_SUCCESS) {
 653                         DHD_EVENT(("MACEVENT: %s, MAC %s, %s, SUCCESS\n",
 654                                    event_name, eabuf, auth_str));
 655                 } else if (status == WLC_E_STATUS_TIMEOUT) {
 656                         DHD_EVENT(("MACEVENT: %s, MAC %s, %s, TIMEOUT\n",
 657                                    event_name, eabuf, auth_str));
 658                 } else if (status == WLC_E_STATUS_FAIL) {
 659                         DHD_EVENT(("MACEVENT: %s, MAC %s, %s, FAILURE, "
 660                                 "reason %d\n",
 661                                 event_name, eabuf, auth_str, (int)reason));
 662                 }
 663
 664                 break;
 665
 666         case WLC_E_JOIN:
 667         case WLC_E_ROAM:
 668         case WLC_E_SET_SSID:
 669                 if (status == WLC_E_STATUS_SUCCESS) {
 670                         DHD_EVENT(("MACEVENT: %s, MAC %s\n", event_name,
 671                                    eabuf));
 672                 } else if (status == WLC_E_STATUS_FAIL) {
 673                         DHD_EVENT(("MACEVENT: %s, failed\n", event_name));
 674                 } else if (status == WLC_E_STATUS_NO_NETWORKS) {
 675                         DHD_EVENT(("MACEVENT: %s, no networks found\n",
 676                                    event_name));
 677                 } else {
 678                         DHD_EVENT(("MACEVENT: %s, unexpected status %d\n",
 679                                    event_name, (int)status));
 680                 }
 681                 break;
 682
 683         case WLC_E_BEACON_RX:
 684                 if (status == WLC_E_STATUS_SUCCESS) {
 685                         DHD_EVENT(("MACEVENT: %s, SUCCESS\n", event_name));
 686                 } else if (status == WLC_E_STATUS_FAIL) {
 687                         DHD_EVENT(("MACEVENT: %s, FAIL\n", event_name));
 688                 } else {
 689                         DHD_EVENT(("MACEVENT: %s, status %d\n", event_name,
 690                                    status));
 691                 }
 692                 break;
 693
 694         case WLC_E_LINK:
 695                 DHD_EVENT(("MACEVENT: %s %s\n", event_name,
 696                            link ? "UP" : "DOWN"));
 697                 break;
 698
 699         case WLC_E_MIC_ERROR:
 700                 DHD_EVENT(("MACEVENT: %s, MAC %s, Group %d, Flush %d\n",
 701                            event_name, eabuf, group, flush_txq));
 702                 break;
 703
 704         case WLC_E_ICV_ERROR:
 705         case WLC_E_UNICAST_DECODE_ERROR:
 706         case WLC_E_MULTICAST_DECODE_ERROR:
 707                 DHD_EVENT(("MACEVENT: %s, MAC %s\n", event_name, eabuf));
 708                 break;
 709
 710         case WLC_E_TXFAIL:
 711                 DHD_EVENT(("MACEVENT: %s, RA %s\n", event_name, eabuf));
 712                 break;
 713
 714         case WLC_E_SCAN_COMPLETE:
 715         case WLC_E_PMKID_CACHE:
 716                 DHD_EVENT(("MACEVENT: %s\n", event_name));
 717                 break;
 718
 719         case WLC_E_PFN_NET_FOUND:
 720         case WLC_E_PFN_NET_LOST:
 721         case WLC_E_PFN_SCAN_COMPLETE:
 722                 DHD_EVENT(("PNOEVENT: %s\n", event_name));
 723                 break;
 724
 725         case WLC_E_PSK_SUP:
 726         case WLC_E_PRUNE:
 727                 DHD_EVENT(("MACEVENT: %s, status %d, reason %d\n",
 728                            event_name, (int)status, (int)reason));
 729                 break;
 730
 731         case WLC_E_TRACE:
 732                 {
 733                         static u32 seqnum_prev;
 734                         msgtrace_hdr_t hdr;
 735                         u32 nblost;
 736                         char *s, *p;
 737
 738                         buf = (unsigned char *) event_data;
 739                         memcpy(&hdr, buf, MSGTRACE_HDRLEN);
 740
 741                         if (hdr.version != MSGTRACE_VERSION) {
 742                                 DHD_ERROR(
 743                                     ("\nMACEVENT: %s [unsupported version --> "
 744                                      "dhd version:%d dongle version:%d]\n",
 745                                      event_name, MSGTRACE_VERSION, hdr.version)
 746                                 );
 747                                 /* Reset datalen to avoid display below */
 748                                 datalen = 0;
 749                                 break;
 750                         }
 751
 752                         /* There are 2 bytes available at the end of data */
 753                         buf[MSGTRACE_HDRLEN + be16_to_cpu(hdr.len)] = '\0';
 754
 755                         if (be32_to_cpu(hdr.discarded_bytes)
 756                             || be32_to_cpu(hdr.discarded_printf)) {
 757                                 DHD_ERROR(
 758                                     ("\nWLC_E_TRACE: [Discarded traces in dongle -->"
 759                                      "discarded_bytes %d discarded_printf %d]\n",
 760                                      be32_to_cpu(hdr.discarded_bytes),
 761                                      be32_to_cpu(hdr.discarded_printf)));
 762                         }
 763
 764                         nblost = be32_to_cpu(hdr.seqnum) - seqnum_prev - 1;
 765                         if (nblost > 0) {
 766                                 DHD_ERROR(
 767                                     ("\nWLC_E_TRACE: [Event lost --> seqnum %d nblost %d\n",
 768                                      be32_to_cpu(hdr.seqnum), nblost));
 769                         }
 770                         seqnum_prev = be32_to_cpu(hdr.seqnum);
 771
 772                         /* Display the trace buffer. Advance from \n to \n to
 773                          * avoid display big
 774                          * printf (issue with Linux printk )
 775                          */
 776                         p = (char *)&buf[MSGTRACE_HDRLEN];
 777                         while ((s = strstr(p, "\n")) != NULL) {
 778                                 *s = '\0';
 779                                 printk(KERN_DEBUG"%s\n", p);
 780                                 p = s + 1;
 781                         }
 782                         printk(KERN_DEBUG "%s\n", p);
 783
 784                         /* Reset datalen to avoid display below */
 785                         datalen = 0;
 786                 }
 787                 break;
 788
 789         case WLC_E_RSSI:
 790                 DHD_EVENT(("MACEVENT: %s %d\n", event_name,
 791                            be32_to_cpu(*((int *)event_data))));
 792                 break;
 793
 794         default:
 795                 DHD_EVENT(("MACEVENT: %s %d, MAC %s, status %d, reason %d, "
 796                         "auth %d\n", event_name, event_type, eabuf,
 797                         (int)status, (int)reason, (int)auth_type));
 798                 break;
 799         }
 800
 801         /* show any appended data */
 802         if (datalen) {
 803                 buf = (unsigned char *) event_data;
 804                 DHD_EVENT((" data (%d) : ", datalen));
 805                 for (i = 0; i < datalen; i++)
 806                         DHD_EVENT((" 0x%02x ", *buf++));
 807                 DHD_EVENT(("\n"));
 808         }
 809 }
 810 #endif                          /* SHOW_EVENTS */
 811
 812 int
 813 wl_host_event(struct dhd_info *dhd, int *ifidx, void *pktdata,
 814               wl_event_msg_t *event, void **data_ptr)
 815 {
 816         /* check whether packet is a BRCM event pkt */
 817         bcm_event_t *pvt_data = (bcm_event_t *) pktdata;
 818         char *event_data;
 819         u32 type, status;
 820         u16 flags;
 821         int evlen;
 822
 823         if (memcmp(BRCM_OUI, &pvt_data->bcm_hdr.oui[0], DOT11_OUI_LEN)) {
 824                 DHD_ERROR(("%s: mismatched OUI, bailing\n", __func__));
 825                 return BCME_ERROR;
 826         }
 827
 828         /* BRCM event pkt may be unaligned - use xxx_ua to load user_subtype. */
 829         if (ntoh16_ua((void *)&pvt_data->bcm_hdr.usr_subtype) !=
 830             BCMILCP_BCM_SUBTYPE_EVENT) {
 831                 DHD_ERROR(("%s: mismatched subtype, bailing\n", __func__));
 832                 return BCME_ERROR;
 833         }
 834
 835         *data_ptr = &pvt_data[1];
 836         event_data = *data_ptr;
 837
 838         /* memcpy since BRCM event pkt may be unaligned. */
 839         memcpy(event, &pvt_data->event, sizeof(wl_event_msg_t));
 840
 841         type = ntoh32_ua((void *)&event->event_type);
 842         flags = ntoh16_ua((void *)&event->flags);
 843         status = ntoh32_ua((void *)&event->status);
 844         evlen = ntoh32_ua((void *)&event->datalen) + sizeof(bcm_event_t);
 845
 846         switch (type) {
 847         case WLC_E_IF:
 848                 {
 849                         dhd_if_event_t *ifevent = (dhd_if_event_t *) event_data;
 850                         DHD_TRACE(("%s: if event\n", __func__));
 851
 852                         if (ifevent->ifidx > 0 &&
 853                                  ifevent->ifidx < DHD_MAX_IFS) {
 854                                 if (ifevent->action == WLC_E_IF_ADD)
 855                                         dhd_add_if(dhd, ifevent->ifidx,
 856                                                    NULL, event->ifname,
 857                                                    pvt_data->eth.h_dest,
 858                                                    ifevent->flags,
 859                                                    ifevent->bssidx);
 860                                 else
 861                                         dhd_del_if(dhd, ifevent->ifidx);
 862                         } else {
 863                                 DHD_ERROR(("%s: Invalid ifidx %d for %s\n",
 864                                            __func__, ifevent->ifidx,
 865                                            event->ifname));
 866                         }
 867                 }
 868                 /* send up the if event: btamp user needs it */
 869                 *ifidx = dhd_ifname2idx(dhd, event->ifname);
 870                 /* push up to external supp/auth */
 871                 dhd_event(dhd, (char *)pvt_data, evlen, *ifidx);
 872                 break;
 873
 874 #ifdef P2P
 875         case WLC_E_NDIS_LINK:
 876                 break;
 877 #endif
 878                 /* fall through */
 879                 /* These are what external supplicant/authenticator wants */
 880         case WLC_E_LINK:
 881         case WLC_E_ASSOC_IND:
 882         case WLC_E_REASSOC_IND:
 883         case WLC_E_DISASSOC_IND:
 884         case WLC_E_MIC_ERROR:
 885         default:
 886                 /* Fall through: this should get _everything_  */
 887
 888                 *ifidx = dhd_ifname2idx(dhd, event->ifname);
 889                 /* push up to external supp/auth */
 890                 dhd_event(dhd, (char *)pvt_data, evlen, *ifidx);
 891                 DHD_TRACE(("%s: MAC event %d, flags %x, status %x\n",
 892                            __func__, type, flags, status));
 893
 894                 /* put it back to WLC_E_NDIS_LINK */
 895                 if (type == WLC_E_NDIS_LINK) {
 896                         u32 temp;
 897
 898                         temp = ntoh32_ua((void *)&event->event_type);
 899                         DHD_TRACE(("Converted to WLC_E_LINK type %d\n", temp));
 900
 901                         temp = be32_to_cpu(WLC_E_NDIS_LINK);
 902                         memcpy((void *)(&pvt_data->event.event_type), &temp,
 903                                sizeof(pvt_data->event.event_type));
 904                 }
 905                 break;
 906         }
 907
 908 #ifdef SHOW_EVENTS
 909         wl_show_host_event(event, event_data);
 910 #endif                          /* SHOW_EVENTS */
 911
 912         return BCME_OK;
 913 }
 914
 915 /* Convert user's input in hex pattern to byte-size mask */
 916 static int wl_pattern_atoh(char *src, char *dst)
 917 {
 918         int i;
 919         if (strncmp(src, "0x", 2) != 0 && strncmp(src, "0X", 2) != 0) {
 920                 DHD_ERROR(("Mask invalid format. Needs to start with 0x\n"));
 921                 return -1;
 922         }
 923         src = src + 2;          /* Skip past 0x */
 924         if (strlen(src) % 2 != 0) {
 925                 DHD_ERROR(("Mask invalid format. Length must be even.\n"));
 926                 return -1;
 927         }
 928         for (i = 0; *src != '\0'; i++) {
 929                 char num[3];
 930                 strncpy(num, src, 2);
 931                 num[2] = '\0';
 932                 dst[i] = (u8) simple_strtoul(num, NULL, 16);
 933                 src += 2;
 934         }
 935         return i;
 936 }
 937
 938 void
 939 dhd_pktfilter_offload_enable(dhd_pub_t *dhd, char *arg, int enable,
 940                              int master_mode)
 941 {
 942         char *argv[8];
 943         int i = 0;
 944         const char *str;
 945         int buf_len;
 946         int str_len;
 947         char *arg_save = 0, *arg_org = 0;
 948         int rc;
 949         char buf[128];
 950         wl_pkt_filter_enable_t enable_parm;
 951         wl_pkt_filter_enable_t *pkt_filterp;
 952
 953         arg_save = kmalloc(strlen(arg) + 1, GFP_ATOMIC);
 954         if (!arg_save) {
 955                 DHD_ERROR(("%s: kmalloc failed\n", __func__));
 956                 goto fail;
 957         }
 958         arg_org = arg_save;
 959         memcpy(arg_save, arg, strlen(arg) + 1);
 960
 961         argv[i] = strsep(&arg_save, " ");
 962
 963         i = 0;
 964         if (NULL == argv[i]) {
 965                 DHD_ERROR(("No args provided\n"));
 966                 goto fail;
 967         }
 968
 969         str = "pkt_filter_enable";
 970         str_len = strlen(str);
 971         strncpy(buf, str, str_len);
 972         buf[str_len] = '\0';
 973         buf_len = str_len + 1;
 974
 975         pkt_filterp = (wl_pkt_filter_enable_t *) (buf + str_len + 1);
 976
 977         /* Parse packet filter id. */
 978         enable_parm.id = htod32(simple_strtoul(argv[i], NULL, 0));
 979
 980         /* Parse enable/disable value. */
 981         enable_parm.enable = htod32(enable);
 982
 983         buf_len += sizeof(enable_parm);
 984         memcpy((char *)pkt_filterp, &enable_parm, sizeof(enable_parm));
 985
 986         /* Enable/disable the specified filter. */
 987         rc = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, buf, buf_len);
 988         rc = rc >= 0 ? 0 : rc;
 989         if (rc)
 990                 DHD_TRACE(("%s: failed to add pktfilter %s, retcode = %d\n",
 991                            __func__, arg, rc));
 992         else
 993                 DHD_TRACE(("%s: successfully added pktfilter %s\n",
 994                            __func__, arg));
 995
 996         /* Contorl the master mode */
 997         bcm_mkiovar("pkt_filter_mode", (char *)&master_mode, 4, buf,
 998                     sizeof(buf));
 999         rc = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, buf, sizeof(buf));
1000         rc = rc >= 0 ? 0 : rc;
1001         if (rc)
1002                 DHD_TRACE(("%s: failed to add pktfilter %s, retcode = %d\n",
1003                            __func__, arg, rc));
1004
1005 fail:
1006         if (arg_org)
1007                 kfree(arg_org);
1008 }
1009
1010 void dhd_pktfilter_offload_set(dhd_pub_t *dhd, char *arg)
1011 {
1012         const char *str;
1013         wl_pkt_filter_t pkt_filter;
1014         wl_pkt_filter_t *pkt_filterp;
1015         int buf_len;
1016         int str_len;
1017         int rc;
1018         u32 mask_size;
1019         u32 pattern_size;
1020         char *argv[8], *buf = 0;
1021         int i = 0;
1022         char *arg_save = 0, *arg_org = 0;
1023 #define BUF_SIZE                2048
1024
1025         arg_save = kmalloc(strlen(arg) + 1, GFP_ATOMIC);
1026         if (!arg_save) {
1027                 DHD_ERROR(("%s: kmalloc failed\n", __func__));
1028                 goto fail;
1029         }
1030
1031         arg_org = arg_save;
1032
1033         buf = kmalloc(BUF_SIZE, GFP_ATOMIC);
1034         if (!buf) {
1035                 DHD_ERROR(("%s: kmalloc failed\n", __func__));
1036                 goto fail;
1037         }
1038
1039         memcpy(arg_save, arg, strlen(arg) + 1);
1040
1041         if (strlen(arg) > BUF_SIZE) {
1042                 DHD_ERROR(("Not enough buffer %d < %d\n", (int)strlen(arg),
1043                            (int)sizeof(buf)));
1044                 goto fail;
1045         }
1046
1047         argv[i] = strsep(&arg_save, " ");
1048         while (argv[i++])
1049                 argv[i] = strsep(&arg_save, " ");
1050
1051         i = 0;
1052         if (NULL == argv[i]) {
1053                 DHD_ERROR(("No args provided\n"));
1054                 goto fail;
1055         }
1056
1057         str = "pkt_filter_add";
1058         str_len = strlen(str);
1059         strncpy(buf, str, str_len);
1060         buf[str_len] = '\0';
1061         buf_len = str_len + 1;
1062
1063         pkt_filterp = (wl_pkt_filter_t *) (buf + str_len + 1);
1064
1065         /* Parse packet filter id. */
1066         pkt_filter.id = htod32(simple_strtoul(argv[i], NULL, 0));
1067
1068         if (NULL == argv[++i]) {
1069                 DHD_ERROR(("Polarity not provided\n"));
1070                 goto fail;
1071         }
1072
1073         /* Parse filter polarity. */
1074         pkt_filter.negate_match = htod32(simple_strtoul(argv[i], NULL, 0));
1075
1076         if (NULL == argv[++i]) {
1077                 DHD_ERROR(("Filter type not provided\n"));
1078                 goto fail;
1079         }
1080
1081         /* Parse filter type. */
1082         pkt_filter.type = htod32(simple_strtoul(argv[i], NULL, 0));
1083
1084         if (NULL == argv[++i]) {
1085                 DHD_ERROR(("Offset not provided\n"));
1086                 goto fail;
1087         }
1088
1089         /* Parse pattern filter offset. */
1090         pkt_filter.u.pattern.offset = htod32(simple_strtoul(argv[i], NULL, 0));
1091
1092         if (NULL == argv[++i]) {
1093                 DHD_ERROR(("Bitmask not provided\n"));
1094                 goto fail;
1095         }
1096
1097         /* Parse pattern filter mask. */
1098         mask_size =
1099             htod32(wl_pattern_atoh
1100                    (argv[i], (char *)pkt_filterp->u.pattern.mask_and_pattern));
1101
1102         if (NULL == argv[++i]) {
1103                 DHD_ERROR(("Pattern not provided\n"));
1104                 goto fail;
1105         }
1106
1107         /* Parse pattern filter pattern. */
1108         pattern_size =
1109             htod32(wl_pattern_atoh(argv[i],
1110                                    (char *)&pkt_filterp->u.pattern.
1111                                    mask_and_pattern[mask_size]));
1112
1113         if (mask_size != pattern_size) {
1114                 DHD_ERROR(("Mask and pattern not the same size\n"));
1115                 goto fail;
1116         }
1117
1118         pkt_filter.u.pattern.size_bytes = mask_size;
1119         buf_len += WL_PKT_FILTER_FIXED_LEN;
1120         buf_len += (WL_PKT_FILTER_PATTERN_FIXED_LEN + 2 * mask_size);
1121
1122         /* Keep-alive attributes are set in local
1123          * variable (keep_alive_pkt), and
1124          ** then memcpy'ed into buffer (keep_alive_pktp) since there is no
1125          ** guarantee that the buffer is properly aligned.
1126          */
1127         memcpy((char *)pkt_filterp,
1128                &pkt_filter,
1129                WL_PKT_FILTER_FIXED_LEN + WL_PKT_FILTER_PATTERN_FIXED_LEN);
1130
1131         rc = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, buf, buf_len);
1132         rc = rc >= 0 ? 0 : rc;
1133
1134         if (rc)
1135                 DHD_TRACE(("%s: failed to add pktfilter %s, retcode = %d\n",
1136                            __func__, arg, rc));
1137         else
1138                 DHD_TRACE(("%s: successfully added pktfilter %s\n",
1139                            __func__, arg));
1140
1141 fail:
1142         if (arg_org)
1143                 kfree(arg_org);
1144
1145         if (buf)
1146                 kfree(buf);
1147 }
1148
1149 void dhd_arp_offload_set(dhd_pub_t *dhd, int arp_mode)
1150 {
1151         char iovbuf[32];
1152         int retcode;
1153
1154         bcm_mkiovar("arp_ol", (char *)&arp_mode, 4, iovbuf, sizeof(iovbuf));
1155         retcode = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1156         retcode = retcode >= 0 ? 0 : retcode;
1157         if (retcode)
1158                 DHD_TRACE(("%s: failed to set ARP offload mode to 0x%x, "
1159                         "retcode = %d\n", __func__, arp_mode, retcode));
1160         else
1161                 DHD_TRACE(("%s: successfully set ARP offload mode to 0x%x\n",
1162                            __func__, arp_mode));
1163 }
1164
1165 void dhd_arp_offload_enable(dhd_pub_t *dhd, int arp_enable)
1166 {
1167         char iovbuf[32];
1168         int retcode;
1169
1170         bcm_mkiovar("arpoe", (char *)&arp_enable, 4, iovbuf, sizeof(iovbuf));
1171         retcode = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1172         retcode = retcode >= 0 ? 0 : retcode;
1173         if (retcode)
1174                 DHD_TRACE(("%s: failed to enabe ARP offload to %d, "
1175                         "retcode = %d\n", __func__, arp_enable, retcode));
1176         else
1177                 DHD_TRACE(("%s: successfully enabed ARP offload to %d\n",
1178                            __func__, arp_enable));
1179 }
1180
1181 int dhd_preinit_ioctls(dhd_pub_t *dhd)
1182 {
1183         char iovbuf[WL_EVENTING_MASK_LEN + 12]; /*  Room for
1184                                  "event_msgs" + '\0' + bitvec  */
1185         uint up = 0;
1186         char buf[128], *ptr;
1187         uint power_mode = PM_FAST;
1188         u32 dongle_align = DHD_SDALIGN;
1189         u32 glom = 0;
1190         uint bcn_timeout = 3;
1191         int scan_assoc_time = 40;
1192         int scan_unassoc_time = 40;
1193 #ifdef GET_CUSTOM_MAC_ENABLE
1194         int ret = 0;
1195         u8 ea_addr[ETH_ALEN];
1196 #endif                          /* GET_CUSTOM_MAC_ENABLE */
1197
1198         dhd_os_proto_block(dhd);
1199
1200 #ifdef GET_CUSTOM_MAC_ENABLE
1201         /* Read MAC address from external customer place
1202          ** NOTE that default mac address has to be present in
1203          ** otp or nvram file to bring up
1204          ** firmware but unique per board mac address maybe provided by
1205          ** customer code
1206          */
1207         ret = dhd_custom_get_mac_address(ea_addr);
1208         if (!ret) {
1209                 bcm_mkiovar("cur_etheraddr", (void *)ea_addr, ETH_ALEN,
1210                             buf, sizeof(buf));
1211                 ret = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, buf, sizeof(buf));
1212                 if (ret < 0) {
1213                         DHD_ERROR(("%s: can't set MAC address , error=%d\n",
1214                                    __func__, ret));
1215                 } else
1216                         memcpy(dhd->mac.octet, (void *)&ea_addr,
1217                                ETH_ALEN);
1218         }
1219 #endif                          /* GET_CUSTOM_MAC_ENABLE */
1220
1221         /* Set Country code */
1222         if (dhd->country_code[0] != 0) {
1223                 if (dhdcdc_set_ioctl(dhd, 0, WLC_SET_COUNTRY,
1224                                      dhd->country_code,
1225                                      sizeof(dhd->country_code)) < 0) {
1226                         DHD_ERROR(("%s: country code setting failed\n",
1227                                    __func__));
1228                 }
1229         }
1230
1231         /* query for 'ver' to get version info from firmware */
1232         memset(buf, 0, sizeof(buf));
1233         ptr = buf;
1234         bcm_mkiovar("ver", 0, 0, buf, sizeof(buf));
1235         dhdcdc_query_ioctl(dhd, 0, WLC_GET_VAR, buf, sizeof(buf));
1236         strsep(&ptr, "\n");
1237         /* Print fw version info */
1238         DHD_ERROR(("Firmware version = %s\n", buf));
1239
1240         /* Set PowerSave mode */
1241         dhdcdc_set_ioctl(dhd, 0, WLC_SET_PM, (char *)&power_mode,
1242                          sizeof(power_mode));
1243
1244         /* Match Host and Dongle rx alignment */
1245         bcm_mkiovar("bus:txglomalign", (char *)&dongle_align, 4, iovbuf,
1246                     sizeof(iovbuf));
1247         dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1248
1249         /* disable glom option per default */
1250         bcm_mkiovar("bus:txglom", (char *)&glom, 4, iovbuf, sizeof(iovbuf));
1251         dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1252
1253         /* Setup timeout if Beacons are lost and roam is off to report
1254                  link down */
1255         bcm_mkiovar("bcn_timeout", (char *)&bcn_timeout, 4, iovbuf,
1256                     sizeof(iovbuf));
1257         dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1258
1259         /* Enable/Disable build-in roaming to allowed ext supplicant to take
1260                  of romaing */
1261         bcm_mkiovar("roam_off", (char *)&dhd_roam, 4, iovbuf, sizeof(iovbuf));
1262         dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1263
1264         /* Force STA UP */
1265         if (dhd_radio_up)
1266                 dhdcdc_set_ioctl(dhd, 0, WLC_UP, (char *)&up, sizeof(up));
1267
1268         /* Setup event_msgs */
1269         bcm_mkiovar("event_msgs", dhd->eventmask, WL_EVENTING_MASK_LEN, iovbuf,
1270                     sizeof(iovbuf));
1271         dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1272
1273         dhdcdc_set_ioctl(dhd, 0, WLC_SET_SCAN_CHANNEL_TIME,
1274                          (char *)&scan_assoc_time, sizeof(scan_assoc_time));
1275         dhdcdc_set_ioctl(dhd, 0, WLC_SET_SCAN_UNASSOC_TIME,
1276                          (char *)&scan_unassoc_time, sizeof(scan_unassoc_time));
1277
1278 #ifdef ARP_OFFLOAD_SUPPORT
1279         /* Set and enable ARP offload feature */
1280         if (dhd_arp_enable)
1281                 dhd_arp_offload_set(dhd, dhd_arp_mode);
1282         dhd_arp_offload_enable(dhd, dhd_arp_enable);
1283 #endif                          /* ARP_OFFLOAD_SUPPORT */
1284
1285 #ifdef PKT_FILTER_SUPPORT
1286         {
1287                 int i;
1288                 /* Set up pkt filter */
1289                 if (dhd_pkt_filter_enable) {
1290                         for (i = 0; i < dhd->pktfilter_count; i++) {
1291                                 dhd_pktfilter_offload_set(dhd,
1292                                                           dhd->pktfilter[i]);
1293                                 dhd_pktfilter_offload_enable(dhd,
1294                                      dhd->pktfilter[i],
1295                                      dhd_pkt_filter_init,
1296                                      dhd_master_mode);
1297                         }
1298                 }
1299         }
1300 #endif                          /* PKT_FILTER_SUPPORT */
1301
1302         dhd_os_proto_unblock(dhd);
1303
1304         return 0;
1305 }
1306
1307 #ifdef SIMPLE_ISCAN
1308 uint iscan_thread_id;
1309 iscan_buf_t *iscan_chain;
1310
1311 iscan_buf_t *dhd_iscan_allocate_buf(dhd_pub_t *dhd, iscan_buf_t **iscanbuf)
1312 {
1313         iscan_buf_t *iscanbuf_alloc = 0;
1314         iscan_buf_t *iscanbuf_head;
1315
1316         dhd_iscan_lock();
1317
1318         iscanbuf_alloc = kmalloc(sizeof(iscan_buf_t), GFP_ATOMIC);
1319         if (iscanbuf_alloc == NULL)
1320                 goto fail;
1321
1322         iscanbuf_alloc->next = NULL;
1323         iscanbuf_head = *iscanbuf;
1324
1325         DHD_ISCAN(("%s: addr of allocated node = 0x%X"
1326                    "addr of iscanbuf_head = 0x%X dhd = 0x%X\n",
1327                    __func__, iscanbuf_alloc, iscanbuf_head, dhd));
1328
1329         if (iscanbuf_head == NULL) {
1330                 *iscanbuf = iscanbuf_alloc;
1331                 DHD_ISCAN(("%s: Head is allocated\n", __func__));
1332                 goto fail;
1333         }
1334
1335         while (iscanbuf_head->next)
1336                 iscanbuf_head = iscanbuf_head->next;
1337
1338         iscanbuf_head->next = iscanbuf_alloc;
1339
1340 fail:
1341         dhd_iscan_unlock();
1342         return iscanbuf_alloc;
1343 }
1344
1345 void dhd_iscan_free_buf(void *dhdp, iscan_buf_t *iscan_delete)
1346 {
1347         iscan_buf_t *iscanbuf_free = 0;
1348         iscan_buf_t *iscanbuf_prv = 0;
1349         iscan_buf_t *iscanbuf_cur = iscan_chain;
1350         dhd_pub_t *dhd = dhd_bus_pub(dhdp);
1351
1352         dhd_iscan_lock();
1353         /* If iscan_delete is null then delete the entire
1354          * chain or else delete specific one provided
1355          */
1356         if (!iscan_delete) {
1357                 while (iscanbuf_cur) {
1358                         iscanbuf_free = iscanbuf_cur;
1359                         iscanbuf_cur = iscanbuf_cur->next;
1360                         iscanbuf_free->next = 0;
1361                         kfree(iscanbuf_free);
1362                 }
1363                 iscan_chain = 0;
1364         } else {
1365                 while (iscanbuf_cur) {
1366                         if (iscanbuf_cur == iscan_delete)
1367                                 break;
1368                         iscanbuf_prv = iscanbuf_cur;
1369                         iscanbuf_cur = iscanbuf_cur->next;
1370                 }
1371                 if (iscanbuf_prv)
1372                         iscanbuf_prv->next = iscan_delete->next;
1373
1374                 iscan_delete->next = 0;
1375                 kfree(iscan_delete);
1376
1377                 if (!iscanbuf_prv)
1378                         iscan_chain = 0;
1379         }
1380         dhd_iscan_unlock();
1381 }
1382
1383 iscan_buf_t *dhd_iscan_result_buf(void)
1384 {
1385         return iscan_chain;
1386 }
1387
1388 /*
1389 * print scan cache
1390 * print partial iscan_skip list differently
1391 */
1392 int dhd_iscan_print_cache(iscan_buf_t *iscan_skip)
1393 {
1394         int i = 0, l = 0;
1395         iscan_buf_t *iscan_cur;
1396         wl_iscan_results_t *list;
1397         wl_scan_results_t *results;
1398         wl_bss_info_t UNALIGNED *bi;
1399
1400         dhd_iscan_lock();
1401
1402         iscan_cur = dhd_iscan_result_buf();
1403
1404         while (iscan_cur) {
1405                 list = (wl_iscan_results_t *)iscan_cur->iscan_buf;
1406                 if (!list)
1407                         break;
1408
1409                 results = (wl_scan_results_t *)&list->results;
1410                 if (!results)
1411                         break;
1412
1413                 if (results->version != WL_BSS_INFO_VERSION) {
1414                         DHD_ISCAN(("%s: results->version %d != "
1415                                 "WL_BSS_INFO_VERSION\n",
1416                                 __func__, results->version));
1417                         goto done;
1418                 }
1419
1420                 bi = results->bss_info;
1421                 for (i = 0; i < results->count; i++) {
1422                         if (!bi)
1423                                 break;
1424
1425                         DHD_ISCAN(("%s[%2.2d:%2.2d] %X:%X:%X:%X:%X:%X\n",
1426                                    iscan_cur != iscan_skip ? "BSS" : "bss", l,
1427                                    i, bi->BSSID.octet[0], bi->BSSID.octet[1],
1428                                    bi->BSSID.octet[2], bi->BSSID.octet[3],
1429                                    bi->BSSID.octet[4], bi->BSSID.octet[5]));
1430
1431                         bi = (wl_bss_info_t *)((unsigned long)bi +
1432                                                 dtoh32(bi->length));
1433                 }
1434                 iscan_cur = iscan_cur->next;
1435                 l++;
1436         }
1437
1438 done:
1439         dhd_iscan_unlock();
1440         return 0;
1441 }
1442
1443 /*
1444 * delete disappeared AP from specific scan cache but skip partial
1445 * list in iscan_skip
1446 */
1447 int dhd_iscan_delete_bss(void *dhdp, void *addr, iscan_buf_t *iscan_skip)
1448 {
1449         int i = 0, j = 0, l = 0;
1450         iscan_buf_t *iscan_cur;
1451         wl_iscan_results_t *list;
1452         wl_scan_results_t *results;
1453         wl_bss_info_t UNALIGNED *bi, *bi_new, *bi_next;
1454
1455         unsigned char *s_addr = addr;
1456
1457         dhd_iscan_lock();
1458         DHD_ISCAN(("%s: BSS to remove %X:%X:%X:%X:%X:%X\n",
1459                    __func__, s_addr[0], s_addr[1], s_addr[2],
1460                    s_addr[3], s_addr[4], s_addr[5]));
1461
1462         iscan_cur = dhd_iscan_result_buf();
1463
1464         while (iscan_cur) {
1465                 if (iscan_cur != iscan_skip) {
1466                         list = (wl_iscan_results_t *)iscan_cur->iscan_buf;
1467                         if (!list)
1468                                 break;
1469
1470                         results = (wl_scan_results_t *)&list->results;
1471                         if (!results)
1472                                 break;
1473
1474                         if (results->version != WL_BSS_INFO_VERSION) {
1475                                 DHD_ERROR(("%s: results->version %d != "
1476                                         "WL_BSS_INFO_VERSION\n",
1477                                         __func__, results->version));
1478                                 goto done;
1479                         }
1480
1481                         bi = results->bss_info;
1482                         for (i = 0; i < results->count; i++) {
1483                                 if (!bi)
1484                                         break;
1485
1486                                 if (!memcmp
1487                                     (bi->BSSID.octet, addr, ETH_ALEN)) {
1488                                         DHD_ISCAN(("%s: Del BSS[%2.2d:%2.2d] "
1489                                         "%X:%X:%X:%X:%X:%X\n",
1490                                         __func__, l, i, bi->BSSID.octet[0],
1491                                         bi->BSSID.octet[1], bi->BSSID.octet[2],
1492                                         bi->BSSID.octet[3], bi->BSSID.octet[4],
1493                                         bi->BSSID.octet[5]));
1494
1495                                         bi_new = bi;
1496                                         bi = (wl_bss_info_t *)((unsigned long)bi +
1497                                                                 dtoh32
1498                                                                 (bi->length));
1499 /*
1500                         if(bi && bi_new) {
1501                                 memcpy(bi_new, bi, results->buflen -
1502                                 dtoh32(bi_new->length));
1503                                 results->buflen -= dtoh32(bi_new->length);
1504                         }
1505 */
1506                                         results->buflen -=
1507                                             dtoh32(bi_new->length);
1508                                         results->count--;
1509
1510                                         for (j = i; j < results->count; j++) {
1511                                                 if (bi && bi_new) {
1512                                                         DHD_ISCAN(("%s: Moved up BSS[%2.2d:%2.2d]" "%X:%X:%X:%X:%X:%X\n",
1513                                                         __func__, l, j,
1514                                                         bi->BSSID.octet[0],
1515                                                         bi->BSSID.octet[1],
1516                                                         bi->BSSID.octet[2],
1517                                                         bi->BSSID.octet[3],
1518                                                         bi->BSSID.octet[4],
1519                                                         bi->BSSID.octet[5]));
1520
1521                                                         bi_next =
1522                                                             (wl_bss_info_t *)((unsigned long)bi +
1523                                                                  dtoh32
1524                                                                  (bi->length));
1525                                                         memcpy(bi_new, bi,
1526                                                               dtoh32
1527                                                               (bi->length));
1528                                                         bi_new =
1529                                                             (wl_bss_info_t *)((unsigned long)bi_new +
1530                                                                  dtoh32
1531                                                                  (bi_new->
1532                                                                   length));
1533                                                         bi = bi_next;
1534                                                 }
1535                                         }
1536
1537                                         if (results->count == 0) {
1538                                                 /* Prune now empty partial
1539                                                 scan list */
1540                                                 dhd_iscan_free_buf(dhdp,
1541                                                                    iscan_cur);
1542                                                 goto done;
1543                                         }
1544                                         break;
1545                                 }
1546                                 bi = (wl_bss_info_t *)((unsigned long)bi +
1547                                                         dtoh32(bi->length));
1548                         }
1549                 }
1550                 iscan_cur = iscan_cur->next;
1551                 l++;
1552         }
1553
1554 done:
1555         dhd_iscan_unlock();
1556         return 0;
1557 }
1558
1559 int dhd_iscan_remove_duplicates(void *dhdp, iscan_buf_t *iscan_cur)
1560 {
1561         int i = 0;
1562         wl_iscan_results_t *list;
1563         wl_scan_results_t *results;
1564         wl_bss_info_t UNALIGNED *bi, *bi_new, *bi_next;
1565
1566         dhd_iscan_lock();
1567
1568         DHD_ISCAN(("%s: Scan cache before delete\n", __func__));
1569         dhd_iscan_print_cache(iscan_cur);
1570
1571         if (!iscan_cur)
1572                 goto done;
1573
1574         list = (wl_iscan_results_t *)iscan_cur->iscan_buf;
1575         if (!list)
1576                 goto done;
1577
1578         results = (wl_scan_results_t *)&list->results;
1579         if (!results)
1580                 goto done;
1581
1582         if (results->version != WL_BSS_INFO_VERSION) {
1583                 DHD_ERROR(("%s: results->version %d != WL_BSS_INFO_VERSION\n",
1584                            __func__, results->version));
1585                 goto done;
1586         }
1587
1588         bi = results->bss_info;
1589         for (i = 0; i < results->count; i++) {
1590                 if (!bi)
1591                         break;
1592
1593                 DHD_ISCAN(("%s: Find dups for BSS[%2.2d] %X:%X:%X:%X:%X:%X\n",
1594                            __func__, i, bi->BSSID.octet[0],
1595                            bi->BSSID.octet[1], bi->BSSID.octet[2],
1596                            bi->BSSID.octet[3], bi->BSSID.octet[4],
1597                            bi->BSSID.octet[5]));
1598
1599                 dhd_iscan_delete_bss(dhdp, bi->BSSID.octet, iscan_cur);
1600
1601                 bi = (wl_bss_info_t *)((unsigned long)bi + dtoh32(bi->length));
1602         }
1603
1604 done:
1605         DHD_ISCAN(("%s: Scan cache after delete\n", __func__));
1606         dhd_iscan_print_cache(iscan_cur);
1607         dhd_iscan_unlock();
1608         return 0;
1609 }
1610
1611 void dhd_iscan_ind_scan_confirm(void *dhdp, bool status)
1612 {
1613
1614         dhd_ind_scan_confirm(dhdp, status);
1615 }
1616
1617 int dhd_iscan_request(void *dhdp, u16 action)
1618 {
1619         int rc;
1620         wl_iscan_params_t params;
1621         dhd_pub_t *dhd = dhd_bus_pub(dhdp);
1622         char buf[WLC_IOCTL_SMLEN];
1623
1624         memset(&params, 0, sizeof(wl_iscan_params_t));
1625         memcpy(&params.params.bssid, &ether_bcast, ETH_ALEN);
1626
1627         params.params.bss_type = DOT11_BSSTYPE_ANY;
1628         params.params.scan_type = DOT11_SCANTYPE_ACTIVE;
1629
1630         params.params.nprobes = htod32(-1);
1631         params.params.active_time = htod32(-1);
1632         params.params.passive_time = htod32(-1);
1633         params.params.home_time = htod32(-1);
1634         params.params.channel_num = htod32(0);
1635
1636         params.version = htod32(ISCAN_REQ_VERSION);
1637         params.action = htod16(action);
1638         params.scan_duration = htod16(0);
1639
1640         bcm_mkiovar("iscan", (char *)&params, sizeof(wl_iscan_params_t), buf,
1641                     WLC_IOCTL_SMLEN);
1642         rc = dhd_wl_ioctl(dhdp, WLC_SET_VAR, buf, WLC_IOCTL_SMLEN);
1643
1644         return rc;
1645 }
1646
1647 static int dhd_iscan_get_partial_result(void *dhdp, uint *scan_count)
1648 {
1649         wl_iscan_results_t *list_buf;
1650         wl_iscan_results_t list;
1651         wl_scan_results_t *results;
1652         iscan_buf_t *iscan_cur;
1653         int status = -1;
1654         dhd_pub_t *dhd = dhd_bus_pub(dhdp);
1655         int rc;
1656
1657         iscan_cur = dhd_iscan_allocate_buf(dhd, &iscan_chain);
1658         if (!iscan_cur) {
1659                 DHD_ERROR(("%s: Failed to allocate node\n", __func__));
1660                 dhd_iscan_free_buf(dhdp, 0);
1661                 dhd_iscan_request(dhdp, WL_SCAN_ACTION_ABORT);
1662                 goto fail;
1663         }
1664
1665         dhd_iscan_lock();
1666
1667         memset(iscan_cur->iscan_buf, 0, WLC_IW_ISCAN_MAXLEN);
1668         list_buf = (wl_iscan_results_t *) iscan_cur->iscan_buf;
1669         results = &list_buf->results;
1670         results->buflen = WL_ISCAN_RESULTS_FIXED_SIZE;
1671         results->version = 0;
1672         results->count = 0;
1673
1674         memset(&list, 0, sizeof(list));
1675         list.results.buflen = htod32(WLC_IW_ISCAN_MAXLEN);
1676         bcm_mkiovar("iscanresults", (char *)&list, WL_ISCAN_RESULTS_FIXED_SIZE,
1677                     iscan_cur->iscan_buf, WLC_IW_ISCAN_MAXLEN);
1678         rc = dhd_wl_ioctl(dhdp, WLC_GET_VAR, iscan_cur->iscan_buf,
1679                           WLC_IW_ISCAN_MAXLEN);
1680
1681         results->buflen = dtoh32(results->buflen);
1682         results->version = dtoh32(results->version);
1683         *scan_count = results->count = dtoh32(results->count);
1684         status = dtoh32(list_buf->status);
1685
1686         dhd_iscan_unlock();
1687
1688         if (!(*scan_count))
1689                 dhd_iscan_free_buf(dhdp, iscan_cur);
1690         else
1691                 dhd_iscan_remove_duplicates(dhdp, iscan_cur);
1692
1693 fail:
1694         return status;
1695 }
1696 #endif                          /* SIMPLE_ISCAN */
1697
1698 #ifdef PNO_SUPPORT
1699 int dhd_pno_clean(dhd_pub_t *dhd)
1700 {
1701         char iovbuf[128];
1702         int pfn_enabled = 0;
1703         int iov_len = 0;
1704         int ret;
1705
1706         /* Disable pfn */
1707         iov_len =
1708             bcm_mkiovar("pfn", (char *)&pfn_enabled, 4, iovbuf, sizeof(iovbuf));
1709         ret = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1710         if (ret >= 0) {
1711                 /* clear pfn */
1712                 iov_len = bcm_mkiovar("pfnclear", 0, 0, iovbuf, sizeof(iovbuf));
1713                 if (iov_len) {
1714                         ret = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf,
1715                                         iov_len);
1716                         if (ret < 0) {
1717                                 DHD_ERROR(("%s failed code %d\n", __func__,
1718                                            ret));
1719                         }
1720                 } else {
1721                         ret = -1;
1722                         DHD_ERROR(("%s failed code %d\n", __func__, iov_len));
1723                 }
1724         } else
1725                 DHD_ERROR(("%s failed code %d\n", __func__, ret));
1726
1727         return ret;
1728 }
1729
1730 int dhd_pno_enable(dhd_pub_t *dhd, int pfn_enabled)
1731 {
1732         char iovbuf[128];
1733         int ret = -1;
1734
1735         if ((!dhd) && ((pfn_enabled != 0) || (pfn_enabled != 1))) {
1736                 DHD_ERROR(("%s error exit\n", __func__));
1737                 return ret;
1738         }
1739
1740         /* Enable/disable PNO */
1741         ret = bcm_mkiovar("pfn", (char *)&pfn_enabled, 4, iovbuf,
1742                         sizeof(iovbuf));
1743         if (ret > 0) {
1744                 ret = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf,
1745                                 sizeof(iovbuf));
1746                 if (ret < 0) {
1747                         DHD_ERROR(("%s failed for error=%d\n", __func__, ret));
1748                         return ret;
1749                 } else {
1750                         dhd->pno_enable = pfn_enabled;
1751                         DHD_TRACE(("%s set pno as %d\n", __func__,
1752                                    dhd->pno_enable));
1753                 }
1754         } else
1755                 DHD_ERROR(("%s failed err=%d\n", __func__, ret));
1756
1757         return ret;
1758 }
1759
1760 /* Function to execute combined scan */
1761 int
1762 dhd_pno_set(dhd_pub_t *dhd, wlc_ssid_t *ssids_local, int nssid, unsigned char scan_fr)
1763 {
1764         int err = -1;
1765         char iovbuf[128];
1766         int k, i;
1767         wl_pfn_param_t pfn_param;
1768         wl_pfn_t pfn_element;
1769
1770         DHD_TRACE(("%s nssid=%d nchan=%d\n", __func__, nssid, scan_fr));
1771
1772         if ((!dhd) && (!ssids_local)) {
1773                 DHD_ERROR(("%s error exit\n", __func__));
1774                 err = -1;
1775         }
1776
1777         /* Check for broadcast ssid */
1778         for (k = 0; k < nssid; k++) {
1779                 if (!ssids_local[k].SSID_len) {
1780                         DHD_ERROR(("%d: Broadcast SSID is ilegal for PNO "
1781                                 "setting\n", k));
1782                         return err;
1783                 }
1784         }
1785 /* #define  PNO_DUMP 1 */
1786 #ifdef PNO_DUMP
1787         {
1788                 int j;
1789                 for (j = 0; j < nssid; j++) {
1790                         DHD_ERROR(("%d: scan  for  %s size =%d\n", j,
1791                                    ssids_local[j].SSID,
1792                                    ssids_local[j].SSID_len));
1793                 }
1794         }
1795 #endif                          /* PNO_DUMP */
1796
1797         /* clean up everything */
1798         err = dhd_pno_clean(dhd);
1799         if (err < 0) {
1800                 DHD_ERROR(("%s failed error=%d\n", __func__, err));
1801                 return err;
1802         }
1803         memset(&pfn_param, 0, sizeof(pfn_param));
1804         memset(&pfn_element, 0, sizeof(pfn_element));
1805
1806         /* set pfn parameters */
1807         pfn_param.version = htod32(PFN_VERSION);
1808         pfn_param.flags = htod16((PFN_LIST_ORDER << SORT_CRITERIA_BIT));
1809
1810         /* set up pno scan fr */
1811         if (scan_fr != 0)
1812                 pfn_param.scan_freq = htod32(scan_fr);
1813
1814         bcm_mkiovar("pfn_set", (char *)&pfn_param, sizeof(pfn_param), iovbuf,
1815                     sizeof(iovbuf));
1816         dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf, sizeof(iovbuf));
1817
1818         /* set all pfn ssid */
1819         for (i = 0; i < nssid; i++) {
1820
1821                 pfn_element.bss_type = htod32(DOT11_BSSTYPE_INFRASTRUCTURE);
1822                 pfn_element.auth = (DOT11_OPEN_SYSTEM);
1823                 pfn_element.wpa_auth = htod32(WPA_AUTH_PFN_ANY);
1824                 pfn_element.wsec = htod32(0);
1825                 pfn_element.infra = htod32(1);
1826
1827                 memcpy((char *)pfn_element.ssid.SSID, ssids_local[i].SSID,
1828                        ssids_local[i].SSID_len);
1829                 pfn_element.ssid.SSID_len = ssids_local[i].SSID_len;
1830
1831                 err = bcm_mkiovar("pfn_add", (char *)&pfn_element,
1832                                 sizeof(pfn_element), iovbuf, sizeof(iovbuf));
1833                 if (err > 0) {
1834                         err = dhdcdc_set_ioctl(dhd, 0, WLC_SET_VAR, iovbuf,
1835                                         sizeof(iovbuf));
1836                         if (err < 0) {
1837                                 DHD_ERROR(("%s failed for i=%d error=%d\n",
1838                                            __func__, i, err));
1839                                 return err;
1840                         }
1841                 } else
1842                         DHD_ERROR(("%s failed err=%d\n", __func__, err));
1843         }
1844
1845         /* Enable PNO */
1846         /* dhd_pno_enable(dhd, 1); */
1847         return err;
1848 }
1849
1850 int dhd_pno_get_status(dhd_pub_t *dhd)
1851 {
1852         int ret = -1;
1853
1854         if (!dhd)
1855                 return ret;
1856         else
1857                 return dhd->pno_enable;
1858 }
1859
1860 #endif                          /* PNO_SUPPORT */
1861
1862 /* Androd ComboSCAN support */