[deliverable/linux.git] / drivers / net / wireless / libertas / cmdresp.c

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

#include "host.h"
#include "decl.h"
#include "cmd.h"
#include "defs.h"
#include "dev.h"
#include "assoc.h"
#include "wext.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);
	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;

	/* reset SNR/NF/RSSI values */
	memset(priv->SNR, 0x00, sizeof(priv->SNR));
	memset(priv->NF, 0x00, sizeof(priv->NF));
	memset(priv->RSSI, 0x00, sizeof(priv->RSSI));
	memset(priv->rawSNR, 0x00, sizeof(priv->rawSNR));
	memset(priv->rawNF, 0x00, sizeof(priv->rawNF));
	priv->nextSNRNF = 0;
	priv->numSNRNF = 0;
	priv->connect_status = LBS_DISCONNECTED;

	/* Clear out associated SSID and BSSID since connection is
	 * no longer valid.
	 */
	memset(&priv->curbssparams.bssid, 0, ETH_ALEN);
	memset(&priv->curbssparams.ssid, 0, IEEE80211_MAX_SSID_LEN);
	priv->curbssparams.ssid_len = 0;

	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_SET_AFC):
	case CMD_RET(CMD_802_11_GET_AFC):
		spin_lock_irqsave(&priv->driver_lock, flags);
		memmove((void *)priv->cur_cmd->callback_arg, &resp->params.afc,
			sizeof(struct cmd_ds_802_11_afc));
		spin_unlock_irqrestore(&priv->driver_lock, flags);

		break;

	case CMD_RET(CMD_802_11_BEACON_STOP):
		break;

	case CMD_RET(CMD_802_11_RSSI):
		ret = lbs_ret_802_11_rssi(priv, resp);
		break;

	case CMD_RET(CMD_802_11_TPC_CFG):
		spin_lock_irqsave(&priv->driver_lock, flags);
		memmove((void *)priv->cur_cmd->callback_arg, &resp->params.tpccfg,
			sizeof(struct cmd_ds_802_11_tpc_cfg));
		spin_unlock_irqrestore(&priv->driver_lock, flags);
		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;
	case CMD_RET(CMD_802_11_BEACON_CTRL):
		ret = lbs_ret_802_11_bcn_ctrl(priv, resp);
		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->mode == IW_MODE_ADHOC &&
			    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;
}

static int lbs_send_confirmwake(struct lbs_private *priv)
{
	struct cmd_header cmd;
	int ret = 0;

	lbs_deb_enter(LBS_DEB_HOST);

	cmd.command = cpu_to_le16(CMD_802_11_WAKEUP_CONFIRM);
	cmd.size = cpu_to_le16(sizeof(cmd));
	cmd.seqnum = cpu_to_le16(++priv->seqnum);
	cmd.result = 0;

	lbs_deb_hex(LBS_DEB_HOST, "wake confirm", (u8 *) &cmd,
		sizeof(cmd));

	ret = priv->hw_host_to_card(priv, MVMS_CMD, (u8 *) &cmd, sizeof(cmd));
	if (ret)
		lbs_pr_alert("SEND_WAKEC_CMD: Host to Card failed for Confirm Wake\n");

	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;

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