blob: 888f92d8afc9c0b60d016254b904fe4012d0830d [file] [log] [blame]
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001/**
2 * This file contains the handling of command
3 * responses as well as events generated by firmware.
4 */
5#include <linux/delay.h>
6#include <linux/if_arp.h>
7#include <linux/netdevice.h>
8
9#include <net/iw_handler.h>
10
11#include "host.h"
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020012#include "decl.h"
13#include "defs.h"
14#include "dev.h"
15#include "join.h"
16#include "wext.h"
17
18/**
19 * @brief This function handles disconnect event. it
20 * reports disconnect to upper layer, clean tx/rx packets,
21 * reset link state etc.
22 *
Holger Schurig69f90322007-11-23 15:43:44 +010023 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020024 * @return n/a
25 */
Holger Schurig69f90322007-11-23 15:43:44 +010026void lbs_mac_event_disconnected(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020027{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020028 union iwreq_data wrqu;
29
David Woodhouseaa21c002007-12-08 20:04:36 +000030 if (priv->connect_status != LBS_CONNECTED)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020031 return;
32
Holger Schurig91843462007-11-28 14:05:02 +010033 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020034
35 memset(wrqu.ap_addr.sa_data, 0x00, ETH_ALEN);
36 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
37
38 /*
39 * Cisco AP sends EAP failure and de-auth in less than 0.5 ms.
40 * It causes problem in the Supplicant
41 */
42
43 msleep_interruptible(1000);
Holger Schurig634b8f42007-05-25 13:05:16 -040044 wireless_send_event(priv->dev, SIOCGIWAP, &wrqu, NULL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020045
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020046 /* report disconnect to upper layer */
Holger Schurig634b8f42007-05-25 13:05:16 -040047 netif_stop_queue(priv->dev);
48 netif_carrier_off(priv->dev);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020049
David Woodhousea27b9f92007-12-12 00:41:51 -050050 /* Free Tx and Rx packets */
51 kfree_skb(priv->currenttxskb);
52 priv->currenttxskb = NULL;
53 priv->tx_pending_len = 0;
54
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020055 /* reset SNR/NF/RSSI values */
David Woodhouseaa21c002007-12-08 20:04:36 +000056 memset(priv->SNR, 0x00, sizeof(priv->SNR));
57 memset(priv->NF, 0x00, sizeof(priv->NF));
58 memset(priv->RSSI, 0x00, sizeof(priv->RSSI));
59 memset(priv->rawSNR, 0x00, sizeof(priv->rawSNR));
60 memset(priv->rawNF, 0x00, sizeof(priv->rawNF));
61 priv->nextSNRNF = 0;
62 priv->numSNRNF = 0;
63 priv->connect_status = LBS_DISCONNECTED;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020064
Dan Williamse76850d2007-05-25 17:09:41 -040065 /* Clear out associated SSID and BSSID since connection is
66 * no longer valid.
67 */
David Woodhouseaa21c002007-12-08 20:04:36 +000068 memset(&priv->curbssparams.bssid, 0, ETH_ALEN);
69 memset(&priv->curbssparams.ssid, 0, IW_ESSID_MAX_SIZE);
70 priv->curbssparams.ssid_len = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020071
David Woodhouseaa21c002007-12-08 20:04:36 +000072 if (priv->psstate != PS_STATE_FULL_POWER) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020073 /* make firmware to exit PS mode */
Holger Schuriga6c87002007-08-02 11:54:10 -040074 lbs_deb_cmd("disconnected, so exit PS mode\n");
Holger Schurig10078322007-11-15 18:05:47 -050075 lbs_ps_wakeup(priv, 0);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020076 }
Holger Schurig52507c22008-01-28 17:25:53 +010077 lbs_deb_leave(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020078}
79
80/**
81 * @brief This function handles MIC failure event.
82 *
Holger Schurig69f90322007-11-23 15:43:44 +010083 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020084 * @para event the event id
85 * @return n/a
86 */
Holger Schurig69f90322007-11-23 15:43:44 +010087static void handle_mic_failureevent(struct lbs_private *priv, u32 event)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020088{
89 char buf[50];
90
Holger Schuriga6c87002007-08-02 11:54:10 -040091 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020092 memset(buf, 0, sizeof(buf));
93
94 sprintf(buf, "%s", "MLME-MICHAELMICFAILURE.indication ");
95
96 if (event == MACREG_INT_CODE_MIC_ERR_UNICAST) {
97 strcat(buf, "unicast ");
98 } else {
99 strcat(buf, "multicast ");
100 }
101
Holger Schurig10078322007-11-15 18:05:47 -0500102 lbs_send_iwevcustom_event(priv, buf);
Holger Schuriga6c87002007-08-02 11:54:10 -0400103 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200104}
105
Holger Schurig69f90322007-11-23 15:43:44 +0100106static int lbs_ret_reg_access(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200107 u16 type, struct cmd_ds_command *resp)
108{
Holger Schurig9012b282007-05-25 11:27:16 -0400109 int ret = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200110
Holger Schurig9012b282007-05-25 11:27:16 -0400111 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200112
113 switch (type) {
Holger Schurig6b63cd02007-08-02 11:53:36 -0400114 case CMD_RET(CMD_MAC_REG_ACCESS):
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200115 {
David Woodhouse981f1872007-05-25 23:36:54 -0400116 struct cmd_ds_mac_reg_access *reg = &resp->params.macreg;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200117
David Woodhouseaa21c002007-12-08 20:04:36 +0000118 priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
119 priv->offsetvalue.value = le32_to_cpu(reg->value);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200120 break;
121 }
122
Holger Schurig6b63cd02007-08-02 11:53:36 -0400123 case CMD_RET(CMD_BBP_REG_ACCESS):
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200124 {
David Woodhouse981f1872007-05-25 23:36:54 -0400125 struct cmd_ds_bbp_reg_access *reg = &resp->params.bbpreg;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200126
David Woodhouseaa21c002007-12-08 20:04:36 +0000127 priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
128 priv->offsetvalue.value = reg->value;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200129 break;
130 }
131
Holger Schurig6b63cd02007-08-02 11:53:36 -0400132 case CMD_RET(CMD_RF_REG_ACCESS):
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200133 {
David Woodhouse981f1872007-05-25 23:36:54 -0400134 struct cmd_ds_rf_reg_access *reg = &resp->params.rfreg;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200135
David Woodhouseaa21c002007-12-08 20:04:36 +0000136 priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset);
137 priv->offsetvalue.value = reg->value;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200138 break;
139 }
140
141 default:
Holger Schurig9012b282007-05-25 11:27:16 -0400142 ret = -1;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200143 }
144
Holger Schurig8b17d722007-10-08 11:09:30 +0200145 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
Holger Schurig9012b282007-05-25 11:27:16 -0400146 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200147}
148
Holger Schurig69f90322007-11-23 15:43:44 +0100149static int lbs_ret_802_11_snmp_mib(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200150 struct cmd_ds_command *resp)
151{
152 struct cmd_ds_802_11_snmp_mib *smib = &resp->params.smib;
153 u16 oid = le16_to_cpu(smib->oid);
154 u16 querytype = le16_to_cpu(smib->querytype);
155
Holger Schurig9012b282007-05-25 11:27:16 -0400156 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200157
Holger Schuriga6c87002007-08-02 11:54:10 -0400158 lbs_deb_cmd("SNMP_RESP: oid 0x%x, querytype 0x%x\n", oid,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200159 querytype);
Holger Schuriga6c87002007-08-02 11:54:10 -0400160 lbs_deb_cmd("SNMP_RESP: Buf size %d\n", le16_to_cpu(smib->bufsize));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200161
Dan Williams0aef64d2007-08-02 11:31:18 -0400162 if (querytype == CMD_ACT_GET) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200163 switch (oid) {
Dan Williams0aef64d2007-08-02 11:31:18 -0400164 case FRAGTHRESH_I:
David Woodhouseaa21c002007-12-08 20:04:36 +0000165 priv->fragthsd =
David Woodhouse981f1872007-05-25 23:36:54 -0400166 le16_to_cpu(*((__le16 *)(smib->value)));
Holger Schuriga6c87002007-08-02 11:54:10 -0400167 lbs_deb_cmd("SNMP_RESP: frag threshold %u\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000168 priv->fragthsd);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200169 break;
Dan Williams0aef64d2007-08-02 11:31:18 -0400170 case RTSTHRESH_I:
David Woodhouseaa21c002007-12-08 20:04:36 +0000171 priv->rtsthsd =
David Woodhouse981f1872007-05-25 23:36:54 -0400172 le16_to_cpu(*((__le16 *)(smib->value)));
Holger Schuriga6c87002007-08-02 11:54:10 -0400173 lbs_deb_cmd("SNMP_RESP: rts threshold %u\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000174 priv->rtsthsd);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200175 break;
Dan Williams0aef64d2007-08-02 11:31:18 -0400176 case SHORT_RETRYLIM_I:
David Woodhouseaa21c002007-12-08 20:04:36 +0000177 priv->txretrycount =
David Woodhouse981f1872007-05-25 23:36:54 -0400178 le16_to_cpu(*((__le16 *)(smib->value)));
Holger Schuriga6c87002007-08-02 11:54:10 -0400179 lbs_deb_cmd("SNMP_RESP: tx retry count %u\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000180 priv->rtsthsd);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200181 break;
182 default:
183 break;
184 }
185 }
186
Holger Schurig9012b282007-05-25 11:27:16 -0400187 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200188 return 0;
189}
190
Holger Schurig69f90322007-11-23 15:43:44 +0100191static int lbs_ret_802_11_mac_address(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200192 struct cmd_ds_command *resp)
193{
194 struct cmd_ds_802_11_mac_address *macadd = &resp->params.macadd;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200195
Holger Schurig9012b282007-05-25 11:27:16 -0400196 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200197
David Woodhouseaa21c002007-12-08 20:04:36 +0000198 memcpy(priv->current_addr, macadd->macadd, ETH_ALEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200199
Holger Schurig9012b282007-05-25 11:27:16 -0400200 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200201 return 0;
202}
203
Holger Schurig69f90322007-11-23 15:43:44 +0100204static int lbs_ret_802_11_rf_tx_power(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200205 struct cmd_ds_command *resp)
206{
207 struct cmd_ds_802_11_rf_tx_power *rtp = &resp->params.txp;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200208
Holger Schurig9012b282007-05-25 11:27:16 -0400209 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200210
David Woodhouseaa21c002007-12-08 20:04:36 +0000211 priv->txpowerlevel = le16_to_cpu(rtp->currentlevel);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200212
David Woodhouseaa21c002007-12-08 20:04:36 +0000213 lbs_deb_cmd("TX power currently %d\n", priv->txpowerlevel);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200214
Holger Schuriga6c87002007-08-02 11:54:10 -0400215 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200216 return 0;
217}
218
Holger Schurig69f90322007-11-23 15:43:44 +0100219static int lbs_ret_802_11_rate_adapt_rateset(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200220 struct cmd_ds_command *resp)
221{
David Woodhouse981f1872007-05-25 23:36:54 -0400222 struct cmd_ds_802_11_rate_adapt_rateset *rates = &resp->params.rateset;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200223
Holger Schurig9012b282007-05-25 11:27:16 -0400224 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200225
Dan Williams0aef64d2007-08-02 11:31:18 -0400226 if (rates->action == CMD_ACT_GET) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000227 priv->enablehwauto = le16_to_cpu(rates->enablehwauto);
228 priv->ratebitmap = le16_to_cpu(rates->bitmap);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200229 }
230
Holger Schuriga6c87002007-08-02 11:54:10 -0400231 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200232 return 0;
233}
234
Holger Schurig69f90322007-11-23 15:43:44 +0100235static int lbs_ret_802_11_rssi(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200236 struct cmd_ds_command *resp)
237{
238 struct cmd_ds_802_11_rssi_rsp *rssirsp = &resp->params.rssirsp;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200239
Holger Schuriga6c87002007-08-02 11:54:10 -0400240 lbs_deb_enter(LBS_DEB_CMD);
241
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200242 /* store the non average value */
David Woodhouseaa21c002007-12-08 20:04:36 +0000243 priv->SNR[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->SNR);
244 priv->NF[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->noisefloor);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200245
David Woodhouseaa21c002007-12-08 20:04:36 +0000246 priv->SNR[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgSNR);
247 priv->NF[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgnoisefloor);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200248
David Woodhouseaa21c002007-12-08 20:04:36 +0000249 priv->RSSI[TYPE_BEACON][TYPE_NOAVG] =
250 CAL_RSSI(priv->SNR[TYPE_BEACON][TYPE_NOAVG],
251 priv->NF[TYPE_BEACON][TYPE_NOAVG]);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200252
David Woodhouseaa21c002007-12-08 20:04:36 +0000253 priv->RSSI[TYPE_BEACON][TYPE_AVG] =
254 CAL_RSSI(priv->SNR[TYPE_BEACON][TYPE_AVG] / AVG_SCALE,
255 priv->NF[TYPE_BEACON][TYPE_AVG] / AVG_SCALE);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200256
Holger Schuriga6c87002007-08-02 11:54:10 -0400257 lbs_deb_cmd("RSSI: beacon %d, avg %d\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000258 priv->RSSI[TYPE_BEACON][TYPE_NOAVG],
259 priv->RSSI[TYPE_BEACON][TYPE_AVG]);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200260
Holger Schuriga6c87002007-08-02 11:54:10 -0400261 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200262 return 0;
263}
264
Holger Schurig69f90322007-11-23 15:43:44 +0100265static int lbs_ret_802_11_eeprom_access(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200266 struct cmd_ds_command *resp)
267{
Holger Schurig10078322007-11-15 18:05:47 -0500268 struct lbs_ioctl_regrdwr *pbuf;
David Woodhouseaa21c002007-12-08 20:04:36 +0000269 pbuf = (struct lbs_ioctl_regrdwr *) priv->prdeeprom;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200270
Holger Schuriga6c87002007-08-02 11:54:10 -0400271 lbs_deb_enter_args(LBS_DEB_CMD, "len %d",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200272 le16_to_cpu(resp->params.rdeeprom.bytecount));
273 if (pbuf->NOB < le16_to_cpu(resp->params.rdeeprom.bytecount)) {
274 pbuf->NOB = 0;
Holger Schuriga6c87002007-08-02 11:54:10 -0400275 lbs_deb_cmd("EEPROM read length too big\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200276 return -1;
277 }
278 pbuf->NOB = le16_to_cpu(resp->params.rdeeprom.bytecount);
279 if (pbuf->NOB > 0) {
280
281 memcpy(&pbuf->value, (u8 *) & resp->params.rdeeprom.value,
282 le16_to_cpu(resp->params.rdeeprom.bytecount));
Holger Schuriga6c87002007-08-02 11:54:10 -0400283 lbs_deb_hex(LBS_DEB_CMD, "EEPROM", (char *)&pbuf->value,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200284 le16_to_cpu(resp->params.rdeeprom.bytecount));
285 }
Holger Schuriga6c87002007-08-02 11:54:10 -0400286 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200287 return 0;
288}
289
Brajesh Dave96287ac2007-11-20 17:44:28 -0500290static int lbs_ret_802_11_bcn_ctrl(struct lbs_private * priv,
291 struct cmd_ds_command *resp)
292{
293 struct cmd_ds_802_11_beacon_control *bcn_ctrl =
294 &resp->params.bcn_ctrl;
Brajesh Dave96287ac2007-11-20 17:44:28 -0500295
296 lbs_deb_enter(LBS_DEB_CMD);
297
298 if (bcn_ctrl->action == CMD_ACT_GET) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000299 priv->beacon_enable = (u8) le16_to_cpu(bcn_ctrl->beacon_enable);
300 priv->beacon_period = le16_to_cpu(bcn_ctrl->beacon_period);
Brajesh Dave96287ac2007-11-20 17:44:28 -0500301 }
302
303 lbs_deb_enter(LBS_DEB_CMD);
304 return 0;
305}
306
David Woodhouse1309b552007-12-10 13:36:10 -0500307static inline int handle_cmd_response(struct lbs_private *priv,
Dan Williamsddac4522007-12-11 13:49:39 -0500308 struct cmd_header *cmd_response)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200309{
Dan Williamsddac4522007-12-11 13:49:39 -0500310 struct cmd_ds_command *resp = (struct cmd_ds_command *) cmd_response;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200311 int ret = 0;
312 unsigned long flags;
David Woodhouse1309b552007-12-10 13:36:10 -0500313 uint16_t respcmd = le16_to_cpu(resp->command);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200314
Holger Schuriga6c87002007-08-02 11:54:10 -0400315 lbs_deb_enter(LBS_DEB_HOST);
316
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200317 switch (respcmd) {
Holger Schurig6b63cd02007-08-02 11:53:36 -0400318 case CMD_RET(CMD_MAC_REG_ACCESS):
319 case CMD_RET(CMD_BBP_REG_ACCESS):
320 case CMD_RET(CMD_RF_REG_ACCESS):
Holger Schurig10078322007-11-15 18:05:47 -0500321 ret = lbs_ret_reg_access(priv, respcmd, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200322 break;
323
Dan Williams0aef64d2007-08-02 11:31:18 -0400324 case CMD_RET_802_11_ASSOCIATE:
Holger Schurig6b63cd02007-08-02 11:53:36 -0400325 case CMD_RET(CMD_802_11_ASSOCIATE):
326 case CMD_RET(CMD_802_11_REASSOCIATE):
Holger Schurig10078322007-11-15 18:05:47 -0500327 ret = lbs_ret_80211_associate(priv, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200328 break;
329
Holger Schurig6b63cd02007-08-02 11:53:36 -0400330 case CMD_RET(CMD_802_11_DISASSOCIATE):
331 case CMD_RET(CMD_802_11_DEAUTHENTICATE):
Holger Schurige98a88d2008-03-19 14:25:58 +0100332 ret = lbs_ret_80211_disassociate(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200333 break;
334
Holger Schurig6b63cd02007-08-02 11:53:36 -0400335 case CMD_RET(CMD_802_11_AD_HOC_START):
336 case CMD_RET(CMD_802_11_AD_HOC_JOIN):
Holger Schurig10078322007-11-15 18:05:47 -0500337 ret = lbs_ret_80211_ad_hoc_start(priv, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200338 break;
339
Holger Schurig6b63cd02007-08-02 11:53:36 -0400340 case CMD_RET(CMD_802_11_SNMP_MIB):
Holger Schurig10078322007-11-15 18:05:47 -0500341 ret = lbs_ret_802_11_snmp_mib(priv, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200342 break;
343
Holger Schurig6b63cd02007-08-02 11:53:36 -0400344 case CMD_RET(CMD_802_11_RF_TX_POWER):
Holger Schurig10078322007-11-15 18:05:47 -0500345 ret = lbs_ret_802_11_rf_tx_power(priv, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200346 break;
347
Holger Schurig6b63cd02007-08-02 11:53:36 -0400348 case CMD_RET(CMD_802_11_SET_AFC):
349 case CMD_RET(CMD_802_11_GET_AFC):
David Woodhouseaa21c002007-12-08 20:04:36 +0000350 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouse75567672007-12-15 02:38:17 -0500351 memmove((void *)priv->cur_cmd->callback_arg, &resp->params.afc,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200352 sizeof(struct cmd_ds_802_11_afc));
David Woodhouseaa21c002007-12-08 20:04:36 +0000353 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200354
355 break;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200356
Holger Schurig6b63cd02007-08-02 11:53:36 -0400357 case CMD_RET(CMD_MAC_MULTICAST_ADR):
Holger Schurig6b63cd02007-08-02 11:53:36 -0400358 case CMD_RET(CMD_802_11_RESET):
359 case CMD_RET(CMD_802_11_AUTHENTICATE):
Holger Schurig6b63cd02007-08-02 11:53:36 -0400360 case CMD_RET(CMD_802_11_BEACON_STOP):
Dan Williams18c96c342007-06-18 12:01:12 -0400361 break;
362
Holger Schurig6b63cd02007-08-02 11:53:36 -0400363 case CMD_RET(CMD_802_11_RATE_ADAPT_RATESET):
Holger Schurig10078322007-11-15 18:05:47 -0500364 ret = lbs_ret_802_11_rate_adapt_rateset(priv, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200365 break;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200366
Holger Schurig6b63cd02007-08-02 11:53:36 -0400367 case CMD_RET(CMD_802_11_RSSI):
Holger Schurig10078322007-11-15 18:05:47 -0500368 ret = lbs_ret_802_11_rssi(priv, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200369 break;
370
Holger Schurig6b63cd02007-08-02 11:53:36 -0400371 case CMD_RET(CMD_802_11_MAC_ADDRESS):
Holger Schurig10078322007-11-15 18:05:47 -0500372 ret = lbs_ret_802_11_mac_address(priv, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200373 break;
374
Holger Schurig6b63cd02007-08-02 11:53:36 -0400375 case CMD_RET(CMD_802_11_AD_HOC_STOP):
Holger Schurige98a88d2008-03-19 14:25:58 +0100376 ret = lbs_ret_80211_ad_hoc_stop(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200377 break;
378
Holger Schurig6b63cd02007-08-02 11:53:36 -0400379 case CMD_RET(CMD_802_11_EEPROM_ACCESS):
Holger Schurig10078322007-11-15 18:05:47 -0500380 ret = lbs_ret_802_11_eeprom_access(priv, resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200381 break;
382
Holger Schurig6b63cd02007-08-02 11:53:36 -0400383 case CMD_RET(CMD_802_11D_DOMAIN_INFO):
Holger Schurige98a88d2008-03-19 14:25:58 +0100384 ret = lbs_ret_802_11d_domain_info(resp);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200385 break;
386
Holger Schurig6b63cd02007-08-02 11:53:36 -0400387 case CMD_RET(CMD_802_11_TPC_CFG):
David Woodhouseaa21c002007-12-08 20:04:36 +0000388 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouse75567672007-12-15 02:38:17 -0500389 memmove((void *)priv->cur_cmd->callback_arg, &resp->params.tpccfg,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200390 sizeof(struct cmd_ds_802_11_tpc_cfg));
David Woodhouseaa21c002007-12-08 20:04:36 +0000391 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200392 break;
Holger Schurig6b63cd02007-08-02 11:53:36 -0400393 case CMD_RET(CMD_802_11_LED_GPIO_CTRL):
David Woodhouseaa21c002007-12-08 20:04:36 +0000394 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouse75567672007-12-15 02:38:17 -0500395 memmove((void *)priv->cur_cmd->callback_arg, &resp->params.ledgpio,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200396 sizeof(struct cmd_ds_802_11_led_ctrl));
David Woodhouseaa21c002007-12-08 20:04:36 +0000397 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200398 break;
Holger Schurig3a188642007-11-26 10:07:14 +0100399
Holger Schurig6b63cd02007-08-02 11:53:36 -0400400 case CMD_RET(CMD_802_11_PWR_CFG):
David Woodhouseaa21c002007-12-08 20:04:36 +0000401 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouse75567672007-12-15 02:38:17 -0500402 memmove((void *)priv->cur_cmd->callback_arg, &resp->params.pwrcfg,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200403 sizeof(struct cmd_ds_802_11_pwr_cfg));
David Woodhouseaa21c002007-12-08 20:04:36 +0000404 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200405
406 break;
407
Holger Schurig6b63cd02007-08-02 11:53:36 -0400408 case CMD_RET(CMD_GET_TSF):
David Woodhouseaa21c002007-12-08 20:04:36 +0000409 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouse75567672007-12-15 02:38:17 -0500410 memcpy((void *)priv->cur_cmd->callback_arg,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200411 &resp->params.gettsf.tsfvalue, sizeof(u64));
David Woodhouseaa21c002007-12-08 20:04:36 +0000412 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200413 break;
Holger Schurig6b63cd02007-08-02 11:53:36 -0400414 case CMD_RET(CMD_BT_ACCESS):
David Woodhouseaa21c002007-12-08 20:04:36 +0000415 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouse75567672007-12-15 02:38:17 -0500416 if (priv->cur_cmd->callback_arg)
417 memcpy((void *)priv->cur_cmd->callback_arg,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200418 &resp->params.bt.addr1, 2 * ETH_ALEN);
David Woodhouseaa21c002007-12-08 20:04:36 +0000419 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200420 break;
Holger Schurig6b63cd02007-08-02 11:53:36 -0400421 case CMD_RET(CMD_FWT_ACCESS):
David Woodhouseaa21c002007-12-08 20:04:36 +0000422 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouse75567672007-12-15 02:38:17 -0500423 if (priv->cur_cmd->callback_arg)
424 memcpy((void *)priv->cur_cmd->callback_arg, &resp->params.fwt,
David Woodhouse981f1872007-05-25 23:36:54 -0400425 sizeof(resp->params.fwt));
David Woodhouseaa21c002007-12-08 20:04:36 +0000426 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200427 break;
Brajesh Dave96287ac2007-11-20 17:44:28 -0500428 case CMD_RET(CMD_802_11_BEACON_CTRL):
429 ret = lbs_ret_802_11_bcn_ctrl(priv, resp);
430 break;
431
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200432 default:
Holger Schuriga6c87002007-08-02 11:54:10 -0400433 lbs_deb_host("CMD_RESP: unknown cmd response 0x%04x\n",
David Woodhousee1258172007-12-11 23:42:49 -0500434 le16_to_cpu(resp->command));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200435 break;
436 }
Holger Schuriga6c87002007-08-02 11:54:10 -0400437 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200438 return ret;
439}
440
Holger Schurig69f90322007-11-23 15:43:44 +0100441int lbs_process_rx_command(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200442{
David Woodhousee1258172007-12-11 23:42:49 -0500443 uint16_t respcmd, curcmd;
Dan Williamsddac4522007-12-11 13:49:39 -0500444 struct cmd_header *resp;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200445 int ret = 0;
David Woodhousee1258172007-12-11 23:42:49 -0500446 unsigned long flags;
447 uint16_t result;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200448
Holger Schuriga6c87002007-08-02 11:54:10 -0400449 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200450
David Woodhouseaa21c002007-12-08 20:04:36 +0000451 mutex_lock(&priv->lock);
452 spin_lock_irqsave(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200453
David Woodhouseaa21c002007-12-08 20:04:36 +0000454 if (!priv->cur_cmd) {
Holger Schuriga6c87002007-08-02 11:54:10 -0400455 lbs_deb_host("CMD_RESP: cur_cmd is NULL\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200456 ret = -1;
David Woodhouseaa21c002007-12-08 20:04:36 +0000457 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200458 goto done;
459 }
David Woodhousee1258172007-12-11 23:42:49 -0500460
David Woodhouse7003b072007-12-17 15:22:43 -0500461 resp = (void *)priv->upld_buf;
Sebastian Siewior8a96df82008-03-04 18:22:27 +0100462 curcmd = le16_to_cpu(priv->cur_cmd->cmdbuf->command);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200463 respcmd = le16_to_cpu(resp->command);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200464 result = le16_to_cpu(resp->result);
465
Holger Schurig1afc09ab2008-01-29 09:14:40 +0100466 lbs_deb_cmd("CMD_RESP: response 0x%04x, seq %d, size %d, jiffies %lu\n",
David Woodhousee1258172007-12-11 23:42:49 -0500467 respcmd, le16_to_cpu(resp->seqnum), priv->upld_len, jiffies);
Holger Schurig1afc09ab2008-01-29 09:14:40 +0100468 lbs_deb_hex(LBS_DEB_CMD, "CMD_RESP", (void *) resp, priv->upld_len);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200469
David Woodhouse6305f492008-03-03 12:20:12 +0100470 if (resp->seqnum != priv->cur_cmd->cmdbuf->seqnum) {
David Woodhousee1258172007-12-11 23:42:49 -0500471 lbs_pr_info("Received CMD_RESP with invalid sequence %d (expected %d)\n",
David Woodhouse6305f492008-03-03 12:20:12 +0100472 le16_to_cpu(resp->seqnum), le16_to_cpu(priv->cur_cmd->cmdbuf->seqnum));
David Woodhouseaa21c002007-12-08 20:04:36 +0000473 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200474 ret = -1;
475 goto done;
476 }
David Woodhousee1258172007-12-11 23:42:49 -0500477 if (respcmd != CMD_RET(curcmd) &&
Sebastian Siewior5f0547c22008-03-06 10:30:21 +0100478 respcmd != CMD_RET_802_11_ASSOCIATE && curcmd != CMD_802_11_ASSOCIATE) {
David Woodhousee1258172007-12-11 23:42:49 -0500479 lbs_pr_info("Invalid CMD_RESP %x to command %x!\n", respcmd, curcmd);
480 spin_unlock_irqrestore(&priv->driver_lock, flags);
481 ret = -1;
482 goto done;
483 }
484
David Woodhouse85388232007-12-17 15:41:30 -0500485 if (resp->result == cpu_to_le16(0x0004)) {
486 /* 0x0004 means -EAGAIN. Drop the response, let it time out
487 and be resubmitted */
488 lbs_pr_info("Firmware returns DEFER to command %x. Will let it time out...\n",
489 le16_to_cpu(resp->command));
490 spin_unlock_irqrestore(&priv->driver_lock, flags);
491 ret = -1;
492 goto done;
493 }
494
David Woodhousee1258172007-12-11 23:42:49 -0500495 /* Now we got response from FW, cancel the command timer */
496 del_timer(&priv->command_timer);
David Woodhouse2a345092007-12-15 19:33:43 -0500497 priv->cmd_timed_out = 0;
498 if (priv->nr_retries) {
499 lbs_pr_info("Received result %x to command %x after %d retries\n",
500 result, curcmd, priv->nr_retries);
501 priv->nr_retries = 0;
502 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200503
504 /* Store the response code to cur_cmd_retcode. */
David Woodhouseaa21c002007-12-08 20:04:36 +0000505 priv->cur_cmd_retcode = result;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200506
Holger Schurig6b63cd02007-08-02 11:53:36 -0400507 if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) {
David Woodhouse38bfab12007-12-16 23:26:54 -0500508 struct cmd_ds_802_11_ps_mode *psmode = (void *) &resp[1];
David Woodhouse981f1872007-05-25 23:36:54 -0400509 u16 action = le16_to_cpu(psmode->action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200510
Holger Schuriga6c87002007-08-02 11:54:10 -0400511 lbs_deb_host(
512 "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n",
David Woodhouse981f1872007-05-25 23:36:54 -0400513 result, action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200514
515 if (result) {
Holger Schuriga6c87002007-08-02 11:54:10 -0400516 lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n",
David Woodhouse981f1872007-05-25 23:36:54 -0400517 result);
518 /*
519 * We should not re-try enter-ps command in
520 * ad-hoc mode. It takes place in
Holger Schurig10078322007-11-15 18:05:47 -0500521 * lbs_execute_next_command().
David Woodhouse981f1872007-05-25 23:36:54 -0400522 */
David Woodhouseaa21c002007-12-08 20:04:36 +0000523 if (priv->mode == IW_MODE_ADHOC &&
Dan Williams0aef64d2007-08-02 11:31:18 -0400524 action == CMD_SUBCMD_ENTER_PS)
David Woodhouseaa21c002007-12-08 20:04:36 +0000525 priv->psmode = LBS802_11POWERMODECAM;
Dan Williams0aef64d2007-08-02 11:31:18 -0400526 } else if (action == CMD_SUBCMD_ENTER_PS) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000527 priv->needtowakeup = 0;
528 priv->psstate = PS_STATE_AWAKE;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200529
Holger Schuriga6c87002007-08-02 11:54:10 -0400530 lbs_deb_host("CMD_RESP: ENTER_PS command response\n");
David Woodhouseaa21c002007-12-08 20:04:36 +0000531 if (priv->connect_status != LBS_CONNECTED) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200532 /*
533 * When Deauth Event received before Enter_PS command
534 * response, We need to wake up the firmware.
535 */
Holger Schuriga6c87002007-08-02 11:54:10 -0400536 lbs_deb_host(
Holger Schurig10078322007-11-15 18:05:47 -0500537 "disconnected, invoking lbs_ps_wakeup\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200538
David Woodhouseaa21c002007-12-08 20:04:36 +0000539 spin_unlock_irqrestore(&priv->driver_lock, flags);
540 mutex_unlock(&priv->lock);
Holger Schurig10078322007-11-15 18:05:47 -0500541 lbs_ps_wakeup(priv, 0);
David Woodhouseaa21c002007-12-08 20:04:36 +0000542 mutex_lock(&priv->lock);
543 spin_lock_irqsave(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200544 }
Dan Williams0aef64d2007-08-02 11:31:18 -0400545 } else if (action == CMD_SUBCMD_EXIT_PS) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000546 priv->needtowakeup = 0;
547 priv->psstate = PS_STATE_FULL_POWER;
Holger Schuriga6c87002007-08-02 11:54:10 -0400548 lbs_deb_host("CMD_RESP: EXIT_PS command response\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200549 } else {
Holger Schuriga6c87002007-08-02 11:54:10 -0400550 lbs_deb_host("CMD_RESP: PS action 0x%X\n", action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200551 }
552
David Woodhouse183aeac2007-12-15 01:52:54 -0500553 lbs_complete_command(priv, priv->cur_cmd, result);
David Woodhouseaa21c002007-12-08 20:04:36 +0000554 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200555
556 ret = 0;
557 goto done;
558 }
559
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200560 /* If the command is not successful, cleanup and return failure */
561 if ((result != 0 || !(respcmd & 0x8000))) {
Holger Schuriga6c87002007-08-02 11:54:10 -0400562 lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n",
563 result, respcmd);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200564 /*
565 * Handling errors here
566 */
567 switch (respcmd) {
Holger Schurig6b63cd02007-08-02 11:53:36 -0400568 case CMD_RET(CMD_GET_HW_SPEC):
569 case CMD_RET(CMD_802_11_RESET):
Holger Schuriga6c87002007-08-02 11:54:10 -0400570 lbs_deb_host("CMD_RESP: reset failed\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200571 break;
572
573 }
David Woodhouse183aeac2007-12-15 01:52:54 -0500574 lbs_complete_command(priv, priv->cur_cmd, result);
David Woodhouseaa21c002007-12-08 20:04:36 +0000575 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200576
577 ret = -1;
578 goto done;
579 }
580
David Woodhouseaa21c002007-12-08 20:04:36 +0000581 spin_unlock_irqrestore(&priv->driver_lock, flags);
David Woodhouse17230472007-12-07 15:13:05 +0000582
Dan Williams7ad994d2007-12-11 12:33:30 -0500583 if (priv->cur_cmd && priv->cur_cmd->callback) {
584 ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg,
Dan Williamsddac4522007-12-11 13:49:39 -0500585 resp);
Dan Williams7ad994d2007-12-11 12:33:30 -0500586 } else
Holger Schurige98a88d2008-03-19 14:25:58 +0100587 ret = handle_cmd_response(priv, resp);
David Woodhouse17230472007-12-07 15:13:05 +0000588
David Woodhouseaa21c002007-12-08 20:04:36 +0000589 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouse17230472007-12-07 15:13:05 +0000590
David Woodhouseaa21c002007-12-08 20:04:36 +0000591 if (priv->cur_cmd) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200592 /* Clean up and Put current command back to cmdfreeq */
David Woodhouse183aeac2007-12-15 01:52:54 -0500593 lbs_complete_command(priv, priv->cur_cmd, result);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200594 }
David Woodhouseaa21c002007-12-08 20:04:36 +0000595 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200596
597done:
David Woodhouseaa21c002007-12-08 20:04:36 +0000598 mutex_unlock(&priv->lock);
Holger Schuriga6c87002007-08-02 11:54:10 -0400599 lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200600 return ret;
601}
602
David Woodhouseb47ef242007-12-17 13:26:42 -0500603static int lbs_send_confirmwake(struct lbs_private *priv)
604{
605 struct cmd_header *cmd = &priv->lbs_ps_confirm_wake;
606 int ret = 0;
607
608 lbs_deb_enter(LBS_DEB_HOST);
609
610 cmd->command = cpu_to_le16(CMD_802_11_WAKEUP_CONFIRM);
611 cmd->size = cpu_to_le16(sizeof(*cmd));
612 cmd->seqnum = cpu_to_le16(++priv->seqnum);
613 cmd->result = 0;
614
615 lbs_deb_host("SEND_WAKEC_CMD: before download\n");
616
617 lbs_deb_hex(LBS_DEB_HOST, "wake confirm command", (void *)cmd, sizeof(*cmd));
618
619 ret = priv->hw_host_to_card(priv, MVMS_CMD, (void *)cmd, sizeof(*cmd));
620 if (ret)
621 lbs_pr_alert("SEND_WAKEC_CMD: Host to Card failed for Confirm Wake\n");
622
623 lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
624 return ret;
625}
626
Holger Schurig69f90322007-11-23 15:43:44 +0100627int lbs_process_event(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200628{
629 int ret = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200630 u32 eventcause;
631
Holger Schurig9556d212007-08-02 13:14:07 -0400632 lbs_deb_enter(LBS_DEB_CMD);
633
David Woodhouseaa21c002007-12-08 20:04:36 +0000634 spin_lock_irq(&priv->driver_lock);
635 eventcause = priv->eventcause >> SBI_EVENT_CAUSE_SHIFT;
636 spin_unlock_irq(&priv->driver_lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200637
Holger Schurig0b3c07f2007-11-28 09:15:11 +0100638 switch (eventcause) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200639 case MACREG_INT_CODE_LINK_SENSED:
Holger Schurigd4ff0ef2008-03-19 14:25:18 +0100640 lbs_deb_cmd("EVENT: link sensed\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200641 break;
642
643 case MACREG_INT_CODE_DEAUTHENTICATED:
Holger Schuriga6c87002007-08-02 11:54:10 -0400644 lbs_deb_cmd("EVENT: deauthenticated\n");
Holger Schurig10078322007-11-15 18:05:47 -0500645 lbs_mac_event_disconnected(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200646 break;
647
648 case MACREG_INT_CODE_DISASSOCIATED:
Holger Schuriga6c87002007-08-02 11:54:10 -0400649 lbs_deb_cmd("EVENT: disassociated\n");
Holger Schurig10078322007-11-15 18:05:47 -0500650 lbs_mac_event_disconnected(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200651 break;
652
Holger Schurig0b3c07f2007-11-28 09:15:11 +0100653 case MACREG_INT_CODE_LINK_LOST_NO_SCAN:
Holger Schuriga6c87002007-08-02 11:54:10 -0400654 lbs_deb_cmd("EVENT: link lost\n");
Holger Schurig10078322007-11-15 18:05:47 -0500655 lbs_mac_event_disconnected(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200656 break;
657
658 case MACREG_INT_CODE_PS_SLEEP:
Holger Schurigd4ff0ef2008-03-19 14:25:18 +0100659 lbs_deb_cmd("EVENT: ps sleep\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200660
661 /* handle unexpected PS SLEEP event */
David Woodhouseaa21c002007-12-08 20:04:36 +0000662 if (priv->psstate == PS_STATE_FULL_POWER) {
Holger Schurig9012b282007-05-25 11:27:16 -0400663 lbs_deb_cmd(
Holger Schuriga6c87002007-08-02 11:54:10 -0400664 "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200665 break;
666 }
David Woodhouseaa21c002007-12-08 20:04:36 +0000667 priv->psstate = PS_STATE_PRE_SLEEP;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200668
Holger Schurigd4ff0ef2008-03-19 14:25:18 +0100669 lbs_ps_confirm_sleep(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200670
671 break;
672
David Woodhouseb47ef242007-12-17 13:26:42 -0500673 case MACREG_INT_CODE_HOST_AWAKE:
Holger Schurigd4ff0ef2008-03-19 14:25:18 +0100674 lbs_deb_cmd("EVENT: host awake\n");
David Woodhouseb47ef242007-12-17 13:26:42 -0500675 lbs_send_confirmwake(priv);
676 break;
677
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200678 case MACREG_INT_CODE_PS_AWAKE:
Holger Schurigd4ff0ef2008-03-19 14:25:18 +0100679 lbs_deb_cmd("EVENT: ps awake\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200680 /* handle unexpected PS AWAKE event */
David Woodhouseaa21c002007-12-08 20:04:36 +0000681 if (priv->psstate == PS_STATE_FULL_POWER) {
Holger Schurig9012b282007-05-25 11:27:16 -0400682 lbs_deb_cmd(
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200683 "EVENT: In FULL POWER mode - ignore PS AWAKE\n");
684 break;
685 }
686
David Woodhouseaa21c002007-12-08 20:04:36 +0000687 priv->psstate = PS_STATE_AWAKE;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200688
David Woodhouseaa21c002007-12-08 20:04:36 +0000689 if (priv->needtowakeup) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200690 /*
691 * wait for the command processing to finish
692 * before resuming sending
David Woodhouseaa21c002007-12-08 20:04:36 +0000693 * priv->needtowakeup will be set to FALSE
Holger Schurig10078322007-11-15 18:05:47 -0500694 * in lbs_ps_wakeup()
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200695 */
Holger Schuriga6c87002007-08-02 11:54:10 -0400696 lbs_deb_cmd("waking up ...\n");
Holger Schurig10078322007-11-15 18:05:47 -0500697 lbs_ps_wakeup(priv, 0);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200698 }
699 break;
700
701 case MACREG_INT_CODE_MIC_ERR_UNICAST:
Holger Schurig9012b282007-05-25 11:27:16 -0400702 lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200703 handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_UNICAST);
704 break;
705
706 case MACREG_INT_CODE_MIC_ERR_MULTICAST:
Holger Schurig9012b282007-05-25 11:27:16 -0400707 lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200708 handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_MULTICAST);
709 break;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200710
Holger Schurigd4ff0ef2008-03-19 14:25:18 +0100711 case MACREG_INT_CODE_MIB_CHANGED:
712 lbs_deb_cmd("EVENT: MIB CHANGED\n");
713 break;
714 case MACREG_INT_CODE_INIT_DONE:
715 lbs_deb_cmd("EVENT: INIT DONE\n");
716 break;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200717 case MACREG_INT_CODE_ADHOC_BCN_LOST:
Holger Schuriga6c87002007-08-02 11:54:10 -0400718 lbs_deb_cmd("EVENT: ADHOC beacon lost\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200719 break;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200720 case MACREG_INT_CODE_RSSI_LOW:
Holger Schuriga6c87002007-08-02 11:54:10 -0400721 lbs_pr_alert("EVENT: rssi low\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200722 break;
723 case MACREG_INT_CODE_SNR_LOW:
Holger Schuriga6c87002007-08-02 11:54:10 -0400724 lbs_pr_alert("EVENT: snr low\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200725 break;
726 case MACREG_INT_CODE_MAX_FAIL:
Holger Schuriga6c87002007-08-02 11:54:10 -0400727 lbs_pr_alert("EVENT: max fail\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200728 break;
729 case MACREG_INT_CODE_RSSI_HIGH:
Holger Schuriga6c87002007-08-02 11:54:10 -0400730 lbs_pr_alert("EVENT: rssi high\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200731 break;
732 case MACREG_INT_CODE_SNR_HIGH:
Holger Schuriga6c87002007-08-02 11:54:10 -0400733 lbs_pr_alert("EVENT: snr high\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200734 break;
735
Luis Carlos Cobo Rus7d8d28b2007-05-25 23:12:19 -0400736 case MACREG_INT_CODE_MESH_AUTO_STARTED:
Dan Williams5612c012007-08-02 13:20:12 -0400737 /* Ignore spurious autostart events if autostart is disabled */
738 if (!priv->mesh_autostart_enabled) {
739 lbs_pr_info("EVENT: MESH_AUTO_STARTED (ignoring)\n");
740 break;
741 }
Luis Carlos Cobo9cdc6d22007-08-02 11:55:22 -0400742 lbs_pr_info("EVENT: MESH_AUTO_STARTED\n");
David Woodhouseaa21c002007-12-08 20:04:36 +0000743 priv->mesh_connect_status = LBS_CONNECTED;
David Woodhousea27b9f92007-12-12 00:41:51 -0500744 if (priv->mesh_open) {
Luis Carlos Cobo9cdc6d22007-08-02 11:55:22 -0400745 netif_carrier_on(priv->mesh_dev);
David Woodhousea27b9f92007-12-12 00:41:51 -0500746 if (!priv->tx_pending_len)
747 netif_wake_queue(priv->mesh_dev);
Luis Carlos Cobo Rus7d8d28b2007-05-25 23:12:19 -0400748 }
David Woodhouseaa21c002007-12-08 20:04:36 +0000749 priv->mode = IW_MODE_ADHOC;
Luis Carlos Cobo Rusb8bedef2007-05-30 12:14:34 -0400750 schedule_work(&priv->sync_channel);
Luis Carlos Cobo Rus7d8d28b2007-05-25 23:12:19 -0400751 break;
752
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200753 default:
Holger Schurig0b3c07f2007-11-28 09:15:11 +0100754 lbs_pr_alert("EVENT: unknown event id %d\n", eventcause);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200755 break;
756 }
757
David Woodhouseaa21c002007-12-08 20:04:36 +0000758 spin_lock_irq(&priv->driver_lock);
759 priv->eventcause = 0;
760 spin_unlock_irq(&priv->driver_lock);
Holger Schurig9012b282007-05-25 11:27:16 -0400761
Holger Schurig9556d212007-08-02 13:14:07 -0400762 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200763 return ret;
764}