drivers/net/wireless/mwifiex/sta_cmdresp.c

   1 /*
   2  * Marvell Wireless LAN device driver: station command response handling
   3  *
   4  * Copyright (C) 2011, Marvell International Ltd.
   5  *
   6  * This software file (the "File") is distributed by Marvell International
   7  * Ltd. under the terms of the GNU General Public License Version 2, June 1991
   8  * (the "License").  You may use, redistribute and/or modify this File in
   9  * accordance with the terms and conditions of the License, a copy of which
  10  * is available by writing to the Free Software Foundation, Inc.,
  11  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
  12  * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
  13  *
  14  * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
  15  * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
  16  * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
  17  * this warranty disclaimer.
  18  */
  19
  20 #include "decl.h"
  21 #include "ioctl.h"
  22 #include "util.h"
  23 #include "fw.h"
  24 #include "main.h"
  25 #include "wmm.h"
  26 #include "11n.h"
  27
  28
  29 /*
  30  * This function handles the command response error case.
  31  *
  32  * For scan response error, the function cancels all the pending
  33  * scan commands and generates an event to inform the applications
  34  * of the scan completion.
  35  *
  36  * For Power Save command failure, we do not retry enter PS
  37  * command in case of Ad-hoc mode.
  38  *
  39  * For all other response errors, the current command buffer is freed
  40  * and returned to the free command queue.
  41  */
  42 static void
  43 mwifiex_process_cmdresp_error(struct mwifiex_private *priv,
  44                               struct host_cmd_ds_command *resp)
  45 {
  46         struct cmd_ctrl_node *cmd_node = NULL, *tmp_node;
  47         struct mwifiex_adapter *adapter = priv->adapter;
  48         struct host_cmd_ds_802_11_ps_mode_enh *pm;
  49         unsigned long flags;
  50
  51         dev_err(adapter->dev, "CMD_RESP: cmd %#x error, result=%#x\n",
  52                 resp->command, resp->result);
  53
  54         if (adapter->curr_cmd->wait_q_enabled)
  55                 adapter->cmd_wait_q.status = -1;
  56
  57         switch (le16_to_cpu(resp->command)) {
  58         case HostCmd_CMD_802_11_PS_MODE_ENH:
  59                 pm = &resp->params.psmode_enh;
  60                 dev_err(adapter->dev,
  61                         "PS_MODE_ENH cmd failed: result=0x%x action=0x%X\n",
  62                         resp->result, le16_to_cpu(pm->action));
  63                 /* We do not re-try enter-ps command in ad-hoc mode. */
  64                 if (le16_to_cpu(pm->action) == EN_AUTO_PS &&
  65                     (le16_to_cpu(pm->params.ps_bitmap) & BITMAP_STA_PS) &&
  66                     priv->bss_mode == NL80211_IFTYPE_ADHOC)
  67                         adapter->ps_mode = MWIFIEX_802_11_POWER_MODE_CAM;
  68
  69                 break;
  70         case HostCmd_CMD_802_11_SCAN:
  71                 /* Cancel all pending scan command */
  72                 spin_lock_irqsave(&adapter->scan_pending_q_lock, flags);
  73                 list_for_each_entry_safe(cmd_node, tmp_node,
  74                                          &adapter->scan_pending_q, list) {
  75                         list_del(&cmd_node->list);
  76                         spin_unlock_irqrestore(&adapter->scan_pending_q_lock,
  77                                                flags);
  78                         mwifiex_insert_cmd_to_free_q(adapter, cmd_node);
  79                         spin_lock_irqsave(&adapter->scan_pending_q_lock, flags);
  80                 }
  81                 spin_unlock_irqrestore(&adapter->scan_pending_q_lock, flags);
  82
  83                 spin_lock_irqsave(&adapter->mwifiex_cmd_lock, flags);
  84                 adapter->scan_processing = false;
  85                 spin_unlock_irqrestore(&adapter->mwifiex_cmd_lock, flags);
  86                 if (priv->report_scan_result)
  87                         priv->report_scan_result = false;
  88                 if (priv->scan_pending_on_block) {
  89                         priv->scan_pending_on_block = false;
  90                         up(&priv->async_sem);
  91                 }
  92                 break;
  93
  94         case HostCmd_CMD_MAC_CONTROL:
  95                 break;
  96
  97         default:
  98                 break;
  99         }
 100         /* Handling errors here */
 101         mwifiex_insert_cmd_to_free_q(adapter, adapter->curr_cmd);
 102
 103         spin_lock_irqsave(&adapter->mwifiex_cmd_lock, flags);
 104         adapter->curr_cmd = NULL;
 105         spin_unlock_irqrestore(&adapter->mwifiex_cmd_lock, flags);
 106 }
 107
 108 /*
 109  * This function handles the command response of get RSSI info.
 110  *
 111  * Handling includes changing the header fields into CPU format
 112  * and saving the following parameters in driver -
 113  *      - Last data and beacon RSSI value
 114  *      - Average data and beacon RSSI value
 115  *      - Last data and beacon NF value
 116  *      - Average data and beacon NF value
 117  *
 118  * The parameters are send to the application as well, along with
 119  * calculated SNR values.
 120  */
 121 static int mwifiex_ret_802_11_rssi_info(struct mwifiex_private *priv,
 122                                         struct host_cmd_ds_command *resp)
 123 {
 124         struct host_cmd_ds_802_11_rssi_info_rsp *rssi_info_rsp =
 125                                                 &resp->params.rssi_info_rsp;
 126         struct mwifiex_ds_misc_subsc_evt subsc_evt;
 127
 128         priv->data_rssi_last = le16_to_cpu(rssi_info_rsp->data_rssi_last);
 129         priv->data_nf_last = le16_to_cpu(rssi_info_rsp->data_nf_last);
 130
 131         priv->data_rssi_avg = le16_to_cpu(rssi_info_rsp->data_rssi_avg);
 132         priv->data_nf_avg = le16_to_cpu(rssi_info_rsp->data_nf_avg);
 133
 134         priv->bcn_rssi_last = le16_to_cpu(rssi_info_rsp->bcn_rssi_last);
 135         priv->bcn_nf_last = le16_to_cpu(rssi_info_rsp->bcn_nf_last);
 136
 137         priv->bcn_rssi_avg = le16_to_cpu(rssi_info_rsp->bcn_rssi_avg);
 138         priv->bcn_nf_avg = le16_to_cpu(rssi_info_rsp->bcn_nf_avg);
 139
 140         if (priv->subsc_evt_rssi_state == EVENT_HANDLED)
 141                 return 0;
 142
 143         /* Resubscribe low and high rssi events with new thresholds */
 144         memset(&subsc_evt, 0x00, sizeof(struct mwifiex_ds_misc_subsc_evt));
 145         subsc_evt.events = BITMASK_BCN_RSSI_LOW | BITMASK_BCN_RSSI_HIGH;
 146         subsc_evt.action = HostCmd_ACT_BITWISE_SET;
 147         if (priv->subsc_evt_rssi_state == RSSI_LOW_RECVD) {
 148                 subsc_evt.bcn_l_rssi_cfg.abs_value = abs(priv->bcn_rssi_avg -
 149                                 priv->cqm_rssi_hyst);
 150                 subsc_evt.bcn_h_rssi_cfg.abs_value = abs(priv->cqm_rssi_thold);
 151         } else if (priv->subsc_evt_rssi_state == RSSI_HIGH_RECVD) {
 152                 subsc_evt.bcn_l_rssi_cfg.abs_value = abs(priv->cqm_rssi_thold);
 153                 subsc_evt.bcn_h_rssi_cfg.abs_value = abs(priv->bcn_rssi_avg +
 154                                 priv->cqm_rssi_hyst);
 155         }
 156         subsc_evt.bcn_l_rssi_cfg.evt_freq = 1;
 157         subsc_evt.bcn_h_rssi_cfg.evt_freq = 1;
 158
 159         priv->subsc_evt_rssi_state = EVENT_HANDLED;
 160
 161         mwifiex_send_cmd_async(priv, HostCmd_CMD_802_11_SUBSCRIBE_EVENT,
 162                                0, 0, &subsc_evt);
 163
 164         return 0;
 165 }
 166
 167 /*
 168  * This function handles the command response of set/get SNMP
 169  * MIB parameters.
 170  *
 171  * Handling includes changing the header fields into CPU format
 172  * and saving the parameter in driver.
 173  *
 174  * The following parameters are supported -
 175  *      - Fragmentation threshold
 176  *      - RTS threshold
 177  *      - Short retry limit
 178  */
 179 static int mwifiex_ret_802_11_snmp_mib(struct mwifiex_private *priv,
 180                                        struct host_cmd_ds_command *resp,
 181                                        u32 *data_buf)
 182 {
 183         struct host_cmd_ds_802_11_snmp_mib *smib = &resp->params.smib;
 184         u16 oid = le16_to_cpu(smib->oid);
 185         u16 query_type = le16_to_cpu(smib->query_type);
 186         u32 ul_temp;
 187
 188         dev_dbg(priv->adapter->dev, "info: SNMP_RESP: oid value = %#x,"
 189                 " query_type = %#x, buf size = %#x\n",
 190                 oid, query_type, le16_to_cpu(smib->buf_size));
 191         if (query_type == HostCmd_ACT_GEN_GET) {
 192                 ul_temp = le16_to_cpu(*((__le16 *) (smib->value)));
 193                 if (data_buf)
 194                         *data_buf = ul_temp;
 195                 switch (oid) {
 196                 case FRAG_THRESH_I:
 197                         dev_dbg(priv->adapter->dev,
 198                                 "info: SNMP_RESP: FragThsd =%u\n", ul_temp);
 199                         break;
 200                 case RTS_THRESH_I:
 201                         dev_dbg(priv->adapter->dev,
 202                                 "info: SNMP_RESP: RTSThsd =%u\n", ul_temp);
 203                         break;
 204                 case SHORT_RETRY_LIM_I:
 205                         dev_dbg(priv->adapter->dev,
 206                                 "info: SNMP_RESP: TxRetryCount=%u\n", ul_temp);
 207                         break;
 208                 case DTIM_PERIOD_I:
 209                         dev_dbg(priv->adapter->dev,
 210                                 "info: SNMP_RESP: DTIM period=%u\n", ul_temp);
 211                 default:
 212                         break;
 213                 }
 214         }
 215
 216         return 0;
 217 }
 218
 219 /*
 220  * This function handles the command response of get log request
 221  *
 222  * Handling includes changing the header fields into CPU format
 223  * and sending the received parameters to application.
 224  */
 225 static int mwifiex_ret_get_log(struct mwifiex_private *priv,
 226                                struct host_cmd_ds_command *resp,
 227                                struct mwifiex_ds_get_stats *stats)
 228 {
 229         struct host_cmd_ds_802_11_get_log *get_log =
 230                 &resp->params.get_log;
 231
 232         if (stats) {
 233                 stats->mcast_tx_frame = le32_to_cpu(get_log->mcast_tx_frame);
 234                 stats->failed = le32_to_cpu(get_log->failed);
 235                 stats->retry = le32_to_cpu(get_log->retry);
 236                 stats->multi_retry = le32_to_cpu(get_log->multi_retry);
 237                 stats->frame_dup = le32_to_cpu(get_log->frame_dup);
 238                 stats->rts_success = le32_to_cpu(get_log->rts_success);
 239                 stats->rts_failure = le32_to_cpu(get_log->rts_failure);
 240                 stats->ack_failure = le32_to_cpu(get_log->ack_failure);
 241                 stats->rx_frag = le32_to_cpu(get_log->rx_frag);
 242                 stats->mcast_rx_frame = le32_to_cpu(get_log->mcast_rx_frame);
 243                 stats->fcs_error = le32_to_cpu(get_log->fcs_error);
 244                 stats->tx_frame = le32_to_cpu(get_log->tx_frame);
 245                 stats->wep_icv_error[0] =
 246                         le32_to_cpu(get_log->wep_icv_err_cnt[0]);
 247                 stats->wep_icv_error[1] =
 248                         le32_to_cpu(get_log->wep_icv_err_cnt[1]);
 249                 stats->wep_icv_error[2] =
 250                         le32_to_cpu(get_log->wep_icv_err_cnt[2]);
 251                 stats->wep_icv_error[3] =
 252                         le32_to_cpu(get_log->wep_icv_err_cnt[3]);
 253         }
 254
 255         return 0;
 256 }
 257
 258 /*
 259  * This function handles the command response of set/get Tx rate
 260  * configurations.
 261  *
 262  * Handling includes changing the header fields into CPU format
 263  * and saving the following parameters in driver -
 264  *      - DSSS rate bitmap
 265  *      - OFDM rate bitmap
 266  *      - HT MCS rate bitmaps
 267  *
 268  * Based on the new rate bitmaps, the function re-evaluates if
 269  * auto data rate has been activated. If not, it sends another
 270  * query to the firmware to get the current Tx data rate and updates
 271  * the driver value.
 272  */
 273 static int mwifiex_ret_tx_rate_cfg(struct mwifiex_private *priv,
 274                                    struct host_cmd_ds_command *resp,
 275                                    struct mwifiex_rate_cfg *ds_rate)
 276 {
 277         struct host_cmd_ds_tx_rate_cfg *rate_cfg = &resp->params.tx_rate_cfg;
 278         struct mwifiex_rate_scope *rate_scope;
 279         struct mwifiex_ie_types_header *head;
 280         u16 tlv, tlv_buf_len;
 281         u8 *tlv_buf;
 282         u32 i;
 283         int ret = 0;
 284
 285         tlv_buf = ((u8 *)rate_cfg) +
 286                         sizeof(struct host_cmd_ds_tx_rate_cfg);
 287         tlv_buf_len = *(u16 *) (tlv_buf + sizeof(u16));
 288
 289         while (tlv_buf && tlv_buf_len > 0) {
 290                 tlv = (*tlv_buf);
 291                 tlv = tlv | (*(tlv_buf + 1) << 8);
 292
 293                 switch (tlv) {
 294                 case TLV_TYPE_RATE_SCOPE:
 295                         rate_scope = (struct mwifiex_rate_scope *) tlv_buf;
 296                         priv->bitmap_rates[0] =
 297                                 le16_to_cpu(rate_scope->hr_dsss_rate_bitmap);
 298                         priv->bitmap_rates[1] =
 299                                 le16_to_cpu(rate_scope->ofdm_rate_bitmap);
 300                         for (i = 0;
 301                              i <
 302                              sizeof(rate_scope->ht_mcs_rate_bitmap) /
 303                              sizeof(u16); i++)
 304                                 priv->bitmap_rates[2 + i] =
 305                                         le16_to_cpu(rate_scope->
 306                                                     ht_mcs_rate_bitmap[i]);
 307                         break;
 308                         /* Add RATE_DROP tlv here */
 309                 }
 310
 311                 head = (struct mwifiex_ie_types_header *) tlv_buf;
 312                 tlv_buf += le16_to_cpu(head->len) + sizeof(*head);
 313                 tlv_buf_len -= le16_to_cpu(head->len);
 314         }
 315
 316         priv->is_data_rate_auto = mwifiex_is_rate_auto(priv);
 317
 318         if (priv->is_data_rate_auto)
 319                 priv->data_rate = 0;
 320         else
 321                 ret = mwifiex_send_cmd_async(priv,
 322                                           HostCmd_CMD_802_11_TX_RATE_QUERY,
 323                                           HostCmd_ACT_GEN_GET, 0, NULL);
 324
 325         if (!ds_rate)
 326                 return ret;
 327
 328         if (le16_to_cpu(rate_cfg->action) == HostCmd_ACT_GEN_GET) {
 329                 if (priv->is_data_rate_auto) {
 330                         ds_rate->is_rate_auto = 1;
 331                 return ret;
 332         }
 333         ds_rate->rate = mwifiex_get_rate_index(priv->bitmap_rates,
 334                                                sizeof(priv->bitmap_rates));
 335
 336         if (ds_rate->rate >= MWIFIEX_RATE_BITMAP_OFDM0 &&
 337             ds_rate->rate <= MWIFIEX_RATE_BITMAP_OFDM7)
 338                 ds_rate->rate -= (MWIFIEX_RATE_BITMAP_OFDM0 -
 339                                   MWIFIEX_RATE_INDEX_OFDM0);
 340
 341         if (ds_rate->rate >= MWIFIEX_RATE_BITMAP_MCS0 &&
 342             ds_rate->rate <= MWIFIEX_RATE_BITMAP_MCS127)
 343                 ds_rate->rate -= (MWIFIEX_RATE_BITMAP_MCS0 -
 344                                   MWIFIEX_RATE_INDEX_MCS0);
 345         }
 346
 347         return ret;
 348 }
 349
 350 /*
 351  * This function handles the command response of get Tx power level.
 352  *
 353  * Handling includes saving the maximum and minimum Tx power levels
 354  * in driver, as well as sending the values to user.
 355  */
 356 static int mwifiex_get_power_level(struct mwifiex_private *priv, void *data_buf)
 357 {
 358         int length, max_power = -1, min_power = -1;
 359         struct mwifiex_types_power_group *pg_tlv_hdr;
 360         struct mwifiex_power_group *pg;
 361
 362         if (!data_buf)
 363                 return -1;
 364
 365         pg_tlv_hdr = (struct mwifiex_types_power_group *)
 366                 ((u8 *) data_buf + sizeof(struct host_cmd_ds_txpwr_cfg));
 367         pg = (struct mwifiex_power_group *)
 368                 ((u8 *) pg_tlv_hdr + sizeof(struct mwifiex_types_power_group));
 369         length = pg_tlv_hdr->length;
 370         if (length > 0) {
 371                 max_power = pg->power_max;
 372                 min_power = pg->power_min;
 373                 length -= sizeof(struct mwifiex_power_group);
 374         }
 375         while (length) {
 376                 pg++;
 377                 if (max_power < pg->power_max)
 378                         max_power = pg->power_max;
 379
 380                 if (min_power > pg->power_min)
 381                         min_power = pg->power_min;
 382
 383                 length -= sizeof(struct mwifiex_power_group);
 384         }
 385         if (pg_tlv_hdr->length > 0) {
 386                 priv->min_tx_power_level = (u8) min_power;
 387                 priv->max_tx_power_level = (u8) max_power;
 388         }
 389
 390         return 0;
 391 }
 392
 393 /*
 394  * This function handles the command response of set/get Tx power
 395  * configurations.
 396  *
 397  * Handling includes changing the header fields into CPU format
 398  * and saving the current Tx power level in driver.
 399  */
 400 static int mwifiex_ret_tx_power_cfg(struct mwifiex_private *priv,
 401                                     struct host_cmd_ds_command *resp)
 402 {
 403         struct mwifiex_adapter *adapter = priv->adapter;
 404         struct host_cmd_ds_txpwr_cfg *txp_cfg = &resp->params.txp_cfg;
 405         struct mwifiex_types_power_group *pg_tlv_hdr;
 406         struct mwifiex_power_group *pg;
 407         u16 action = le16_to_cpu(txp_cfg->action);
 408
 409         switch (action) {
 410         case HostCmd_ACT_GEN_GET:
 411                 pg_tlv_hdr = (struct mwifiex_types_power_group *)
 412                         ((u8 *) txp_cfg +
 413                          sizeof(struct host_cmd_ds_txpwr_cfg));
 414
 415                 pg = (struct mwifiex_power_group *)
 416                         ((u8 *) pg_tlv_hdr +
 417                          sizeof(struct mwifiex_types_power_group));
 418
 419                 if (adapter->hw_status == MWIFIEX_HW_STATUS_INITIALIZING)
 420                         mwifiex_get_power_level(priv, txp_cfg);
 421
 422                 priv->tx_power_level = (u16) pg->power_min;
 423                 break;
 424
 425         case HostCmd_ACT_GEN_SET:
 426                 if (!le32_to_cpu(txp_cfg->mode))
 427                         break;
 428
 429                 pg_tlv_hdr = (struct mwifiex_types_power_group *)
 430                         ((u8 *) txp_cfg +
 431                          sizeof(struct host_cmd_ds_txpwr_cfg));
 432
 433                 pg = (struct mwifiex_power_group *)
 434                         ((u8 *) pg_tlv_hdr +
 435                          sizeof(struct mwifiex_types_power_group));
 436
 437                 if (pg->power_max == pg->power_min)
 438                         priv->tx_power_level = (u16) pg->power_min;
 439                 break;
 440         default:
 441                 dev_err(adapter->dev, "CMD_RESP: unknown cmd action %d\n",
 442                         action);
 443                 return 0;
 444         }
 445         dev_dbg(adapter->dev,
 446                 "info: Current TxPower Level = %d, Max Power=%d, Min Power=%d\n",
 447                priv->tx_power_level, priv->max_tx_power_level,
 448                priv->min_tx_power_level);
 449
 450         return 0;
 451 }
 452
 453 /*
 454  * This function handles the command response of get RF Tx power.
 455  */
 456 static int mwifiex_ret_rf_tx_power(struct mwifiex_private *priv,
 457                                    struct host_cmd_ds_command *resp)
 458 {
 459         struct host_cmd_ds_rf_tx_pwr *txp = &resp->params.txp;
 460         u16 action = le16_to_cpu(txp->action);
 461
 462         priv->tx_power_level = le16_to_cpu(txp->cur_level);
 463
 464         if (action == HostCmd_ACT_GEN_GET) {
 465                 priv->max_tx_power_level = txp->max_power;
 466                 priv->min_tx_power_level = txp->min_power;
 467         }
 468
 469         dev_dbg(priv->adapter->dev,
 470                 "Current TxPower Level=%d, Max Power=%d, Min Power=%d\n",
 471                 priv->tx_power_level, priv->max_tx_power_level,
 472                 priv->min_tx_power_level);
 473
 474         return 0;
 475 }
 476
 477 /*
 478  * This function handles the command response of set/get MAC address.
 479  *
 480  * Handling includes saving the MAC address in driver.
 481  */
 482 static int mwifiex_ret_802_11_mac_address(struct mwifiex_private *priv,
 483                                           struct host_cmd_ds_command *resp)
 484 {
 485         struct host_cmd_ds_802_11_mac_address *cmd_mac_addr =
 486                                                         &resp->params.mac_addr;
 487
 488         memcpy(priv->curr_addr, cmd_mac_addr->mac_addr, ETH_ALEN);
 489
 490         dev_dbg(priv->adapter->dev,
 491                 "info: set mac address: %pM\n", priv->curr_addr);
 492
 493         return 0;
 494 }
 495
 496 /*
 497  * This function handles the command response of set/get MAC multicast
 498  * address.
 499  */
 500 static int mwifiex_ret_mac_multicast_adr(struct mwifiex_private *priv,
 501                                          struct host_cmd_ds_command *resp)
 502 {
 503         return 0;
 504 }
 505
 506 /*
 507  * This function handles the command response of get Tx rate query.
 508  *
 509  * Handling includes changing the header fields into CPU format
 510  * and saving the Tx rate and HT information parameters in driver.
 511  *
 512  * Both rate configuration and current data rate can be retrieved
 513  * with this request.
 514  */
 515 static int mwifiex_ret_802_11_tx_rate_query(struct mwifiex_private *priv,
 516                                             struct host_cmd_ds_command *resp)
 517 {
 518         priv->tx_rate = resp->params.tx_rate.tx_rate;
 519         priv->tx_htinfo = resp->params.tx_rate.ht_info;
 520         if (!priv->is_data_rate_auto)
 521                 priv->data_rate =
 522                         mwifiex_index_to_data_rate(priv, priv->tx_rate,
 523                                                    priv->tx_htinfo);
 524
 525         return 0;
 526 }
 527
 528 /*
 529  * This function handles the command response of a deauthenticate
 530  * command.
 531  *
 532  * If the deauthenticated MAC matches the current BSS MAC, the connection
 533  * state is reset.
 534  */
 535 static int mwifiex_ret_802_11_deauthenticate(struct mwifiex_private *priv,
 536                                              struct host_cmd_ds_command *resp)
 537 {
 538         struct mwifiex_adapter *adapter = priv->adapter;
 539
 540         adapter->dbg.num_cmd_deauth++;
 541         if (!memcmp(resp->params.deauth.mac_addr,
 542                     &priv->curr_bss_params.bss_descriptor.mac_address,
 543                     sizeof(resp->params.deauth.mac_addr)))
 544                 mwifiex_reset_connect_state(priv);
 545
 546         return 0;
 547 }
 548
 549 /*
 550  * This function handles the command response of ad-hoc stop.
 551  *
 552  * The function resets the connection state in driver.
 553  */
 554 static int mwifiex_ret_802_11_ad_hoc_stop(struct mwifiex_private *priv,
 555                                           struct host_cmd_ds_command *resp)
 556 {
 557         mwifiex_reset_connect_state(priv);
 558         return 0;
 559 }
 560
 561 /*
 562  * This function handles the command response of set/get key material.
 563  *
 564  * Handling includes updating the driver parameters to reflect the
 565  * changes.
 566  */
 567 static int mwifiex_ret_802_11_key_material(struct mwifiex_private *priv,
 568                                            struct host_cmd_ds_command *resp)
 569 {
 570         struct host_cmd_ds_802_11_key_material *key =
 571                                                 &resp->params.key_material;
 572
 573         if (le16_to_cpu(key->action) == HostCmd_ACT_GEN_SET) {
 574                 if ((le16_to_cpu(key->key_param_set.key_info) & KEY_MCAST)) {
 575                         dev_dbg(priv->adapter->dev, "info: key: GTK is set\n");
 576                         priv->wpa_is_gtk_set = true;
 577                         priv->scan_block = false;
 578                 }
 579         }
 580
 581         memset(priv->aes_key.key_param_set.key, 0,
 582                sizeof(key->key_param_set.key));
 583         priv->aes_key.key_param_set.key_len = key->key_param_set.key_len;
 584         memcpy(priv->aes_key.key_param_set.key, key->key_param_set.key,
 585                le16_to_cpu(priv->aes_key.key_param_set.key_len));
 586
 587         return 0;
 588 }
 589
 590 /*
 591  * This function handles the command response of get 11d domain information.
 592  */
 593 static int mwifiex_ret_802_11d_domain_info(struct mwifiex_private *priv,
 594                                            struct host_cmd_ds_command *resp)
 595 {
 596         struct host_cmd_ds_802_11d_domain_info_rsp *domain_info =
 597                 &resp->params.domain_info_resp;
 598         struct mwifiex_ietypes_domain_param_set *domain = &domain_info->domain;
 599         u16 action = le16_to_cpu(domain_info->action);
 600         u8 no_of_triplet;
 601
 602         no_of_triplet = (u8) ((le16_to_cpu(domain->header.len)
 603                                 - IEEE80211_COUNTRY_STRING_LEN)
 604                               / sizeof(struct ieee80211_country_ie_triplet));
 605
 606         dev_dbg(priv->adapter->dev,
 607                 "info: 11D Domain Info Resp: no_of_triplet=%d\n",
 608                 no_of_triplet);
 609
 610         if (no_of_triplet > MWIFIEX_MAX_TRIPLET_802_11D) {
 611                 dev_warn(priv->adapter->dev,
 612                          "11D: invalid number of triplets %d returned\n",
 613                          no_of_triplet);
 614                 return -1;
 615         }
 616
 617         switch (action) {
 618         case HostCmd_ACT_GEN_SET:  /* Proc Set Action */
 619                 break;
 620         case HostCmd_ACT_GEN_GET:
 621                 break;
 622         default:
 623                 dev_err(priv->adapter->dev,
 624                         "11D: invalid action:%d\n", domain_info->action);
 625                 return -1;
 626         }
 627
 628         return 0;
 629 }
 630
 631 /*
 632  * This function handles the command response of get RF channel.
 633  *
 634  * Handling includes changing the header fields into CPU format
 635  * and saving the new channel in driver.
 636  */
 637 static int mwifiex_ret_802_11_rf_channel(struct mwifiex_private *priv,
 638                                          struct host_cmd_ds_command *resp,
 639                                          u16 *data_buf)
 640 {
 641         struct host_cmd_ds_802_11_rf_channel *rf_channel =
 642                 &resp->params.rf_channel;
 643         u16 new_channel = le16_to_cpu(rf_channel->current_channel);
 644
 645         if (priv->curr_bss_params.bss_descriptor.channel != new_channel) {
 646                 dev_dbg(priv->adapter->dev, "cmd: Channel Switch: %d to %d\n",
 647                         priv->curr_bss_params.bss_descriptor.channel,
 648                         new_channel);
 649                 /* Update the channel again */
 650                 priv->curr_bss_params.bss_descriptor.channel = new_channel;
 651         }
 652
 653         if (data_buf)
 654                 *data_buf = new_channel;
 655
 656         return 0;
 657 }
 658
 659 /*
 660  * This function handles the command response of get extended version.
 661  *
 662  * Handling includes forming the extended version string and sending it
 663  * to application.
 664  */
 665 static int mwifiex_ret_ver_ext(struct mwifiex_private *priv,
 666                                struct host_cmd_ds_command *resp,
 667                                struct host_cmd_ds_version_ext *version_ext)
 668 {
 669         struct host_cmd_ds_version_ext *ver_ext = &resp->params.verext;
 670
 671         if (version_ext) {
 672                 version_ext->version_str_sel = ver_ext->version_str_sel;
 673                 memcpy(version_ext->version_str, ver_ext->version_str,
 674                        sizeof(char) * 128);
 675                 memcpy(priv->version_str, ver_ext->version_str, 128);
 676         }
 677         return 0;
 678 }
 679
 680 /*
 681  * This function handles the command response of register access.
 682  *
 683  * The register value and offset are returned to the user. For EEPROM
 684  * access, the byte count is also returned.
 685  */
 686 static int mwifiex_ret_reg_access(u16 type, struct host_cmd_ds_command *resp,
 687                                   void *data_buf)
 688 {
 689         struct mwifiex_ds_reg_rw *reg_rw;
 690         struct mwifiex_ds_read_eeprom *eeprom;
 691         union reg {
 692                 struct host_cmd_ds_mac_reg_access *mac;
 693                 struct host_cmd_ds_bbp_reg_access *bbp;
 694                 struct host_cmd_ds_rf_reg_access *rf;
 695                 struct host_cmd_ds_pmic_reg_access *pmic;
 696                 struct host_cmd_ds_802_11_eeprom_access *eeprom;
 697         } r;
 698
 699         if (!data_buf)
 700                 return 0;
 701
 702         reg_rw = data_buf;
 703         eeprom = data_buf;
 704         switch (type) {
 705         case HostCmd_CMD_MAC_REG_ACCESS:
 706                 r.mac = &resp->params.mac_reg;
 707                 reg_rw->offset = cpu_to_le32((u32) le16_to_cpu(r.mac->offset));
 708                 reg_rw->value = r.mac->value;
 709                 break;
 710         case HostCmd_CMD_BBP_REG_ACCESS:
 711                 r.bbp = &resp->params.bbp_reg;
 712                 reg_rw->offset = cpu_to_le32((u32) le16_to_cpu(r.bbp->offset));
 713                 reg_rw->value = cpu_to_le32((u32) r.bbp->value);
 714                 break;
 715
 716         case HostCmd_CMD_RF_REG_ACCESS:
 717                 r.rf = &resp->params.rf_reg;
 718                 reg_rw->offset = cpu_to_le32((u32) le16_to_cpu(r.rf->offset));
 719                 reg_rw->value = cpu_to_le32((u32) r.bbp->value);
 720                 break;
 721         case HostCmd_CMD_PMIC_REG_ACCESS:
 722                 r.pmic = &resp->params.pmic_reg;
 723                 reg_rw->offset = cpu_to_le32((u32) le16_to_cpu(r.pmic->offset));
 724                 reg_rw->value = cpu_to_le32((u32) r.pmic->value);
 725                 break;
 726         case HostCmd_CMD_CAU_REG_ACCESS:
 727                 r.rf = &resp->params.rf_reg;
 728                 reg_rw->offset = cpu_to_le32((u32) le16_to_cpu(r.rf->offset));
 729                 reg_rw->value = cpu_to_le32((u32) r.rf->value);
 730                 break;
 731         case HostCmd_CMD_802_11_EEPROM_ACCESS:
 732                 r.eeprom = &resp->params.eeprom;
 733                 pr_debug("info: EEPROM read len=%x\n", r.eeprom->byte_count);
 734                 if (le16_to_cpu(eeprom->byte_count) <
 735                     le16_to_cpu(r.eeprom->byte_count)) {
 736                         eeprom->byte_count = cpu_to_le16(0);
 737                         pr_debug("info: EEPROM read length is too big\n");
 738                         return -1;
 739                 }
 740                 eeprom->offset = r.eeprom->offset;
 741                 eeprom->byte_count = r.eeprom->byte_count;
 742                 if (le16_to_cpu(eeprom->byte_count) > 0)
 743                         memcpy(&eeprom->value, &r.eeprom->value,
 744                                le16_to_cpu(r.eeprom->byte_count));
 745
 746                 break;
 747         default:
 748                 return -1;
 749         }
 750         return 0;
 751 }
 752
 753 /*
 754  * This function handles the command response of get IBSS coalescing status.
 755  *
 756  * If the received BSSID is different than the current one, the current BSSID,
 757  * beacon interval, ATIM window and ERP information are updated, along with
 758  * changing the ad-hoc state accordingly.
 759  */
 760 static int mwifiex_ret_ibss_coalescing_status(struct mwifiex_private *priv,
 761                                               struct host_cmd_ds_command *resp)
 762 {
 763         struct host_cmd_ds_802_11_ibss_status *ibss_coal_resp =
 764                                         &(resp->params.ibss_coalescing);
 765         u8 zero_mac[ETH_ALEN] = { 0, 0, 0, 0, 0, 0 };
 766
 767         if (le16_to_cpu(ibss_coal_resp->action) == HostCmd_ACT_GEN_SET)
 768                 return 0;
 769
 770         dev_dbg(priv->adapter->dev,
 771                 "info: new BSSID %pM\n", ibss_coal_resp->bssid);
 772
 773         /* If rsp has NULL BSSID, Just return..... No Action */
 774         if (!memcmp(ibss_coal_resp->bssid, zero_mac, ETH_ALEN)) {
 775                 dev_warn(priv->adapter->dev, "new BSSID is NULL\n");
 776                 return 0;
 777         }
 778
 779         /* If BSSID is diff, modify current BSS parameters */
 780         if (memcmp(priv->curr_bss_params.bss_descriptor.mac_address,
 781                    ibss_coal_resp->bssid, ETH_ALEN)) {
 782                 /* BSSID */
 783                 memcpy(priv->curr_bss_params.bss_descriptor.mac_address,
 784                        ibss_coal_resp->bssid, ETH_ALEN);
 785
 786                 /* Beacon Interval */
 787                 priv->curr_bss_params.bss_descriptor.beacon_period
 788                         = le16_to_cpu(ibss_coal_resp->beacon_interval);
 789
 790                 /* ERP Information */
 791                 priv->curr_bss_params.bss_descriptor.erp_flags =
 792                         (u8) le16_to_cpu(ibss_coal_resp->use_g_rate_protect);
 793
 794                 priv->adhoc_state = ADHOC_COALESCED;
 795         }
 796
 797         return 0;
 798 }
 799
 800 /*
 801  * This function handles the command response for subscribe event command.
 802  */
 803 static int mwifiex_ret_subsc_evt(struct mwifiex_private *priv,
 804                                  struct host_cmd_ds_command *resp,
 805                                  struct mwifiex_ds_misc_subsc_evt *sub_event)
 806 {
 807         struct host_cmd_ds_802_11_subsc_evt *cmd_sub_event =
 808                 &resp->params.subsc_evt;
 809
 810         /* For every subscribe event command (Get/Set/Clear), FW reports the
 811          * current set of subscribed events*/
 812         dev_dbg(priv->adapter->dev, "Bitmap of currently subscribed events: %16x\n",
 813                 le16_to_cpu(cmd_sub_event->events));
 814
 815         /*Return the subscribed event info for a Get request*/
 816         if (sub_event)
 817                 sub_event->events = le16_to_cpu(cmd_sub_event->events);
 818
 819         return 0;
 820 }
 821
 822 /*
 823  * This function handles the command responses.
 824  *
 825  * This is a generic function, which calls command specific
 826  * response handlers based on the command ID.
 827  */
 828 int mwifiex_process_sta_cmdresp(struct mwifiex_private *priv, u16 cmdresp_no,
 829                                 struct host_cmd_ds_command *resp)
 830 {
 831         int ret = 0;
 832         struct mwifiex_adapter *adapter = priv->adapter;
 833         void *data_buf = adapter->curr_cmd->data_buf;
 834
 835         /* If the command is not successful, cleanup and return failure */
 836         if (resp->result != HostCmd_RESULT_OK) {
 837                 mwifiex_process_cmdresp_error(priv, resp);
 838                 return -1;
 839         }
 840         /* Command successful, handle response */
 841         switch (cmdresp_no) {
 842         case HostCmd_CMD_GET_HW_SPEC:
 843                 ret = mwifiex_ret_get_hw_spec(priv, resp);
 844                 break;
 845         case HostCmd_CMD_MAC_CONTROL:
 846                 break;
 847         case HostCmd_CMD_802_11_MAC_ADDRESS:
 848                 ret = mwifiex_ret_802_11_mac_address(priv, resp);
 849                 break;
 850         case HostCmd_CMD_MAC_MULTICAST_ADR:
 851                 ret = mwifiex_ret_mac_multicast_adr(priv, resp);
 852                 break;
 853         case HostCmd_CMD_TX_RATE_CFG:
 854                 ret = mwifiex_ret_tx_rate_cfg(priv, resp, data_buf);
 855                 break;
 856         case HostCmd_CMD_802_11_SCAN:
 857                 ret = mwifiex_ret_802_11_scan(priv, resp);
 858                 adapter->curr_cmd->wait_q_enabled = false;
 859                 break;
 860         case HostCmd_CMD_802_11_BG_SCAN_QUERY:
 861                 ret = mwifiex_ret_802_11_scan(priv, resp);
 862                 dev_dbg(adapter->dev,
 863                         "info: CMD_RESP: BG_SCAN result is ready!\n");
 864                 break;
 865         case HostCmd_CMD_TXPWR_CFG:
 866                 ret = mwifiex_ret_tx_power_cfg(priv, resp);
 867                 break;
 868         case HostCmd_CMD_RF_TX_PWR:
 869                 ret = mwifiex_ret_rf_tx_power(priv, resp);
 870                 break;
 871         case HostCmd_CMD_802_11_PS_MODE_ENH:
 872                 ret = mwifiex_ret_enh_power_mode(priv, resp, data_buf);
 873                 break;
 874         case HostCmd_CMD_802_11_HS_CFG_ENH:
 875                 ret = mwifiex_ret_802_11_hs_cfg(priv, resp);
 876                 break;
 877         case HostCmd_CMD_802_11_ASSOCIATE:
 878                 ret = mwifiex_ret_802_11_associate(priv, resp);
 879                 break;
 880         case HostCmd_CMD_802_11_DEAUTHENTICATE:
 881                 ret = mwifiex_ret_802_11_deauthenticate(priv, resp);
 882                 break;
 883         case HostCmd_CMD_802_11_AD_HOC_START:
 884         case HostCmd_CMD_802_11_AD_HOC_JOIN:
 885                 ret = mwifiex_ret_802_11_ad_hoc(priv, resp);
 886                 break;
 887         case HostCmd_CMD_802_11_AD_HOC_STOP:
 888                 ret = mwifiex_ret_802_11_ad_hoc_stop(priv, resp);
 889                 break;
 890         case HostCmd_CMD_802_11_GET_LOG:
 891                 ret = mwifiex_ret_get_log(priv, resp, data_buf);
 892                 break;
 893         case HostCmd_CMD_RSSI_INFO:
 894                 ret = mwifiex_ret_802_11_rssi_info(priv, resp);
 895                 break;
 896         case HostCmd_CMD_802_11_SNMP_MIB:
 897                 ret = mwifiex_ret_802_11_snmp_mib(priv, resp, data_buf);
 898                 break;
 899         case HostCmd_CMD_802_11_TX_RATE_QUERY:
 900                 ret = mwifiex_ret_802_11_tx_rate_query(priv, resp);
 901                 break;
 902         case HostCmd_CMD_802_11_RF_CHANNEL:
 903                 ret = mwifiex_ret_802_11_rf_channel(priv, resp, data_buf);
 904                 break;
 905         case HostCmd_CMD_VERSION_EXT:
 906                 ret = mwifiex_ret_ver_ext(priv, resp, data_buf);
 907                 break;
 908         case HostCmd_CMD_FUNC_INIT:
 909         case HostCmd_CMD_FUNC_SHUTDOWN:
 910                 break;
 911         case HostCmd_CMD_802_11_KEY_MATERIAL:
 912                 ret = mwifiex_ret_802_11_key_material(priv, resp);
 913                 break;
 914         case HostCmd_CMD_802_11D_DOMAIN_INFO:
 915                 ret = mwifiex_ret_802_11d_domain_info(priv, resp);
 916                 break;
 917         case HostCmd_CMD_11N_ADDBA_REQ:
 918                 ret = mwifiex_ret_11n_addba_req(priv, resp);
 919                 break;
 920         case HostCmd_CMD_11N_DELBA:
 921                 ret = mwifiex_ret_11n_delba(priv, resp);
 922                 break;
 923         case HostCmd_CMD_11N_ADDBA_RSP:
 924                 ret = mwifiex_ret_11n_addba_resp(priv, resp);
 925                 break;
 926         case HostCmd_CMD_RECONFIGURE_TX_BUFF:
 927                 adapter->tx_buf_size = (u16) le16_to_cpu(resp->params.
 928                                                              tx_buf.buff_size);
 929                 adapter->tx_buf_size = (adapter->tx_buf_size
 930                                         / MWIFIEX_SDIO_BLOCK_SIZE)
 931                                        * MWIFIEX_SDIO_BLOCK_SIZE;
 932                 adapter->curr_tx_buf_size = adapter->tx_buf_size;
 933                 dev_dbg(adapter->dev,
 934                         "cmd: max_tx_buf_size=%d, tx_buf_size=%d\n",
 935                         adapter->max_tx_buf_size, adapter->tx_buf_size);
 936
 937                 if (adapter->if_ops.update_mp_end_port)
 938                         adapter->if_ops.update_mp_end_port(adapter,
 939                                 le16_to_cpu(resp->params.tx_buf.mp_end_port));
 940                 break;
 941         case HostCmd_CMD_AMSDU_AGGR_CTRL:
 942                 ret = mwifiex_ret_amsdu_aggr_ctrl(resp, data_buf);
 943                 break;
 944         case HostCmd_CMD_WMM_GET_STATUS:
 945                 ret = mwifiex_ret_wmm_get_status(priv, resp);
 946                 break;
 947         case HostCmd_CMD_802_11_IBSS_COALESCING_STATUS:
 948                 ret = mwifiex_ret_ibss_coalescing_status(priv, resp);
 949                 break;
 950         case HostCmd_CMD_MAC_REG_ACCESS:
 951         case HostCmd_CMD_BBP_REG_ACCESS:
 952         case HostCmd_CMD_RF_REG_ACCESS:
 953         case HostCmd_CMD_PMIC_REG_ACCESS:
 954         case HostCmd_CMD_CAU_REG_ACCESS:
 955         case HostCmd_CMD_802_11_EEPROM_ACCESS:
 956                 ret = mwifiex_ret_reg_access(cmdresp_no, resp, data_buf);
 957                 break;
 958         case HostCmd_CMD_SET_BSS_MODE:
 959                 break;
 960         case HostCmd_CMD_11N_CFG:
 961                 ret = mwifiex_ret_11n_cfg(resp, data_buf);
 962                 break;
 963         case HostCmd_CMD_PCIE_DESC_DETAILS:
 964                 break;
 965         case HostCmd_CMD_802_11_SUBSCRIBE_EVENT:
 966                 ret = mwifiex_ret_subsc_evt(priv, resp, data_buf);
 967                 break;
 968         case HostCmd_CMD_UAP_SYS_CONFIG:
 969                 break;
 970         case HostCmd_CMD_UAP_BSS_START:
 971                 priv->bss_started = 1;
 972                 break;
 973         case HostCmd_CMD_UAP_BSS_STOP:
 974                 priv->bss_started = 0;
 975                 break;
 976         default:
 977                 dev_err(adapter->dev, "CMD_RESP: unknown cmd response %#x\n",
 978                         resp->command);
 979                 break;
 980         }
 981
 982         return ret;
 983 }