[net-next-2.6.git] / drivers / net / wireless / libertas / cmdresp.c

/**
  * This file contains the handling of command
  * responses as well as events generated by firmware.
  */
#include <linux/slab.h>
#include <linux/delay.h>
#include <linux/sched.h>
#include <asm/unaligned.h>
#include <net/cfg80211.h>

#include "cfg.h"
#include "cmd.h"

/**
 *  @brief This function handles disconnect event. it
 *  reports disconnect to upper layer, clean tx/rx packets,
 *  reset link state etc.
 *
 *  @param priv    A pointer to struct lbs_private structure
 *  @return 	   n/a
 */
void lbs_mac_event_disconnected(struct lbs_private *priv)
{
	if (priv->connect_status != LBS_CONNECTED)
		return;

	lbs_deb_enter(LBS_DEB_ASSOC);

	/*
	 * Cisco AP sends EAP failure and de-auth in less than 0.5 ms.
	 * It causes problem in the Supplicant
	 */
	msleep_interruptible(1000);

	if (priv->wdev->iftype == NL80211_IFTYPE_STATION)
		lbs_send_disconnect_notification(priv);

	/* report disconnect to upper layer */
	netif_stop_queue(priv->dev);
	netif_carrier_off(priv->dev);

	/* Free Tx and Rx packets */
	kfree_skb(priv->currenttxskb);
	priv->currenttxskb = NULL;
	priv->tx_pending_len = 0;

	priv->connect_status = LBS_DISCONNECTED;

	if (priv->psstate != PS_STATE_FULL_POWER) {
		/* make firmware to exit PS mode */
		lbs_deb_cmd("disconnected, so exit PS mode\n");
		lbs_ps_wakeup(priv, 0);
	}
	lbs_deb_leave(LBS_DEB_ASSOC);
}

static int lbs_ret_reg_access(struct lbs_private *priv,
			       u16 type, struct cmd_ds_command *resp)
{
	int ret = 0;

	lbs_deb_enter(LBS_DEB_CMD);

	switch (type) {
	case CMD_RET(CMD_MAC_REG_ACCESS):
		{
			struct cmd_ds_mac_reg_access *reg = &resp->params.macreg;

			priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
			priv->offsetvalue.value = le32_to_cpu(reg->value);
			break;
		}

	case CMD_RET(CMD_BBP_REG_ACCESS):
		{
			struct cmd_ds_bbp_reg_access *reg = &resp->params.bbpreg;

			priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
			priv->offsetvalue.value = reg->value;
			break;
		}

	case CMD_RET(CMD_RF_REG_ACCESS):
		{
			struct cmd_ds_rf_reg_access *reg = &resp->params.rfreg;

			priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
			priv->offsetvalue.value = reg->value;
			break;
		}

	default:
		ret = -1;
	}

	lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
	return ret;
}
static inline int handle_cmd_response(struct lbs_private *priv,
				      struct cmd_header *cmd_response)
{
	struct cmd_ds_command *resp = (struct cmd_ds_command *) cmd_response;
	int ret = 0;
	unsigned long flags;
	uint16_t respcmd = le16_to_cpu(resp->command);

	lbs_deb_enter(LBS_DEB_HOST);

	switch (respcmd) {
	case CMD_RET(CMD_MAC_REG_ACCESS):
	case CMD_RET(CMD_BBP_REG_ACCESS):
	case CMD_RET(CMD_RF_REG_ACCESS):
		ret = lbs_ret_reg_access(priv, respcmd, resp);
		break;

	case CMD_RET(CMD_802_11_BEACON_STOP):
		break;

	case CMD_RET(CMD_BT_ACCESS):
		spin_lock_irqsave(&priv->driver_lock, flags);
		if (priv->cur_cmd->callback_arg)
			memcpy((void *)priv->cur_cmd->callback_arg,
			       &resp->params.bt.addr1, 2 * ETH_ALEN);
		spin_unlock_irqrestore(&priv->driver_lock, flags);
		break;
	case CMD_RET(CMD_FWT_ACCESS):
		spin_lock_irqsave(&priv->driver_lock, flags);
		if (priv->cur_cmd->callback_arg)
			memcpy((void *)priv->cur_cmd->callback_arg, &resp->params.fwt,
			       sizeof(resp->params.fwt));
		spin_unlock_irqrestore(&priv->driver_lock, flags);
		break;

	default:
		lbs_pr_err("CMD_RESP: unknown cmd response 0x%04x\n",
			   le16_to_cpu(resp->command));
		break;
	}
	lbs_deb_leave(LBS_DEB_HOST);
	return ret;
}

int lbs_process_command_response(struct lbs_private *priv, u8 *data, u32 len)
{
	uint16_t respcmd, curcmd;
	struct cmd_header *resp;
	int ret = 0;
	unsigned long flags;
	uint16_t result;

	lbs_deb_enter(LBS_DEB_HOST);

	mutex_lock(&priv->lock);
	spin_lock_irqsave(&priv->driver_lock, flags);

	if (!priv->cur_cmd) {
		lbs_deb_host("CMD_RESP: cur_cmd is NULL\n");
		ret = -1;
		spin_unlock_irqrestore(&priv->driver_lock, flags);
		goto done;
	}

	resp = (void *)data;
	curcmd = le16_to_cpu(priv->cur_cmd->cmdbuf->command);
	respcmd = le16_to_cpu(resp->command);
	result = le16_to_cpu(resp->result);

	lbs_deb_cmd("CMD_RESP: response 0x%04x, seq %d, size %d\n",
		     respcmd, le16_to_cpu(resp->seqnum), len);
	lbs_deb_hex(LBS_DEB_CMD, "CMD_RESP", (void *) resp, len);

	if (resp->seqnum != priv->cur_cmd->cmdbuf->seqnum) {
		lbs_pr_info("Received CMD_RESP with invalid sequence %d (expected %d)\n",
			    le16_to_cpu(resp->seqnum), le16_to_cpu(priv->cur_cmd->cmdbuf->seqnum));
		spin_unlock_irqrestore(&priv->driver_lock, flags);
		ret = -1;
		goto done;
	}
	if (respcmd != CMD_RET(curcmd) &&
	    respcmd != CMD_RET_802_11_ASSOCIATE && curcmd != CMD_802_11_ASSOCIATE) {
		lbs_pr_info("Invalid CMD_RESP %x to command %x!\n", respcmd, curcmd);
		spin_unlock_irqrestore(&priv->driver_lock, flags);
		ret = -1;
		goto done;
	}

	if (resp->result == cpu_to_le16(0x0004)) {
		/* 0x0004 means -EAGAIN. Drop the response, let it time out
		   and be resubmitted */
		lbs_pr_info("Firmware returns DEFER to command %x. Will let it time out...\n",
			    le16_to_cpu(resp->command));
		spin_unlock_irqrestore(&priv->driver_lock, flags);
		ret = -1;
		goto done;
	}

	/* Now we got response from FW, cancel the command timer */
	del_timer(&priv->command_timer);
	priv->cmd_timed_out = 0;

	/* Store the response code to cur_cmd_retcode. */
	priv->cur_cmd_retcode = result;

	if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) {
		struct cmd_ds_802_11_ps_mode *psmode = (void *) &resp[1];
		u16 action = le16_to_cpu(psmode->action);

		lbs_deb_host(
		       "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n",
		       result, action);

		if (result) {
			lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n",
				    result);
			/*
			 * We should not re-try enter-ps command in
			 * ad-hoc mode. It takes place in
			 * lbs_execute_next_command().
			 */
			if (priv->wdev->iftype == NL80211_IFTYPE_MONITOR &&
			    action == CMD_SUBCMD_ENTER_PS)
				priv->psmode = LBS802_11POWERMODECAM;
		} else if (action == CMD_SUBCMD_ENTER_PS) {
			priv->needtowakeup = 0;
			priv->psstate = PS_STATE_AWAKE;

			lbs_deb_host("CMD_RESP: ENTER_PS command response\n");
			if (priv->connect_status != LBS_CONNECTED) {
				/*
				 * When Deauth Event received before Enter_PS command
				 * response, We need to wake up the firmware.
				 */
				lbs_deb_host(
				       "disconnected, invoking lbs_ps_wakeup\n");

				spin_unlock_irqrestore(&priv->driver_lock, flags);
				mutex_unlock(&priv->lock);
				lbs_ps_wakeup(priv, 0);
				mutex_lock(&priv->lock);
				spin_lock_irqsave(&priv->driver_lock, flags);
			}
		} else if (action == CMD_SUBCMD_EXIT_PS) {
			priv->needtowakeup = 0;
			priv->psstate = PS_STATE_FULL_POWER;
			lbs_deb_host("CMD_RESP: EXIT_PS command response\n");
		} else {
			lbs_deb_host("CMD_RESP: PS action 0x%X\n", action);
		}

		lbs_complete_command(priv, priv->cur_cmd, result);
		spin_unlock_irqrestore(&priv->driver_lock, flags);

		ret = 0;
		goto done;
	}

	/* If the command is not successful, cleanup and return failure */
	if ((result != 0 || !(respcmd & 0x8000))) {
		lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n",
		       result, respcmd);
		/*
		 * Handling errors here
		 */
		switch (respcmd) {
		case CMD_RET(CMD_GET_HW_SPEC):
		case CMD_RET(CMD_802_11_RESET):
			lbs_deb_host("CMD_RESP: reset failed\n");
			break;

		}
		lbs_complete_command(priv, priv->cur_cmd, result);
		spin_unlock_irqrestore(&priv->driver_lock, flags);

		ret = -1;
		goto done;
	}

	spin_unlock_irqrestore(&priv->driver_lock, flags);

	if (priv->cur_cmd && priv->cur_cmd->callback) {
		ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg,
				resp);
	} else
		ret = handle_cmd_response(priv, resp);

	spin_lock_irqsave(&priv->driver_lock, flags);

	if (priv->cur_cmd) {
		/* Clean up and Put current command back to cmdfreeq */
		lbs_complete_command(priv, priv->cur_cmd, result);
	}
	spin_unlock_irqrestore(&priv->driver_lock, flags);

done:
	mutex_unlock(&priv->lock);
	lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
	return ret;
}

int lbs_process_event(struct lbs_private *priv, u32 event)
{
	int ret = 0;
	struct cmd_header cmd;

	lbs_deb_enter(LBS_DEB_CMD);

	switch (event) {
	case MACREG_INT_CODE_LINK_SENSED:
		lbs_deb_cmd("EVENT: link sensed\n");
		break;

	case MACREG_INT_CODE_DEAUTHENTICATED:
		lbs_deb_cmd("EVENT: deauthenticated\n");
		lbs_mac_event_disconnected(priv);
		break;

	case MACREG_INT_CODE_DISASSOCIATED:
		lbs_deb_cmd("EVENT: disassociated\n");
		lbs_mac_event_disconnected(priv);
		break;

	case MACREG_INT_CODE_LINK_LOST_NO_SCAN:
		lbs_deb_cmd("EVENT: link lost\n");
		lbs_mac_event_disconnected(priv);
		break;

	case MACREG_INT_CODE_PS_SLEEP:
		lbs_deb_cmd("EVENT: ps sleep\n");

		/* handle unexpected PS SLEEP event */
		if (priv->psstate == PS_STATE_FULL_POWER) {
			lbs_deb_cmd(
			       "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n");
			break;
		}
		priv->psstate = PS_STATE_PRE_SLEEP;

		lbs_ps_confirm_sleep(priv);

		break;

	case MACREG_INT_CODE_HOST_AWAKE:
		lbs_deb_cmd("EVENT: host awake\n");
		if (priv->reset_deep_sleep_wakeup)
			priv->reset_deep_sleep_wakeup(priv);
		priv->is_deep_sleep = 0;
		lbs_cmd_async(priv, CMD_802_11_WAKEUP_CONFIRM, &cmd,
				sizeof(cmd));
		priv->is_host_sleep_activated = 0;
		wake_up_interruptible(&priv->host_sleep_q);
		break;

	case MACREG_INT_CODE_DEEP_SLEEP_AWAKE:
		if (priv->reset_deep_sleep_wakeup)
			priv->reset_deep_sleep_wakeup(priv);
		lbs_deb_cmd("EVENT: ds awake\n");
		priv->is_deep_sleep = 0;
		priv->wakeup_dev_required = 0;
		wake_up_interruptible(&priv->ds_awake_q);
		break;

	case MACREG_INT_CODE_PS_AWAKE:
		lbs_deb_cmd("EVENT: ps awake\n");
		/* handle unexpected PS AWAKE event */
		if (priv->psstate == PS_STATE_FULL_POWER) {
			lbs_deb_cmd(
			       "EVENT: In FULL POWER mode - ignore PS AWAKE\n");
			break;
		}

		priv->psstate = PS_STATE_AWAKE;

		if (priv->needtowakeup) {
			/*
			 * wait for the command processing to finish
			 * before resuming sending
			 * priv->needtowakeup will be set to FALSE
			 * in lbs_ps_wakeup()
			 */
			lbs_deb_cmd("waking up ...\n");
			lbs_ps_wakeup(priv, 0);
		}
		break;

	case MACREG_INT_CODE_MIC_ERR_UNICAST:
		lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n");
		lbs_send_mic_failureevent(priv, event);
		break;

	case MACREG_INT_CODE_MIC_ERR_MULTICAST:
		lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n");
		lbs_send_mic_failureevent(priv, event);
		break;

	case MACREG_INT_CODE_MIB_CHANGED:
		lbs_deb_cmd("EVENT: MIB CHANGED\n");
		break;
	case MACREG_INT_CODE_INIT_DONE:
		lbs_deb_cmd("EVENT: INIT DONE\n");
		break;
	case MACREG_INT_CODE_ADHOC_BCN_LOST:
		lbs_deb_cmd("EVENT: ADHOC beacon lost\n");
		break;
	case MACREG_INT_CODE_RSSI_LOW:
		lbs_pr_alert("EVENT: rssi low\n");
		break;
	case MACREG_INT_CODE_SNR_LOW:
		lbs_pr_alert("EVENT: snr low\n");
		break;
	case MACREG_INT_CODE_MAX_FAIL:
		lbs_pr_alert("EVENT: max fail\n");
		break;
	case MACREG_INT_CODE_RSSI_HIGH:
		lbs_pr_alert("EVENT: rssi high\n");
		break;
	case MACREG_INT_CODE_SNR_HIGH:
		lbs_pr_alert("EVENT: snr high\n");
		break;

	case MACREG_INT_CODE_MESH_AUTO_STARTED:
		/* Ignore spurious autostart events */
		lbs_pr_info("EVENT: MESH_AUTO_STARTED (ignoring)\n");
		break;

	default:
		lbs_pr_alert("EVENT: unknown event id %d\n", event);
		break;
	}

	lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
	return ret;
}
Commit	Line	Data
876c9d3a MT	1	/**
	2	* This file contains the handling of command
	3	* responses as well as events generated by firmware.
	4	*/
5a0e3ad6	5	#include <linux/slab.h>
876c9d3a	6	#include <linux/delay.h>
767e366f	7	#include <linux/sched.h>
2c5b9e51	8	#include <asm/unaligned.h>
e86dc1ca	9	#include <net/cfg80211.h>
876c9d3a	10
e86dc1ca	11	#include "cfg.h"
66fceb69	12	#include "cmd.h"
876c9d3a MT	13
	14	/**
	15	* @brief This function handles disconnect event. it
	16	* reports disconnect to upper layer, clean tx/rx packets,
	17	* reset link state etc.
	18	*
69f9032d	19	* @param priv A pointer to struct lbs_private structure
876c9d3a MT	20	* @return n/a
876c9d3a MT	21	*/
69f9032d	22	void lbs_mac_event_disconnected(struct lbs_private *priv)
876c9d3a	23	{
aa21c004	24	if (priv->connect_status != LBS_CONNECTED)
876c9d3a MT	25	return;
876c9d3a MT	26
91843463	27	lbs_deb_enter(LBS_DEB_ASSOC);
876c9d3a	28
876c9d3a MT	29	/*
	30	* Cisco AP sends EAP failure and de-auth in less than 0.5 ms.
	31	* It causes problem in the Supplicant
	32	*/
876c9d3a	33	msleep_interruptible(1000);
e4fe4eaf KD	34
	35	if (priv->wdev->iftype == NL80211_IFTYPE_STATION)
	36	lbs_send_disconnect_notification(priv);
876c9d3a	37
876c9d3a	38	/* report disconnect to upper layer */
634b8f49 HS	39	netif_stop_queue(priv->dev);
634b8f49 HS	40	netif_carrier_off(priv->dev);
876c9d3a	41
a27b9f96 DW	42	/* Free Tx and Rx packets */
	43	kfree_skb(priv->currenttxskb);
	44	priv->currenttxskb = NULL;
	45	priv->tx_pending_len = 0;
	46
aa21c004	47	priv->connect_status = LBS_DISCONNECTED;
876c9d3a	48
aa21c004	49	if (priv->psstate != PS_STATE_FULL_POWER) {
876c9d3a	50	/* make firmware to exit PS mode */
a6c8700f	51	lbs_deb_cmd("disconnected, so exit PS mode\n");
10078321	52	lbs_ps_wakeup(priv, 0);
876c9d3a	53	}
52507c20	54	lbs_deb_leave(LBS_DEB_ASSOC);
876c9d3a MT	55	}
876c9d3a MT	56
69f9032d	57	static int lbs_ret_reg_access(struct lbs_private *priv,
876c9d3a MT	58	u16 type, struct cmd_ds_command *resp)
876c9d3a MT	59	{
9012b28a	60	int ret = 0;
876c9d3a	61
9012b28a	62	lbs_deb_enter(LBS_DEB_CMD);
876c9d3a MT	63
876c9d3a MT	64	switch (type) {
6b63cd0f	65	case CMD_RET(CMD_MAC_REG_ACCESS):
876c9d3a	66	{
981f187b	67	struct cmd_ds_mac_reg_access *reg = &resp->params.macreg;
876c9d3a	68
aa21c004 DW	69	priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
aa21c004 DW	70	priv->offsetvalue.value = le32_to_cpu(reg->value);
876c9d3a MT	71	break;
	72	}
	73
6b63cd0f	74	case CMD_RET(CMD_BBP_REG_ACCESS):
876c9d3a	75	{
981f187b	76	struct cmd_ds_bbp_reg_access *reg = &resp->params.bbpreg;
876c9d3a	77
aa21c004 DW	78	priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
aa21c004 DW	79	priv->offsetvalue.value = reg->value;
876c9d3a MT	80	break;
	81	}
	82
6b63cd0f	83	case CMD_RET(CMD_RF_REG_ACCESS):
876c9d3a	84	{
981f187b	85	struct cmd_ds_rf_reg_access *reg = &resp->params.rfreg;
876c9d3a	86
aa21c004 DW	87	priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
aa21c004 DW	88	priv->offsetvalue.value = reg->value;
876c9d3a MT	89	break;
	90	}
	91
	92	default:
9012b28a	93	ret = -1;
876c9d3a MT	94	}
876c9d3a MT	95
8b17d723	96	lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
9012b28a	97	return ret;
876c9d3a	98	}
1309b55b	99	static inline int handle_cmd_response(struct lbs_private *priv,
ddac4526	100	struct cmd_header *cmd_response)
876c9d3a	101	{
ddac4526	102	struct cmd_ds_command resp = (struct cmd_ds_command ) cmd_response;
876c9d3a MT	103	int ret = 0;
876c9d3a MT	104	unsigned long flags;
1309b55b	105	uint16_t respcmd = le16_to_cpu(resp->command);
876c9d3a	106
a6c8700f HS	107	lbs_deb_enter(LBS_DEB_HOST);
a6c8700f HS	108
876c9d3a	109	switch (respcmd) {
6b63cd0f HS	110	case CMD_RET(CMD_MAC_REG_ACCESS):
	111	case CMD_RET(CMD_BBP_REG_ACCESS):
	112	case CMD_RET(CMD_RF_REG_ACCESS):
10078321	113	ret = lbs_ret_reg_access(priv, respcmd, resp);
876c9d3a MT	114	break;
876c9d3a MT	115
6b63cd0f	116	case CMD_RET(CMD_802_11_BEACON_STOP):
18c96c34 DW	117	break;
18c96c34 DW	118
6b63cd0f	119	case CMD_RET(CMD_BT_ACCESS):
aa21c004	120	spin_lock_irqsave(&priv->driver_lock, flags);
75567670 DW	121	if (priv->cur_cmd->callback_arg)
75567670 DW	122	memcpy((void *)priv->cur_cmd->callback_arg,
876c9d3a	123	&resp->params.bt.addr1, 2 * ETH_ALEN);
aa21c004	124	spin_unlock_irqrestore(&priv->driver_lock, flags);
876c9d3a	125	break;
6b63cd0f	126	case CMD_RET(CMD_FWT_ACCESS):
aa21c004	127	spin_lock_irqsave(&priv->driver_lock, flags);
75567670 DW	128	if (priv->cur_cmd->callback_arg)
75567670 DW	129	memcpy((void *)priv->cur_cmd->callback_arg, &resp->params.fwt,
981f187b	130	sizeof(resp->params.fwt));
aa21c004	131	spin_unlock_irqrestore(&priv->driver_lock, flags);
876c9d3a	132	break;
96287ac4	133
876c9d3a	134	default:
e37fc6e1 DW	135	lbs_pr_err("CMD_RESP: unknown cmd response 0x%04x\n",
e37fc6e1 DW	136	le16_to_cpu(resp->command));
876c9d3a MT	137	break;
876c9d3a MT	138	}
a6c8700f	139	lbs_deb_leave(LBS_DEB_HOST);
876c9d3a MT	140	return ret;
	141	}
	142
7919b89c	143	int lbs_process_command_response(struct lbs_private priv, u8 data, u32 len)
876c9d3a	144	{
e1258177	145	uint16_t respcmd, curcmd;
ddac4526	146	struct cmd_header *resp;
876c9d3a	147	int ret = 0;
e1258177 DW	148	unsigned long flags;
e1258177 DW	149	uint16_t result;
876c9d3a	150
a6c8700f	151	lbs_deb_enter(LBS_DEB_HOST);
876c9d3a	152
aa21c004 DW	153	mutex_lock(&priv->lock);
aa21c004 DW	154	spin_lock_irqsave(&priv->driver_lock, flags);
876c9d3a	155
aa21c004	156	if (!priv->cur_cmd) {
a6c8700f	157	lbs_deb_host("CMD_RESP: cur_cmd is NULL\n");
876c9d3a	158	ret = -1;
aa21c004	159	spin_unlock_irqrestore(&priv->driver_lock, flags);
876c9d3a MT	160	goto done;
876c9d3a MT	161	}
e1258177	162
7919b89c	163	resp = (void *)data;
8a96df80	164	curcmd = le16_to_cpu(priv->cur_cmd->cmdbuf->command);
876c9d3a	165	respcmd = le16_to_cpu(resp->command);
876c9d3a MT	166	result = le16_to_cpu(resp->result);
876c9d3a MT	167
e5225b39	168	lbs_deb_cmd("CMD_RESP: response 0x%04x, seq %d, size %d\n",
7919b89c HS	169	respcmd, le16_to_cpu(resp->seqnum), len);
7919b89c HS	170	lbs_deb_hex(LBS_DEB_CMD, "CMD_RESP", (void *) resp, len);
876c9d3a	171
6305f498	172	if (resp->seqnum != priv->cur_cmd->cmdbuf->seqnum) {
e1258177	173	lbs_pr_info("Received CMD_RESP with invalid sequence %d (expected %d)\n",
6305f498	174	le16_to_cpu(resp->seqnum), le16_to_cpu(priv->cur_cmd->cmdbuf->seqnum));
aa21c004	175	spin_unlock_irqrestore(&priv->driver_lock, flags);
876c9d3a MT	176	ret = -1;
	177	goto done;
	178	}
e1258177	179	if (respcmd != CMD_RET(curcmd) &&
5f0547c2	180	respcmd != CMD_RET_802_11_ASSOCIATE && curcmd != CMD_802_11_ASSOCIATE) {
e1258177 DW	181	lbs_pr_info("Invalid CMD_RESP %x to command %x!\n", respcmd, curcmd);
	182	spin_unlock_irqrestore(&priv->driver_lock, flags);
	183	ret = -1;
	184	goto done;
	185	}
	186
8538823f DW	187	if (resp->result == cpu_to_le16(0x0004)) {
	188	/* 0x0004 means -EAGAIN. Drop the response, let it time out
	189	and be resubmitted */
	190	lbs_pr_info("Firmware returns DEFER to command %x. Will let it time out...\n",
	191	le16_to_cpu(resp->command));
	192	spin_unlock_irqrestore(&priv->driver_lock, flags);
	193	ret = -1;
	194	goto done;
	195	}
	196
e1258177 DW	197	/* Now we got response from FW, cancel the command timer */
e1258177 DW	198	del_timer(&priv->command_timer);
2a345099	199	priv->cmd_timed_out = 0;
876c9d3a MT	200
876c9d3a MT	201	/* Store the response code to cur_cmd_retcode. */
aa21c004	202	priv->cur_cmd_retcode = result;
876c9d3a	203
6b63cd0f	204	if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) {
38bfab1a	205	struct cmd_ds_802_11_ps_mode psmode = (void ) &resp[1];
981f187b	206	u16 action = le16_to_cpu(psmode->action);
876c9d3a	207
a6c8700f HS	208	lbs_deb_host(
a6c8700f HS	209	"CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n",
981f187b	210	result, action);
876c9d3a MT	211
876c9d3a MT	212	if (result) {
a6c8700f	213	lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n",
981f187b DW	214	result);
	215	/*
	216	* We should not re-try enter-ps command in
	217	* ad-hoc mode. It takes place in
10078321	218	* lbs_execute_next_command().
981f187b	219	*/
e86dc1ca	220	if (priv->wdev->iftype == NL80211_IFTYPE_MONITOR &&
0aef64d7	221	action == CMD_SUBCMD_ENTER_PS)
aa21c004	222	priv->psmode = LBS802_11POWERMODECAM;
0aef64d7	223	} else if (action == CMD_SUBCMD_ENTER_PS) {
aa21c004 DW	224	priv->needtowakeup = 0;
aa21c004 DW	225	priv->psstate = PS_STATE_AWAKE;
876c9d3a	226
a6c8700f	227	lbs_deb_host("CMD_RESP: ENTER_PS command response\n");
aa21c004	228	if (priv->connect_status != LBS_CONNECTED) {
876c9d3a MT	229	/*
	230	* When Deauth Event received before Enter_PS command
	231	* response, We need to wake up the firmware.
	232	*/
a6c8700f	233	lbs_deb_host(
10078321	234	"disconnected, invoking lbs_ps_wakeup\n");
876c9d3a	235
aa21c004 DW	236	spin_unlock_irqrestore(&priv->driver_lock, flags);
aa21c004 DW	237	mutex_unlock(&priv->lock);
10078321	238	lbs_ps_wakeup(priv, 0);
aa21c004 DW	239	mutex_lock(&priv->lock);
aa21c004 DW	240	spin_lock_irqsave(&priv->driver_lock, flags);
876c9d3a	241	}
0aef64d7	242	} else if (action == CMD_SUBCMD_EXIT_PS) {
aa21c004 DW	243	priv->needtowakeup = 0;
aa21c004 DW	244	priv->psstate = PS_STATE_FULL_POWER;
a6c8700f	245	lbs_deb_host("CMD_RESP: EXIT_PS command response\n");
876c9d3a	246	} else {
a6c8700f	247	lbs_deb_host("CMD_RESP: PS action 0x%X\n", action);
876c9d3a MT	248	}
876c9d3a MT	249
183aeac1	250	lbs_complete_command(priv, priv->cur_cmd, result);
aa21c004	251	spin_unlock_irqrestore(&priv->driver_lock, flags);
876c9d3a MT	252
	253	ret = 0;
	254	goto done;
	255	}
	256
876c9d3a MT	257	/* If the command is not successful, cleanup and return failure */
876c9d3a MT	258	if ((result != 0 \|\| !(respcmd & 0x8000))) {
a6c8700f HS	259	lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n",
a6c8700f HS	260	result, respcmd);
876c9d3a MT	261	/*
	262	* Handling errors here
	263	*/
	264	switch (respcmd) {
6b63cd0f HS	265	case CMD_RET(CMD_GET_HW_SPEC):
6b63cd0f HS	266	case CMD_RET(CMD_802_11_RESET):
a6c8700f	267	lbs_deb_host("CMD_RESP: reset failed\n");
876c9d3a MT	268	break;
	269
	270	}
183aeac1	271	lbs_complete_command(priv, priv->cur_cmd, result);
aa21c004	272	spin_unlock_irqrestore(&priv->driver_lock, flags);
876c9d3a MT	273
	274	ret = -1;
	275	goto done;
	276	}
	277
aa21c004	278	spin_unlock_irqrestore(&priv->driver_lock, flags);
1723047d	279
7ad994de DW	280	if (priv->cur_cmd && priv->cur_cmd->callback) {
7ad994de DW	281	ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg,
ddac4526	282	resp);
7ad994de	283	} else
e98a88dd	284	ret = handle_cmd_response(priv, resp);
1723047d	285
aa21c004	286	spin_lock_irqsave(&priv->driver_lock, flags);
1723047d	287
aa21c004	288	if (priv->cur_cmd) {
876c9d3a	289	/* Clean up and Put current command back to cmdfreeq */
183aeac1	290	lbs_complete_command(priv, priv->cur_cmd, result);
876c9d3a	291	}
aa21c004	292	spin_unlock_irqrestore(&priv->driver_lock, flags);
876c9d3a MT	293
876c9d3a MT	294	done:
aa21c004	295	mutex_unlock(&priv->lock);
a6c8700f	296	lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
876c9d3a MT	297	return ret;
	298	}
	299
7919b89c	300	int lbs_process_event(struct lbs_private *priv, u32 event)
876c9d3a MT	301	{
876c9d3a MT	302	int ret = 0;
66fceb69	303	struct cmd_header cmd;
876c9d3a	304
9556d212 HS	305	lbs_deb_enter(LBS_DEB_CMD);
9556d212 HS	306
7919b89c	307	switch (event) {
876c9d3a	308	case MACREG_INT_CODE_LINK_SENSED:
d4ff0ef6	309	lbs_deb_cmd("EVENT: link sensed\n");
876c9d3a MT	310	break;
	311
	312	case MACREG_INT_CODE_DEAUTHENTICATED:
a6c8700f	313	lbs_deb_cmd("EVENT: deauthenticated\n");
10078321	314	lbs_mac_event_disconnected(priv);
876c9d3a MT	315	break;
	316
	317	case MACREG_INT_CODE_DISASSOCIATED:
a6c8700f	318	lbs_deb_cmd("EVENT: disassociated\n");
10078321	319	lbs_mac_event_disconnected(priv);
876c9d3a MT	320	break;
876c9d3a MT	321
0b3c07ff	322	case MACREG_INT_CODE_LINK_LOST_NO_SCAN:
a6c8700f	323	lbs_deb_cmd("EVENT: link lost\n");
10078321	324	lbs_mac_event_disconnected(priv);
876c9d3a MT	325	break;
	326
	327	case MACREG_INT_CODE_PS_SLEEP:
d4ff0ef6	328	lbs_deb_cmd("EVENT: ps sleep\n");
876c9d3a MT	329
876c9d3a MT	330	/* handle unexpected PS SLEEP event */
aa21c004	331	if (priv->psstate == PS_STATE_FULL_POWER) {
9012b28a	332	lbs_deb_cmd(
a6c8700f	333	"EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n");
876c9d3a MT	334	break;
876c9d3a MT	335	}
aa21c004	336	priv->psstate = PS_STATE_PRE_SLEEP;
876c9d3a	337
d4ff0ef6	338	lbs_ps_confirm_sleep(priv);
876c9d3a MT	339
	340	break;
	341
b47ef243	342	case MACREG_INT_CODE_HOST_AWAKE:
d4ff0ef6	343	lbs_deb_cmd("EVENT: host awake\n");
49125454 AK	344	if (priv->reset_deep_sleep_wakeup)
	345	priv->reset_deep_sleep_wakeup(priv);
	346	priv->is_deep_sleep = 0;
66fceb69 AK	347	lbs_cmd_async(priv, CMD_802_11_WAKEUP_CONFIRM, &cmd,
	348	sizeof(cmd));
	349	priv->is_host_sleep_activated = 0;
	350	wake_up_interruptible(&priv->host_sleep_q);
b47ef243 DW	351	break;
b47ef243 DW	352
49125454 AK	353	case MACREG_INT_CODE_DEEP_SLEEP_AWAKE:
	354	if (priv->reset_deep_sleep_wakeup)
	355	priv->reset_deep_sleep_wakeup(priv);
	356	lbs_deb_cmd("EVENT: ds awake\n");
	357	priv->is_deep_sleep = 0;
	358	priv->wakeup_dev_required = 0;
	359	wake_up_interruptible(&priv->ds_awake_q);
	360	break;
	361
876c9d3a	362	case MACREG_INT_CODE_PS_AWAKE:
d4ff0ef6	363	lbs_deb_cmd("EVENT: ps awake\n");
876c9d3a	364	/* handle unexpected PS AWAKE event */
aa21c004	365	if (priv->psstate == PS_STATE_FULL_POWER) {
9012b28a	366	lbs_deb_cmd(
876c9d3a MT	367	"EVENT: In FULL POWER mode - ignore PS AWAKE\n");
	368	break;
	369	}
	370
aa21c004	371	priv->psstate = PS_STATE_AWAKE;
876c9d3a	372
aa21c004	373	if (priv->needtowakeup) {
876c9d3a MT	374	/*
	375	* wait for the command processing to finish
	376	* before resuming sending
aa21c004	377	* priv->needtowakeup will be set to FALSE
10078321	378	* in lbs_ps_wakeup()
876c9d3a	379	*/
a6c8700f	380	lbs_deb_cmd("waking up ...\n");
10078321	381	lbs_ps_wakeup(priv, 0);
876c9d3a MT	382	}
	383	break;
	384
	385	case MACREG_INT_CODE_MIC_ERR_UNICAST:
9012b28a	386	lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n");
560c6338	387	lbs_send_mic_failureevent(priv, event);
876c9d3a MT	388	break;
	389
	390	case MACREG_INT_CODE_MIC_ERR_MULTICAST:
9012b28a	391	lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n");
560c6338	392	lbs_send_mic_failureevent(priv, event);
876c9d3a	393	break;
d4ff0ef6	394
876c9d3a	395	case MACREG_INT_CODE_MIB_CHANGED:
d4ff0ef6 HS	396	lbs_deb_cmd("EVENT: MIB CHANGED\n");
d4ff0ef6 HS	397	break;
876c9d3a	398	case MACREG_INT_CODE_INIT_DONE:
d4ff0ef6	399	lbs_deb_cmd("EVENT: INIT DONE\n");
876c9d3a	400	break;
876c9d3a	401	case MACREG_INT_CODE_ADHOC_BCN_LOST:
a6c8700f	402	lbs_deb_cmd("EVENT: ADHOC beacon lost\n");
876c9d3a	403	break;
876c9d3a	404	case MACREG_INT_CODE_RSSI_LOW:
a6c8700f	405	lbs_pr_alert("EVENT: rssi low\n");
876c9d3a MT	406	break;
876c9d3a MT	407	case MACREG_INT_CODE_SNR_LOW:
a6c8700f	408	lbs_pr_alert("EVENT: snr low\n");
876c9d3a MT	409	break;
876c9d3a MT	410	case MACREG_INT_CODE_MAX_FAIL:
a6c8700f	411	lbs_pr_alert("EVENT: max fail\n");
876c9d3a MT	412	break;
876c9d3a MT	413	case MACREG_INT_CODE_RSSI_HIGH:
a6c8700f	414	lbs_pr_alert("EVENT: rssi high\n");
876c9d3a MT	415	break;
876c9d3a MT	416	case MACREG_INT_CODE_SNR_HIGH:
a6c8700f	417	lbs_pr_alert("EVENT: snr high\n");
876c9d3a MT	418	break;
876c9d3a MT	419
7d8d28b3	420	case MACREG_INT_CODE_MESH_AUTO_STARTED:
d6ede678 HS	421	/* Ignore spurious autostart events */
d6ede678 HS	422	lbs_pr_info("EVENT: MESH_AUTO_STARTED (ignoring)\n");
7d8d28b3 LCCR	423	break;
7d8d28b3 LCCR	424
876c9d3a	425	default:
7919b89c	426	lbs_pr_alert("EVENT: unknown event id %d\n", event);
876c9d3a MT	427	break;
	428	}
	429
9556d212	430	lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
876c9d3a MT	431	return ret;
876c9d3a MT	432	}