SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/net/wireless/iwlwifi/iwl-hcmd.c

   1 /******************************************************************************
   2  *
   3  * GPL LICENSE SUMMARY
   4  *
   5  * Copyright(c) 2008 Intel Corporation. All rights reserved.
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of version 2 of the GNU General Public License as
   9  * published by the Free Software Foundation.
  10  *
  11  * This program is distributed in the hope that it will be useful, but
  12  * WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
  19  * USA
  20  *
  21  * The full GNU General Public License is included in this distribution
  22  * in the file called LICENSE.GPL.
  23  *
  24  * Contact Information:
  25  * Tomas Winkler <tomas.winkler@intel.com>
  26  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  27  *****************************************************************************/
  28
  29 #include <linux/kernel.h>
  30 #include <linux/module.h>
  31 #include <linux/version.h>
  32 #include <net/mac80211.h>
  33
  34 #include "iwl-4965.h" /* FIXME: remove */
  35 #include "iwl-debug.h"
  36 #include "iwl-eeprom.h"
  37 #include "iwl-core.h"
  38
  39
  40 #define IWL_CMD(x) case x : return #x
  41
  42 const char *get_cmd_string(u8 cmd)
  43 {
  44         switch (cmd) {
  45                 IWL_CMD(REPLY_ALIVE);
  46                 IWL_CMD(REPLY_ERROR);
  47                 IWL_CMD(REPLY_RXON);
  48                 IWL_CMD(REPLY_RXON_ASSOC);
  49                 IWL_CMD(REPLY_QOS_PARAM);
  50                 IWL_CMD(REPLY_RXON_TIMING);
  51                 IWL_CMD(REPLY_ADD_STA);
  52                 IWL_CMD(REPLY_REMOVE_STA);
  53                 IWL_CMD(REPLY_REMOVE_ALL_STA);
  54                 IWL_CMD(REPLY_TX);
  55                 IWL_CMD(REPLY_RATE_SCALE);
  56                 IWL_CMD(REPLY_LEDS_CMD);
  57                 IWL_CMD(REPLY_TX_LINK_QUALITY_CMD);
  58                 IWL_CMD(RADAR_NOTIFICATION);
  59                 IWL_CMD(REPLY_QUIET_CMD);
  60                 IWL_CMD(REPLY_CHANNEL_SWITCH);
  61                 IWL_CMD(CHANNEL_SWITCH_NOTIFICATION);
  62                 IWL_CMD(REPLY_SPECTRUM_MEASUREMENT_CMD);
  63                 IWL_CMD(SPECTRUM_MEASURE_NOTIFICATION);
  64                 IWL_CMD(POWER_TABLE_CMD);
  65                 IWL_CMD(PM_SLEEP_NOTIFICATION);
  66                 IWL_CMD(PM_DEBUG_STATISTIC_NOTIFIC);
  67                 IWL_CMD(REPLY_SCAN_CMD);
  68                 IWL_CMD(REPLY_SCAN_ABORT_CMD);
  69                 IWL_CMD(SCAN_START_NOTIFICATION);
  70                 IWL_CMD(SCAN_RESULTS_NOTIFICATION);
  71                 IWL_CMD(SCAN_COMPLETE_NOTIFICATION);
  72                 IWL_CMD(BEACON_NOTIFICATION);
  73                 IWL_CMD(REPLY_TX_BEACON);
  74                 IWL_CMD(WHO_IS_AWAKE_NOTIFICATION);
  75                 IWL_CMD(QUIET_NOTIFICATION);
  76                 IWL_CMD(REPLY_TX_PWR_TABLE_CMD);
  77                 IWL_CMD(MEASURE_ABORT_NOTIFICATION);
  78                 IWL_CMD(REPLY_BT_CONFIG);
  79                 IWL_CMD(REPLY_STATISTICS_CMD);
  80                 IWL_CMD(STATISTICS_NOTIFICATION);
  81                 IWL_CMD(REPLY_CARD_STATE_CMD);
  82                 IWL_CMD(CARD_STATE_NOTIFICATION);
  83                 IWL_CMD(MISSED_BEACONS_NOTIFICATION);
  84                 IWL_CMD(REPLY_CT_KILL_CONFIG_CMD);
  85                 IWL_CMD(SENSITIVITY_CMD);
  86                 IWL_CMD(REPLY_PHY_CALIBRATION_CMD);
  87                 IWL_CMD(REPLY_RX_PHY_CMD);
  88                 IWL_CMD(REPLY_RX_MPDU_CMD);
  89                 IWL_CMD(REPLY_RX);
  90                 IWL_CMD(REPLY_COMPRESSED_BA);
  91         default:
  92                 return "UNKNOWN";
  93
  94         }
  95 }
  96 EXPORT_SYMBOL(get_cmd_string);
  97
  98 #define HOST_COMPLETE_TIMEOUT (HZ / 2)
  99
 100 static int iwl_send_cmd_async(struct iwl_priv *priv, struct iwl_host_cmd *cmd)
 101 {
 102         int ret;
 103
 104         BUG_ON(!(cmd->meta.flags & CMD_ASYNC));
 105
 106         /* An asynchronous command can not expect an SKB to be set. */
 107         BUG_ON(cmd->meta.flags & CMD_WANT_SKB);
 108
 109         /* An asynchronous command MUST have a callback. */
 110         BUG_ON(!cmd->meta.u.callback);
 111
 112         if (test_bit(STATUS_EXIT_PENDING, &priv->status))
 113                 return -EBUSY;
 114
 115         ret = priv->cfg->ops->utils->enqueue_hcmd(priv, cmd);
 116         if (ret < 0) {
 117                 IWL_ERROR("Error sending %s: enqueue_hcmd failed: %d\n",
 118                           get_cmd_string(cmd->id), ret);
 119                 return ret;
 120         }
 121         return 0;
 122 }
 123
 124 int iwl_send_cmd_sync(struct iwl_priv *priv, struct iwl_host_cmd *cmd)
 125 {
 126         int cmd_idx;
 127         int ret;
 128         static atomic_t entry = ATOMIC_INIT(0); /* reentrance protection */
 129
 130         BUG_ON(cmd->meta.flags & CMD_ASYNC);
 131
 132          /* A synchronous command can not have a callback set. */
 133         BUG_ON(cmd->meta.u.callback != NULL);
 134
 135         if (atomic_xchg(&entry, 1)) {
 136                 IWL_ERROR("Error sending %s: Already sending a host command\n",
 137                           get_cmd_string(cmd->id));
 138                 return -EBUSY;
 139         }
 140
 141         set_bit(STATUS_HCMD_ACTIVE, &priv->status);
 142
 143         if (cmd->meta.flags & CMD_WANT_SKB)
 144                 cmd->meta.source = &cmd->meta;
 145
 146         cmd_idx = priv->cfg->ops->utils->enqueue_hcmd(priv, cmd);
 147         if (cmd_idx < 0) {
 148                 ret = cmd_idx;
 149                 IWL_ERROR("Error sending %s: enqueue_hcmd failed: %d\n",
 150                           get_cmd_string(cmd->id), ret);
 151                 goto out;
 152         }
 153
 154         ret = wait_event_interruptible_timeout(priv->wait_command_queue,
 155                         !test_bit(STATUS_HCMD_ACTIVE, &priv->status),
 156                         HOST_COMPLETE_TIMEOUT);
 157         if (!ret) {
 158                 if (test_bit(STATUS_HCMD_ACTIVE, &priv->status)) {
 159                         IWL_ERROR("Error sending %s: time out after %dms.\n",
 160                                   get_cmd_string(cmd->id),
 161                                   jiffies_to_msecs(HOST_COMPLETE_TIMEOUT));
 162
 163                         clear_bit(STATUS_HCMD_ACTIVE, &priv->status);
 164                         ret = -ETIMEDOUT;
 165                         goto cancel;
 166                 }
 167         }
 168
 169         if (test_bit(STATUS_RF_KILL_HW, &priv->status)) {
 170                 IWL_DEBUG_INFO("Command %s aborted: RF KILL Switch\n",
 171                                get_cmd_string(cmd->id));
 172                 ret = -ECANCELED;
 173                 goto fail;
 174         }
 175         if (test_bit(STATUS_FW_ERROR, &priv->status)) {
 176                 IWL_DEBUG_INFO("Command %s failed: FW Error\n",
 177                                get_cmd_string(cmd->id));
 178                 ret = -EIO;
 179                 goto fail;
 180         }
 181         if ((cmd->meta.flags & CMD_WANT_SKB) && !cmd->meta.u.skb) {
 182                 IWL_ERROR("Error: Response NULL in '%s'\n",
 183                           get_cmd_string(cmd->id));
 184                 ret = -EIO;
 185                 goto out;
 186         }
 187
 188         ret = 0;
 189         goto out;
 190
 191 cancel:
 192         if (cmd->meta.flags & CMD_WANT_SKB) {
 193                 struct iwl_cmd *qcmd;
 194
 195                 /* Cancel the CMD_WANT_SKB flag for the cmd in the
 196                  * TX cmd queue. Otherwise in case the cmd comes
 197                  * in later, it will possibly set an invalid
 198                  * address (cmd->meta.source). */
 199                 qcmd = &priv->txq[IWL_CMD_QUEUE_NUM].cmd[cmd_idx];
 200                 qcmd->meta.flags &= ~CMD_WANT_SKB;
 201         }
 202 fail:
 203         if (cmd->meta.u.skb) {
 204                 dev_kfree_skb_any(cmd->meta.u.skb);
 205                 cmd->meta.u.skb = NULL;
 206         }
 207 out:
 208         atomic_set(&entry, 0);
 209         return ret;
 210 }
 211 EXPORT_SYMBOL(iwl_send_cmd_sync);
 212
 213 int iwl_send_cmd(struct iwl_priv *priv, struct iwl_host_cmd *cmd)
 214 {
 215         if (cmd->meta.flags & CMD_ASYNC)
 216                 return iwl_send_cmd_async(priv, cmd);
 217
 218         return iwl_send_cmd_sync(priv, cmd);
 219 }
 220 EXPORT_SYMBOL(iwl_send_cmd);
 221
 222 int iwl_send_cmd_pdu(struct iwl_priv *priv, u8 id, u16 len, const void *data)
 223 {
 224         struct iwl_host_cmd cmd = {
 225                 .id = id,
 226                 .len = len,
 227                 .data = data,
 228         };
 229
 230         return iwl_send_cmd_sync(priv, &cmd);
 231 }
 232 EXPORT_SYMBOL(iwl_send_cmd_pdu);
 233
 234 int iwl_send_cmd_pdu_async(struct iwl_priv *priv,
 235                            u8 id, u16 len, const void *data,
 236                            int (*callback)(struct iwl_priv *priv,
 237                                            struct iwl_cmd *cmd,
 238                                            struct sk_buff *skb))
 239 {
 240         struct iwl_host_cmd cmd = {
 241                 .id = id,
 242                 .len = len,
 243                 .data = data,
 244         };
 245
 246         cmd.meta.flags |= CMD_ASYNC;
 247         cmd.meta.u.callback = callback;
 248
 249         return iwl_send_cmd_async(priv, &cmd);
 250 }
 251 EXPORT_SYMBOL(iwl_send_cmd_pdu_async);