[deliverable/linux.git] / drivers / net / wireless / iwlwifi / iwl-hcmd.c

/******************************************************************************
 *
 * GPL LICENSE SUMMARY
 *
 * Copyright(c) 2008 Intel Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
 * USA
 *
 * The full GNU General Public License is included in this distribution
 * in the file called LICENSE.GPL.
 *
 * Contact Information:
 * Tomas Winkler <tomas.winkler@intel.com>
 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 *****************************************************************************/

#include <linux/kernel.h>
#include <linux/module.h>
#include <net/mac80211.h>

#include "iwl-dev.h" /* FIXME: remove */
#include "iwl-debug.h"
#include "iwl-eeprom.h"
#include "iwl-core.h"


#define IWL_CMD(x) case x : return #x

const char *get_cmd_string(u8 cmd)
{
	switch (cmd) {
		IWL_CMD(REPLY_ALIVE);
		IWL_CMD(REPLY_ERROR);
		IWL_CMD(REPLY_RXON);
		IWL_CMD(REPLY_RXON_ASSOC);
		IWL_CMD(REPLY_QOS_PARAM);
		IWL_CMD(REPLY_RXON_TIMING);
		IWL_CMD(REPLY_ADD_STA);
		IWL_CMD(REPLY_REMOVE_STA);
		IWL_CMD(REPLY_REMOVE_ALL_STA);
		IWL_CMD(REPLY_WEPKEY);
		IWL_CMD(REPLY_TX);
		IWL_CMD(REPLY_RATE_SCALE);
		IWL_CMD(REPLY_LEDS_CMD);
		IWL_CMD(REPLY_TX_LINK_QUALITY_CMD);
		IWL_CMD(COEX_PRIORITY_TABLE_CMD);
		IWL_CMD(RADAR_NOTIFICATION);
		IWL_CMD(REPLY_QUIET_CMD);
		IWL_CMD(REPLY_CHANNEL_SWITCH);
		IWL_CMD(CHANNEL_SWITCH_NOTIFICATION);
		IWL_CMD(REPLY_SPECTRUM_MEASUREMENT_CMD);
		IWL_CMD(SPECTRUM_MEASURE_NOTIFICATION);
		IWL_CMD(POWER_TABLE_CMD);
		IWL_CMD(PM_SLEEP_NOTIFICATION);
		IWL_CMD(PM_DEBUG_STATISTIC_NOTIFIC);
		IWL_CMD(REPLY_SCAN_CMD);
		IWL_CMD(REPLY_SCAN_ABORT_CMD);
		IWL_CMD(SCAN_START_NOTIFICATION);
		IWL_CMD(SCAN_RESULTS_NOTIFICATION);
		IWL_CMD(SCAN_COMPLETE_NOTIFICATION);
		IWL_CMD(BEACON_NOTIFICATION);
		IWL_CMD(REPLY_TX_BEACON);
		IWL_CMD(WHO_IS_AWAKE_NOTIFICATION);
		IWL_CMD(QUIET_NOTIFICATION);
		IWL_CMD(REPLY_TX_PWR_TABLE_CMD);
		IWL_CMD(MEASURE_ABORT_NOTIFICATION);
		IWL_CMD(REPLY_BT_CONFIG);
		IWL_CMD(REPLY_STATISTICS_CMD);
		IWL_CMD(STATISTICS_NOTIFICATION);
		IWL_CMD(REPLY_CARD_STATE_CMD);
		IWL_CMD(CARD_STATE_NOTIFICATION);
		IWL_CMD(MISSED_BEACONS_NOTIFICATION);
		IWL_CMD(REPLY_CT_KILL_CONFIG_CMD);
		IWL_CMD(SENSITIVITY_CMD);
		IWL_CMD(REPLY_PHY_CALIBRATION_CMD);
		IWL_CMD(REPLY_RX_PHY_CMD);
		IWL_CMD(REPLY_RX_MPDU_CMD);
		IWL_CMD(REPLY_RX);
		IWL_CMD(REPLY_COMPRESSED_BA);
		IWL_CMD(CALIBRATION_CFG_CMD);
		IWL_CMD(CALIBRATION_RES_NOTIFICATION);
		IWL_CMD(CALIBRATION_COMPLETE_NOTIFICATION);
		IWL_CMD(REPLY_TX_POWER_DBM_CMD);
	default:
		return "UNKNOWN";

	}
}
EXPORT_SYMBOL(get_cmd_string);

#define HOST_COMPLETE_TIMEOUT (HZ / 2)

static int iwl_generic_cmd_callback(struct iwl_priv *priv,
				    struct iwl_cmd *cmd, struct sk_buff *skb)
{
	struct iwl_rx_packet *pkt = NULL;

	if (!skb) {
		IWL_ERROR("Error: Response NULL in %s.\n",
				get_cmd_string(cmd->hdr.cmd));
		return 1;
	}

	pkt = (struct iwl_rx_packet *)skb->data;
	if (pkt->hdr.flags & IWL_CMD_FAILED_MSK) {
		IWL_ERROR("Bad return from %s (0x%08X)\n",
			get_cmd_string(cmd->hdr.cmd), pkt->hdr.flags);
		return 1;
	}

	IWL_DEBUG_HC("back from %s (0x%08X)\n",
			get_cmd_string(cmd->hdr.cmd), pkt->hdr.flags);

	/* Let iwl_tx_complete free the response skb */
	return 1;
}

static int iwl_send_cmd_async(struct iwl_priv *priv, struct iwl_host_cmd *cmd)
{
	int ret;

	BUG_ON(!(cmd->meta.flags & CMD_ASYNC));

	/* An asynchronous command can not expect an SKB to be set. */
	BUG_ON(cmd->meta.flags & CMD_WANT_SKB);

	/* Assign a generic callback if one is not provided */
	if (!cmd->meta.u.callback)
		cmd->meta.u.callback = iwl_generic_cmd_callback;

	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
		return -EBUSY;

	ret = iwl_enqueue_hcmd(priv, cmd);
	if (ret < 0) {
		IWL_ERROR("Error sending %s: enqueue_hcmd failed: %d\n",
			  get_cmd_string(cmd->id), ret);
		return ret;
	}
	return 0;
}

int iwl_send_cmd_sync(struct iwl_priv *priv, struct iwl_host_cmd *cmd)
{
	int cmd_idx;
	int ret;

	BUG_ON(cmd->meta.flags & CMD_ASYNC);

	 /* A synchronous command can not have a callback set. */
	BUG_ON(cmd->meta.u.callback != NULL);

	if (test_and_set_bit(STATUS_HCMD_SYNC_ACTIVE, &priv->status)) {
		IWL_ERROR("Error sending %s: Already sending a host command\n",
			  get_cmd_string(cmd->id));
		ret = -EBUSY;
		goto out;
	}

	set_bit(STATUS_HCMD_ACTIVE, &priv->status);

	if (cmd->meta.flags & CMD_WANT_SKB)
		cmd->meta.source = &cmd->meta;

	cmd_idx = iwl_enqueue_hcmd(priv, cmd);
	if (cmd_idx < 0) {
		ret = cmd_idx;
		IWL_ERROR("Error sending %s: enqueue_hcmd failed: %d\n",
			  get_cmd_string(cmd->id), ret);
		goto out;
	}

	ret = wait_event_interruptible_timeout(priv->wait_command_queue,
			!test_bit(STATUS_HCMD_ACTIVE, &priv->status),
			HOST_COMPLETE_TIMEOUT);
	if (!ret) {
		if (test_bit(STATUS_HCMD_ACTIVE, &priv->status)) {
			IWL_ERROR("Error sending %s: time out after %dms.\n",
				  get_cmd_string(cmd->id),
				  jiffies_to_msecs(HOST_COMPLETE_TIMEOUT));

			clear_bit(STATUS_HCMD_ACTIVE, &priv->status);
			ret = -ETIMEDOUT;
			goto cancel;
		}
	}

	if (test_bit(STATUS_RF_KILL_HW, &priv->status)) {
		IWL_DEBUG_INFO("Command %s aborted: RF KILL Switch\n",
			       get_cmd_string(cmd->id));
		ret = -ECANCELED;
		goto fail;
	}
	if (test_bit(STATUS_FW_ERROR, &priv->status)) {
		IWL_DEBUG_INFO("Command %s failed: FW Error\n",
			       get_cmd_string(cmd->id));
		ret = -EIO;
		goto fail;
	}
	if ((cmd->meta.flags & CMD_WANT_SKB) && !cmd->meta.u.skb) {
		IWL_ERROR("Error: Response NULL in '%s'\n",
			  get_cmd_string(cmd->id));
		ret = -EIO;
		goto out;
	}

	ret = 0;
	goto out;

cancel:
	if (cmd->meta.flags & CMD_WANT_SKB) {
		struct iwl_cmd *qcmd;

		/* Cancel the CMD_WANT_SKB flag for the cmd in the
		 * TX cmd queue. Otherwise in case the cmd comes
		 * in later, it will possibly set an invalid
		 * address (cmd->meta.source). */
		qcmd = priv->txq[IWL_CMD_QUEUE_NUM].cmd[cmd_idx];
		qcmd->meta.flags &= ~CMD_WANT_SKB;
	}
fail:
	if (cmd->meta.u.skb) {
		dev_kfree_skb_any(cmd->meta.u.skb);
		cmd->meta.u.skb = NULL;
	}
out:
	clear_bit(STATUS_HCMD_SYNC_ACTIVE, &priv->status);
	return ret;
}
EXPORT_SYMBOL(iwl_send_cmd_sync);

int iwl_send_cmd(struct iwl_priv *priv, struct iwl_host_cmd *cmd)
{
	if (cmd->meta.flags & CMD_ASYNC)
		return iwl_send_cmd_async(priv, cmd);

	return iwl_send_cmd_sync(priv, cmd);
}
EXPORT_SYMBOL(iwl_send_cmd);

int iwl_send_cmd_pdu(struct iwl_priv *priv, u8 id, u16 len, const void *data)
{
	struct iwl_host_cmd cmd = {
		.id = id,
		.len = len,
		.data = data,
	};

	return iwl_send_cmd_sync(priv, &cmd);
}
EXPORT_SYMBOL(iwl_send_cmd_pdu);

int iwl_send_cmd_pdu_async(struct iwl_priv *priv,
			   u8 id, u16 len, const void *data,
			   int (*callback)(struct iwl_priv *priv,
					   struct iwl_cmd *cmd,
					   struct sk_buff *skb))
{
	struct iwl_host_cmd cmd = {
		.id = id,
		.len = len,
		.data = data,
	};

	cmd.meta.flags |= CMD_ASYNC;
	cmd.meta.u.callback = callback;

	return iwl_send_cmd_async(priv, &cmd);
}
EXPORT_SYMBOL(iwl_send_cmd_pdu_async);
Commit	Line	Data
857485c0 TW	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>
857485c0 TW	31	#include <net/mac80211.h>
857485c0 TW	32
3e0d4cb1	33	#include "iwl-dev.h" /* FIXME: remove */
857485c0 TW	34	#include "iwl-debug.h"
	35	#include "iwl-eeprom.h"
	36	#include "iwl-core.h"
	37
	38
	39	#define IWL_CMD(x) case x : return #x
	40
	41	const char *get_cmd_string(u8 cmd)
	42	{
	43	switch (cmd) {
	44	IWL_CMD(REPLY_ALIVE);
	45	IWL_CMD(REPLY_ERROR);
	46	IWL_CMD(REPLY_RXON);
	47	IWL_CMD(REPLY_RXON_ASSOC);
	48	IWL_CMD(REPLY_QOS_PARAM);
	49	IWL_CMD(REPLY_RXON_TIMING);
	50	IWL_CMD(REPLY_ADD_STA);
	51	IWL_CMD(REPLY_REMOVE_STA);
	52	IWL_CMD(REPLY_REMOVE_ALL_STA);
0a0bed1d	53	IWL_CMD(REPLY_WEPKEY);
857485c0 TW	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);
7c616cba	58	IWL_CMD(COEX_PRIORITY_TABLE_CMD);
857485c0 TW	59	IWL_CMD(RADAR_NOTIFICATION);
	60	IWL_CMD(REPLY_QUIET_CMD);
	61	IWL_CMD(REPLY_CHANNEL_SWITCH);
	62	IWL_CMD(CHANNEL_SWITCH_NOTIFICATION);
	63	IWL_CMD(REPLY_SPECTRUM_MEASUREMENT_CMD);
	64	IWL_CMD(SPECTRUM_MEASURE_NOTIFICATION);
	65	IWL_CMD(POWER_TABLE_CMD);
	66	IWL_CMD(PM_SLEEP_NOTIFICATION);
	67	IWL_CMD(PM_DEBUG_STATISTIC_NOTIFIC);
	68	IWL_CMD(REPLY_SCAN_CMD);
	69	IWL_CMD(REPLY_SCAN_ABORT_CMD);
	70	IWL_CMD(SCAN_START_NOTIFICATION);
	71	IWL_CMD(SCAN_RESULTS_NOTIFICATION);
	72	IWL_CMD(SCAN_COMPLETE_NOTIFICATION);
	73	IWL_CMD(BEACON_NOTIFICATION);
	74	IWL_CMD(REPLY_TX_BEACON);
	75	IWL_CMD(WHO_IS_AWAKE_NOTIFICATION);
	76	IWL_CMD(QUIET_NOTIFICATION);
	77	IWL_CMD(REPLY_TX_PWR_TABLE_CMD);
	78	IWL_CMD(MEASURE_ABORT_NOTIFICATION);
	79	IWL_CMD(REPLY_BT_CONFIG);
	80	IWL_CMD(REPLY_STATISTICS_CMD);
	81	IWL_CMD(STATISTICS_NOTIFICATION);
	82	IWL_CMD(REPLY_CARD_STATE_CMD);
	83	IWL_CMD(CARD_STATE_NOTIFICATION);
	84	IWL_CMD(MISSED_BEACONS_NOTIFICATION);
	85	IWL_CMD(REPLY_CT_KILL_CONFIG_CMD);
	86	IWL_CMD(SENSITIVITY_CMD);
	87	IWL_CMD(REPLY_PHY_CALIBRATION_CMD);
	88	IWL_CMD(REPLY_RX_PHY_CMD);
	89	IWL_CMD(REPLY_RX_MPDU_CMD);
	90	IWL_CMD(REPLY_RX);
	91	IWL_CMD(REPLY_COMPRESSED_BA);
7c616cba TW	92	IWL_CMD(CALIBRATION_CFG_CMD);
	93	IWL_CMD(CALIBRATION_RES_NOTIFICATION);
	94	IWL_CMD(CALIBRATION_COMPLETE_NOTIFICATION);
ebbbdc3f	95	IWL_CMD(REPLY_TX_POWER_DBM_CMD);
857485c0 TW	96	default:
	97	return "UNKNOWN";
	98
	99	}
	100	}
	101	EXPORT_SYMBOL(get_cmd_string);
	102
	103	#define HOST_COMPLETE_TIMEOUT (HZ / 2)
	104
0472f887 EG	105	static int iwl_generic_cmd_callback(struct iwl_priv *priv,
	106	struct iwl_cmd cmd, struct sk_buff skb)
	107	{
db11d634	108	struct iwl_rx_packet *pkt = NULL;
0472f887 EG	109
	110	if (!skb) {
	111	IWL_ERROR("Error: Response NULL in %s.\n",
	112	get_cmd_string(cmd->hdr.cmd));
	113	return 1;
	114	}
	115
db11d634	116	pkt = (struct iwl_rx_packet *)skb->data;
0472f887 EG	117	if (pkt->hdr.flags & IWL_CMD_FAILED_MSK) {
	118	IWL_ERROR("Bad return from %s (0x%08X)\n",
	119	get_cmd_string(cmd->hdr.cmd), pkt->hdr.flags);
	120	return 1;
	121	}
	122
	123	IWL_DEBUG_HC("back from %s (0x%08X)\n",
	124	get_cmd_string(cmd->hdr.cmd), pkt->hdr.flags);
	125
	126	/* Let iwl_tx_complete free the response skb */
	127	return 1;
	128	}
	129
857485c0 TW	130	static int iwl_send_cmd_async(struct iwl_priv priv, struct iwl_host_cmd cmd)
	131	{
	132	int ret;
	133
	134	BUG_ON(!(cmd->meta.flags & CMD_ASYNC));
	135
	136	/* An asynchronous command can not expect an SKB to be set. */
	137	BUG_ON(cmd->meta.flags & CMD_WANT_SKB);
	138
0472f887 EG	139	/* Assign a generic callback if one is not provided */
	140	if (!cmd->meta.u.callback)
	141	cmd->meta.u.callback = iwl_generic_cmd_callback;
857485c0 TW	142
	143	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
	144	return -EBUSY;
	145
fd4abac5	146	ret = iwl_enqueue_hcmd(priv, cmd);
857485c0 TW	147	if (ret < 0) {
	148	IWL_ERROR("Error sending %s: enqueue_hcmd failed: %d\n",
	149	get_cmd_string(cmd->id), ret);
	150	return ret;
	151	}
	152	return 0;
	153	}
	154
	155	int iwl_send_cmd_sync(struct iwl_priv priv, struct iwl_host_cmd cmd)
	156	{
	157	int cmd_idx;
	158	int ret;
857485c0 TW	159
	160	BUG_ON(cmd->meta.flags & CMD_ASYNC);
	161
	162	/* A synchronous command can not have a callback set. */
	163	BUG_ON(cmd->meta.u.callback != NULL);
	164
e5472978	165	if (test_and_set_bit(STATUS_HCMD_SYNC_ACTIVE, &priv->status)) {
857485c0 TW	166	IWL_ERROR("Error sending %s: Already sending a host command\n",
857485c0 TW	167	get_cmd_string(cmd->id));
e5472978 TW	168	ret = -EBUSY;
e5472978 TW	169	goto out;
857485c0 TW	170	}
	171
	172	set_bit(STATUS_HCMD_ACTIVE, &priv->status);
	173
	174	if (cmd->meta.flags & CMD_WANT_SKB)
	175	cmd->meta.source = &cmd->meta;
	176
fd4abac5	177	cmd_idx = iwl_enqueue_hcmd(priv, cmd);
857485c0 TW	178	if (cmd_idx < 0) {
	179	ret = cmd_idx;
	180	IWL_ERROR("Error sending %s: enqueue_hcmd failed: %d\n",
	181	get_cmd_string(cmd->id), ret);
	182	goto out;
	183	}
	184
	185	ret = wait_event_interruptible_timeout(priv->wait_command_queue,
	186	!test_bit(STATUS_HCMD_ACTIVE, &priv->status),
	187	HOST_COMPLETE_TIMEOUT);
	188	if (!ret) {
	189	if (test_bit(STATUS_HCMD_ACTIVE, &priv->status)) {
	190	IWL_ERROR("Error sending %s: time out after %dms.\n",
	191	get_cmd_string(cmd->id),
	192	jiffies_to_msecs(HOST_COMPLETE_TIMEOUT));
	193
	194	clear_bit(STATUS_HCMD_ACTIVE, &priv->status);
	195	ret = -ETIMEDOUT;
	196	goto cancel;
	197	}
	198	}
	199
	200	if (test_bit(STATUS_RF_KILL_HW, &priv->status)) {
	201	IWL_DEBUG_INFO("Command %s aborted: RF KILL Switch\n",
	202	get_cmd_string(cmd->id));
	203	ret = -ECANCELED;
	204	goto fail;
	205	}
	206	if (test_bit(STATUS_FW_ERROR, &priv->status)) {
	207	IWL_DEBUG_INFO("Command %s failed: FW Error\n",
	208	get_cmd_string(cmd->id));
	209	ret = -EIO;
	210	goto fail;
	211	}
	212	if ((cmd->meta.flags & CMD_WANT_SKB) && !cmd->meta.u.skb) {
	213	IWL_ERROR("Error: Response NULL in '%s'\n",
	214	get_cmd_string(cmd->id));
	215	ret = -EIO;
	216	goto out;
	217	}
	218
	219	ret = 0;
	220	goto out;
	221
	222	cancel:
	223	if (cmd->meta.flags & CMD_WANT_SKB) {
	224	struct iwl_cmd *qcmd;
	225
	226	/* Cancel the CMD_WANT_SKB flag for the cmd in the
	227	* TX cmd queue. Otherwise in case the cmd comes
	228	* in later, it will possibly set an invalid
	229	* address (cmd->meta.source). */
da99c4b6	230	qcmd = priv->txq[IWL_CMD_QUEUE_NUM].cmd[cmd_idx];
857485c0 TW	231	qcmd->meta.flags &= ~CMD_WANT_SKB;
	232	}
	233	fail:
	234	if (cmd->meta.u.skb) {
	235	dev_kfree_skb_any(cmd->meta.u.skb);
	236	cmd->meta.u.skb = NULL;
	237	}
	238	out:
e5472978	239	clear_bit(STATUS_HCMD_SYNC_ACTIVE, &priv->status);
857485c0 TW	240	return ret;
	241	}
	242	EXPORT_SYMBOL(iwl_send_cmd_sync);
	243
	244	int iwl_send_cmd(struct iwl_priv priv, struct iwl_host_cmd cmd)
	245	{
	246	if (cmd->meta.flags & CMD_ASYNC)
	247	return iwl_send_cmd_async(priv, cmd);
	248
	249	return iwl_send_cmd_sync(priv, cmd);
	250	}
	251	EXPORT_SYMBOL(iwl_send_cmd);
	252
	253	int iwl_send_cmd_pdu(struct iwl_priv priv, u8 id, u16 len, const void data)
	254	{
	255	struct iwl_host_cmd cmd = {
	256	.id = id,
	257	.len = len,
	258	.data = data,
	259	};
	260
	261	return iwl_send_cmd_sync(priv, &cmd);
	262	}
	263	EXPORT_SYMBOL(iwl_send_cmd_pdu);
	264
	265	int iwl_send_cmd_pdu_async(struct iwl_priv *priv,
	266	u8 id, u16 len, const void *data,
	267	int (callback)(struct iwl_priv priv,
	268	struct iwl_cmd *cmd,
	269	struct sk_buff *skb))
	270	{
	271	struct iwl_host_cmd cmd = {
	272	.id = id,
	273	.len = len,
	274	.data = data,
	275	};
	276
	277	cmd.meta.flags \|= CMD_ASYNC;
	278	cmd.meta.u.callback = callback;
	279
	280	return iwl_send_cmd_async(priv, &cmd);
	281	}
	282	EXPORT_SYMBOL(iwl_send_cmd_pdu_async);