| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 1 | /** | 
|  | 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 Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 12 | #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 Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 23 | *  @param priv    A pointer to struct lbs_private structure | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 24 | *  @return 	   n/a | 
|  | 25 | */ | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 26 | void lbs_mac_event_disconnected(struct lbs_private *priv) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 27 | { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 28 | union iwreq_data wrqu; | 
|  | 29 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 30 | if (priv->connect_status != LBS_CONNECTED) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 31 | return; | 
|  | 32 |  | 
| Holger Schurig | 9184346 | 2007-11-28 14:05:02 +0100 | [diff] [blame] | 33 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 34 |  | 
|  | 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 Schurig | 634b8f4 | 2007-05-25 13:05:16 -0400 | [diff] [blame] | 44 | wireless_send_event(priv->dev, SIOCGIWAP, &wrqu, NULL); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 45 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 46 | /* report disconnect to upper layer */ | 
| Holger Schurig | 634b8f4 | 2007-05-25 13:05:16 -0400 | [diff] [blame] | 47 | netif_stop_queue(priv->dev); | 
|  | 48 | netif_carrier_off(priv->dev); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 49 |  | 
| David Woodhouse | a27b9f9 | 2007-12-12 00:41:51 -0500 | [diff] [blame] | 50 | /* Free Tx and Rx packets */ | 
|  | 51 | kfree_skb(priv->currenttxskb); | 
|  | 52 | priv->currenttxskb = NULL; | 
|  | 53 | priv->tx_pending_len = 0; | 
|  | 54 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 55 | /* reset SNR/NF/RSSI values */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 56 | 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 Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 64 |  | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 65 | /* Clear out associated SSID and BSSID since connection is | 
|  | 66 | * no longer valid. | 
|  | 67 | */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 68 | memset(&priv->curbssparams.bssid, 0, ETH_ALEN); | 
|  | 69 | memset(&priv->curbssparams.ssid, 0, IW_ESSID_MAX_SIZE); | 
|  | 70 | priv->curbssparams.ssid_len = 0; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 71 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 72 | if (priv->psstate != PS_STATE_FULL_POWER) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 73 | /* make firmware to exit PS mode */ | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 74 | lbs_deb_cmd("disconnected, so exit PS mode\n"); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 75 | lbs_ps_wakeup(priv, 0); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 76 | } | 
| Holger Schurig | 52507c2 | 2008-01-28 17:25:53 +0100 | [diff] [blame] | 77 | lbs_deb_leave(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 78 | } | 
|  | 79 |  | 
|  | 80 | /** | 
|  | 81 | *  @brief This function handles MIC failure event. | 
|  | 82 | * | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 83 | *  @param priv    A pointer to struct lbs_private structure | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 84 | *  @para  event   the event id | 
|  | 85 | *  @return 	   n/a | 
|  | 86 | */ | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 87 | static void handle_mic_failureevent(struct lbs_private *priv, u32 event) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 88 | { | 
|  | 89 | char buf[50]; | 
|  | 90 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 91 | lbs_deb_enter(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 92 | 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 Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 102 | lbs_send_iwevcustom_event(priv, buf); | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 103 | lbs_deb_leave(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 104 | } | 
|  | 105 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 106 | static int lbs_ret_reg_access(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 107 | u16 type, struct cmd_ds_command *resp) | 
|  | 108 | { | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 109 | int ret = 0; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 110 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 111 | lbs_deb_enter(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 112 |  | 
|  | 113 | switch (type) { | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 114 | case CMD_RET(CMD_MAC_REG_ACCESS): | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 115 | { | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 116 | struct cmd_ds_mac_reg_access *reg = &resp->params.macreg; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 117 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 118 | priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); | 
|  | 119 | priv->offsetvalue.value = le32_to_cpu(reg->value); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 120 | break; | 
|  | 121 | } | 
|  | 122 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 123 | case CMD_RET(CMD_BBP_REG_ACCESS): | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 124 | { | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 125 | struct cmd_ds_bbp_reg_access *reg = &resp->params.bbpreg; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 126 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 127 | priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); | 
|  | 128 | priv->offsetvalue.value = reg->value; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 129 | break; | 
|  | 130 | } | 
|  | 131 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 132 | case CMD_RET(CMD_RF_REG_ACCESS): | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 133 | { | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 134 | struct cmd_ds_rf_reg_access *reg = &resp->params.rfreg; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 135 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 136 | priv->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); | 
|  | 137 | priv->offsetvalue.value = reg->value; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 138 | break; | 
|  | 139 | } | 
|  | 140 |  | 
|  | 141 | default: | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 142 | ret = -1; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 143 | } | 
|  | 144 |  | 
| Holger Schurig | 8b17d72 | 2007-10-08 11:09:30 +0200 | [diff] [blame] | 145 | lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret); | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 146 | return ret; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 147 | } | 
|  | 148 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 149 | static int lbs_ret_802_11_snmp_mib(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 150 | 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 Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 156 | lbs_deb_enter(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 157 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 158 | lbs_deb_cmd("SNMP_RESP: oid 0x%x, querytype 0x%x\n", oid, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 159 | querytype); | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 160 | lbs_deb_cmd("SNMP_RESP: Buf size %d\n", le16_to_cpu(smib->bufsize)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 161 |  | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 162 | if (querytype == CMD_ACT_GET) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 163 | switch (oid) { | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 164 | case FRAGTHRESH_I: | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 165 | priv->fragthsd = | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 166 | le16_to_cpu(*((__le16 *)(smib->value))); | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 167 | lbs_deb_cmd("SNMP_RESP: frag threshold %u\n", | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 168 | priv->fragthsd); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 169 | break; | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 170 | case RTSTHRESH_I: | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 171 | priv->rtsthsd = | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 172 | le16_to_cpu(*((__le16 *)(smib->value))); | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 173 | lbs_deb_cmd("SNMP_RESP: rts threshold %u\n", | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 174 | priv->rtsthsd); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 175 | break; | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 176 | case SHORT_RETRYLIM_I: | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 177 | priv->txretrycount = | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 178 | le16_to_cpu(*((__le16 *)(smib->value))); | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 179 | lbs_deb_cmd("SNMP_RESP: tx retry count %u\n", | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 180 | priv->rtsthsd); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 181 | break; | 
|  | 182 | default: | 
|  | 183 | break; | 
|  | 184 | } | 
|  | 185 | } | 
|  | 186 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 187 | lbs_deb_enter(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 188 | return 0; | 
|  | 189 | } | 
|  | 190 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 191 | static int lbs_ret_802_11_mac_address(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 192 | struct cmd_ds_command *resp) | 
|  | 193 | { | 
|  | 194 | struct cmd_ds_802_11_mac_address *macadd = &resp->params.macadd; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 195 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 196 | lbs_deb_enter(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 197 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 198 | memcpy(priv->current_addr, macadd->macadd, ETH_ALEN); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 199 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 200 | lbs_deb_enter(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 201 | return 0; | 
|  | 202 | } | 
|  | 203 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 204 | static int lbs_ret_802_11_rf_tx_power(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 205 | struct cmd_ds_command *resp) | 
|  | 206 | { | 
|  | 207 | struct cmd_ds_802_11_rf_tx_power *rtp = &resp->params.txp; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 208 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 209 | lbs_deb_enter(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 210 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 211 | priv->txpowerlevel = le16_to_cpu(rtp->currentlevel); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 212 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 213 | lbs_deb_cmd("TX power currently %d\n", priv->txpowerlevel); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 214 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 215 | lbs_deb_leave(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 216 | return 0; | 
|  | 217 | } | 
|  | 218 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 219 | static int lbs_ret_802_11_rate_adapt_rateset(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 220 | struct cmd_ds_command *resp) | 
|  | 221 | { | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 222 | struct cmd_ds_802_11_rate_adapt_rateset *rates = &resp->params.rateset; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 223 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 224 | lbs_deb_enter(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 225 |  | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 226 | if (rates->action == CMD_ACT_GET) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 227 | priv->enablehwauto = le16_to_cpu(rates->enablehwauto); | 
|  | 228 | priv->ratebitmap = le16_to_cpu(rates->bitmap); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 229 | } | 
|  | 230 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 231 | lbs_deb_leave(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 232 | return 0; | 
|  | 233 | } | 
|  | 234 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 235 | static int lbs_ret_802_11_rssi(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 236 | struct cmd_ds_command *resp) | 
|  | 237 | { | 
|  | 238 | struct cmd_ds_802_11_rssi_rsp *rssirsp = &resp->params.rssirsp; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 239 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 240 | lbs_deb_enter(LBS_DEB_CMD); | 
|  | 241 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 242 | /* store the non average value */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 243 | priv->SNR[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->SNR); | 
|  | 244 | priv->NF[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->noisefloor); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 245 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 246 | priv->SNR[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgSNR); | 
|  | 247 | priv->NF[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgnoisefloor); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 248 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 249 | priv->RSSI[TYPE_BEACON][TYPE_NOAVG] = | 
|  | 250 | CAL_RSSI(priv->SNR[TYPE_BEACON][TYPE_NOAVG], | 
|  | 251 | priv->NF[TYPE_BEACON][TYPE_NOAVG]); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 252 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 253 | 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 Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 256 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 257 | lbs_deb_cmd("RSSI: beacon %d, avg %d\n", | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 258 | priv->RSSI[TYPE_BEACON][TYPE_NOAVG], | 
|  | 259 | priv->RSSI[TYPE_BEACON][TYPE_AVG]); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 260 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 261 | lbs_deb_leave(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 262 | return 0; | 
|  | 263 | } | 
|  | 264 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 265 | static int lbs_ret_802_11_eeprom_access(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 266 | struct cmd_ds_command *resp) | 
|  | 267 | { | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 268 | struct lbs_ioctl_regrdwr *pbuf; | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 269 | pbuf = (struct lbs_ioctl_regrdwr *) priv->prdeeprom; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 270 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 271 | lbs_deb_enter_args(LBS_DEB_CMD, "len %d", | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 272 | le16_to_cpu(resp->params.rdeeprom.bytecount)); | 
|  | 273 | if (pbuf->NOB < le16_to_cpu(resp->params.rdeeprom.bytecount)) { | 
|  | 274 | pbuf->NOB = 0; | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 275 | lbs_deb_cmd("EEPROM read length too big\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 276 | 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 Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 283 | lbs_deb_hex(LBS_DEB_CMD, "EEPROM", (char *)&pbuf->value, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 284 | le16_to_cpu(resp->params.rdeeprom.bytecount)); | 
|  | 285 | } | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 286 | lbs_deb_leave(LBS_DEB_CMD); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 287 | return 0; | 
|  | 288 | } | 
|  | 289 |  | 
| Brajesh Dave | 96287ac | 2007-11-20 17:44:28 -0500 | [diff] [blame] | 290 | static 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 Dave | 96287ac | 2007-11-20 17:44:28 -0500 | [diff] [blame] | 295 |  | 
|  | 296 | lbs_deb_enter(LBS_DEB_CMD); | 
|  | 297 |  | 
|  | 298 | if (bcn_ctrl->action == CMD_ACT_GET) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 299 | priv->beacon_enable = (u8) le16_to_cpu(bcn_ctrl->beacon_enable); | 
|  | 300 | priv->beacon_period = le16_to_cpu(bcn_ctrl->beacon_period); | 
| Brajesh Dave | 96287ac | 2007-11-20 17:44:28 -0500 | [diff] [blame] | 301 | } | 
|  | 302 |  | 
|  | 303 | lbs_deb_enter(LBS_DEB_CMD); | 
|  | 304 | return 0; | 
|  | 305 | } | 
|  | 306 |  | 
| David Woodhouse | 1309b55 | 2007-12-10 13:36:10 -0500 | [diff] [blame] | 307 | static inline int handle_cmd_response(struct lbs_private *priv, | 
| Dan Williams | ddac452 | 2007-12-11 13:49:39 -0500 | [diff] [blame] | 308 | struct cmd_header *cmd_response) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 309 | { | 
| Dan Williams | ddac452 | 2007-12-11 13:49:39 -0500 | [diff] [blame] | 310 | struct cmd_ds_command *resp = (struct cmd_ds_command *) cmd_response; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 311 | int ret = 0; | 
|  | 312 | unsigned long flags; | 
| David Woodhouse | 1309b55 | 2007-12-10 13:36:10 -0500 | [diff] [blame] | 313 | uint16_t respcmd = le16_to_cpu(resp->command); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 314 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 315 | lbs_deb_enter(LBS_DEB_HOST); | 
|  | 316 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 317 | switch (respcmd) { | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 318 | case CMD_RET(CMD_MAC_REG_ACCESS): | 
|  | 319 | case CMD_RET(CMD_BBP_REG_ACCESS): | 
|  | 320 | case CMD_RET(CMD_RF_REG_ACCESS): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 321 | ret = lbs_ret_reg_access(priv, respcmd, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 322 | break; | 
|  | 323 |  | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 324 | case CMD_RET_802_11_ASSOCIATE: | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 325 | case CMD_RET(CMD_802_11_ASSOCIATE): | 
|  | 326 | case CMD_RET(CMD_802_11_REASSOCIATE): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 327 | ret = lbs_ret_80211_associate(priv, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 328 | break; | 
|  | 329 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 330 | case CMD_RET(CMD_802_11_DISASSOCIATE): | 
|  | 331 | case CMD_RET(CMD_802_11_DEAUTHENTICATE): | 
| Holger Schurig | e98a88d | 2008-03-19 14:25:58 +0100 | [diff] [blame] | 332 | ret = lbs_ret_80211_disassociate(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 333 | break; | 
|  | 334 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 335 | case CMD_RET(CMD_802_11_AD_HOC_START): | 
|  | 336 | case CMD_RET(CMD_802_11_AD_HOC_JOIN): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 337 | ret = lbs_ret_80211_ad_hoc_start(priv, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 338 | break; | 
|  | 339 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 340 | case CMD_RET(CMD_802_11_SNMP_MIB): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 341 | ret = lbs_ret_802_11_snmp_mib(priv, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 342 | break; | 
|  | 343 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 344 | case CMD_RET(CMD_802_11_RF_TX_POWER): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 345 | ret = lbs_ret_802_11_rf_tx_power(priv, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 346 | break; | 
|  | 347 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 348 | case CMD_RET(CMD_802_11_SET_AFC): | 
|  | 349 | case CMD_RET(CMD_802_11_GET_AFC): | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 350 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| David Woodhouse | 7556767 | 2007-12-15 02:38:17 -0500 | [diff] [blame] | 351 | memmove((void *)priv->cur_cmd->callback_arg, &resp->params.afc, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 352 | sizeof(struct cmd_ds_802_11_afc)); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 353 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 354 |  | 
|  | 355 | break; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 356 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 357 | case CMD_RET(CMD_MAC_MULTICAST_ADR): | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 358 | case CMD_RET(CMD_802_11_RESET): | 
|  | 359 | case CMD_RET(CMD_802_11_AUTHENTICATE): | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 360 | case CMD_RET(CMD_802_11_BEACON_STOP): | 
| Dan Williams | 18c96c34 | 2007-06-18 12:01:12 -0400 | [diff] [blame] | 361 | break; | 
|  | 362 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 363 | case CMD_RET(CMD_802_11_RATE_ADAPT_RATESET): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 364 | ret = lbs_ret_802_11_rate_adapt_rateset(priv, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 365 | break; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 366 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 367 | case CMD_RET(CMD_802_11_RSSI): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 368 | ret = lbs_ret_802_11_rssi(priv, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 369 | break; | 
|  | 370 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 371 | case CMD_RET(CMD_802_11_MAC_ADDRESS): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 372 | ret = lbs_ret_802_11_mac_address(priv, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 373 | break; | 
|  | 374 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 375 | case CMD_RET(CMD_802_11_AD_HOC_STOP): | 
| Holger Schurig | e98a88d | 2008-03-19 14:25:58 +0100 | [diff] [blame] | 376 | ret = lbs_ret_80211_ad_hoc_stop(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 377 | break; | 
|  | 378 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 379 | case CMD_RET(CMD_802_11_EEPROM_ACCESS): | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 380 | ret = lbs_ret_802_11_eeprom_access(priv, resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 381 | break; | 
|  | 382 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 383 | case CMD_RET(CMD_802_11D_DOMAIN_INFO): | 
| Holger Schurig | e98a88d | 2008-03-19 14:25:58 +0100 | [diff] [blame] | 384 | ret = lbs_ret_802_11d_domain_info(resp); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 385 | break; | 
|  | 386 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 387 | case CMD_RET(CMD_802_11_TPC_CFG): | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 388 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| David Woodhouse | 7556767 | 2007-12-15 02:38:17 -0500 | [diff] [blame] | 389 | memmove((void *)priv->cur_cmd->callback_arg, &resp->params.tpccfg, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 390 | sizeof(struct cmd_ds_802_11_tpc_cfg)); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 391 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 392 | break; | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 393 | case CMD_RET(CMD_802_11_LED_GPIO_CTRL): | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 394 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| David Woodhouse | 7556767 | 2007-12-15 02:38:17 -0500 | [diff] [blame] | 395 | memmove((void *)priv->cur_cmd->callback_arg, &resp->params.ledgpio, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 396 | sizeof(struct cmd_ds_802_11_led_ctrl)); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 397 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 398 | break; | 
| Holger Schurig | 3a18864 | 2007-11-26 10:07:14 +0100 | [diff] [blame] | 399 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 400 | case CMD_RET(CMD_GET_TSF): | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 401 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| David Woodhouse | 7556767 | 2007-12-15 02:38:17 -0500 | [diff] [blame] | 402 | memcpy((void *)priv->cur_cmd->callback_arg, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 403 | &resp->params.gettsf.tsfvalue, sizeof(u64)); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 404 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 405 | break; | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 406 | case CMD_RET(CMD_BT_ACCESS): | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 407 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| David Woodhouse | 7556767 | 2007-12-15 02:38:17 -0500 | [diff] [blame] | 408 | if (priv->cur_cmd->callback_arg) | 
|  | 409 | memcpy((void *)priv->cur_cmd->callback_arg, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 410 | &resp->params.bt.addr1, 2 * ETH_ALEN); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 411 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 412 | break; | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 413 | case CMD_RET(CMD_FWT_ACCESS): | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 414 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| David Woodhouse | 7556767 | 2007-12-15 02:38:17 -0500 | [diff] [blame] | 415 | if (priv->cur_cmd->callback_arg) | 
|  | 416 | memcpy((void *)priv->cur_cmd->callback_arg, &resp->params.fwt, | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 417 | sizeof(resp->params.fwt)); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 418 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 419 | break; | 
| Brajesh Dave | 96287ac | 2007-11-20 17:44:28 -0500 | [diff] [blame] | 420 | case CMD_RET(CMD_802_11_BEACON_CTRL): | 
|  | 421 | ret = lbs_ret_802_11_bcn_ctrl(priv, resp); | 
|  | 422 | break; | 
|  | 423 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 424 | default: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 425 | lbs_deb_host("CMD_RESP: unknown cmd response 0x%04x\n", | 
| David Woodhouse | e125817 | 2007-12-11 23:42:49 -0500 | [diff] [blame] | 426 | le16_to_cpu(resp->command)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 427 | break; | 
|  | 428 | } | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 429 | lbs_deb_leave(LBS_DEB_HOST); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 430 | return ret; | 
|  | 431 | } | 
|  | 432 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 433 | int lbs_process_rx_command(struct lbs_private *priv) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 434 | { | 
| David Woodhouse | e125817 | 2007-12-11 23:42:49 -0500 | [diff] [blame] | 435 | uint16_t respcmd, curcmd; | 
| Dan Williams | ddac452 | 2007-12-11 13:49:39 -0500 | [diff] [blame] | 436 | struct cmd_header *resp; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 437 | int ret = 0; | 
| David Woodhouse | e125817 | 2007-12-11 23:42:49 -0500 | [diff] [blame] | 438 | unsigned long flags; | 
|  | 439 | uint16_t result; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 440 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 441 | lbs_deb_enter(LBS_DEB_HOST); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 442 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 443 | mutex_lock(&priv->lock); | 
|  | 444 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 445 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 446 | if (!priv->cur_cmd) { | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 447 | lbs_deb_host("CMD_RESP: cur_cmd is NULL\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 448 | ret = -1; | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 449 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 450 | goto done; | 
|  | 451 | } | 
| David Woodhouse | e125817 | 2007-12-11 23:42:49 -0500 | [diff] [blame] | 452 |  | 
| David Woodhouse | 7003b07 | 2007-12-17 15:22:43 -0500 | [diff] [blame] | 453 | resp = (void *)priv->upld_buf; | 
| Sebastian Siewior | 8a96df8 | 2008-03-04 18:22:27 +0100 | [diff] [blame] | 454 | curcmd = le16_to_cpu(priv->cur_cmd->cmdbuf->command); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 455 | respcmd = le16_to_cpu(resp->command); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 456 | result = le16_to_cpu(resp->result); | 
|  | 457 |  | 
| Holger Schurig | e5225b3 | 2008-03-26 10:04:44 +0100 | [diff] [blame] | 458 | lbs_deb_cmd("CMD_RESP: response 0x%04x, seq %d, size %d\n", | 
|  | 459 | respcmd, le16_to_cpu(resp->seqnum), priv->upld_len); | 
| Holger Schurig | 1afc09ab | 2008-01-29 09:14:40 +0100 | [diff] [blame] | 460 | lbs_deb_hex(LBS_DEB_CMD, "CMD_RESP", (void *) resp, priv->upld_len); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 461 |  | 
| David Woodhouse | 6305f49 | 2008-03-03 12:20:12 +0100 | [diff] [blame] | 462 | if (resp->seqnum != priv->cur_cmd->cmdbuf->seqnum) { | 
| David Woodhouse | e125817 | 2007-12-11 23:42:49 -0500 | [diff] [blame] | 463 | lbs_pr_info("Received CMD_RESP with invalid sequence %d (expected %d)\n", | 
| David Woodhouse | 6305f49 | 2008-03-03 12:20:12 +0100 | [diff] [blame] | 464 | le16_to_cpu(resp->seqnum), le16_to_cpu(priv->cur_cmd->cmdbuf->seqnum)); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 465 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 466 | ret = -1; | 
|  | 467 | goto done; | 
|  | 468 | } | 
| David Woodhouse | e125817 | 2007-12-11 23:42:49 -0500 | [diff] [blame] | 469 | if (respcmd != CMD_RET(curcmd) && | 
| Sebastian Siewior | 5f0547c | 2008-03-06 10:30:21 +0100 | [diff] [blame] | 470 | respcmd != CMD_RET_802_11_ASSOCIATE && curcmd != CMD_802_11_ASSOCIATE) { | 
| David Woodhouse | e125817 | 2007-12-11 23:42:49 -0500 | [diff] [blame] | 471 | lbs_pr_info("Invalid CMD_RESP %x to command %x!\n", respcmd, curcmd); | 
|  | 472 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
|  | 473 | ret = -1; | 
|  | 474 | goto done; | 
|  | 475 | } | 
|  | 476 |  | 
| David Woodhouse | 8538823 | 2007-12-17 15:41:30 -0500 | [diff] [blame] | 477 | if (resp->result == cpu_to_le16(0x0004)) { | 
|  | 478 | /* 0x0004 means -EAGAIN. Drop the response, let it time out | 
|  | 479 | and be resubmitted */ | 
|  | 480 | lbs_pr_info("Firmware returns DEFER to command %x. Will let it time out...\n", | 
|  | 481 | le16_to_cpu(resp->command)); | 
|  | 482 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
|  | 483 | ret = -1; | 
|  | 484 | goto done; | 
|  | 485 | } | 
|  | 486 |  | 
| David Woodhouse | e125817 | 2007-12-11 23:42:49 -0500 | [diff] [blame] | 487 | /* Now we got response from FW, cancel the command timer */ | 
|  | 488 | del_timer(&priv->command_timer); | 
| David Woodhouse | 2a34509 | 2007-12-15 19:33:43 -0500 | [diff] [blame] | 489 | priv->cmd_timed_out = 0; | 
|  | 490 | if (priv->nr_retries) { | 
|  | 491 | lbs_pr_info("Received result %x to command %x after %d retries\n", | 
|  | 492 | result, curcmd, priv->nr_retries); | 
|  | 493 | priv->nr_retries = 0; | 
|  | 494 | } | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 495 |  | 
|  | 496 | /* Store the response code to cur_cmd_retcode. */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 497 | priv->cur_cmd_retcode = result; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 498 |  | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 499 | if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) { | 
| David Woodhouse | 38bfab1 | 2007-12-16 23:26:54 -0500 | [diff] [blame] | 500 | struct cmd_ds_802_11_ps_mode *psmode = (void *) &resp[1]; | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 501 | u16 action = le16_to_cpu(psmode->action); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 502 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 503 | lbs_deb_host( | 
|  | 504 | "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n", | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 505 | result, action); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 506 |  | 
|  | 507 | if (result) { | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 508 | lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n", | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 509 | result); | 
|  | 510 | /* | 
|  | 511 | * We should not re-try enter-ps command in | 
|  | 512 | * ad-hoc mode. It takes place in | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 513 | * lbs_execute_next_command(). | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 514 | */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 515 | if (priv->mode == IW_MODE_ADHOC && | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 516 | action == CMD_SUBCMD_ENTER_PS) | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 517 | priv->psmode = LBS802_11POWERMODECAM; | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 518 | } else if (action == CMD_SUBCMD_ENTER_PS) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 519 | priv->needtowakeup = 0; | 
|  | 520 | priv->psstate = PS_STATE_AWAKE; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 521 |  | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 522 | lbs_deb_host("CMD_RESP: ENTER_PS command response\n"); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 523 | if (priv->connect_status != LBS_CONNECTED) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 524 | /* | 
|  | 525 | * When Deauth Event received before Enter_PS command | 
|  | 526 | * response, We need to wake up the firmware. | 
|  | 527 | */ | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 528 | lbs_deb_host( | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 529 | "disconnected, invoking lbs_ps_wakeup\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 530 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 531 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
|  | 532 | mutex_unlock(&priv->lock); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 533 | lbs_ps_wakeup(priv, 0); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 534 | mutex_lock(&priv->lock); | 
|  | 535 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 536 | } | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 537 | } else if (action == CMD_SUBCMD_EXIT_PS) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 538 | priv->needtowakeup = 0; | 
|  | 539 | priv->psstate = PS_STATE_FULL_POWER; | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 540 | lbs_deb_host("CMD_RESP: EXIT_PS command response\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 541 | } else { | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 542 | lbs_deb_host("CMD_RESP: PS action 0x%X\n", action); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 543 | } | 
|  | 544 |  | 
| David Woodhouse | 183aeac | 2007-12-15 01:52:54 -0500 | [diff] [blame] | 545 | lbs_complete_command(priv, priv->cur_cmd, result); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 546 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 547 |  | 
|  | 548 | ret = 0; | 
|  | 549 | goto done; | 
|  | 550 | } | 
|  | 551 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 552 | /* If the command is not successful, cleanup and return failure */ | 
|  | 553 | if ((result != 0 || !(respcmd & 0x8000))) { | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 554 | lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n", | 
|  | 555 | result, respcmd); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 556 | /* | 
|  | 557 | * Handling errors here | 
|  | 558 | */ | 
|  | 559 | switch (respcmd) { | 
| Holger Schurig | 6b63cd0 | 2007-08-02 11:53:36 -0400 | [diff] [blame] | 560 | case CMD_RET(CMD_GET_HW_SPEC): | 
|  | 561 | case CMD_RET(CMD_802_11_RESET): | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 562 | lbs_deb_host("CMD_RESP: reset failed\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 563 | break; | 
|  | 564 |  | 
|  | 565 | } | 
| David Woodhouse | 183aeac | 2007-12-15 01:52:54 -0500 | [diff] [blame] | 566 | lbs_complete_command(priv, priv->cur_cmd, result); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 567 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 568 |  | 
|  | 569 | ret = -1; | 
|  | 570 | goto done; | 
|  | 571 | } | 
|  | 572 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 573 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| David Woodhouse | 1723047 | 2007-12-07 15:13:05 +0000 | [diff] [blame] | 574 |  | 
| Dan Williams | 7ad994d | 2007-12-11 12:33:30 -0500 | [diff] [blame] | 575 | if (priv->cur_cmd && priv->cur_cmd->callback) { | 
|  | 576 | ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg, | 
| Dan Williams | ddac452 | 2007-12-11 13:49:39 -0500 | [diff] [blame] | 577 | resp); | 
| Dan Williams | 7ad994d | 2007-12-11 12:33:30 -0500 | [diff] [blame] | 578 | } else | 
| Holger Schurig | e98a88d | 2008-03-19 14:25:58 +0100 | [diff] [blame] | 579 | ret = handle_cmd_response(priv, resp); | 
| David Woodhouse | 1723047 | 2007-12-07 15:13:05 +0000 | [diff] [blame] | 580 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 581 | spin_lock_irqsave(&priv->driver_lock, flags); | 
| David Woodhouse | 1723047 | 2007-12-07 15:13:05 +0000 | [diff] [blame] | 582 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 583 | if (priv->cur_cmd) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 584 | /* Clean up and Put current command back to cmdfreeq */ | 
| David Woodhouse | 183aeac | 2007-12-15 01:52:54 -0500 | [diff] [blame] | 585 | lbs_complete_command(priv, priv->cur_cmd, result); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 586 | } | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 587 | spin_unlock_irqrestore(&priv->driver_lock, flags); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 588 |  | 
|  | 589 | done: | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 590 | mutex_unlock(&priv->lock); | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 591 | lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 592 | return ret; | 
|  | 593 | } | 
|  | 594 |  | 
| David Woodhouse | b47ef24 | 2007-12-17 13:26:42 -0500 | [diff] [blame] | 595 | static int lbs_send_confirmwake(struct lbs_private *priv) | 
|  | 596 | { | 
|  | 597 | struct cmd_header *cmd = &priv->lbs_ps_confirm_wake; | 
|  | 598 | int ret = 0; | 
|  | 599 |  | 
|  | 600 | lbs_deb_enter(LBS_DEB_HOST); | 
|  | 601 |  | 
|  | 602 | cmd->command = cpu_to_le16(CMD_802_11_WAKEUP_CONFIRM); | 
|  | 603 | cmd->size = cpu_to_le16(sizeof(*cmd)); | 
|  | 604 | cmd->seqnum = cpu_to_le16(++priv->seqnum); | 
|  | 605 | cmd->result = 0; | 
|  | 606 |  | 
|  | 607 | lbs_deb_host("SEND_WAKEC_CMD: before download\n"); | 
|  | 608 |  | 
|  | 609 | lbs_deb_hex(LBS_DEB_HOST, "wake confirm command", (void *)cmd, sizeof(*cmd)); | 
|  | 610 |  | 
|  | 611 | ret = priv->hw_host_to_card(priv, MVMS_CMD, (void *)cmd, sizeof(*cmd)); | 
|  | 612 | if (ret) | 
|  | 613 | lbs_pr_alert("SEND_WAKEC_CMD: Host to Card failed for Confirm Wake\n"); | 
|  | 614 |  | 
|  | 615 | lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret); | 
|  | 616 | return ret; | 
|  | 617 | } | 
|  | 618 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 619 | int lbs_process_event(struct lbs_private *priv) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 620 | { | 
|  | 621 | int ret = 0; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 622 | u32 eventcause; | 
|  | 623 |  | 
| Holger Schurig | 9556d21 | 2007-08-02 13:14:07 -0400 | [diff] [blame] | 624 | lbs_deb_enter(LBS_DEB_CMD); | 
|  | 625 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 626 | spin_lock_irq(&priv->driver_lock); | 
|  | 627 | eventcause = priv->eventcause >> SBI_EVENT_CAUSE_SHIFT; | 
|  | 628 | spin_unlock_irq(&priv->driver_lock); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 629 |  | 
| Holger Schurig | 0b3c07f | 2007-11-28 09:15:11 +0100 | [diff] [blame] | 630 | switch (eventcause) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 631 | case MACREG_INT_CODE_LINK_SENSED: | 
| Holger Schurig | d4ff0ef | 2008-03-19 14:25:18 +0100 | [diff] [blame] | 632 | lbs_deb_cmd("EVENT: link sensed\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 633 | break; | 
|  | 634 |  | 
|  | 635 | case MACREG_INT_CODE_DEAUTHENTICATED: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 636 | lbs_deb_cmd("EVENT: deauthenticated\n"); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 637 | lbs_mac_event_disconnected(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 638 | break; | 
|  | 639 |  | 
|  | 640 | case MACREG_INT_CODE_DISASSOCIATED: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 641 | lbs_deb_cmd("EVENT: disassociated\n"); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 642 | lbs_mac_event_disconnected(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 643 | break; | 
|  | 644 |  | 
| Holger Schurig | 0b3c07f | 2007-11-28 09:15:11 +0100 | [diff] [blame] | 645 | case MACREG_INT_CODE_LINK_LOST_NO_SCAN: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 646 | lbs_deb_cmd("EVENT: link lost\n"); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 647 | lbs_mac_event_disconnected(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 648 | break; | 
|  | 649 |  | 
|  | 650 | case MACREG_INT_CODE_PS_SLEEP: | 
| Holger Schurig | d4ff0ef | 2008-03-19 14:25:18 +0100 | [diff] [blame] | 651 | lbs_deb_cmd("EVENT: ps sleep\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 652 |  | 
|  | 653 | /* handle unexpected PS SLEEP event */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 654 | if (priv->psstate == PS_STATE_FULL_POWER) { | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 655 | lbs_deb_cmd( | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 656 | "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 657 | break; | 
|  | 658 | } | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 659 | priv->psstate = PS_STATE_PRE_SLEEP; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 660 |  | 
| Holger Schurig | d4ff0ef | 2008-03-19 14:25:18 +0100 | [diff] [blame] | 661 | lbs_ps_confirm_sleep(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 662 |  | 
|  | 663 | break; | 
|  | 664 |  | 
| David Woodhouse | b47ef24 | 2007-12-17 13:26:42 -0500 | [diff] [blame] | 665 | case MACREG_INT_CODE_HOST_AWAKE: | 
| Holger Schurig | d4ff0ef | 2008-03-19 14:25:18 +0100 | [diff] [blame] | 666 | lbs_deb_cmd("EVENT: host awake\n"); | 
| David Woodhouse | b47ef24 | 2007-12-17 13:26:42 -0500 | [diff] [blame] | 667 | lbs_send_confirmwake(priv); | 
|  | 668 | break; | 
|  | 669 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 670 | case MACREG_INT_CODE_PS_AWAKE: | 
| Holger Schurig | d4ff0ef | 2008-03-19 14:25:18 +0100 | [diff] [blame] | 671 | lbs_deb_cmd("EVENT: ps awake\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 672 | /* handle unexpected PS AWAKE event */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 673 | if (priv->psstate == PS_STATE_FULL_POWER) { | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 674 | lbs_deb_cmd( | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 675 | "EVENT: In FULL POWER mode - ignore PS AWAKE\n"); | 
|  | 676 | break; | 
|  | 677 | } | 
|  | 678 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 679 | priv->psstate = PS_STATE_AWAKE; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 680 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 681 | if (priv->needtowakeup) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 682 | /* | 
|  | 683 | * wait for the command processing to finish | 
|  | 684 | * before resuming sending | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 685 | * priv->needtowakeup will be set to FALSE | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 686 | * in lbs_ps_wakeup() | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 687 | */ | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 688 | lbs_deb_cmd("waking up ...\n"); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 689 | lbs_ps_wakeup(priv, 0); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 690 | } | 
|  | 691 | break; | 
|  | 692 |  | 
|  | 693 | case MACREG_INT_CODE_MIC_ERR_UNICAST: | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 694 | lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 695 | handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_UNICAST); | 
|  | 696 | break; | 
|  | 697 |  | 
|  | 698 | case MACREG_INT_CODE_MIC_ERR_MULTICAST: | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 699 | lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 700 | handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_MULTICAST); | 
|  | 701 | break; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 702 |  | 
| Holger Schurig | d4ff0ef | 2008-03-19 14:25:18 +0100 | [diff] [blame] | 703 | case MACREG_INT_CODE_MIB_CHANGED: | 
|  | 704 | lbs_deb_cmd("EVENT: MIB CHANGED\n"); | 
|  | 705 | break; | 
|  | 706 | case MACREG_INT_CODE_INIT_DONE: | 
|  | 707 | lbs_deb_cmd("EVENT: INIT DONE\n"); | 
|  | 708 | break; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 709 | case MACREG_INT_CODE_ADHOC_BCN_LOST: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 710 | lbs_deb_cmd("EVENT: ADHOC beacon lost\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 711 | break; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 712 | case MACREG_INT_CODE_RSSI_LOW: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 713 | lbs_pr_alert("EVENT: rssi low\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 714 | break; | 
|  | 715 | case MACREG_INT_CODE_SNR_LOW: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 716 | lbs_pr_alert("EVENT: snr low\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 717 | break; | 
|  | 718 | case MACREG_INT_CODE_MAX_FAIL: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 719 | lbs_pr_alert("EVENT: max fail\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 720 | break; | 
|  | 721 | case MACREG_INT_CODE_RSSI_HIGH: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 722 | lbs_pr_alert("EVENT: rssi high\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 723 | break; | 
|  | 724 | case MACREG_INT_CODE_SNR_HIGH: | 
| Holger Schurig | a6c8700 | 2007-08-02 11:54:10 -0400 | [diff] [blame] | 725 | lbs_pr_alert("EVENT: snr high\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 726 | break; | 
|  | 727 |  | 
| Luis Carlos Cobo Rus | 7d8d28b | 2007-05-25 23:12:19 -0400 | [diff] [blame] | 728 | case MACREG_INT_CODE_MESH_AUTO_STARTED: | 
| Dan Williams | 5612c01 | 2007-08-02 13:20:12 -0400 | [diff] [blame] | 729 | /* Ignore spurious autostart events if autostart is disabled */ | 
|  | 730 | if (!priv->mesh_autostart_enabled) { | 
|  | 731 | lbs_pr_info("EVENT: MESH_AUTO_STARTED (ignoring)\n"); | 
|  | 732 | break; | 
|  | 733 | } | 
| Luis Carlos Cobo | 9cdc6d2 | 2007-08-02 11:55:22 -0400 | [diff] [blame] | 734 | lbs_pr_info("EVENT: MESH_AUTO_STARTED\n"); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 735 | priv->mesh_connect_status = LBS_CONNECTED; | 
| David Woodhouse | a27b9f9 | 2007-12-12 00:41:51 -0500 | [diff] [blame] | 736 | if (priv->mesh_open) { | 
| Luis Carlos Cobo | 9cdc6d2 | 2007-08-02 11:55:22 -0400 | [diff] [blame] | 737 | netif_carrier_on(priv->mesh_dev); | 
| David Woodhouse | a27b9f9 | 2007-12-12 00:41:51 -0500 | [diff] [blame] | 738 | if (!priv->tx_pending_len) | 
|  | 739 | netif_wake_queue(priv->mesh_dev); | 
| Luis Carlos Cobo Rus | 7d8d28b | 2007-05-25 23:12:19 -0400 | [diff] [blame] | 740 | } | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 741 | priv->mode = IW_MODE_ADHOC; | 
| Luis Carlos Cobo Rus | b8bedef | 2007-05-30 12:14:34 -0400 | [diff] [blame] | 742 | schedule_work(&priv->sync_channel); | 
| Luis Carlos Cobo Rus | 7d8d28b | 2007-05-25 23:12:19 -0400 | [diff] [blame] | 743 | break; | 
|  | 744 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 745 | default: | 
| Holger Schurig | 0b3c07f | 2007-11-28 09:15:11 +0100 | [diff] [blame] | 746 | lbs_pr_alert("EVENT: unknown event id %d\n", eventcause); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 747 | break; | 
|  | 748 | } | 
|  | 749 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 750 | spin_lock_irq(&priv->driver_lock); | 
|  | 751 | priv->eventcause = 0; | 
|  | 752 | spin_unlock_irq(&priv->driver_lock); | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 753 |  | 
| Holger Schurig | 9556d21 | 2007-08-02 13:14:07 -0400 | [diff] [blame] | 754 | lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 755 | return ret; | 
|  | 756 | } |