drivers/net/wireless/libertas/cmdresp.c

   1 /**
   2   * This file contains the handling of command
   3   * responses as well as events generated by firmware.
   4   */
   5 #include <linux/delay.h>
   6 #include <linux/if_arp.h>
   7 #include <linux/netdevice.h>
   8
   9 #include <net/iw_handler.h>
  10
  11 #include "host.h"
  12 #include "decl.h"
  13 #include "defs.h"
  14 #include "dev.h"
  15 #include "assoc.h"
  16 #include "wext.h"
  17
  18 /**
  19  *  @brief This function handles disconnect event. it
  20  *  reports disconnect to upper layer, clean tx/rx packets,
  21  *  reset link state etc.
  22  *
  23  *  @param priv    A pointer to struct lbs_private structure
  24  *  @return        n/a
  25  */
  26 void lbs_mac_event_disconnected(struct lbs_private *priv)
  27 {
  28         union iwreq_data wrqu;
  29
  30         if (priv->connect_status != LBS_CONNECTED)
  31                 return;
  32
  33         lbs_deb_enter(LBS_DEB_ASSOC);
  34
  35         memset(wrqu.ap_addr.sa_data, 0x00, ETH_ALEN);
  36         wrqu.ap_addr.sa_family = ARPHRD_ETHER;
  37
  38         /*
  39          * Cisco AP sends EAP failure and de-auth in less than 0.5 ms.
  40          * It causes problem in the Supplicant
  41          */
  42
  43         msleep_interruptible(1000);
  44         wireless_send_event(priv->dev, SIOCGIWAP, &wrqu, NULL);
  45
  46         /* report disconnect to upper layer */
  47         netif_stop_queue(priv->dev);
  48         netif_carrier_off(priv->dev);
  49
  50         /* Free Tx and Rx packets */
  51         kfree_skb(priv->currenttxskb);
  52         priv->currenttxskb = NULL;
  53         priv->tx_pending_len = 0;
  54
  55         /* reset SNR/NF/RSSI values */
  56         memset(priv->SNR, 0x00, sizeof(priv->SNR));
  57         memset(priv->NF, 0x00, sizeof(priv->NF));
  58         memset(priv->RSSI, 0x00, sizeof(priv->RSSI));
  59         memset(priv->rawSNR, 0x00, sizeof(priv->rawSNR));
  60         memset(priv->rawNF, 0x00, sizeof(priv->rawNF));
  61         priv->nextSNRNF = 0;
  62         priv->numSNRNF = 0;
  63         priv->connect_status = LBS_DISCONNECTED;
  64
  65         /* Clear out associated SSID and BSSID since connection is
  66          * no longer valid.
  67          */
  68         memset(&priv->curbssparams.bssid, 0, ETH_ALEN);
  69         memset(&priv->curbssparams.ssid, 0, IW_ESSID_MAX_SIZE);
  70         priv->curbssparams.ssid_len = 0;
  71
  72         if (priv->psstate != PS_STATE_FULL_POWER) {
  73                 /* make firmware to exit PS mode */
  74                 lbs_deb_cmd("disconnected, so exit PS mode\n");
  75                 lbs_ps_wakeup(priv, 0);
  76         }
  77         lbs_deb_leave(LBS_DEB_ASSOC);
  78 }
  79
  80 /**
  81  *  @brief This function handles MIC failure event.
  82  *
  83  *  @param priv    A pointer to struct lbs_private structure
  84  *  @para  event   the event id
  85  *  @return        n/a
  86  */
  87 static void handle_mic_failureevent(struct lbs_private *priv, u32 event)
  88 {
  89         char buf[50];
  90
  91         lbs_deb_enter(LBS_DEB_CMD);
  92         memset(buf, 0, sizeof(buf));
  93
  94         sprintf(buf, "%s", "MLME-MICHAELMICFAILURE.indication ");
  95
  96         if (event == MACREG_INT_CODE_MIC_ERR_UNICAST) {
  97                 strcat(buf, "unicast ");
  98         } else {
  99                 strcat(buf, "multicast ");
 100         }
 101
 102         lbs_send_iwevcustom_event(priv, buf);
 103         lbs_deb_leave(LBS_DEB_CMD);
 104 }
 105
 106 static int lbs_ret_reg_access(struct lbs_private *priv,
 107                                u16 type, struct cmd_ds_command *resp)
 108 {
 109         int ret = 0;
 110
 111         lbs_deb_enter(LBS_DEB_CMD);
 112
 113         switch (type) {
 114         case CMD_RET(CMD_MAC_REG_ACCESS):
 115                 {
 116                         struct cmd_ds_mac_reg_access *reg = &resp->params.macreg;
 117
 118                         priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
 119                         priv->offsetvalue.value = le32_to_cpu(reg->value);
 120                         break;
 121                 }
 122
 123         case CMD_RET(CMD_BBP_REG_ACCESS):
 124                 {
 125                         struct cmd_ds_bbp_reg_access *reg = &resp->params.bbpreg;
 126
 127                         priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
 128                         priv->offsetvalue.value = reg->value;
 129                         break;
 130                 }
 131
 132         case CMD_RET(CMD_RF_REG_ACCESS):
 133                 {
 134                         struct cmd_ds_rf_reg_access *reg = &resp->params.rfreg;
 135
 136                         priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
 137                         priv->offsetvalue.value = reg->value;
 138                         break;
 139                 }
 140
 141         default:
 142                 ret = -1;
 143         }
 144
 145         lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
 146         return ret;
 147 }
 148
 149 static int lbs_ret_802_11_snmp_mib(struct lbs_private *priv,
 150                                     struct cmd_ds_command *resp)
 151 {
 152         struct cmd_ds_802_11_snmp_mib *smib = &resp->params.smib;
 153         u16 oid = le16_to_cpu(smib->oid);
 154         u16 querytype = le16_to_cpu(smib->querytype);
 155
 156         lbs_deb_enter(LBS_DEB_CMD);
 157
 158         lbs_deb_cmd("SNMP_RESP: oid 0x%x, querytype 0x%x\n", oid,
 159                querytype);
 160         lbs_deb_cmd("SNMP_RESP: Buf size %d\n", le16_to_cpu(smib->bufsize));
 161
 162         if (querytype == CMD_ACT_GET) {
 163                 switch (oid) {
 164                 case FRAGTHRESH_I:
 165                         priv->fragthsd =
 166                                 le16_to_cpu(*((__le16 *)(smib->value)));
 167                         lbs_deb_cmd("SNMP_RESP: frag threshold %u\n",
 168                                     priv->fragthsd);
 169                         break;
 170                 case RTSTHRESH_I:
 171                         priv->rtsthsd =
 172                                 le16_to_cpu(*((__le16 *)(smib->value)));
 173                         lbs_deb_cmd("SNMP_RESP: rts threshold %u\n",
 174                                     priv->rtsthsd);
 175                         break;
 176                 case SHORT_RETRYLIM_I:
 177                         priv->txretrycount =
 178                                 le16_to_cpu(*((__le16 *)(smib->value)));
 179                         lbs_deb_cmd("SNMP_RESP: tx retry count %u\n",
 180                                     priv->rtsthsd);
 181                         break;
 182                 default:
 183                         break;
 184                 }
 185         }
 186
 187         lbs_deb_enter(LBS_DEB_CMD);
 188         return 0;
 189 }
 190
 191 static int lbs_ret_802_11_rssi(struct lbs_private *priv,
 192                                 struct cmd_ds_command *resp)
 193 {
 194         struct cmd_ds_802_11_rssi_rsp *rssirsp = &resp->params.rssirsp;
 195
 196         lbs_deb_enter(LBS_DEB_CMD);
 197
 198         /* store the non average value */
 199         priv->SNR[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->SNR);
 200         priv->NF[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->noisefloor);
 201
 202         priv->SNR[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgSNR);
 203         priv->NF[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgnoisefloor);
 204
 205         priv->RSSI[TYPE_BEACON][TYPE_NOAVG] =
 206             CAL_RSSI(priv->SNR[TYPE_BEACON][TYPE_NOAVG],
 207                      priv->NF[TYPE_BEACON][TYPE_NOAVG]);
 208
 209         priv->RSSI[TYPE_BEACON][TYPE_AVG] =
 210             CAL_RSSI(priv->SNR[TYPE_BEACON][TYPE_AVG] / AVG_SCALE,
 211                      priv->NF[TYPE_BEACON][TYPE_AVG] / AVG_SCALE);
 212
 213         lbs_deb_cmd("RSSI: beacon %d, avg %d\n",
 214                priv->RSSI[TYPE_BEACON][TYPE_NOAVG],
 215                priv->RSSI[TYPE_BEACON][TYPE_AVG]);
 216
 217         lbs_deb_leave(LBS_DEB_CMD);
 218         return 0;
 219 }
 220
 221 static int lbs_ret_802_11_bcn_ctrl(struct lbs_private * priv,
 222                                         struct cmd_ds_command *resp)
 223 {
 224         struct cmd_ds_802_11_beacon_control *bcn_ctrl =
 225             &resp->params.bcn_ctrl;
 226
 227         lbs_deb_enter(LBS_DEB_CMD);
 228
 229         if (bcn_ctrl->action == CMD_ACT_GET) {
 230                 priv->beacon_enable = (u8) le16_to_cpu(bcn_ctrl->beacon_enable);
 231                 priv->beacon_period = le16_to_cpu(bcn_ctrl->beacon_period);
 232         }
 233
 234         lbs_deb_enter(LBS_DEB_CMD);
 235         return 0;
 236 }
 237
 238 static inline int handle_cmd_response(struct lbs_private *priv,
 239                                       struct cmd_header *cmd_response)
 240 {
 241         struct cmd_ds_command *resp = (struct cmd_ds_command *) cmd_response;
 242         int ret = 0;
 243         unsigned long flags;
 244         uint16_t respcmd = le16_to_cpu(resp->command);
 245
 246         lbs_deb_enter(LBS_DEB_HOST);
 247
 248         switch (respcmd) {
 249         case CMD_RET(CMD_MAC_REG_ACCESS):
 250         case CMD_RET(CMD_BBP_REG_ACCESS):
 251         case CMD_RET(CMD_RF_REG_ACCESS):
 252                 ret = lbs_ret_reg_access(priv, respcmd, resp);
 253                 break;
 254
 255         case CMD_RET_802_11_ASSOCIATE:
 256         case CMD_RET(CMD_802_11_ASSOCIATE):
 257         case CMD_RET(CMD_802_11_REASSOCIATE):
 258                 ret = lbs_ret_80211_associate(priv, resp);
 259                 break;
 260
 261         case CMD_RET(CMD_802_11_SNMP_MIB):
 262                 ret = lbs_ret_802_11_snmp_mib(priv, resp);
 263                 break;
 264
 265         case CMD_RET(CMD_802_11_SET_AFC):
 266         case CMD_RET(CMD_802_11_GET_AFC):
 267                 spin_lock_irqsave(&priv->driver_lock, flags);
 268                 memmove((void *)priv->cur_cmd->callback_arg, &resp->params.afc,
 269                         sizeof(struct cmd_ds_802_11_afc));
 270                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 271
 272                 break;
 273
 274         case CMD_RET(CMD_802_11_RESET):
 275         case CMD_RET(CMD_802_11_AUTHENTICATE):
 276         case CMD_RET(CMD_802_11_BEACON_STOP):
 277                 break;
 278
 279         case CMD_RET(CMD_802_11_RSSI):
 280                 ret = lbs_ret_802_11_rssi(priv, resp);
 281                 break;
 282
 283         case CMD_RET(CMD_802_11D_DOMAIN_INFO):
 284                 ret = lbs_ret_802_11d_domain_info(resp);
 285                 break;
 286
 287         case CMD_RET(CMD_802_11_TPC_CFG):
 288                 spin_lock_irqsave(&priv->driver_lock, flags);
 289                 memmove((void *)priv->cur_cmd->callback_arg, &resp->params.tpccfg,
 290                         sizeof(struct cmd_ds_802_11_tpc_cfg));
 291                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 292                 break;
 293         case CMD_RET(CMD_802_11_LED_GPIO_CTRL):
 294                 spin_lock_irqsave(&priv->driver_lock, flags);
 295                 memmove((void *)priv->cur_cmd->callback_arg, &resp->params.ledgpio,
 296                         sizeof(struct cmd_ds_802_11_led_ctrl));
 297                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 298                 break;
 299
 300         case CMD_RET(CMD_GET_TSF):
 301                 spin_lock_irqsave(&priv->driver_lock, flags);
 302                 memcpy((void *)priv->cur_cmd->callback_arg,
 303                        &resp->params.gettsf.tsfvalue, sizeof(u64));
 304                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 305                 break;
 306         case CMD_RET(CMD_BT_ACCESS):
 307                 spin_lock_irqsave(&priv->driver_lock, flags);
 308                 if (priv->cur_cmd->callback_arg)
 309                         memcpy((void *)priv->cur_cmd->callback_arg,
 310                                &resp->params.bt.addr1, 2 * ETH_ALEN);
 311                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 312                 break;
 313         case CMD_RET(CMD_FWT_ACCESS):
 314                 spin_lock_irqsave(&priv->driver_lock, flags);
 315                 if (priv->cur_cmd->callback_arg)
 316                         memcpy((void *)priv->cur_cmd->callback_arg, &resp->params.fwt,
 317                                sizeof(resp->params.fwt));
 318                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 319                 break;
 320         case CMD_RET(CMD_802_11_BEACON_CTRL):
 321                 ret = lbs_ret_802_11_bcn_ctrl(priv, resp);
 322                 break;
 323
 324         default:
 325                 lbs_pr_err("CMD_RESP: unknown cmd response 0x%04x\n",
 326                            le16_to_cpu(resp->command));
 327                 break;
 328         }
 329         lbs_deb_leave(LBS_DEB_HOST);
 330         return ret;
 331 }
 332
 333 int lbs_process_command_response(struct lbs_private *priv, u8 *data, u32 len)
 334 {
 335         uint16_t respcmd, curcmd;
 336         struct cmd_header *resp;
 337         int ret = 0;
 338         unsigned long flags;
 339         uint16_t result;
 340
 341         lbs_deb_enter(LBS_DEB_HOST);
 342
 343         mutex_lock(&priv->lock);
 344         spin_lock_irqsave(&priv->driver_lock, flags);
 345
 346         if (!priv->cur_cmd) {
 347                 lbs_deb_host("CMD_RESP: cur_cmd is NULL\n");
 348                 ret = -1;
 349                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 350                 goto done;
 351         }
 352
 353         resp = (void *)data;
 354         curcmd = le16_to_cpu(priv->cur_cmd->cmdbuf->command);
 355         respcmd = le16_to_cpu(resp->command);
 356         result = le16_to_cpu(resp->result);
 357
 358         lbs_deb_cmd("CMD_RESP: response 0x%04x, seq %d, size %d\n",
 359                      respcmd, le16_to_cpu(resp->seqnum), len);
 360         lbs_deb_hex(LBS_DEB_CMD, "CMD_RESP", (void *) resp, len);
 361
 362         if (resp->seqnum != priv->cur_cmd->cmdbuf->seqnum) {
 363                 lbs_pr_info("Received CMD_RESP with invalid sequence %d (expected %d)\n",
 364                             le16_to_cpu(resp->seqnum), le16_to_cpu(priv->cur_cmd->cmdbuf->seqnum));
 365                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 366                 ret = -1;
 367                 goto done;
 368         }
 369         if (respcmd != CMD_RET(curcmd) &&
 370             respcmd != CMD_RET_802_11_ASSOCIATE && curcmd != CMD_802_11_ASSOCIATE) {
 371                 lbs_pr_info("Invalid CMD_RESP %x to command %x!\n", respcmd, curcmd);
 372                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 373                 ret = -1;
 374                 goto done;
 375         }
 376
 377         if (resp->result == cpu_to_le16(0x0004)) {
 378                 /* 0x0004 means -EAGAIN. Drop the response, let it time out
 379                    and be resubmitted */
 380                 lbs_pr_info("Firmware returns DEFER to command %x. Will let it time out...\n",
 381                             le16_to_cpu(resp->command));
 382                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 383                 ret = -1;
 384                 goto done;
 385         }
 386
 387         /* Now we got response from FW, cancel the command timer */
 388         del_timer(&priv->command_timer);
 389         priv->cmd_timed_out = 0;
 390         if (priv->nr_retries) {
 391                 lbs_pr_info("Received result %x to command %x after %d retries\n",
 392                             result, curcmd, priv->nr_retries);
 393                 priv->nr_retries = 0;
 394         }
 395
 396         /* Store the response code to cur_cmd_retcode. */
 397         priv->cur_cmd_retcode = result;
 398
 399         if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) {
 400                 struct cmd_ds_802_11_ps_mode *psmode = (void *) &resp[1];
 401                 u16 action = le16_to_cpu(psmode->action);
 402
 403                 lbs_deb_host(
 404                        "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n",
 405                        result, action);
 406
 407                 if (result) {
 408                         lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n",
 409                                     result);
 410                         /*
 411                          * We should not re-try enter-ps command in
 412                          * ad-hoc mode. It takes place in
 413                          * lbs_execute_next_command().
 414                          */
 415                         if (priv->mode == IW_MODE_ADHOC &&
 416                             action == CMD_SUBCMD_ENTER_PS)
 417                                 priv->psmode = LBS802_11POWERMODECAM;
 418                 } else if (action == CMD_SUBCMD_ENTER_PS) {
 419                         priv->needtowakeup = 0;
 420                         priv->psstate = PS_STATE_AWAKE;
 421
 422                         lbs_deb_host("CMD_RESP: ENTER_PS command response\n");
 423                         if (priv->connect_status != LBS_CONNECTED) {
 424                                 /*
 425                                  * When Deauth Event received before Enter_PS command
 426                                  * response, We need to wake up the firmware.
 427                                  */
 428                                 lbs_deb_host(
 429                                        "disconnected, invoking lbs_ps_wakeup\n");
 430
 431                                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 432                                 mutex_unlock(&priv->lock);
 433                                 lbs_ps_wakeup(priv, 0);
 434                                 mutex_lock(&priv->lock);
 435                                 spin_lock_irqsave(&priv->driver_lock, flags);
 436                         }
 437                 } else if (action == CMD_SUBCMD_EXIT_PS) {
 438                         priv->needtowakeup = 0;
 439                         priv->psstate = PS_STATE_FULL_POWER;
 440                         lbs_deb_host("CMD_RESP: EXIT_PS command response\n");
 441                 } else {
 442                         lbs_deb_host("CMD_RESP: PS action 0x%X\n", action);
 443                 }
 444
 445                 lbs_complete_command(priv, priv->cur_cmd, result);
 446                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 447
 448                 ret = 0;
 449                 goto done;
 450         }
 451
 452         /* If the command is not successful, cleanup and return failure */
 453         if ((result != 0 || !(respcmd & 0x8000))) {
 454                 lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n",
 455                        result, respcmd);
 456                 /*
 457                  * Handling errors here
 458                  */
 459                 switch (respcmd) {
 460                 case CMD_RET(CMD_GET_HW_SPEC):
 461                 case CMD_RET(CMD_802_11_RESET):
 462                         lbs_deb_host("CMD_RESP: reset failed\n");
 463                         break;
 464
 465                 }
 466                 lbs_complete_command(priv, priv->cur_cmd, result);
 467                 spin_unlock_irqrestore(&priv->driver_lock, flags);
 468
 469                 ret = -1;
 470                 goto done;
 471         }
 472
 473         spin_unlock_irqrestore(&priv->driver_lock, flags);
 474
 475         if (priv->cur_cmd && priv->cur_cmd->callback) {
 476                 ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg,
 477                                 resp);
 478         } else
 479                 ret = handle_cmd_response(priv, resp);
 480
 481         spin_lock_irqsave(&priv->driver_lock, flags);
 482
 483         if (priv->cur_cmd) {
 484                 /* Clean up and Put current command back to cmdfreeq */
 485                 lbs_complete_command(priv, priv->cur_cmd, result);
 486         }
 487         spin_unlock_irqrestore(&priv->driver_lock, flags);
 488
 489 done:
 490         mutex_unlock(&priv->lock);
 491         lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
 492         return ret;
 493 }
 494
 495 static int lbs_send_confirmwake(struct lbs_private *priv)
 496 {
 497         struct cmd_header cmd;
 498         int ret = 0;
 499
 500         lbs_deb_enter(LBS_DEB_HOST);
 501
 502         cmd.command = cpu_to_le16(CMD_802_11_WAKEUP_CONFIRM);
 503         cmd.size = cpu_to_le16(sizeof(cmd));
 504         cmd.seqnum = cpu_to_le16(++priv->seqnum);
 505         cmd.result = 0;
 506
 507         lbs_deb_hex(LBS_DEB_HOST, "wake confirm", (u8 *) &cmd,
 508                 sizeof(cmd));
 509
 510         ret = priv->hw_host_to_card(priv, MVMS_CMD, (u8 *) &cmd, sizeof(cmd));
 511         if (ret)
 512                 lbs_pr_alert("SEND_WAKEC_CMD: Host to Card failed for Confirm Wake\n");
 513
 514         lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
 515         return ret;
 516 }
 517
 518 int lbs_process_event(struct lbs_private *priv, u32 event)
 519 {
 520         int ret = 0;
 521
 522         lbs_deb_enter(LBS_DEB_CMD);
 523
 524         switch (event) {
 525         case MACREG_INT_CODE_LINK_SENSED:
 526                 lbs_deb_cmd("EVENT: link sensed\n");
 527                 break;
 528
 529         case MACREG_INT_CODE_DEAUTHENTICATED:
 530                 lbs_deb_cmd("EVENT: deauthenticated\n");
 531                 lbs_mac_event_disconnected(priv);
 532                 break;
 533
 534         case MACREG_INT_CODE_DISASSOCIATED:
 535                 lbs_deb_cmd("EVENT: disassociated\n");
 536                 lbs_mac_event_disconnected(priv);
 537                 break;
 538
 539         case MACREG_INT_CODE_LINK_LOST_NO_SCAN:
 540                 lbs_deb_cmd("EVENT: link lost\n");
 541                 lbs_mac_event_disconnected(priv);
 542                 break;
 543
 544         case MACREG_INT_CODE_PS_SLEEP:
 545                 lbs_deb_cmd("EVENT: ps sleep\n");
 546
 547                 /* handle unexpected PS SLEEP event */
 548                 if (priv->psstate == PS_STATE_FULL_POWER) {
 549                         lbs_deb_cmd(
 550                                "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n");
 551                         break;
 552                 }
 553                 priv->psstate = PS_STATE_PRE_SLEEP;
 554
 555                 lbs_ps_confirm_sleep(priv);
 556
 557                 break;
 558
 559         case MACREG_INT_CODE_HOST_AWAKE:
 560                 lbs_deb_cmd("EVENT: host awake\n");
 561                 lbs_send_confirmwake(priv);
 562                 break;
 563
 564         case MACREG_INT_CODE_PS_AWAKE:
 565                 lbs_deb_cmd("EVENT: ps awake\n");
 566                 /* handle unexpected PS AWAKE event */
 567                 if (priv->psstate == PS_STATE_FULL_POWER) {
 568                         lbs_deb_cmd(
 569                                "EVENT: In FULL POWER mode - ignore PS AWAKE\n");
 570                         break;
 571                 }
 572
 573                 priv->psstate = PS_STATE_AWAKE;
 574
 575                 if (priv->needtowakeup) {
 576                         /*
 577                          * wait for the command processing to finish
 578                          * before resuming sending
 579                          * priv->needtowakeup will be set to FALSE
 580                          * in lbs_ps_wakeup()
 581                          */
 582                         lbs_deb_cmd("waking up ...\n");
 583                         lbs_ps_wakeup(priv, 0);
 584                 }
 585                 break;
 586
 587         case MACREG_INT_CODE_MIC_ERR_UNICAST:
 588                 lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n");
 589                 handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_UNICAST);
 590                 break;
 591
 592         case MACREG_INT_CODE_MIC_ERR_MULTICAST:
 593                 lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n");
 594                 handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_MULTICAST);
 595                 break;
 596
 597         case MACREG_INT_CODE_MIB_CHANGED:
 598                 lbs_deb_cmd("EVENT: MIB CHANGED\n");
 599                 break;
 600         case MACREG_INT_CODE_INIT_DONE:
 601                 lbs_deb_cmd("EVENT: INIT DONE\n");
 602                 break;
 603         case MACREG_INT_CODE_ADHOC_BCN_LOST:
 604                 lbs_deb_cmd("EVENT: ADHOC beacon lost\n");
 605                 break;
 606         case MACREG_INT_CODE_RSSI_LOW:
 607                 lbs_pr_alert("EVENT: rssi low\n");
 608                 break;
 609         case MACREG_INT_CODE_SNR_LOW:
 610                 lbs_pr_alert("EVENT: snr low\n");
 611                 break;
 612         case MACREG_INT_CODE_MAX_FAIL:
 613                 lbs_pr_alert("EVENT: max fail\n");
 614                 break;
 615         case MACREG_INT_CODE_RSSI_HIGH:
 616                 lbs_pr_alert("EVENT: rssi high\n");
 617                 break;
 618         case MACREG_INT_CODE_SNR_HIGH:
 619                 lbs_pr_alert("EVENT: snr high\n");
 620                 break;
 621
 622         case MACREG_INT_CODE_MESH_AUTO_STARTED:
 623                 /* Ignore spurious autostart events if autostart is disabled */
 624                 if (!priv->mesh_autostart_enabled) {
 625                         lbs_pr_info("EVENT: MESH_AUTO_STARTED (ignoring)\n");
 626                         break;
 627                 }
 628                 lbs_pr_info("EVENT: MESH_AUTO_STARTED\n");
 629                 priv->mesh_connect_status = LBS_CONNECTED;
 630                 if (priv->mesh_open) {
 631                         netif_carrier_on(priv->mesh_dev);
 632                         if (!priv->tx_pending_len)
 633                                 netif_wake_queue(priv->mesh_dev);
 634                 }
 635                 priv->mode = IW_MODE_ADHOC;
 636                 schedule_work(&priv->sync_channel);
 637                 break;
 638
 639         default:
 640                 lbs_pr_alert("EVENT: unknown event id %d\n", event);
 641                 break;
 642         }
 643
 644         lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
 645         return ret;
 646 }