blob: b3c1acbcc655103fe898157dcbb70078d267db6d [file] [log] [blame]
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001/**
2 * This file contains the handling of command.
3 * It prepares command and sends it to firmware when it is ready.
4 */
5
6#include <net/iw_handler.h>
7#include "host.h"
8#include "hostcmd.h"
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02009#include "decl.h"
10#include "defs.h"
11#include "dev.h"
12#include "join.h"
13#include "wext.h"
Dan Williams6e66f032007-12-11 12:42:16 -050014#include "cmd.h"
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020015
David Woodhouse2fd6cfe2007-12-11 17:44:10 -050016static struct cmd_ctrl_node *lbs_get_cmd_ctrl_node(struct lbs_private *priv);
17static void lbs_set_cmd_ctrl_node(struct lbs_private *priv,
Holger Schurig0d61d042007-12-05 17:58:06 +010018 struct cmd_ctrl_node *ptempnode,
David Woodhouse8e5b6b2d2007-12-14 23:08:13 -050019 void *pdata_buf);
Holger Schurig0d61d042007-12-05 17:58:06 +010020
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020021
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020022/**
Dan Williams852e1f22007-12-10 15:24:47 -050023 * @brief Checks whether a command is allowed in Power Save mode
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020024 *
25 * @param command the command ID
Dan Williams852e1f22007-12-10 15:24:47 -050026 * @return 1 if allowed, 0 if not allowed
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020027 */
Dan Williams852e1f22007-12-10 15:24:47 -050028static u8 is_command_allowed_in_ps(u16 cmd)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020029{
Dan Williams852e1f22007-12-10 15:24:47 -050030 switch (cmd) {
31 case CMD_802_11_RSSI:
32 return 1;
33 default:
34 break;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020035 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020036 return 0;
37}
38
Dan Williams6e66f032007-12-11 12:42:16 -050039/**
40 * @brief Updates the hardware details like MAC address and regulatory region
41 *
42 * @param priv A pointer to struct lbs_private structure
43 *
44 * @return 0 on success, error on failure
45 */
46int lbs_update_hw_spec(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020047{
Dan Williams6e66f032007-12-11 12:42:16 -050048 struct cmd_ds_get_hw_spec cmd;
49 int ret = -1;
50 u32 i;
51 DECLARE_MAC_BUF(mac);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020052
Holger Schurig9012b282007-05-25 11:27:16 -040053 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020054
Dan Williams6e66f032007-12-11 12:42:16 -050055 memset(&cmd, 0, sizeof(cmd));
56 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
57 memcpy(cmd.permanentaddr, priv->current_addr, ETH_ALEN);
David Woodhouse689442d2007-12-12 16:00:42 -050058 ret = lbs_cmd_with_response(priv, CMD_GET_HW_SPEC, &cmd);
Dan Williams6e66f032007-12-11 12:42:16 -050059 if (ret)
60 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020061
Dan Williams6e66f032007-12-11 12:42:16 -050062 priv->fwcapinfo = le32_to_cpu(cmd.fwcapinfo);
Dan Williams6e66f032007-12-11 12:42:16 -050063
Holger Schurigdac10a92008-01-16 15:55:22 +010064 /* The firmware release is in an interesting format: the patch
65 * level is in the most significant nibble ... so fix that: */
66 priv->fwrelease = le32_to_cpu(cmd.fwrelease);
67 priv->fwrelease = (priv->fwrelease << 8) |
68 (priv->fwrelease >> 24 & 0xff);
69
70 /* Some firmware capabilities:
71 * CF card firmware 5.0.16p0: cap 0x00000303
72 * USB dongle firmware 5.110.17p2: cap 0x00000303
73 */
74 printk("libertas: %s, fw %u.%u.%up%u, cap 0x%08x\n",
75 print_mac(mac, cmd.permanentaddr),
76 priv->fwrelease >> 24 & 0xff,
77 priv->fwrelease >> 16 & 0xff,
78 priv->fwrelease >> 8 & 0xff,
79 priv->fwrelease & 0xff,
80 priv->fwcapinfo);
Dan Williams6e66f032007-12-11 12:42:16 -050081 lbs_deb_cmd("GET_HW_SPEC: hardware interface 0x%x, hardware spec 0x%04x\n",
82 cmd.hwifversion, cmd.version);
83
84 /* Clamp region code to 8-bit since FW spec indicates that it should
85 * only ever be 8-bit, even though the field size is 16-bit. Some firmware
86 * returns non-zero high 8 bits here.
87 */
88 priv->regioncode = le16_to_cpu(cmd.regioncode) & 0xFF;
89
90 for (i = 0; i < MRVDRV_MAX_REGION_CODE; i++) {
91 /* use the region code to search for the index */
92 if (priv->regioncode == lbs_region_code_to_index[i])
93 break;
94 }
95
96 /* if it's unidentified region code, use the default (USA) */
97 if (i >= MRVDRV_MAX_REGION_CODE) {
98 priv->regioncode = 0x10;
99 lbs_pr_info("unidentified region code; using the default (USA)\n");
100 }
101
102 if (priv->current_addr[0] == 0xff)
103 memmove(priv->current_addr, cmd.permanentaddr, ETH_ALEN);
104
105 memcpy(priv->dev->dev_addr, priv->current_addr, ETH_ALEN);
106 if (priv->mesh_dev)
107 memcpy(priv->mesh_dev->dev_addr, priv->current_addr, ETH_ALEN);
108
109 if (lbs_set_regiontable(priv, priv->regioncode, 0)) {
110 ret = -1;
111 goto out;
112 }
113
114 if (lbs_set_universaltable(priv, 0)) {
115 ret = -1;
116 goto out;
117 }
118
119out:
Holger Schurig9012b282007-05-25 11:27:16 -0400120 lbs_deb_leave(LBS_DEB_CMD);
Dan Williams6e66f032007-12-11 12:42:16 -0500121 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200122}
123
David Woodhouse506e9022007-12-12 20:06:06 -0500124int lbs_host_sleep_cfg(struct lbs_private *priv, uint32_t criteria)
David Woodhouse6ce4fd22007-12-12 15:19:29 -0500125{
126 struct cmd_ds_host_sleep cmd_config;
127 int ret;
128
David Woodhouse9fae8992007-12-15 03:46:44 -0500129 cmd_config.hdr.size = cpu_to_le16(sizeof(cmd_config));
David Woodhouse6ce4fd22007-12-12 15:19:29 -0500130 cmd_config.criteria = cpu_to_le32(criteria);
David Woodhouse506e9022007-12-12 20:06:06 -0500131 cmd_config.gpio = priv->wol_gpio;
132 cmd_config.gap = priv->wol_gap;
David Woodhouse6ce4fd22007-12-12 15:19:29 -0500133
David Woodhouse689442d2007-12-12 16:00:42 -0500134 ret = lbs_cmd_with_response(priv, CMD_802_11_HOST_SLEEP_CFG, &cmd_config);
David Woodhouse506e9022007-12-12 20:06:06 -0500135 if (!ret) {
136 lbs_deb_cmd("Set WOL criteria to %x\n", criteria);
137 priv->wol_criteria = criteria;
138 } else {
David Woodhouse6ce4fd22007-12-12 15:19:29 -0500139 lbs_pr_info("HOST_SLEEP_CFG failed %d\n", ret);
David Woodhouse6ce4fd22007-12-12 15:19:29 -0500140 }
David Woodhouse506e9022007-12-12 20:06:06 -0500141
David Woodhouse6ce4fd22007-12-12 15:19:29 -0500142 return ret;
143}
144EXPORT_SYMBOL_GPL(lbs_host_sleep_cfg);
145
Holger Schurig69f90322007-11-23 15:43:44 +0100146static int lbs_cmd_802_11_ps_mode(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200147 struct cmd_ds_command *cmd,
148 u16 cmd_action)
149{
150 struct cmd_ds_802_11_ps_mode *psm = &cmd->params.psmode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200151
Holger Schurig9012b282007-05-25 11:27:16 -0400152 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200153
Dan Williams0aef64d2007-08-02 11:31:18 -0400154 cmd->command = cpu_to_le16(CMD_802_11_PS_MODE);
David Woodhouse981f1872007-05-25 23:36:54 -0400155 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_802_11_ps_mode) +
156 S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200157 psm->action = cpu_to_le16(cmd_action);
158 psm->multipledtim = 0;
David Woodhouse981f1872007-05-25 23:36:54 -0400159 switch (cmd_action) {
Dan Williams0aef64d2007-08-02 11:31:18 -0400160 case CMD_SUBCMD_ENTER_PS:
Holger Schurig9012b282007-05-25 11:27:16 -0400161 lbs_deb_cmd("PS command:" "SubCode- Enter PS\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200162
Holger Schurig252cf0d2007-08-02 13:09:34 -0400163 psm->locallisteninterval = 0;
Holger Schurig97605c32007-08-02 13:09:15 -0400164 psm->nullpktinterval = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200165 psm->multipledtim =
Holger Schurig56c46562007-08-02 13:09:49 -0400166 cpu_to_le16(MRVDRV_DEFAULT_MULTIPLE_DTIM);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200167 break;
168
Dan Williams0aef64d2007-08-02 11:31:18 -0400169 case CMD_SUBCMD_EXIT_PS:
Holger Schurig9012b282007-05-25 11:27:16 -0400170 lbs_deb_cmd("PS command:" "SubCode- Exit PS\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200171 break;
172
Dan Williams0aef64d2007-08-02 11:31:18 -0400173 case CMD_SUBCMD_SLEEP_CONFIRMED:
Holger Schurig9012b282007-05-25 11:27:16 -0400174 lbs_deb_cmd("PS command: SubCode- sleep confirm\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200175 break;
176
177 default:
178 break;
179 }
180
Holger Schurig9012b282007-05-25 11:27:16 -0400181 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200182 return 0;
183}
184
David Woodhouse6e5cc4f2007-12-17 23:04:37 -0500185int lbs_cmd_802_11_inactivity_timeout(struct lbs_private *priv,
186 uint16_t cmd_action, uint16_t *timeout)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200187{
David Woodhouse6e5cc4f2007-12-17 23:04:37 -0500188 struct cmd_ds_802_11_inactivity_timeout cmd;
189 int ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200190
Holger Schurig8ff12da2007-08-02 11:54:31 -0400191 lbs_deb_enter(LBS_DEB_CMD);
192
David Woodhouse6e5cc4f2007-12-17 23:04:37 -0500193 cmd.hdr.command = cpu_to_le16(CMD_802_11_INACTIVITY_TIMEOUT);
194 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200195
David Woodhouse6e5cc4f2007-12-17 23:04:37 -0500196 cmd.action = cpu_to_le16(cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200197
David Woodhouse6e5cc4f2007-12-17 23:04:37 -0500198 if (cmd_action == CMD_ACT_SET)
199 cmd.timeout = cpu_to_le16(*timeout);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200200 else
David Woodhouse6e5cc4f2007-12-17 23:04:37 -0500201 cmd.timeout = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200202
David Woodhouse6e5cc4f2007-12-17 23:04:37 -0500203 ret = lbs_cmd_with_response(priv, CMD_802_11_INACTIVITY_TIMEOUT, &cmd);
204
205 if (!ret)
206 *timeout = le16_to_cpu(cmd.timeout);
207
208 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200209 return 0;
210}
211
David Woodhouse3fbe1042007-12-17 23:48:31 -0500212int lbs_cmd_802_11_sleep_params(struct lbs_private *priv, uint16_t cmd_action,
213 struct sleep_params *sp)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200214{
David Woodhouse3fbe1042007-12-17 23:48:31 -0500215 struct cmd_ds_802_11_sleep_params cmd;
216 int ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200217
Holger Schurig9012b282007-05-25 11:27:16 -0400218 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200219
Dan Williams0aef64d2007-08-02 11:31:18 -0400220 if (cmd_action == CMD_ACT_GET) {
David Woodhouse3fbe1042007-12-17 23:48:31 -0500221 memset(&cmd, 0, sizeof(cmd));
222 } else {
223 cmd.error = cpu_to_le16(sp->sp_error);
224 cmd.offset = cpu_to_le16(sp->sp_offset);
225 cmd.stabletime = cpu_to_le16(sp->sp_stabletime);
226 cmd.calcontrol = sp->sp_calcontrol;
227 cmd.externalsleepclk = sp->sp_extsleepclk;
228 cmd.reserved = cpu_to_le16(sp->sp_reserved);
229 }
230 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
231 cmd.action = cpu_to_le16(cmd_action);
232
233 ret = lbs_cmd_with_response(priv, CMD_802_11_SLEEP_PARAMS, &cmd);
234
235 if (!ret) {
236 lbs_deb_cmd("error 0x%x, offset 0x%x, stabletime 0x%x, "
237 "calcontrol 0x%x extsleepclk 0x%x\n",
238 le16_to_cpu(cmd.error), le16_to_cpu(cmd.offset),
239 le16_to_cpu(cmd.stabletime), cmd.calcontrol,
240 cmd.externalsleepclk);
241
242 sp->sp_error = le16_to_cpu(cmd.error);
243 sp->sp_offset = le16_to_cpu(cmd.offset);
244 sp->sp_stabletime = le16_to_cpu(cmd.stabletime);
245 sp->sp_calcontrol = cmd.calcontrol;
246 sp->sp_extsleepclk = cmd.externalsleepclk;
247 sp->sp_reserved = le16_to_cpu(cmd.reserved);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200248 }
249
David Woodhouse3fbe1042007-12-17 23:48:31 -0500250 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200251 return 0;
252}
253
David Woodhousef70dd452007-12-18 00:18:05 -0500254int lbs_cmd_802_11_set_wep(struct lbs_private *priv, uint16_t cmd_action,
255 struct assoc_request *assoc)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200256{
David Woodhousef70dd452007-12-18 00:18:05 -0500257 struct cmd_ds_802_11_set_wep cmd;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200258 int ret = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200259
Holger Schurig9012b282007-05-25 11:27:16 -0400260 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200261
David Woodhousef70dd452007-12-18 00:18:05 -0500262 cmd.hdr.command = cpu_to_le16(CMD_802_11_SET_WEP);
263 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200264
David Woodhousef70dd452007-12-18 00:18:05 -0500265 cmd.action = cpu_to_le16(cmd_action);
266
267 if (cmd_action == CMD_ACT_ADD) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200268 int i;
269
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200270 /* default tx key index */
David Woodhousef70dd452007-12-18 00:18:05 -0500271 cmd.keyindex = cpu_to_le16(assoc->wep_tx_keyidx &
272 CMD_WEP_KEY_INDEX_MASK);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200273
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200274 /* Copy key types and material to host command structure */
275 for (i = 0; i < 4; i++) {
David Woodhousef70dd452007-12-18 00:18:05 -0500276 struct enc_key *pkey = &assoc->wep_keys[i];
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200277
278 switch (pkey->len) {
279 case KEY_LEN_WEP_40:
David Woodhousef70dd452007-12-18 00:18:05 -0500280 cmd.keytype[i] = CMD_TYPE_WEP_40_BIT;
281 memmove(cmd.keymaterial[i], pkey->key, pkey->len);
Holger Schurig8ff12da2007-08-02 11:54:31 -0400282 lbs_deb_cmd("SET_WEP: add key %d (40 bit)\n", i);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200283 break;
284 case KEY_LEN_WEP_104:
David Woodhousef70dd452007-12-18 00:18:05 -0500285 cmd.keytype[i] = CMD_TYPE_WEP_104_BIT;
286 memmove(cmd.keymaterial[i], pkey->key, pkey->len);
Holger Schurig8ff12da2007-08-02 11:54:31 -0400287 lbs_deb_cmd("SET_WEP: add key %d (104 bit)\n", i);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200288 break;
289 case 0:
290 break;
291 default:
Holger Schurig8ff12da2007-08-02 11:54:31 -0400292 lbs_deb_cmd("SET_WEP: invalid key %d, length %d\n",
David Woodhousef70dd452007-12-18 00:18:05 -0500293 i, pkey->len);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200294 ret = -1;
295 goto done;
296 break;
297 }
298 }
David Woodhousef70dd452007-12-18 00:18:05 -0500299 } else if (cmd_action == CMD_ACT_REMOVE) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200300 /* ACT_REMOVE clears _all_ WEP keys */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200301
302 /* default tx key index */
David Woodhousef70dd452007-12-18 00:18:05 -0500303 cmd.keyindex = cpu_to_le16(priv->wep_tx_keyidx &
304 CMD_WEP_KEY_INDEX_MASK);
David Woodhouseaa21c002007-12-08 20:04:36 +0000305 lbs_deb_cmd("SET_WEP: remove key %d\n", priv->wep_tx_keyidx);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200306 }
307
David Woodhousef70dd452007-12-18 00:18:05 -0500308 ret = lbs_cmd_with_response(priv, CMD_802_11_SET_WEP, &cmd);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200309done:
Holger Schurig9012b282007-05-25 11:27:16 -0400310 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200311 return ret;
312}
313
David Woodhouse4f59abf2007-12-18 00:47:17 -0500314int lbs_cmd_802_11_enable_rsn(struct lbs_private *priv, uint16_t cmd_action,
315 uint16_t *enable)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200316{
David Woodhouse4f59abf2007-12-18 00:47:17 -0500317 struct cmd_ds_802_11_enable_rsn cmd;
318 int ret;
Dan Williams90a42212007-05-25 23:01:24 -0400319
320 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200321
David Woodhouse4f59abf2007-12-18 00:47:17 -0500322 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
323 cmd.action = cpu_to_le16(cmd_action);
Dan Williams18c96c342007-06-18 12:01:12 -0400324
Dan Williams0aef64d2007-08-02 11:31:18 -0400325 if (cmd_action == CMD_ACT_SET) {
Dan Williams18c96c342007-06-18 12:01:12 -0400326 if (*enable)
David Woodhouse4f59abf2007-12-18 00:47:17 -0500327 cmd.enable = cpu_to_le16(CMD_ENABLE_RSN);
Dan Williams18c96c342007-06-18 12:01:12 -0400328 else
David Woodhouse4f59abf2007-12-18 00:47:17 -0500329 cmd.enable = cpu_to_le16(CMD_DISABLE_RSN);
Holger Schurig8ff12da2007-08-02 11:54:31 -0400330 lbs_deb_cmd("ENABLE_RSN: %d\n", *enable);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200331 }
332
David Woodhouse4f59abf2007-12-18 00:47:17 -0500333 ret = lbs_cmd_with_response(priv, CMD_802_11_ENABLE_RSN, &cmd);
334 if (!ret && cmd_action == CMD_ACT_GET)
335 *enable = le16_to_cpu(cmd.enable);
336
337 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
338 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200339}
340
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200341static void set_one_wpa_key(struct MrvlIEtype_keyParamSet * pkeyparamset,
Dan Williams1443b652007-08-02 10:45:55 -0400342 struct enc_key * pkey)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200343{
Holger Schurig8ff12da2007-08-02 11:54:31 -0400344 lbs_deb_enter(LBS_DEB_CMD);
345
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200346 if (pkey->flags & KEY_INFO_WPA_ENABLED) {
Dan Williams90a42212007-05-25 23:01:24 -0400347 pkeyparamset->keyinfo |= cpu_to_le16(KEY_INFO_WPA_ENABLED);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200348 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200349 if (pkey->flags & KEY_INFO_WPA_UNICAST) {
350 pkeyparamset->keyinfo |= cpu_to_le16(KEY_INFO_WPA_UNICAST);
Dan Williams90a42212007-05-25 23:01:24 -0400351 }
352 if (pkey->flags & KEY_INFO_WPA_MCAST) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200353 pkeyparamset->keyinfo |= cpu_to_le16(KEY_INFO_WPA_MCAST);
354 }
355
356 pkeyparamset->type = cpu_to_le16(TLV_TYPE_KEY_MATERIAL);
Dan Williams1443b652007-08-02 10:45:55 -0400357 pkeyparamset->keytypeid = cpu_to_le16(pkey->type);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200358 pkeyparamset->keylen = cpu_to_le16(pkey->len);
359 memcpy(pkeyparamset->key, pkey->key, pkey->len);
360 pkeyparamset->length = cpu_to_le16( sizeof(pkeyparamset->keytypeid)
361 + sizeof(pkeyparamset->keyinfo)
362 + sizeof(pkeyparamset->keylen)
363 + sizeof(pkeyparamset->key));
Holger Schurig8ff12da2007-08-02 11:54:31 -0400364 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200365}
366
Holger Schurig69f90322007-11-23 15:43:44 +0100367static int lbs_cmd_802_11_key_material(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200368 struct cmd_ds_command *cmd,
369 u16 cmd_action,
370 u32 cmd_oid, void *pdata_buf)
371{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200372 struct cmd_ds_802_11_key_material *pkeymaterial =
373 &cmd->params.keymaterial;
Dan Williams90a42212007-05-25 23:01:24 -0400374 struct assoc_request * assoc_req = pdata_buf;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200375 int ret = 0;
376 int index = 0;
377
Holger Schurig9012b282007-05-25 11:27:16 -0400378 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200379
Dan Williams0aef64d2007-08-02 11:31:18 -0400380 cmd->command = cpu_to_le16(CMD_802_11_KEY_MATERIAL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200381 pkeymaterial->action = cpu_to_le16(cmd_action);
382
Dan Williams0aef64d2007-08-02 11:31:18 -0400383 if (cmd_action == CMD_ACT_GET) {
Dan Williams90a42212007-05-25 23:01:24 -0400384 cmd->size = cpu_to_le16(S_DS_GEN + sizeof (pkeymaterial->action));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200385 ret = 0;
386 goto done;
387 }
388
389 memset(&pkeymaterial->keyParamSet, 0, sizeof(pkeymaterial->keyParamSet));
390
Dan Williams90a42212007-05-25 23:01:24 -0400391 if (test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200392 set_one_wpa_key(&pkeymaterial->keyParamSet[index],
Dan Williams90a42212007-05-25 23:01:24 -0400393 &assoc_req->wpa_unicast_key);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200394 index++;
395 }
396
Dan Williams90a42212007-05-25 23:01:24 -0400397 if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200398 set_one_wpa_key(&pkeymaterial->keyParamSet[index],
Dan Williams90a42212007-05-25 23:01:24 -0400399 &assoc_req->wpa_mcast_key);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200400 index++;
401 }
402
403 cmd->size = cpu_to_le16( S_DS_GEN
Dan Williams90a42212007-05-25 23:01:24 -0400404 + sizeof (pkeymaterial->action)
405 + (index * sizeof(struct MrvlIEtype_keyParamSet)));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200406
407 ret = 0;
408
409done:
Holger Schurig9012b282007-05-25 11:27:16 -0400410 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200411 return ret;
412}
413
Holger Schurig69f90322007-11-23 15:43:44 +0100414static int lbs_cmd_802_11_reset(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200415 struct cmd_ds_command *cmd, int cmd_action)
416{
417 struct cmd_ds_802_11_reset *reset = &cmd->params.reset;
418
Holger Schurig8ff12da2007-08-02 11:54:31 -0400419 lbs_deb_enter(LBS_DEB_CMD);
420
Dan Williams0aef64d2007-08-02 11:31:18 -0400421 cmd->command = cpu_to_le16(CMD_802_11_RESET);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200422 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_802_11_reset) + S_DS_GEN);
423 reset->action = cpu_to_le16(cmd_action);
424
Holger Schurig8ff12da2007-08-02 11:54:31 -0400425 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200426 return 0;
427}
428
Holger Schurig69f90322007-11-23 15:43:44 +0100429static int lbs_cmd_802_11_get_log(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200430 struct cmd_ds_command *cmd)
431{
Holger Schurig8ff12da2007-08-02 11:54:31 -0400432 lbs_deb_enter(LBS_DEB_CMD);
Dan Williams0aef64d2007-08-02 11:31:18 -0400433 cmd->command = cpu_to_le16(CMD_802_11_GET_LOG);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200434 cmd->size =
435 cpu_to_le16(sizeof(struct cmd_ds_802_11_get_log) + S_DS_GEN);
436
Holger Schurig8ff12da2007-08-02 11:54:31 -0400437 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200438 return 0;
439}
440
Holger Schurig69f90322007-11-23 15:43:44 +0100441static int lbs_cmd_802_11_get_stat(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200442 struct cmd_ds_command *cmd)
443{
Holger Schurig8ff12da2007-08-02 11:54:31 -0400444 lbs_deb_enter(LBS_DEB_CMD);
Dan Williams0aef64d2007-08-02 11:31:18 -0400445 cmd->command = cpu_to_le16(CMD_802_11_GET_STAT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200446 cmd->size =
David Woodhouse981f1872007-05-25 23:36:54 -0400447 cpu_to_le16(sizeof(struct cmd_ds_802_11_get_stat) + S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200448
Holger Schurig8ff12da2007-08-02 11:54:31 -0400449 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200450 return 0;
451}
452
Holger Schurig69f90322007-11-23 15:43:44 +0100453static int lbs_cmd_802_11_snmp_mib(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200454 struct cmd_ds_command *cmd,
455 int cmd_action,
456 int cmd_oid, void *pdata_buf)
457{
458 struct cmd_ds_802_11_snmp_mib *pSNMPMIB = &cmd->params.smib;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200459 u8 ucTemp;
460
Holger Schurig9012b282007-05-25 11:27:16 -0400461 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200462
Holger Schurig9012b282007-05-25 11:27:16 -0400463 lbs_deb_cmd("SNMP_CMD: cmd_oid = 0x%x\n", cmd_oid);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200464
Dan Williams0aef64d2007-08-02 11:31:18 -0400465 cmd->command = cpu_to_le16(CMD_802_11_SNMP_MIB);
David Woodhouse981f1872007-05-25 23:36:54 -0400466 cmd->size = cpu_to_le16(sizeof(*pSNMPMIB) + S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200467
468 switch (cmd_oid) {
469 case OID_802_11_INFRASTRUCTURE_MODE:
470 {
Dan Williams0dc5a292007-05-10 22:58:02 -0400471 u8 mode = (u8) (size_t) pdata_buf;
Dan Williams0aef64d2007-08-02 11:31:18 -0400472 pSNMPMIB->querytype = cpu_to_le16(CMD_ACT_SET);
473 pSNMPMIB->oid = cpu_to_le16((u16) DESIRED_BSSTYPE_I);
Holger Schurigc2df2ef2007-12-07 15:30:44 +0000474 pSNMPMIB->bufsize = cpu_to_le16(sizeof(u8));
Dan Williams0dc5a292007-05-10 22:58:02 -0400475 if (mode == IW_MODE_ADHOC) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200476 ucTemp = SNMP_MIB_VALUE_ADHOC;
Dan Williams0dc5a292007-05-10 22:58:02 -0400477 } else {
478 /* Infra and Auto modes */
479 ucTemp = SNMP_MIB_VALUE_INFRA;
480 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200481
482 memmove(pSNMPMIB->value, &ucTemp, sizeof(u8));
483
484 break;
485 }
486
487 case OID_802_11D_ENABLE:
488 {
489 u32 ulTemp;
490
Dan Williams0aef64d2007-08-02 11:31:18 -0400491 pSNMPMIB->oid = cpu_to_le16((u16) DOT11D_I);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200492
Dan Williams0aef64d2007-08-02 11:31:18 -0400493 if (cmd_action == CMD_ACT_SET) {
Holger Schurigc2df2ef2007-12-07 15:30:44 +0000494 pSNMPMIB->querytype = cpu_to_le16(CMD_ACT_SET);
495 pSNMPMIB->bufsize = cpu_to_le16(sizeof(u16));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200496 ulTemp = *(u32 *)pdata_buf;
David Woodhouse981f1872007-05-25 23:36:54 -0400497 *((__le16 *)(pSNMPMIB->value)) =
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200498 cpu_to_le16((u16) ulTemp);
499 }
500 break;
501 }
502
503 case OID_802_11_FRAGMENTATION_THRESHOLD:
504 {
505 u32 ulTemp;
506
Dan Williams0aef64d2007-08-02 11:31:18 -0400507 pSNMPMIB->oid = cpu_to_le16((u16) FRAGTHRESH_I);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200508
Dan Williams0aef64d2007-08-02 11:31:18 -0400509 if (cmd_action == CMD_ACT_GET) {
510 pSNMPMIB->querytype = cpu_to_le16(CMD_ACT_GET);
511 } else if (cmd_action == CMD_ACT_SET) {
512 pSNMPMIB->querytype = cpu_to_le16(CMD_ACT_SET);
David Woodhouse981f1872007-05-25 23:36:54 -0400513 pSNMPMIB->bufsize = cpu_to_le16(sizeof(u16));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200514 ulTemp = *((u32 *) pdata_buf);
David Woodhouse981f1872007-05-25 23:36:54 -0400515 *((__le16 *)(pSNMPMIB->value)) =
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200516 cpu_to_le16((u16) ulTemp);
517
518 }
519
520 break;
521 }
522
523 case OID_802_11_RTS_THRESHOLD:
524 {
525
526 u32 ulTemp;
Holger Schurigc2df2ef2007-12-07 15:30:44 +0000527 pSNMPMIB->oid = cpu_to_le16(RTSTHRESH_I);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200528
Dan Williams0aef64d2007-08-02 11:31:18 -0400529 if (cmd_action == CMD_ACT_GET) {
530 pSNMPMIB->querytype = cpu_to_le16(CMD_ACT_GET);
531 } else if (cmd_action == CMD_ACT_SET) {
532 pSNMPMIB->querytype = cpu_to_le16(CMD_ACT_SET);
David Woodhouse981f1872007-05-25 23:36:54 -0400533 pSNMPMIB->bufsize = cpu_to_le16(sizeof(u16));
534 ulTemp = *((u32 *)pdata_buf);
535 *(__le16 *)(pSNMPMIB->value) =
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200536 cpu_to_le16((u16) ulTemp);
537
538 }
539 break;
540 }
541 case OID_802_11_TX_RETRYCOUNT:
Dan Williams0aef64d2007-08-02 11:31:18 -0400542 pSNMPMIB->oid = cpu_to_le16((u16) SHORT_RETRYLIM_I);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200543
Dan Williams0aef64d2007-08-02 11:31:18 -0400544 if (cmd_action == CMD_ACT_GET) {
545 pSNMPMIB->querytype = cpu_to_le16(CMD_ACT_GET);
546 } else if (cmd_action == CMD_ACT_SET) {
547 pSNMPMIB->querytype = cpu_to_le16(CMD_ACT_SET);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200548 pSNMPMIB->bufsize = cpu_to_le16(sizeof(u16));
David Woodhouse981f1872007-05-25 23:36:54 -0400549 *((__le16 *)(pSNMPMIB->value)) =
David Woodhouseaa21c002007-12-08 20:04:36 +0000550 cpu_to_le16((u16) priv->txretrycount);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200551 }
552
553 break;
554 default:
555 break;
556 }
557
Holger Schurig9012b282007-05-25 11:27:16 -0400558 lbs_deb_cmd(
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200559 "SNMP_CMD: command=0x%x, size=0x%x, seqnum=0x%x, result=0x%x\n",
David Woodhouse981f1872007-05-25 23:36:54 -0400560 le16_to_cpu(cmd->command), le16_to_cpu(cmd->size),
561 le16_to_cpu(cmd->seqnum), le16_to_cpu(cmd->result));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200562
Holger Schurig9012b282007-05-25 11:27:16 -0400563 lbs_deb_cmd(
Holger Schurig8ff12da2007-08-02 11:54:31 -0400564 "SNMP_CMD: action 0x%x, oid 0x%x, oidsize 0x%x, value 0x%x\n",
David Woodhouse981f1872007-05-25 23:36:54 -0400565 le16_to_cpu(pSNMPMIB->querytype), le16_to_cpu(pSNMPMIB->oid),
566 le16_to_cpu(pSNMPMIB->bufsize),
567 le16_to_cpu(*(__le16 *) pSNMPMIB->value));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200568
Holger Schurig9012b282007-05-25 11:27:16 -0400569 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200570 return 0;
571}
572
Holger Schurig69f90322007-11-23 15:43:44 +0100573static int lbs_cmd_802_11_rf_tx_power(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200574 struct cmd_ds_command *cmd,
575 u16 cmd_action, void *pdata_buf)
576{
577
578 struct cmd_ds_802_11_rf_tx_power *prtp = &cmd->params.txp;
579
Holger Schurig9012b282007-05-25 11:27:16 -0400580 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200581
582 cmd->size =
David Woodhouse981f1872007-05-25 23:36:54 -0400583 cpu_to_le16((sizeof(struct cmd_ds_802_11_rf_tx_power)) + S_DS_GEN);
Dan Williams0aef64d2007-08-02 11:31:18 -0400584 cmd->command = cpu_to_le16(CMD_802_11_RF_TX_POWER);
David Woodhouse981f1872007-05-25 23:36:54 -0400585 prtp->action = cpu_to_le16(cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200586
David Woodhouse981f1872007-05-25 23:36:54 -0400587 lbs_deb_cmd("RF_TX_POWER_CMD: size:%d cmd:0x%x Act:%d\n",
588 le16_to_cpu(cmd->size), le16_to_cpu(cmd->command),
589 le16_to_cpu(prtp->action));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200590
591 switch (cmd_action) {
Dan Williams0aef64d2007-08-02 11:31:18 -0400592 case CMD_ACT_TX_POWER_OPT_GET:
593 prtp->action = cpu_to_le16(CMD_ACT_GET);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200594 prtp->currentlevel = 0;
595 break;
596
Dan Williams0aef64d2007-08-02 11:31:18 -0400597 case CMD_ACT_TX_POWER_OPT_SET_HIGH:
598 prtp->action = cpu_to_le16(CMD_ACT_SET);
599 prtp->currentlevel = cpu_to_le16(CMD_ACT_TX_POWER_INDEX_HIGH);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200600 break;
601
Dan Williams0aef64d2007-08-02 11:31:18 -0400602 case CMD_ACT_TX_POWER_OPT_SET_MID:
603 prtp->action = cpu_to_le16(CMD_ACT_SET);
604 prtp->currentlevel = cpu_to_le16(CMD_ACT_TX_POWER_INDEX_MID);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200605 break;
606
Dan Williams0aef64d2007-08-02 11:31:18 -0400607 case CMD_ACT_TX_POWER_OPT_SET_LOW:
608 prtp->action = cpu_to_le16(CMD_ACT_SET);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200609 prtp->currentlevel = cpu_to_le16(*((u16 *) pdata_buf));
610 break;
611 }
Holger Schurig9012b282007-05-25 11:27:16 -0400612
613 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200614 return 0;
615}
616
Holger Schurig69f90322007-11-23 15:43:44 +0100617static int lbs_cmd_802_11_monitor_mode(struct lbs_private *priv,
Luis Carlos Cobo965f8bbc2007-08-02 13:16:55 -0400618 struct cmd_ds_command *cmd,
619 u16 cmd_action, void *pdata_buf)
620{
621 struct cmd_ds_802_11_monitor_mode *monitor = &cmd->params.monitor;
622
623 cmd->command = cpu_to_le16(CMD_802_11_MONITOR_MODE);
624 cmd->size =
625 cpu_to_le16(sizeof(struct cmd_ds_802_11_monitor_mode) +
626 S_DS_GEN);
627
628 monitor->action = cpu_to_le16(cmd_action);
629 if (cmd_action == CMD_ACT_SET) {
630 monitor->mode =
631 cpu_to_le16((u16) (*(u32 *) pdata_buf));
632 }
633
634 return 0;
635}
636
Holger Schurig69f90322007-11-23 15:43:44 +0100637static int lbs_cmd_802_11_rate_adapt_rateset(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200638 struct cmd_ds_command *cmd,
639 u16 cmd_action)
640{
641 struct cmd_ds_802_11_rate_adapt_rateset
642 *rateadapt = &cmd->params.rateset;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200643
Holger Schurig8ff12da2007-08-02 11:54:31 -0400644 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200645 cmd->size =
646 cpu_to_le16(sizeof(struct cmd_ds_802_11_rate_adapt_rateset)
647 + S_DS_GEN);
Dan Williams0aef64d2007-08-02 11:31:18 -0400648 cmd->command = cpu_to_le16(CMD_802_11_RATE_ADAPT_RATESET);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200649
David Woodhouse981f1872007-05-25 23:36:54 -0400650 rateadapt->action = cpu_to_le16(cmd_action);
David Woodhouseaa21c002007-12-08 20:04:36 +0000651 rateadapt->enablehwauto = cpu_to_le16(priv->enablehwauto);
652 rateadapt->bitmap = cpu_to_le16(priv->ratebitmap);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200653
Holger Schurig9012b282007-05-25 11:27:16 -0400654 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200655 return 0;
656}
657
Dan Williams8e3c91b2007-12-11 15:50:59 -0500658/**
659 * @brief Get the current data rate
660 *
661 * @param priv A pointer to struct lbs_private structure
662 *
663 * @return The data rate on success, error on failure
664 */
665int lbs_get_data_rate(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200666{
Dan Williams8e3c91b2007-12-11 15:50:59 -0500667 struct cmd_ds_802_11_data_rate cmd;
668 int ret = -1;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200669
Holger Schurig9012b282007-05-25 11:27:16 -0400670 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200671
Dan Williams8e3c91b2007-12-11 15:50:59 -0500672 memset(&cmd, 0, sizeof(cmd));
673 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
674 cmd.action = cpu_to_le16(CMD_ACT_GET_TX_RATE);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200675
David Woodhouse689442d2007-12-12 16:00:42 -0500676 ret = lbs_cmd_with_response(priv, CMD_802_11_DATA_RATE, &cmd);
Dan Williams8e3c91b2007-12-11 15:50:59 -0500677 if (ret)
678 goto out;
679
680 lbs_deb_hex(LBS_DEB_CMD, "DATA_RATE_RESP", (u8 *) &cmd, sizeof (cmd));
681
682 ret = (int) lbs_fw_index_to_data_rate(cmd.rates[0]);
683 lbs_deb_cmd("DATA_RATE: current rate 0x%02x\n", ret);
684
685out:
686 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
687 return ret;
688}
689
690/**
691 * @brief Set the data rate
692 *
693 * @param priv A pointer to struct lbs_private structure
694 * @param rate The desired data rate, or 0 to clear a locked rate
695 *
696 * @return 0 on success, error on failure
697 */
698int lbs_set_data_rate(struct lbs_private *priv, u8 rate)
699{
700 struct cmd_ds_802_11_data_rate cmd;
701 int ret = 0;
702
703 lbs_deb_enter(LBS_DEB_CMD);
704
705 memset(&cmd, 0, sizeof(cmd));
706 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
707
708 if (rate > 0) {
709 cmd.action = cpu_to_le16(CMD_ACT_SET_TX_FIX_RATE);
710 cmd.rates[0] = lbs_data_rate_to_fw_index(rate);
711 if (cmd.rates[0] == 0) {
712 lbs_deb_cmd("DATA_RATE: invalid requested rate of"
713 " 0x%02X\n", rate);
714 ret = 0;
715 goto out;
716 }
717 lbs_deb_cmd("DATA_RATE: set fixed 0x%02X\n", cmd.rates[0]);
718 } else {
719 cmd.action = cpu_to_le16(CMD_ACT_SET_TX_AUTO);
Holger Schurig8ff12da2007-08-02 11:54:31 -0400720 lbs_deb_cmd("DATA_RATE: setting auto\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200721 }
722
David Woodhouse689442d2007-12-12 16:00:42 -0500723 ret = lbs_cmd_with_response(priv, CMD_802_11_DATA_RATE, &cmd);
Dan Williams8e3c91b2007-12-11 15:50:59 -0500724 if (ret)
725 goto out;
726
727 lbs_deb_hex(LBS_DEB_CMD, "DATA_RATE_RESP", (u8 *) &cmd, sizeof (cmd));
728
729 /* FIXME: get actual rates FW can do if this command actually returns
730 * all data rates supported.
731 */
732 priv->cur_rate = lbs_fw_index_to_data_rate(cmd.rates[0]);
733 lbs_deb_cmd("DATA_RATE: current rate is 0x%02x\n", priv->cur_rate);
734
735out:
736 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
737 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200738}
739
Holger Schurig69f90322007-11-23 15:43:44 +0100740static int lbs_cmd_mac_multicast_adr(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200741 struct cmd_ds_command *cmd,
742 u16 cmd_action)
743{
744 struct cmd_ds_mac_multicast_adr *pMCastAdr = &cmd->params.madr;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200745
Holger Schurig8ff12da2007-08-02 11:54:31 -0400746 lbs_deb_enter(LBS_DEB_CMD);
David Woodhouse981f1872007-05-25 23:36:54 -0400747 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_mac_multicast_adr) +
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200748 S_DS_GEN);
Dan Williams0aef64d2007-08-02 11:31:18 -0400749 cmd->command = cpu_to_le16(CMD_MAC_MULTICAST_ADR);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200750
Holger Schurig8ff12da2007-08-02 11:54:31 -0400751 lbs_deb_cmd("MULTICAST_ADR: setting %d addresses\n", pMCastAdr->nr_of_adrs);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200752 pMCastAdr->action = cpu_to_le16(cmd_action);
753 pMCastAdr->nr_of_adrs =
David Woodhouseaa21c002007-12-08 20:04:36 +0000754 cpu_to_le16((u16) priv->nr_of_multicastmacaddr);
755 memcpy(pMCastAdr->maclist, priv->multicastlist,
756 priv->nr_of_multicastmacaddr * ETH_ALEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200757
Holger Schurig8ff12da2007-08-02 11:54:31 -0400758 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200759 return 0;
760}
761
Dan Williams2dd4b262007-12-11 16:54:15 -0500762/**
763 * @brief Get the radio channel
764 *
765 * @param priv A pointer to struct lbs_private structure
766 *
767 * @return The channel on success, error on failure
768 */
769int lbs_get_channel(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200770{
Dan Williams2dd4b262007-12-11 16:54:15 -0500771 struct cmd_ds_802_11_rf_channel cmd;
772 int ret = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200773
Holger Schurig8ff12da2007-08-02 11:54:31 -0400774 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200775
Dan Williams2dd4b262007-12-11 16:54:15 -0500776 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
777 cmd.action = cpu_to_le16(CMD_OPT_802_11_RF_CHANNEL_GET);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200778
David Woodhouse689442d2007-12-12 16:00:42 -0500779 ret = lbs_cmd_with_response(priv, CMD_802_11_RF_CHANNEL, &cmd);
Dan Williams2dd4b262007-12-11 16:54:15 -0500780 if (ret)
781 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200782
Dan Williamscb182a62007-12-11 17:35:51 -0500783 ret = le16_to_cpu(cmd.channel);
784 lbs_deb_cmd("current radio channel is %d\n", ret);
Dan Williams2dd4b262007-12-11 16:54:15 -0500785
786out:
787 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
788 return ret;
789}
790
791/**
792 * @brief Set the radio channel
793 *
794 * @param priv A pointer to struct lbs_private structure
795 * @param channel The desired channel, or 0 to clear a locked channel
796 *
797 * @return 0 on success, error on failure
798 */
799int lbs_set_channel(struct lbs_private *priv, u8 channel)
800{
801 struct cmd_ds_802_11_rf_channel cmd;
802 u8 old_channel = priv->curbssparams.channel;
803 int ret = 0;
804
805 lbs_deb_enter(LBS_DEB_CMD);
806
807 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
808 cmd.action = cpu_to_le16(CMD_OPT_802_11_RF_CHANNEL_SET);
809 cmd.channel = cpu_to_le16(channel);
810
David Woodhouse689442d2007-12-12 16:00:42 -0500811 ret = lbs_cmd_with_response(priv, CMD_802_11_RF_CHANNEL, &cmd);
Dan Williams2dd4b262007-12-11 16:54:15 -0500812 if (ret)
813 goto out;
814
Dan Williamscb182a62007-12-11 17:35:51 -0500815 priv->curbssparams.channel = (uint8_t) le16_to_cpu(cmd.channel);
816 lbs_deb_cmd("channel switch from %d to %d\n", old_channel,
817 priv->curbssparams.channel);
Dan Williams2dd4b262007-12-11 16:54:15 -0500818
819out:
820 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
821 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200822}
823
Holger Schurig69f90322007-11-23 15:43:44 +0100824static int lbs_cmd_802_11_rssi(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200825 struct cmd_ds_command *cmd)
826{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200827
Holger Schurig8ff12da2007-08-02 11:54:31 -0400828 lbs_deb_enter(LBS_DEB_CMD);
Dan Williams0aef64d2007-08-02 11:31:18 -0400829 cmd->command = cpu_to_le16(CMD_802_11_RSSI);
David Woodhouse981f1872007-05-25 23:36:54 -0400830 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_802_11_rssi) + S_DS_GEN);
Holger Schuriga783f1e2007-08-02 13:08:24 -0400831 cmd->params.rssi.N = cpu_to_le16(DEFAULT_BCN_AVG_FACTOR);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200832
833 /* reset Beacon SNR/NF/RSSI values */
David Woodhouseaa21c002007-12-08 20:04:36 +0000834 priv->SNR[TYPE_BEACON][TYPE_NOAVG] = 0;
835 priv->SNR[TYPE_BEACON][TYPE_AVG] = 0;
836 priv->NF[TYPE_BEACON][TYPE_NOAVG] = 0;
837 priv->NF[TYPE_BEACON][TYPE_AVG] = 0;
838 priv->RSSI[TYPE_BEACON][TYPE_NOAVG] = 0;
839 priv->RSSI[TYPE_BEACON][TYPE_AVG] = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200840
Holger Schurig8ff12da2007-08-02 11:54:31 -0400841 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200842 return 0;
843}
844
Holger Schurig69f90322007-11-23 15:43:44 +0100845static int lbs_cmd_reg_access(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200846 struct cmd_ds_command *cmdptr,
847 u8 cmd_action, void *pdata_buf)
848{
Holger Schurig10078322007-11-15 18:05:47 -0500849 struct lbs_offset_value *offval;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200850
Holger Schurig9012b282007-05-25 11:27:16 -0400851 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200852
Holger Schurig10078322007-11-15 18:05:47 -0500853 offval = (struct lbs_offset_value *)pdata_buf;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200854
Holger Schurigc2df2ef2007-12-07 15:30:44 +0000855 switch (le16_to_cpu(cmdptr->command)) {
Dan Williams0aef64d2007-08-02 11:31:18 -0400856 case CMD_MAC_REG_ACCESS:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200857 {
858 struct cmd_ds_mac_reg_access *macreg;
859
860 cmdptr->size =
David Woodhouse981f1872007-05-25 23:36:54 -0400861 cpu_to_le16(sizeof (struct cmd_ds_mac_reg_access)
862 + S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200863 macreg =
864 (struct cmd_ds_mac_reg_access *)&cmdptr->params.
865 macreg;
866
867 macreg->action = cpu_to_le16(cmd_action);
868 macreg->offset = cpu_to_le16((u16) offval->offset);
869 macreg->value = cpu_to_le32(offval->value);
870
871 break;
872 }
873
Dan Williams0aef64d2007-08-02 11:31:18 -0400874 case CMD_BBP_REG_ACCESS:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200875 {
876 struct cmd_ds_bbp_reg_access *bbpreg;
877
878 cmdptr->size =
879 cpu_to_le16(sizeof
880 (struct cmd_ds_bbp_reg_access)
881 + S_DS_GEN);
882 bbpreg =
883 (struct cmd_ds_bbp_reg_access *)&cmdptr->params.
884 bbpreg;
885
886 bbpreg->action = cpu_to_le16(cmd_action);
887 bbpreg->offset = cpu_to_le16((u16) offval->offset);
888 bbpreg->value = (u8) offval->value;
889
890 break;
891 }
892
Dan Williams0aef64d2007-08-02 11:31:18 -0400893 case CMD_RF_REG_ACCESS:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200894 {
895 struct cmd_ds_rf_reg_access *rfreg;
896
897 cmdptr->size =
898 cpu_to_le16(sizeof
899 (struct cmd_ds_rf_reg_access) +
900 S_DS_GEN);
901 rfreg =
902 (struct cmd_ds_rf_reg_access *)&cmdptr->params.
903 rfreg;
904
905 rfreg->action = cpu_to_le16(cmd_action);
906 rfreg->offset = cpu_to_le16((u16) offval->offset);
907 rfreg->value = (u8) offval->value;
908
909 break;
910 }
911
912 default:
913 break;
914 }
915
Holger Schurig9012b282007-05-25 11:27:16 -0400916 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200917 return 0;
918}
919
Holger Schurig69f90322007-11-23 15:43:44 +0100920static int lbs_cmd_802_11_mac_address(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200921 struct cmd_ds_command *cmd,
922 u16 cmd_action)
923{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200924
Holger Schurig8ff12da2007-08-02 11:54:31 -0400925 lbs_deb_enter(LBS_DEB_CMD);
Dan Williams0aef64d2007-08-02 11:31:18 -0400926 cmd->command = cpu_to_le16(CMD_802_11_MAC_ADDRESS);
David Woodhouse981f1872007-05-25 23:36:54 -0400927 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_802_11_mac_address) +
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200928 S_DS_GEN);
929 cmd->result = 0;
930
931 cmd->params.macadd.action = cpu_to_le16(cmd_action);
932
Dan Williams0aef64d2007-08-02 11:31:18 -0400933 if (cmd_action == CMD_ACT_SET) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200934 memcpy(cmd->params.macadd.macadd,
David Woodhouseaa21c002007-12-08 20:04:36 +0000935 priv->current_addr, ETH_ALEN);
936 lbs_deb_hex(LBS_DEB_CMD, "SET_CMD: MAC addr", priv->current_addr, 6);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200937 }
938
Holger Schurig8ff12da2007-08-02 11:54:31 -0400939 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200940 return 0;
941}
942
Holger Schurig69f90322007-11-23 15:43:44 +0100943static int lbs_cmd_802_11_eeprom_access(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200944 struct cmd_ds_command *cmd,
945 int cmd_action, void *pdata_buf)
946{
Holger Schurig10078322007-11-15 18:05:47 -0500947 struct lbs_ioctl_regrdwr *ea = pdata_buf;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200948
Holger Schurig9012b282007-05-25 11:27:16 -0400949 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200950
Dan Williams0aef64d2007-08-02 11:31:18 -0400951 cmd->command = cpu_to_le16(CMD_802_11_EEPROM_ACCESS);
David Woodhouse981f1872007-05-25 23:36:54 -0400952 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_802_11_eeprom_access) +
953 S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200954 cmd->result = 0;
955
956 cmd->params.rdeeprom.action = cpu_to_le16(ea->action);
957 cmd->params.rdeeprom.offset = cpu_to_le16(ea->offset);
958 cmd->params.rdeeprom.bytecount = cpu_to_le16(ea->NOB);
959 cmd->params.rdeeprom.value = 0;
960
Holger Schurig8ff12da2007-08-02 11:54:31 -0400961 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200962 return 0;
963}
964
Holger Schurig69f90322007-11-23 15:43:44 +0100965static int lbs_cmd_bt_access(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200966 struct cmd_ds_command *cmd,
967 u16 cmd_action, void *pdata_buf)
968{
969 struct cmd_ds_bt_access *bt_access = &cmd->params.bt;
Holger Schurig8ff12da2007-08-02 11:54:31 -0400970 lbs_deb_enter_args(LBS_DEB_CMD, "action %d", cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200971
Dan Williams0aef64d2007-08-02 11:31:18 -0400972 cmd->command = cpu_to_le16(CMD_BT_ACCESS);
David Woodhouse981f1872007-05-25 23:36:54 -0400973 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_bt_access) + S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200974 cmd->result = 0;
975 bt_access->action = cpu_to_le16(cmd_action);
976
977 switch (cmd_action) {
Dan Williams0aef64d2007-08-02 11:31:18 -0400978 case CMD_ACT_BT_ACCESS_ADD:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200979 memcpy(bt_access->addr1, pdata_buf, 2 * ETH_ALEN);
Holger Schurigece56192007-08-02 11:53:06 -0400980 lbs_deb_hex(LBS_DEB_MESH, "BT_ADD: blinded MAC addr", bt_access->addr1, 6);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200981 break;
Dan Williams0aef64d2007-08-02 11:31:18 -0400982 case CMD_ACT_BT_ACCESS_DEL:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200983 memcpy(bt_access->addr1, pdata_buf, 1 * ETH_ALEN);
Holger Schurigece56192007-08-02 11:53:06 -0400984 lbs_deb_hex(LBS_DEB_MESH, "BT_DEL: blinded MAC addr", bt_access->addr1, 6);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200985 break;
Dan Williams0aef64d2007-08-02 11:31:18 -0400986 case CMD_ACT_BT_ACCESS_LIST:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200987 bt_access->id = cpu_to_le32(*(u32 *) pdata_buf);
988 break;
Dan Williams0aef64d2007-08-02 11:31:18 -0400989 case CMD_ACT_BT_ACCESS_RESET:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200990 break;
Dan Williams0aef64d2007-08-02 11:31:18 -0400991 case CMD_ACT_BT_ACCESS_SET_INVERT:
Luis Carlos Cobo90e8eaf2007-05-25 13:53:26 -0400992 bt_access->id = cpu_to_le32(*(u32 *) pdata_buf);
993 break;
Dan Williams0aef64d2007-08-02 11:31:18 -0400994 case CMD_ACT_BT_ACCESS_GET_INVERT:
Luis Carlos Cobo90e8eaf2007-05-25 13:53:26 -0400995 break;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200996 default:
997 break;
998 }
Holger Schurig8ff12da2007-08-02 11:54:31 -0400999 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001000 return 0;
1001}
1002
Holger Schurig69f90322007-11-23 15:43:44 +01001003static int lbs_cmd_fwt_access(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001004 struct cmd_ds_command *cmd,
1005 u16 cmd_action, void *pdata_buf)
1006{
1007 struct cmd_ds_fwt_access *fwt_access = &cmd->params.fwt;
Holger Schurig8ff12da2007-08-02 11:54:31 -04001008 lbs_deb_enter_args(LBS_DEB_CMD, "action %d", cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001009
Dan Williams0aef64d2007-08-02 11:31:18 -04001010 cmd->command = cpu_to_le16(CMD_FWT_ACCESS);
David Woodhouse981f1872007-05-25 23:36:54 -04001011 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_fwt_access) + S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001012 cmd->result = 0;
1013
1014 if (pdata_buf)
1015 memcpy(fwt_access, pdata_buf, sizeof(*fwt_access));
1016 else
1017 memset(fwt_access, 0, sizeof(*fwt_access));
1018
1019 fwt_access->action = cpu_to_le16(cmd_action);
1020
Holger Schurig8ff12da2007-08-02 11:54:31 -04001021 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001022 return 0;
1023}
1024
David Woodhouse301eacb2007-12-11 15:23:59 -05001025int lbs_mesh_access(struct lbs_private *priv, uint16_t cmd_action,
1026 struct cmd_ds_mesh_access *cmd)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001027{
David Woodhouse301eacb2007-12-11 15:23:59 -05001028 int ret;
1029
Holger Schurig8ff12da2007-08-02 11:54:31 -04001030 lbs_deb_enter_args(LBS_DEB_CMD, "action %d", cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001031
David Woodhouse301eacb2007-12-11 15:23:59 -05001032 cmd->hdr.command = cpu_to_le16(CMD_MESH_ACCESS);
David Woodhouse9fae8992007-12-15 03:46:44 -05001033 cmd->hdr.size = cpu_to_le16(sizeof(*cmd));
David Woodhouse301eacb2007-12-11 15:23:59 -05001034 cmd->hdr.result = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001035
David Woodhouse301eacb2007-12-11 15:23:59 -05001036 cmd->action = cpu_to_le16(cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001037
David Woodhouse689442d2007-12-12 16:00:42 -05001038 ret = lbs_cmd_with_response(priv, CMD_MESH_ACCESS, cmd);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001039
Holger Schurig8ff12da2007-08-02 11:54:31 -04001040 lbs_deb_leave(LBS_DEB_CMD);
David Woodhouse301eacb2007-12-11 15:23:59 -05001041 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001042}
1043
David Woodhouse86062132007-12-13 00:32:36 -05001044int lbs_mesh_config(struct lbs_private *priv, uint16_t enable, uint16_t chan)
David Woodhouse23a397a2007-12-11 18:56:42 -05001045{
1046 struct cmd_ds_mesh_config cmd;
1047
1048 memset(&cmd, 0, sizeof(cmd));
1049 cmd.action = cpu_to_le16(enable);
David Woodhouse86062132007-12-13 00:32:36 -05001050 cmd.channel = cpu_to_le16(chan);
David Woodhouse020f3d02007-12-12 23:29:13 -05001051 cmd.type = cpu_to_le16(priv->mesh_tlv);
David Woodhouse9fae8992007-12-15 03:46:44 -05001052 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
David Woodhouse7e226272007-12-14 22:53:41 -05001053
David Woodhouse23a397a2007-12-11 18:56:42 -05001054 if (enable) {
1055 cmd.length = cpu_to_le16(priv->mesh_ssid_len);
1056 memcpy(cmd.data, priv->mesh_ssid, priv->mesh_ssid_len);
1057 }
David Woodhouse020f3d02007-12-12 23:29:13 -05001058 lbs_deb_cmd("mesh config enable %d TLV %x channel %d SSID %s\n",
David Woodhouse86062132007-12-13 00:32:36 -05001059 enable, priv->mesh_tlv, chan,
David Woodhouse06113c12007-12-11 22:52:03 -05001060 escape_essid(priv->mesh_ssid, priv->mesh_ssid_len));
David Woodhouse689442d2007-12-12 16:00:42 -05001061 return lbs_cmd_with_response(priv, CMD_MESH_CONFIG, &cmd);
David Woodhouse23a397a2007-12-11 18:56:42 -05001062}
1063
Brajesh Dave96287ac2007-11-20 17:44:28 -05001064static int lbs_cmd_bcn_ctrl(struct lbs_private * priv,
1065 struct cmd_ds_command *cmd,
1066 u16 cmd_action)
1067{
1068 struct cmd_ds_802_11_beacon_control
1069 *bcn_ctrl = &cmd->params.bcn_ctrl;
Brajesh Dave96287ac2007-11-20 17:44:28 -05001070
1071 lbs_deb_enter(LBS_DEB_CMD);
1072 cmd->size =
1073 cpu_to_le16(sizeof(struct cmd_ds_802_11_beacon_control)
1074 + S_DS_GEN);
1075 cmd->command = cpu_to_le16(CMD_802_11_BEACON_CTRL);
1076
1077 bcn_ctrl->action = cpu_to_le16(cmd_action);
David Woodhouseaa21c002007-12-08 20:04:36 +00001078 bcn_ctrl->beacon_enable = cpu_to_le16(priv->beacon_enable);
1079 bcn_ctrl->beacon_period = cpu_to_le16(priv->beacon_period);
Brajesh Dave96287ac2007-11-20 17:44:28 -05001080
1081 lbs_deb_leave(LBS_DEB_CMD);
1082 return 0;
1083}
1084
David Woodhouse681ffbb2007-12-15 20:04:54 -05001085static void lbs_queue_cmd(struct lbs_private *priv,
1086 struct cmd_ctrl_node *cmdnode)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001087{
1088 unsigned long flags;
David Woodhouse681ffbb2007-12-15 20:04:54 -05001089 int addtail = 1;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001090
Holger Schurig8ff12da2007-08-02 11:54:31 -04001091 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001092
David Woodhousec4ab4122007-12-15 00:41:51 -05001093 if (!cmdnode) {
1094 lbs_deb_host("QUEUE_CMD: cmdnode is NULL\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001095 goto done;
1096 }
David Woodhoused9896ee2007-12-15 00:09:25 -05001097 if (!cmdnode->cmdbuf->size) {
1098 lbs_deb_host("DNLD_CMD: cmd size is zero\n");
1099 goto done;
1100 }
David Woodhouseae125bf2007-12-15 04:22:52 -05001101 cmdnode->result = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001102
1103 /* Exit_PS command needs to be queued in the header always. */
Dan Williamsddac4522007-12-11 13:49:39 -05001104 if (le16_to_cpu(cmdnode->cmdbuf->command) == CMD_802_11_PS_MODE) {
David Woodhouse38bfab12007-12-16 23:26:54 -05001105 struct cmd_ds_802_11_ps_mode *psm = (void *) &cmdnode->cmdbuf[1];
Dan Williamsddac4522007-12-11 13:49:39 -05001106
Dan Williams0aef64d2007-08-02 11:31:18 -04001107 if (psm->action == cpu_to_le16(CMD_SUBCMD_EXIT_PS)) {
David Woodhouseaa21c002007-12-08 20:04:36 +00001108 if (priv->psstate != PS_STATE_FULL_POWER)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001109 addtail = 0;
1110 }
1111 }
1112
David Woodhouseaa21c002007-12-08 20:04:36 +00001113 spin_lock_irqsave(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001114
David Woodhouseac472462007-12-08 00:35:00 +00001115 if (addtail)
David Woodhouseaa21c002007-12-08 20:04:36 +00001116 list_add_tail(&cmdnode->list, &priv->cmdpendingq);
David Woodhouseac472462007-12-08 00:35:00 +00001117 else
David Woodhouseaa21c002007-12-08 20:04:36 +00001118 list_add(&cmdnode->list, &priv->cmdpendingq);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001119
David Woodhouseaa21c002007-12-08 20:04:36 +00001120 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001121
Holger Schurig8ff12da2007-08-02 11:54:31 -04001122 lbs_deb_host("QUEUE_CMD: inserted command 0x%04x into cmdpendingq\n",
David Woodhousec4ab4122007-12-15 00:41:51 -05001123 le16_to_cpu(cmdnode->cmdbuf->command));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001124
1125done:
Holger Schurig8ff12da2007-08-02 11:54:31 -04001126 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001127}
1128
David Woodhouse18c52e72007-12-17 16:03:58 -05001129static void lbs_submit_command(struct lbs_private *priv,
1130 struct cmd_ctrl_node *cmdnode)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001131{
1132 unsigned long flags;
Dan Williamsddac4522007-12-11 13:49:39 -05001133 struct cmd_header *cmd;
David Woodhouse18c52e72007-12-17 16:03:58 -05001134 uint16_t cmdsize;
1135 uint16_t command;
1136 int timeo = 5 * HZ;
1137 int ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001138
Holger Schurig8ff12da2007-08-02 11:54:31 -04001139 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001140
Dan Williamsddac4522007-12-11 13:49:39 -05001141 cmd = cmdnode->cmdbuf;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001142
David Woodhouseaa21c002007-12-08 20:04:36 +00001143 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouseaa21c002007-12-08 20:04:36 +00001144 priv->cur_cmd = cmdnode;
1145 priv->cur_cmd_retcode = 0;
1146 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001147
Dan Williamsddac4522007-12-11 13:49:39 -05001148 cmdsize = le16_to_cpu(cmd->size);
1149 command = le16_to_cpu(cmd->command);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001150
David Woodhouse18c52e72007-12-17 16:03:58 -05001151 /* These commands take longer */
1152 if (command == CMD_802_11_SCAN || command == CMD_802_11_ASSOCIATE ||
1153 command == CMD_802_11_AUTHENTICATE)
1154 timeo = 10 * HZ;
1155
David Woodhousee1258172007-12-11 23:42:49 -05001156 lbs_deb_host("DNLD_CMD: command 0x%04x, seq %d, size %d, jiffies %lu\n",
1157 command, le16_to_cpu(cmd->seqnum), cmdsize, jiffies);
Dan Williamsddac4522007-12-11 13:49:39 -05001158 lbs_deb_hex(LBS_DEB_HOST, "DNLD_CMD", (void *) cmdnode->cmdbuf, cmdsize);
Holger Schurig8ff12da2007-08-02 11:54:31 -04001159
Dan Williamsddac4522007-12-11 13:49:39 -05001160 ret = priv->hw_host_to_card(priv, MVMS_CMD, (u8 *) cmd, cmdsize);
David Woodhouse18c52e72007-12-17 16:03:58 -05001161
David Woodhoused9896ee2007-12-15 00:09:25 -05001162 if (ret) {
1163 lbs_pr_info("DNLD_CMD: hw_host_to_card failed: %d\n", ret);
David Woodhouse18c52e72007-12-17 16:03:58 -05001164 /* Let the timer kick in and retry, and potentially reset
1165 the whole thing if the condition persists */
1166 timeo = HZ;
1167 } else
1168 lbs_deb_cmd("DNLD_CMD: sent command 0x%04x, jiffies %lu\n",
1169 command, jiffies);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001170
1171 /* Setup the timer after transmit command */
David Woodhouse18c52e72007-12-17 16:03:58 -05001172 mod_timer(&priv->command_timer, jiffies + timeo);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001173
David Woodhouse18c52e72007-12-17 16:03:58 -05001174 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001175}
1176
Holger Schurig69f90322007-11-23 15:43:44 +01001177static int lbs_cmd_mac_control(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001178 struct cmd_ds_command *cmd)
1179{
1180 struct cmd_ds_mac_control *mac = &cmd->params.macctrl;
1181
Holger Schurig9012b282007-05-25 11:27:16 -04001182 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001183
Dan Williams0aef64d2007-08-02 11:31:18 -04001184 cmd->command = cpu_to_le16(CMD_MAC_CONTROL);
David Woodhouse981f1872007-05-25 23:36:54 -04001185 cmd->size = cpu_to_le16(sizeof(struct cmd_ds_mac_control) + S_DS_GEN);
David Woodhouseaa21c002007-12-08 20:04:36 +00001186 mac->action = cpu_to_le16(priv->currentpacketfilter);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001187
Holger Schurig8ff12da2007-08-02 11:54:31 -04001188 lbs_deb_cmd("MAC_CONTROL: action 0x%x, size %d\n",
David Woodhouse981f1872007-05-25 23:36:54 -04001189 le16_to_cpu(mac->action), le16_to_cpu(cmd->size));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001190
Holger Schurig9012b282007-05-25 11:27:16 -04001191 lbs_deb_leave(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001192 return 0;
1193}
1194
1195/**
1196 * This function inserts command node to cmdfreeq
David Woodhouseaa21c002007-12-08 20:04:36 +00001197 * after cleans it. Requires priv->driver_lock held.
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001198 */
David Woodhouse183aeac2007-12-15 01:52:54 -05001199static void __lbs_cleanup_and_insert_cmd(struct lbs_private *priv,
David Woodhouse5ba2f8a2007-12-15 02:02:56 -05001200 struct cmd_ctrl_node *cmdnode)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001201{
David Woodhouse5ba2f8a2007-12-15 02:02:56 -05001202 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001203
David Woodhouse5ba2f8a2007-12-15 02:02:56 -05001204 if (!cmdnode)
1205 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001206
David Woodhouse5ba2f8a2007-12-15 02:02:56 -05001207 cmdnode->callback = NULL;
1208 cmdnode->callback_arg = 0;
1209
1210 memset(cmdnode->cmdbuf, 0, LBS_CMD_BUFFER_SIZE);
1211
1212 list_add_tail(&cmdnode->list, &priv->cmdfreeq);
1213 out:
1214 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001215}
1216
Holger Schurig69f90322007-11-23 15:43:44 +01001217static void lbs_cleanup_and_insert_cmd(struct lbs_private *priv,
1218 struct cmd_ctrl_node *ptempcmd)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001219{
1220 unsigned long flags;
1221
David Woodhouseaa21c002007-12-08 20:04:36 +00001222 spin_lock_irqsave(&priv->driver_lock, flags);
Holger Schurig10078322007-11-15 18:05:47 -05001223 __lbs_cleanup_and_insert_cmd(priv, ptempcmd);
David Woodhouseaa21c002007-12-08 20:04:36 +00001224 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001225}
1226
David Woodhouse183aeac2007-12-15 01:52:54 -05001227void lbs_complete_command(struct lbs_private *priv, struct cmd_ctrl_node *cmd,
1228 int result)
1229{
1230 if (cmd == priv->cur_cmd)
1231 priv->cur_cmd_retcode = result;
David Woodhouse5ba2f8a2007-12-15 02:02:56 -05001232
David Woodhouseae125bf2007-12-15 04:22:52 -05001233 cmd->result = result;
David Woodhouse5ba2f8a2007-12-15 02:02:56 -05001234 cmd->cmdwaitqwoken = 1;
1235 wake_up_interruptible(&cmd->cmdwait_q);
1236
David Woodhousead12d0f2007-12-15 02:06:16 -05001237 if (!cmd->callback)
1238 __lbs_cleanup_and_insert_cmd(priv, cmd);
David Woodhouse183aeac2007-12-15 01:52:54 -05001239 priv->cur_cmd = NULL;
1240}
1241
Holger Schurig69f90322007-11-23 15:43:44 +01001242int lbs_set_radio_control(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001243{
1244 int ret = 0;
David Woodhousea7c45892007-12-17 22:43:48 -05001245 struct cmd_ds_802_11_radio_control cmd;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001246
Holger Schurig9012b282007-05-25 11:27:16 -04001247 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001248
David Woodhousea7c45892007-12-17 22:43:48 -05001249 cmd.hdr.size = cpu_to_le16(sizeof(cmd));
1250 cmd.action = cpu_to_le16(CMD_ACT_SET);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001251
David Woodhousea7c45892007-12-17 22:43:48 -05001252 switch (priv->preamble) {
1253 case CMD_TYPE_SHORT_PREAMBLE:
1254 cmd.control = cpu_to_le16(SET_SHORT_PREAMBLE);
1255 break;
1256
1257 case CMD_TYPE_LONG_PREAMBLE:
1258 cmd.control = cpu_to_le16(SET_LONG_PREAMBLE);
1259 break;
1260
1261 case CMD_TYPE_AUTO_PREAMBLE:
1262 default:
1263 cmd.control = cpu_to_le16(SET_AUTO_PREAMBLE);
1264 break;
1265 }
1266
1267 if (priv->radioon)
1268 cmd.control |= cpu_to_le16(TURN_ON_RF);
1269 else
1270 cmd.control &= cpu_to_le16(~TURN_ON_RF);
1271
1272 lbs_deb_cmd("RADIO_SET: radio %d, preamble %d\n", priv->radioon,
1273 priv->preamble);
1274
1275 ret = lbs_cmd_with_response(priv, CMD_802_11_RADIO_CONTROL, &cmd);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001276
Holger Schurig9012b282007-05-25 11:27:16 -04001277 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001278 return ret;
1279}
1280
Holger Schurig69f90322007-11-23 15:43:44 +01001281int lbs_set_mac_packet_filter(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001282{
1283 int ret = 0;
1284
Holger Schurig9012b282007-05-25 11:27:16 -04001285 lbs_deb_enter(LBS_DEB_CMD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001286
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001287 /* Send MAC control command to station */
Holger Schurig10078322007-11-15 18:05:47 -05001288 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -04001289 CMD_MAC_CONTROL, 0, 0, 0, NULL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001290
Holger Schurig9012b282007-05-25 11:27:16 -04001291 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001292 return ret;
1293}
1294
1295/**
1296 * @brief This function prepare the command before send to firmware.
1297 *
Holger Schurig69f90322007-11-23 15:43:44 +01001298 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001299 * @param cmd_no command number
1300 * @param cmd_action command action: GET or SET
1301 * @param wait_option wait option: wait response or not
1302 * @param cmd_oid cmd oid: treated as sub command
1303 * @param pdata_buf A pointer to informaion buffer
1304 * @return 0 or -1
1305 */
Holger Schurig69f90322007-11-23 15:43:44 +01001306int lbs_prepare_and_send_command(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001307 u16 cmd_no,
1308 u16 cmd_action,
1309 u16 wait_option, u32 cmd_oid, void *pdata_buf)
1310{
1311 int ret = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001312 struct cmd_ctrl_node *cmdnode;
1313 struct cmd_ds_command *cmdptr;
1314 unsigned long flags;
1315
Holger Schurig8ff12da2007-08-02 11:54:31 -04001316 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001317
David Woodhouseaa21c002007-12-08 20:04:36 +00001318 if (!priv) {
1319 lbs_deb_host("PREP_CMD: priv is NULL\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001320 ret = -1;
1321 goto done;
1322 }
1323
David Woodhouseaa21c002007-12-08 20:04:36 +00001324 if (priv->surpriseremoved) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001325 lbs_deb_host("PREP_CMD: card removed\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001326 ret = -1;
1327 goto done;
1328 }
1329
Holger Schurig0d61d042007-12-05 17:58:06 +01001330 cmdnode = lbs_get_cmd_ctrl_node(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001331
1332 if (cmdnode == NULL) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001333 lbs_deb_host("PREP_CMD: cmdnode is NULL\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001334
1335 /* Wake up main thread to execute next command */
Dan Williamsfe336152007-08-02 11:32:25 -04001336 wake_up_interruptible(&priv->waitq);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001337 ret = -1;
1338 goto done;
1339 }
1340
David Woodhouse8e5b6b2d2007-12-14 23:08:13 -05001341 lbs_set_cmd_ctrl_node(priv, cmdnode, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001342
Dan Williamsddac4522007-12-11 13:49:39 -05001343 cmdptr = (struct cmd_ds_command *)cmdnode->cmdbuf;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001344
Holger Schurig8ff12da2007-08-02 11:54:31 -04001345 lbs_deb_host("PREP_CMD: command 0x%04x\n", cmd_no);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001346
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001347 /* Set sequence number, command and INT option */
David Woodhouseaa21c002007-12-08 20:04:36 +00001348 priv->seqnum++;
1349 cmdptr->seqnum = cpu_to_le16(priv->seqnum);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001350
David Woodhouse981f1872007-05-25 23:36:54 -04001351 cmdptr->command = cpu_to_le16(cmd_no);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001352 cmdptr->result = 0;
1353
1354 switch (cmd_no) {
Dan Williams0aef64d2007-08-02 11:31:18 -04001355 case CMD_802_11_PS_MODE:
Holger Schurig10078322007-11-15 18:05:47 -05001356 ret = lbs_cmd_802_11_ps_mode(priv, cmdptr, cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001357 break;
1358
Dan Williams0aef64d2007-08-02 11:31:18 -04001359 case CMD_802_11_SCAN:
Holger Schurig10078322007-11-15 18:05:47 -05001360 ret = lbs_cmd_80211_scan(priv, cmdptr, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001361 break;
1362
Dan Williams0aef64d2007-08-02 11:31:18 -04001363 case CMD_MAC_CONTROL:
Holger Schurig10078322007-11-15 18:05:47 -05001364 ret = lbs_cmd_mac_control(priv, cmdptr);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001365 break;
1366
Dan Williams0aef64d2007-08-02 11:31:18 -04001367 case CMD_802_11_ASSOCIATE:
1368 case CMD_802_11_REASSOCIATE:
Holger Schurig10078322007-11-15 18:05:47 -05001369 ret = lbs_cmd_80211_associate(priv, cmdptr, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001370 break;
1371
Dan Williams0aef64d2007-08-02 11:31:18 -04001372 case CMD_802_11_DEAUTHENTICATE:
Holger Schurig10078322007-11-15 18:05:47 -05001373 ret = lbs_cmd_80211_deauthenticate(priv, cmdptr);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001374 break;
1375
Dan Williams0aef64d2007-08-02 11:31:18 -04001376 case CMD_802_11_AD_HOC_START:
Holger Schurig10078322007-11-15 18:05:47 -05001377 ret = lbs_cmd_80211_ad_hoc_start(priv, cmdptr, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001378 break;
Dan Williams0aef64d2007-08-02 11:31:18 -04001379 case CMD_CODE_DNLD:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001380 break;
1381
Dan Williams0aef64d2007-08-02 11:31:18 -04001382 case CMD_802_11_RESET:
Holger Schurig10078322007-11-15 18:05:47 -05001383 ret = lbs_cmd_802_11_reset(priv, cmdptr, cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001384 break;
1385
Dan Williams0aef64d2007-08-02 11:31:18 -04001386 case CMD_802_11_GET_LOG:
Holger Schurig10078322007-11-15 18:05:47 -05001387 ret = lbs_cmd_802_11_get_log(priv, cmdptr);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001388 break;
1389
Dan Williams0aef64d2007-08-02 11:31:18 -04001390 case CMD_802_11_AUTHENTICATE:
Holger Schurig10078322007-11-15 18:05:47 -05001391 ret = lbs_cmd_80211_authenticate(priv, cmdptr, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001392 break;
1393
Dan Williams0aef64d2007-08-02 11:31:18 -04001394 case CMD_802_11_GET_STAT:
Holger Schurig10078322007-11-15 18:05:47 -05001395 ret = lbs_cmd_802_11_get_stat(priv, cmdptr);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001396 break;
1397
Dan Williams0aef64d2007-08-02 11:31:18 -04001398 case CMD_802_11_SNMP_MIB:
Holger Schurig10078322007-11-15 18:05:47 -05001399 ret = lbs_cmd_802_11_snmp_mib(priv, cmdptr,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001400 cmd_action, cmd_oid, pdata_buf);
1401 break;
1402
Dan Williams0aef64d2007-08-02 11:31:18 -04001403 case CMD_MAC_REG_ACCESS:
1404 case CMD_BBP_REG_ACCESS:
1405 case CMD_RF_REG_ACCESS:
Holger Schurig10078322007-11-15 18:05:47 -05001406 ret = lbs_cmd_reg_access(priv, cmdptr, cmd_action, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001407 break;
1408
Dan Williams0aef64d2007-08-02 11:31:18 -04001409 case CMD_802_11_RF_TX_POWER:
Holger Schurig10078322007-11-15 18:05:47 -05001410 ret = lbs_cmd_802_11_rf_tx_power(priv, cmdptr,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001411 cmd_action, pdata_buf);
1412 break;
1413
Dan Williams0aef64d2007-08-02 11:31:18 -04001414 case CMD_802_11_RATE_ADAPT_RATESET:
Holger Schurig10078322007-11-15 18:05:47 -05001415 ret = lbs_cmd_802_11_rate_adapt_rateset(priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001416 cmdptr, cmd_action);
1417 break;
1418
Dan Williams0aef64d2007-08-02 11:31:18 -04001419 case CMD_MAC_MULTICAST_ADR:
Holger Schurig10078322007-11-15 18:05:47 -05001420 ret = lbs_cmd_mac_multicast_adr(priv, cmdptr, cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001421 break;
1422
Luis Carlos Cobo965f8bbc2007-08-02 13:16:55 -04001423 case CMD_802_11_MONITOR_MODE:
Holger Schurig10078322007-11-15 18:05:47 -05001424 ret = lbs_cmd_802_11_monitor_mode(priv, cmdptr,
Luis Carlos Cobo965f8bbc2007-08-02 13:16:55 -04001425 cmd_action, pdata_buf);
1426 break;
1427
Dan Williams0aef64d2007-08-02 11:31:18 -04001428 case CMD_802_11_AD_HOC_JOIN:
Holger Schurig10078322007-11-15 18:05:47 -05001429 ret = lbs_cmd_80211_ad_hoc_join(priv, cmdptr, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001430 break;
1431
Dan Williams0aef64d2007-08-02 11:31:18 -04001432 case CMD_802_11_RSSI:
Holger Schurig10078322007-11-15 18:05:47 -05001433 ret = lbs_cmd_802_11_rssi(priv, cmdptr);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001434 break;
1435
Dan Williams0aef64d2007-08-02 11:31:18 -04001436 case CMD_802_11_AD_HOC_STOP:
Holger Schurig10078322007-11-15 18:05:47 -05001437 ret = lbs_cmd_80211_ad_hoc_stop(priv, cmdptr);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001438 break;
1439
Dan Williams0aef64d2007-08-02 11:31:18 -04001440 case CMD_802_11_KEY_MATERIAL:
Holger Schurig10078322007-11-15 18:05:47 -05001441 ret = lbs_cmd_802_11_key_material(priv, cmdptr, cmd_action,
Dan Williams90a42212007-05-25 23:01:24 -04001442 cmd_oid, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001443 break;
1444
Dan Williams0aef64d2007-08-02 11:31:18 -04001445 case CMD_802_11_PAIRWISE_TSC:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001446 break;
Dan Williams0aef64d2007-08-02 11:31:18 -04001447 case CMD_802_11_GROUP_TSC:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001448 break;
1449
Dan Williams0aef64d2007-08-02 11:31:18 -04001450 case CMD_802_11_MAC_ADDRESS:
Holger Schurig10078322007-11-15 18:05:47 -05001451 ret = lbs_cmd_802_11_mac_address(priv, cmdptr, cmd_action);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001452 break;
1453
Dan Williams0aef64d2007-08-02 11:31:18 -04001454 case CMD_802_11_EEPROM_ACCESS:
Holger Schurig10078322007-11-15 18:05:47 -05001455 ret = lbs_cmd_802_11_eeprom_access(priv, cmdptr,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001456 cmd_action, pdata_buf);
1457 break;
1458
Dan Williams0aef64d2007-08-02 11:31:18 -04001459 case CMD_802_11_SET_AFC:
1460 case CMD_802_11_GET_AFC:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001461
1462 cmdptr->command = cpu_to_le16(cmd_no);
David Woodhouse981f1872007-05-25 23:36:54 -04001463 cmdptr->size = cpu_to_le16(sizeof(struct cmd_ds_802_11_afc) +
1464 S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001465
1466 memmove(&cmdptr->params.afc,
1467 pdata_buf, sizeof(struct cmd_ds_802_11_afc));
1468
1469 ret = 0;
1470 goto done;
1471
Dan Williams0aef64d2007-08-02 11:31:18 -04001472 case CMD_802_11D_DOMAIN_INFO:
Holger Schurig10078322007-11-15 18:05:47 -05001473 ret = lbs_cmd_802_11d_domain_info(priv, cmdptr,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001474 cmd_no, cmd_action);
1475 break;
1476
Dan Williams0aef64d2007-08-02 11:31:18 -04001477 case CMD_802_11_TPC_CFG:
1478 cmdptr->command = cpu_to_le16(CMD_802_11_TPC_CFG);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001479 cmdptr->size =
1480 cpu_to_le16(sizeof(struct cmd_ds_802_11_tpc_cfg) +
1481 S_DS_GEN);
1482
1483 memmove(&cmdptr->params.tpccfg,
1484 pdata_buf, sizeof(struct cmd_ds_802_11_tpc_cfg));
1485
1486 ret = 0;
1487 break;
Dan Williams0aef64d2007-08-02 11:31:18 -04001488 case CMD_802_11_LED_GPIO_CTRL:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001489 {
1490 struct mrvlietypes_ledgpio *gpio =
1491 (struct mrvlietypes_ledgpio*)
1492 cmdptr->params.ledgpio.data;
1493
1494 memmove(&cmdptr->params.ledgpio,
1495 pdata_buf,
1496 sizeof(struct cmd_ds_802_11_led_ctrl));
1497
1498 cmdptr->command =
Dan Williams0aef64d2007-08-02 11:31:18 -04001499 cpu_to_le16(CMD_802_11_LED_GPIO_CTRL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001500
1501#define ACTION_NUMLED_TLVTYPE_LEN_FIELDS_LEN 8
1502 cmdptr->size =
Holger Schurigc2df2ef2007-12-07 15:30:44 +00001503 cpu_to_le16(le16_to_cpu(gpio->header.len)
1504 + S_DS_GEN
1505 + ACTION_NUMLED_TLVTYPE_LEN_FIELDS_LEN);
1506 gpio->header.len = gpio->header.len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001507
1508 ret = 0;
1509 break;
1510 }
David Woodhouse5844d122007-12-18 02:01:37 -05001511
Dan Williams0aef64d2007-08-02 11:31:18 -04001512 case CMD_802_11_PWR_CFG:
1513 cmdptr->command = cpu_to_le16(CMD_802_11_PWR_CFG);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001514 cmdptr->size =
1515 cpu_to_le16(sizeof(struct cmd_ds_802_11_pwr_cfg) +
1516 S_DS_GEN);
1517 memmove(&cmdptr->params.pwrcfg, pdata_buf,
1518 sizeof(struct cmd_ds_802_11_pwr_cfg));
1519
1520 ret = 0;
1521 break;
Dan Williams0aef64d2007-08-02 11:31:18 -04001522 case CMD_BT_ACCESS:
Holger Schurig10078322007-11-15 18:05:47 -05001523 ret = lbs_cmd_bt_access(priv, cmdptr, cmd_action, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001524 break;
1525
Dan Williams0aef64d2007-08-02 11:31:18 -04001526 case CMD_FWT_ACCESS:
Holger Schurig10078322007-11-15 18:05:47 -05001527 ret = lbs_cmd_fwt_access(priv, cmdptr, cmd_action, pdata_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001528 break;
1529
Dan Williams0aef64d2007-08-02 11:31:18 -04001530 case CMD_GET_TSF:
1531 cmdptr->command = cpu_to_le16(CMD_GET_TSF);
David Woodhouse981f1872007-05-25 23:36:54 -04001532 cmdptr->size = cpu_to_le16(sizeof(struct cmd_ds_get_tsf) +
1533 S_DS_GEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001534 ret = 0;
1535 break;
Brajesh Dave96287ac2007-11-20 17:44:28 -05001536 case CMD_802_11_BEACON_CTRL:
1537 ret = lbs_cmd_bcn_ctrl(priv, cmdptr, cmd_action);
1538 break;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001539 default:
Holger Schurig8ff12da2007-08-02 11:54:31 -04001540 lbs_deb_host("PREP_CMD: unknown command 0x%04x\n", cmd_no);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001541 ret = -1;
1542 break;
1543 }
1544
1545 /* return error, since the command preparation failed */
1546 if (ret != 0) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001547 lbs_deb_host("PREP_CMD: command preparation failed\n");
Holger Schurig10078322007-11-15 18:05:47 -05001548 lbs_cleanup_and_insert_cmd(priv, cmdnode);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001549 ret = -1;
1550 goto done;
1551 }
1552
1553 cmdnode->cmdwaitqwoken = 0;
1554
David Woodhouse681ffbb2007-12-15 20:04:54 -05001555 lbs_queue_cmd(priv, cmdnode);
Dan Williamsfe336152007-08-02 11:32:25 -04001556 wake_up_interruptible(&priv->waitq);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001557
Dan Williams0aef64d2007-08-02 11:31:18 -04001558 if (wait_option & CMD_OPTION_WAITFORRSP) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001559 lbs_deb_host("PREP_CMD: wait for response\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001560 might_sleep();
1561 wait_event_interruptible(cmdnode->cmdwait_q,
1562 cmdnode->cmdwaitqwoken);
1563 }
1564
David Woodhouseaa21c002007-12-08 20:04:36 +00001565 spin_lock_irqsave(&priv->driver_lock, flags);
1566 if (priv->cur_cmd_retcode) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001567 lbs_deb_host("PREP_CMD: command failed with return code %d\n",
David Woodhouseaa21c002007-12-08 20:04:36 +00001568 priv->cur_cmd_retcode);
1569 priv->cur_cmd_retcode = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001570 ret = -1;
1571 }
David Woodhouseaa21c002007-12-08 20:04:36 +00001572 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001573
1574done:
Holger Schurig8ff12da2007-08-02 11:54:31 -04001575 lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001576 return ret;
1577}
1578
1579/**
1580 * @brief This function allocates the command buffer and link
1581 * it to command free queue.
1582 *
Holger Schurig69f90322007-11-23 15:43:44 +01001583 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001584 * @return 0 or -1
1585 */
Holger Schurig69f90322007-11-23 15:43:44 +01001586int lbs_allocate_cmd_buffer(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001587{
1588 int ret = 0;
Dan Williamsddac4522007-12-11 13:49:39 -05001589 u32 bufsize;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001590 u32 i;
Dan Williamsddac4522007-12-11 13:49:39 -05001591 struct cmd_ctrl_node *cmdarray;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001592
Holger Schurig8ff12da2007-08-02 11:54:31 -04001593 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001594
Dan Williamsddac4522007-12-11 13:49:39 -05001595 /* Allocate and initialize the command array */
1596 bufsize = sizeof(struct cmd_ctrl_node) * LBS_NUM_CMD_BUFFERS;
1597 if (!(cmdarray = kzalloc(bufsize, GFP_KERNEL))) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001598 lbs_deb_host("ALLOC_CMD_BUF: tempcmd_array is NULL\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001599 ret = -1;
1600 goto done;
1601 }
Dan Williamsddac4522007-12-11 13:49:39 -05001602 priv->cmd_array = cmdarray;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001603
Dan Williamsddac4522007-12-11 13:49:39 -05001604 /* Allocate and initialize each command buffer in the command array */
1605 for (i = 0; i < LBS_NUM_CMD_BUFFERS; i++) {
1606 cmdarray[i].cmdbuf = kzalloc(LBS_CMD_BUFFER_SIZE, GFP_KERNEL);
1607 if (!cmdarray[i].cmdbuf) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001608 lbs_deb_host("ALLOC_CMD_BUF: ptempvirtualaddr is NULL\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001609 ret = -1;
1610 goto done;
1611 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001612 }
1613
Dan Williamsddac4522007-12-11 13:49:39 -05001614 for (i = 0; i < LBS_NUM_CMD_BUFFERS; i++) {
1615 init_waitqueue_head(&cmdarray[i].cmdwait_q);
1616 lbs_cleanup_and_insert_cmd(priv, &cmdarray[i]);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001617 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001618 ret = 0;
Holger Schurig9012b282007-05-25 11:27:16 -04001619
1620done:
Holger Schurig8ff12da2007-08-02 11:54:31 -04001621 lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001622 return ret;
1623}
1624
1625/**
1626 * @brief This function frees the command buffer.
1627 *
Holger Schurig69f90322007-11-23 15:43:44 +01001628 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001629 * @return 0 or -1
1630 */
Holger Schurig69f90322007-11-23 15:43:44 +01001631int lbs_free_cmd_buffer(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001632{
Dan Williamsddac4522007-12-11 13:49:39 -05001633 struct cmd_ctrl_node *cmdarray;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001634 unsigned int i;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001635
Holger Schurig8ff12da2007-08-02 11:54:31 -04001636 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001637
1638 /* need to check if cmd array is allocated or not */
David Woodhouseaa21c002007-12-08 20:04:36 +00001639 if (priv->cmd_array == NULL) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001640 lbs_deb_host("FREE_CMD_BUF: cmd_array is NULL\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001641 goto done;
1642 }
1643
Dan Williamsddac4522007-12-11 13:49:39 -05001644 cmdarray = priv->cmd_array;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001645
1646 /* Release shared memory buffers */
Dan Williamsddac4522007-12-11 13:49:39 -05001647 for (i = 0; i < LBS_NUM_CMD_BUFFERS; i++) {
1648 if (cmdarray[i].cmdbuf) {
1649 kfree(cmdarray[i].cmdbuf);
1650 cmdarray[i].cmdbuf = NULL;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001651 }
1652 }
1653
1654 /* Release cmd_ctrl_node */
David Woodhouseaa21c002007-12-08 20:04:36 +00001655 if (priv->cmd_array) {
1656 kfree(priv->cmd_array);
1657 priv->cmd_array = NULL;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001658 }
1659
1660done:
Holger Schurig8ff12da2007-08-02 11:54:31 -04001661 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001662 return 0;
1663}
1664
1665/**
1666 * @brief This function gets a free command node if available in
1667 * command free queue.
1668 *
Holger Schurig69f90322007-11-23 15:43:44 +01001669 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001670 * @return cmd_ctrl_node A pointer to cmd_ctrl_node structure or NULL
1671 */
David Woodhouse2fd6cfe2007-12-11 17:44:10 -05001672static struct cmd_ctrl_node *lbs_get_cmd_ctrl_node(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001673{
1674 struct cmd_ctrl_node *tempnode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001675 unsigned long flags;
1676
Holger Schurig8ff12da2007-08-02 11:54:31 -04001677 lbs_deb_enter(LBS_DEB_HOST);
1678
David Woodhouseaa21c002007-12-08 20:04:36 +00001679 if (!priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001680 return NULL;
1681
David Woodhouseaa21c002007-12-08 20:04:36 +00001682 spin_lock_irqsave(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001683
David Woodhouseaa21c002007-12-08 20:04:36 +00001684 if (!list_empty(&priv->cmdfreeq)) {
1685 tempnode = list_first_entry(&priv->cmdfreeq,
Li Zefanabe3ed12007-12-06 13:01:21 +01001686 struct cmd_ctrl_node, list);
1687 list_del(&tempnode->list);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001688 } else {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001689 lbs_deb_host("GET_CMD_NODE: cmd_ctrl_node is not available\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001690 tempnode = NULL;
1691 }
1692
David Woodhouseaa21c002007-12-08 20:04:36 +00001693 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001694
Holger Schurig8ff12da2007-08-02 11:54:31 -04001695 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001696 return tempnode;
1697}
1698
1699/**
1700 * @brief This function cleans command node.
1701 *
1702 * @param ptempnode A pointer to cmdCtrlNode structure
1703 * @return n/a
1704 */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001705
1706/**
1707 * @brief This function initializes the command node.
1708 *
Holger Schurig69f90322007-11-23 15:43:44 +01001709 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001710 * @param ptempnode A pointer to cmd_ctrl_node structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001711 * @param pdata_buf A pointer to informaion buffer
1712 * @return 0 or -1
1713 */
David Woodhouse2fd6cfe2007-12-11 17:44:10 -05001714static void lbs_set_cmd_ctrl_node(struct lbs_private *priv,
1715 struct cmd_ctrl_node *ptempnode,
David Woodhouse8e5b6b2d2007-12-14 23:08:13 -05001716 void *pdata_buf)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001717{
Holger Schurig8ff12da2007-08-02 11:54:31 -04001718 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001719
1720 if (!ptempnode)
1721 return;
1722
David Woodhouse17230472007-12-07 15:13:05 +00001723 ptempnode->callback = NULL;
David Woodhouse75567672007-12-15 02:38:17 -05001724 ptempnode->callback_arg = (unsigned long)pdata_buf;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001725
Holger Schurig8ff12da2007-08-02 11:54:31 -04001726 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001727}
1728
1729/**
1730 * @brief This function executes next command in command
1731 * pending queue. It will put fimware back to PS mode
1732 * if applicable.
1733 *
Holger Schurig69f90322007-11-23 15:43:44 +01001734 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001735 * @return 0 or -1
1736 */
Holger Schurig69f90322007-11-23 15:43:44 +01001737int lbs_execute_next_command(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001738{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001739 struct cmd_ctrl_node *cmdnode = NULL;
Dan Williamsddac4522007-12-11 13:49:39 -05001740 struct cmd_header *cmd;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001741 unsigned long flags;
1742 int ret = 0;
1743
Holger Schurig8ff12da2007-08-02 11:54:31 -04001744 // Debug group is LBS_DEB_THREAD and not LBS_DEB_HOST, because the
Holger Schurig10078322007-11-15 18:05:47 -05001745 // only caller to us is lbs_thread() and we get even when a
Holger Schurig8ff12da2007-08-02 11:54:31 -04001746 // data packet is received
1747 lbs_deb_enter(LBS_DEB_THREAD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001748
David Woodhouseaa21c002007-12-08 20:04:36 +00001749 spin_lock_irqsave(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001750
David Woodhouseaa21c002007-12-08 20:04:36 +00001751 if (priv->cur_cmd) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001752 lbs_pr_alert( "EXEC_NEXT_CMD: already processing command!\n");
David Woodhouseaa21c002007-12-08 20:04:36 +00001753 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001754 ret = -1;
1755 goto done;
1756 }
1757
David Woodhouseaa21c002007-12-08 20:04:36 +00001758 if (!list_empty(&priv->cmdpendingq)) {
1759 cmdnode = list_first_entry(&priv->cmdpendingq,
Li Zefanabe3ed12007-12-06 13:01:21 +01001760 struct cmd_ctrl_node, list);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001761 }
1762
David Woodhouseaa21c002007-12-08 20:04:36 +00001763 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001764
1765 if (cmdnode) {
Dan Williamsddac4522007-12-11 13:49:39 -05001766 cmd = cmdnode->cmdbuf;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001767
Dan Williamsddac4522007-12-11 13:49:39 -05001768 if (is_command_allowed_in_ps(le16_to_cpu(cmd->command))) {
David Woodhouseaa21c002007-12-08 20:04:36 +00001769 if ((priv->psstate == PS_STATE_SLEEP) ||
1770 (priv->psstate == PS_STATE_PRE_SLEEP)) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001771 lbs_deb_host(
1772 "EXEC_NEXT_CMD: cannot send cmd 0x%04x in psstate %d\n",
Dan Williamsddac4522007-12-11 13:49:39 -05001773 le16_to_cpu(cmd->command),
David Woodhouseaa21c002007-12-08 20:04:36 +00001774 priv->psstate);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001775 ret = -1;
1776 goto done;
1777 }
Holger Schurig8ff12da2007-08-02 11:54:31 -04001778 lbs_deb_host("EXEC_NEXT_CMD: OK to send command "
Dan Williamsddac4522007-12-11 13:49:39 -05001779 "0x%04x in psstate %d\n",
1780 le16_to_cpu(cmd->command), priv->psstate);
David Woodhouseaa21c002007-12-08 20:04:36 +00001781 } else if (priv->psstate != PS_STATE_FULL_POWER) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001782 /*
1783 * 1. Non-PS command:
1784 * Queue it. set needtowakeup to TRUE if current state
Holger Schurig10078322007-11-15 18:05:47 -05001785 * is SLEEP, otherwise call lbs_ps_wakeup to send Exit_PS.
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001786 * 2. PS command but not Exit_PS:
1787 * Ignore it.
1788 * 3. PS command Exit_PS:
1789 * Set needtowakeup to TRUE if current state is SLEEP,
1790 * otherwise send this command down to firmware
1791 * immediately.
1792 */
Dan Williamsddac4522007-12-11 13:49:39 -05001793 if (cmd->command != cpu_to_le16(CMD_802_11_PS_MODE)) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001794 /* Prepare to send Exit PS,
1795 * this non PS command will be sent later */
David Woodhouseaa21c002007-12-08 20:04:36 +00001796 if ((priv->psstate == PS_STATE_SLEEP)
1797 || (priv->psstate == PS_STATE_PRE_SLEEP)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001798 ) {
1799 /* w/ new scheme, it will not reach here.
1800 since it is blocked in main_thread. */
David Woodhouseaa21c002007-12-08 20:04:36 +00001801 priv->needtowakeup = 1;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001802 } else
Holger Schurig10078322007-11-15 18:05:47 -05001803 lbs_ps_wakeup(priv, 0);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001804
1805 ret = 0;
1806 goto done;
1807 } else {
1808 /*
1809 * PS command. Ignore it if it is not Exit_PS.
1810 * otherwise send it down immediately.
1811 */
David Woodhouse38bfab12007-12-16 23:26:54 -05001812 struct cmd_ds_802_11_ps_mode *psm = (void *)&cmd[1];
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001813
Holger Schurig8ff12da2007-08-02 11:54:31 -04001814 lbs_deb_host(
1815 "EXEC_NEXT_CMD: PS cmd, action 0x%02x\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001816 psm->action);
1817 if (psm->action !=
Dan Williams0aef64d2007-08-02 11:31:18 -04001818 cpu_to_le16(CMD_SUBCMD_EXIT_PS)) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001819 lbs_deb_host(
1820 "EXEC_NEXT_CMD: ignore ENTER_PS cmd\n");
Li Zefanabe3ed12007-12-06 13:01:21 +01001821 list_del(&cmdnode->list);
David Woodhouse183aeac2007-12-15 01:52:54 -05001822 spin_lock_irqsave(&priv->driver_lock, flags);
1823 lbs_complete_command(priv, cmdnode, 0);
1824 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001825
1826 ret = 0;
1827 goto done;
1828 }
1829
David Woodhouseaa21c002007-12-08 20:04:36 +00001830 if ((priv->psstate == PS_STATE_SLEEP) ||
1831 (priv->psstate == PS_STATE_PRE_SLEEP)) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001832 lbs_deb_host(
1833 "EXEC_NEXT_CMD: ignore EXIT_PS cmd in sleep\n");
Li Zefanabe3ed12007-12-06 13:01:21 +01001834 list_del(&cmdnode->list);
David Woodhouse183aeac2007-12-15 01:52:54 -05001835 spin_lock_irqsave(&priv->driver_lock, flags);
1836 lbs_complete_command(priv, cmdnode, 0);
1837 spin_unlock_irqrestore(&priv->driver_lock, flags);
David Woodhouseaa21c002007-12-08 20:04:36 +00001838 priv->needtowakeup = 1;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001839
1840 ret = 0;
1841 goto done;
1842 }
1843
Holger Schurig8ff12da2007-08-02 11:54:31 -04001844 lbs_deb_host(
1845 "EXEC_NEXT_CMD: sending EXIT_PS\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001846 }
1847 }
Li Zefanabe3ed12007-12-06 13:01:21 +01001848 list_del(&cmdnode->list);
Holger Schurig8ff12da2007-08-02 11:54:31 -04001849 lbs_deb_host("EXEC_NEXT_CMD: sending command 0x%04x\n",
Dan Williamsddac4522007-12-11 13:49:39 -05001850 le16_to_cpu(cmd->command));
David Woodhoused9896ee2007-12-15 00:09:25 -05001851 lbs_submit_command(priv, cmdnode);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001852 } else {
1853 /*
1854 * check if in power save mode, if yes, put the device back
1855 * to PS mode
1856 */
David Woodhouseaa21c002007-12-08 20:04:36 +00001857 if ((priv->psmode != LBS802_11POWERMODECAM) &&
1858 (priv->psstate == PS_STATE_FULL_POWER) &&
1859 ((priv->connect_status == LBS_CONNECTED) ||
1860 (priv->mesh_connect_status == LBS_CONNECTED))) {
1861 if (priv->secinfo.WPAenabled ||
1862 priv->secinfo.WPA2enabled) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001863 /* check for valid WPA group keys */
David Woodhouseaa21c002007-12-08 20:04:36 +00001864 if (priv->wpa_mcast_key.len ||
1865 priv->wpa_unicast_key.len) {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001866 lbs_deb_host(
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001867 "EXEC_NEXT_CMD: WPA enabled and GTK_SET"
1868 " go back to PS_SLEEP");
Holger Schurig10078322007-11-15 18:05:47 -05001869 lbs_ps_sleep(priv, 0);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001870 }
1871 } else {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001872 lbs_deb_host(
1873 "EXEC_NEXT_CMD: cmdpendingq empty, "
1874 "go back to PS_SLEEP");
Holger Schurig10078322007-11-15 18:05:47 -05001875 lbs_ps_sleep(priv, 0);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001876 }
1877 }
1878 }
1879
1880 ret = 0;
1881done:
Holger Schurig8ff12da2007-08-02 11:54:31 -04001882 lbs_deb_leave(LBS_DEB_THREAD);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001883 return ret;
1884}
1885
Holger Schurig69f90322007-11-23 15:43:44 +01001886void lbs_send_iwevcustom_event(struct lbs_private *priv, s8 *str)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001887{
1888 union iwreq_data iwrq;
1889 u8 buf[50];
1890
Holger Schurig8ff12da2007-08-02 11:54:31 -04001891 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001892
1893 memset(&iwrq, 0, sizeof(union iwreq_data));
1894 memset(buf, 0, sizeof(buf));
1895
1896 snprintf(buf, sizeof(buf) - 1, "%s", str);
1897
1898 iwrq.data.length = strlen(buf) + 1 + IW_EV_LCP_LEN;
1899
1900 /* Send Event to upper layer */
Holger Schurig8ff12da2007-08-02 11:54:31 -04001901 lbs_deb_wext("event indication string %s\n", (char *)buf);
1902 lbs_deb_wext("event indication length %d\n", iwrq.data.length);
1903 lbs_deb_wext("sending wireless event IWEVCUSTOM for %s\n", str);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001904
Holger Schurig634b8f42007-05-25 13:05:16 -04001905 wireless_send_event(priv->dev, IWEVCUSTOM, &iwrq, buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001906
Holger Schurig8ff12da2007-08-02 11:54:31 -04001907 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001908}
1909
Holger Schurig69f90322007-11-23 15:43:44 +01001910static int sendconfirmsleep(struct lbs_private *priv, u8 *cmdptr, u16 size)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001911{
1912 unsigned long flags;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001913 int ret = 0;
1914
Holger Schurig8ff12da2007-08-02 11:54:31 -04001915 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001916
Holger Schurig8ff12da2007-08-02 11:54:31 -04001917 lbs_deb_host("SEND_SLEEPC_CMD: before download, cmd size %d\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001918 size);
1919
Holger Schurig8ff12da2007-08-02 11:54:31 -04001920 lbs_deb_hex(LBS_DEB_HOST, "sleep confirm command", cmdptr, size);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001921
Holger Schurig208fdd22007-05-25 12:17:06 -04001922 ret = priv->hw_host_to_card(priv, MVMS_CMD, cmdptr, size);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001923
David Woodhouseaa21c002007-12-08 20:04:36 +00001924 spin_lock_irqsave(&priv->driver_lock, flags);
1925 if (priv->intcounter || priv->currenttxskb)
Holger Schurig8ff12da2007-08-02 11:54:31 -04001926 lbs_deb_host("SEND_SLEEPC_CMD: intcounter %d, currenttxskb %p\n",
David Woodhouseaa21c002007-12-08 20:04:36 +00001927 priv->intcounter, priv->currenttxskb);
1928 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001929
1930 if (ret) {
1931 lbs_pr_alert(
1932 "SEND_SLEEPC_CMD: Host to Card failed for Confirm Sleep\n");
1933 } else {
David Woodhouseaa21c002007-12-08 20:04:36 +00001934 spin_lock_irqsave(&priv->driver_lock, flags);
1935 if (!priv->intcounter) {
1936 priv->psstate = PS_STATE_SLEEP;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001937 } else {
Holger Schurig8ff12da2007-08-02 11:54:31 -04001938 lbs_deb_host("SEND_SLEEPC_CMD: after sent, intcounter %d\n",
David Woodhouseaa21c002007-12-08 20:04:36 +00001939 priv->intcounter);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001940 }
David Woodhouseaa21c002007-12-08 20:04:36 +00001941 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001942
Holger Schurig8ff12da2007-08-02 11:54:31 -04001943 lbs_deb_host("SEND_SLEEPC_CMD: sent confirm sleep\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001944 }
1945
Holger Schurig8ff12da2007-08-02 11:54:31 -04001946 lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001947 return ret;
1948}
1949
Holger Schurig69f90322007-11-23 15:43:44 +01001950void lbs_ps_sleep(struct lbs_private *priv, int wait_option)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001951{
Holger Schurig8ff12da2007-08-02 11:54:31 -04001952 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001953
1954 /*
1955 * PS is currently supported only in Infrastructure mode
1956 * Remove this check if it is to be supported in IBSS mode also
1957 */
1958
Holger Schurig10078322007-11-15 18:05:47 -05001959 lbs_prepare_and_send_command(priv, CMD_802_11_PS_MODE,
Dan Williams0aef64d2007-08-02 11:31:18 -04001960 CMD_SUBCMD_ENTER_PS, wait_option, 0, NULL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001961
Holger Schurig8ff12da2007-08-02 11:54:31 -04001962 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001963}
1964
1965/**
Holger Schurig8ff12da2007-08-02 11:54:31 -04001966 * @brief This function sends Exit_PS command to firmware.
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001967 *
Holger Schurig69f90322007-11-23 15:43:44 +01001968 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001969 * @param wait_option wait response or not
1970 * @return n/a
1971 */
Holger Schurig69f90322007-11-23 15:43:44 +01001972void lbs_ps_wakeup(struct lbs_private *priv, int wait_option)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001973{
David Woodhouse981f1872007-05-25 23:36:54 -04001974 __le32 Localpsmode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001975
Holger Schurig8ff12da2007-08-02 11:54:31 -04001976 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001977
Holger Schurig10078322007-11-15 18:05:47 -05001978 Localpsmode = cpu_to_le32(LBS802_11POWERMODECAM);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001979
Holger Schurig10078322007-11-15 18:05:47 -05001980 lbs_prepare_and_send_command(priv, CMD_802_11_PS_MODE,
Dan Williams0aef64d2007-08-02 11:31:18 -04001981 CMD_SUBCMD_EXIT_PS,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001982 wait_option, 0, &Localpsmode);
1983
Holger Schurig8ff12da2007-08-02 11:54:31 -04001984 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001985}
1986
1987/**
1988 * @brief This function checks condition and prepares to
1989 * send sleep confirm command to firmware if ok.
1990 *
Holger Schurig69f90322007-11-23 15:43:44 +01001991 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001992 * @param psmode Power Saving mode
1993 * @return n/a
1994 */
Holger Schurig69f90322007-11-23 15:43:44 +01001995void lbs_ps_confirm_sleep(struct lbs_private *priv, u16 psmode)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001996{
1997 unsigned long flags =0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001998 u8 allowed = 1;
1999
Holger Schurig8ff12da2007-08-02 11:54:31 -04002000 lbs_deb_enter(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002001
Holger Schurig634b8f42007-05-25 13:05:16 -04002002 if (priv->dnld_sent) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002003 allowed = 0;
David Woodhouse23d36ee2007-12-12 00:14:21 -05002004 lbs_deb_host("dnld_sent was set\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002005 }
2006
David Woodhouseaa21c002007-12-08 20:04:36 +00002007 spin_lock_irqsave(&priv->driver_lock, flags);
2008 if (priv->cur_cmd) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002009 allowed = 0;
David Woodhouse23d36ee2007-12-12 00:14:21 -05002010 lbs_deb_host("cur_cmd was set\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002011 }
David Woodhouseaa21c002007-12-08 20:04:36 +00002012 if (priv->intcounter > 0) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002013 allowed = 0;
David Woodhouse23d36ee2007-12-12 00:14:21 -05002014 lbs_deb_host("intcounter %d\n", priv->intcounter);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002015 }
David Woodhouseaa21c002007-12-08 20:04:36 +00002016 spin_unlock_irqrestore(&priv->driver_lock, flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002017
2018 if (allowed) {
Holger Schurig10078322007-11-15 18:05:47 -05002019 lbs_deb_host("sending lbs_ps_confirm_sleep\n");
David Woodhouseaa21c002007-12-08 20:04:36 +00002020 sendconfirmsleep(priv, (u8 *) & priv->lbs_ps_confirm_sleep,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002021 sizeof(struct PS_CMD_ConfirmSleep));
2022 } else {
Holger Schurig8ff12da2007-08-02 11:54:31 -04002023 lbs_deb_host("sleep confirm has been delayed\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002024 }
2025
Holger Schurig8ff12da2007-08-02 11:54:31 -04002026 lbs_deb_leave(LBS_DEB_HOST);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002027}
Holger Schurig675787e2007-12-05 17:58:11 +01002028
2029
2030/**
Dan Williamsa8bdcd72007-12-11 12:40:35 -05002031 * @brief Simple callback that copies response back into command
2032 *
2033 * @param priv A pointer to struct lbs_private structure
2034 * @param extra A pointer to the original command structure for which
2035 * 'resp' is a response
2036 * @param resp A pointer to the command response
2037 *
2038 * @return 0 on success, error on failure
2039 */
2040int lbs_cmd_copyback(struct lbs_private *priv, unsigned long extra,
David Woodhousead9d7a72007-12-11 15:22:27 -05002041 struct cmd_header *resp)
Dan Williamsa8bdcd72007-12-11 12:40:35 -05002042{
2043 struct cmd_header *buf = (void *)extra;
2044 uint16_t copy_len;
2045
2046 lbs_deb_enter(LBS_DEB_CMD);
2047
2048 copy_len = min(le16_to_cpu(buf->size), le16_to_cpu(resp->size));
2049 lbs_deb_cmd("Copying back %u bytes; command response was %u bytes, "
David Woodhousead9d7a72007-12-11 15:22:27 -05002050 "copy back buffer was %u bytes\n", copy_len,
2051 le16_to_cpu(resp->size), le16_to_cpu(buf->size));
Dan Williamsa8bdcd72007-12-11 12:40:35 -05002052 memcpy(buf, resp, copy_len);
2053
2054 lbs_deb_leave(LBS_DEB_CMD);
2055 return 0;
2056}
David Woodhouse689442d2007-12-12 16:00:42 -05002057EXPORT_SYMBOL_GPL(lbs_cmd_copyback);
Dan Williamsa8bdcd72007-12-11 12:40:35 -05002058
David Woodhouse3399ea52007-12-15 03:09:33 -05002059struct cmd_ctrl_node *__lbs_cmd_async(struct lbs_private *priv, uint16_t command,
2060 struct cmd_header *in_cmd, int in_cmd_size,
2061 int (*callback)(struct lbs_private *, unsigned long, struct cmd_header *),
2062 unsigned long callback_arg)
Holger Schurig675787e2007-12-05 17:58:11 +01002063{
Holger Schurig675787e2007-12-05 17:58:11 +01002064 struct cmd_ctrl_node *cmdnode;
Holger Schurig675787e2007-12-05 17:58:11 +01002065
2066 lbs_deb_enter(LBS_DEB_HOST);
Holger Schurig675787e2007-12-05 17:58:11 +01002067
David Woodhouseaa21c002007-12-08 20:04:36 +00002068 if (priv->surpriseremoved) {
Holger Schurig675787e2007-12-05 17:58:11 +01002069 lbs_deb_host("PREP_CMD: card removed\n");
David Woodhouse3399ea52007-12-15 03:09:33 -05002070 cmdnode = ERR_PTR(-ENOENT);
Holger Schurig675787e2007-12-05 17:58:11 +01002071 goto done;
2072 }
2073
2074 cmdnode = lbs_get_cmd_ctrl_node(priv);
Holger Schurig675787e2007-12-05 17:58:11 +01002075 if (cmdnode == NULL) {
2076 lbs_deb_host("PREP_CMD: cmdnode is NULL\n");
2077
2078 /* Wake up main thread to execute next command */
2079 wake_up_interruptible(&priv->waitq);
David Woodhouse3399ea52007-12-15 03:09:33 -05002080 cmdnode = ERR_PTR(-ENOBUFS);
Holger Schurig675787e2007-12-05 17:58:11 +01002081 goto done;
2082 }
2083
David Woodhouse448a51a2007-12-08 00:59:54 +00002084 cmdnode->callback = callback;
David Woodhouse1309b552007-12-10 13:36:10 -05002085 cmdnode->callback_arg = callback_arg;
Holger Schurig675787e2007-12-05 17:58:11 +01002086
Dan Williams7ad994d2007-12-11 12:33:30 -05002087 /* Copy the incoming command to the buffer */
Dan Williamsddac4522007-12-11 13:49:39 -05002088 memcpy(cmdnode->cmdbuf, in_cmd, in_cmd_size);
Dan Williams7ad994d2007-12-11 12:33:30 -05002089
Holger Schurig675787e2007-12-05 17:58:11 +01002090 /* Set sequence number, clean result, move to buffer */
David Woodhouseaa21c002007-12-08 20:04:36 +00002091 priv->seqnum++;
Dan Williamsddac4522007-12-11 13:49:39 -05002092 cmdnode->cmdbuf->command = cpu_to_le16(command);
2093 cmdnode->cmdbuf->size = cpu_to_le16(in_cmd_size);
2094 cmdnode->cmdbuf->seqnum = cpu_to_le16(priv->seqnum);
2095 cmdnode->cmdbuf->result = 0;
Holger Schurig675787e2007-12-05 17:58:11 +01002096
2097 lbs_deb_host("PREP_CMD: command 0x%04x\n", command);
2098
2099 /* here was the big old switch() statement, which is now obsolete,
2100 * because the caller of lbs_cmd() sets up all of *cmd for us. */
2101
2102 cmdnode->cmdwaitqwoken = 0;
David Woodhouse681ffbb2007-12-15 20:04:54 -05002103 lbs_queue_cmd(priv, cmdnode);
Holger Schurig675787e2007-12-05 17:58:11 +01002104 wake_up_interruptible(&priv->waitq);
2105
David Woodhouse3399ea52007-12-15 03:09:33 -05002106 done:
2107 lbs_deb_leave_args(LBS_DEB_HOST, "ret %p", cmdnode);
2108 return cmdnode;
2109}
2110
2111int __lbs_cmd(struct lbs_private *priv, uint16_t command,
2112 struct cmd_header *in_cmd, int in_cmd_size,
2113 int (*callback)(struct lbs_private *, unsigned long, struct cmd_header *),
2114 unsigned long callback_arg)
2115{
2116 struct cmd_ctrl_node *cmdnode;
2117 unsigned long flags;
2118 int ret = 0;
2119
2120 lbs_deb_enter(LBS_DEB_HOST);
2121
2122 cmdnode = __lbs_cmd_async(priv, command, in_cmd, in_cmd_size,
2123 callback, callback_arg);
2124 if (IS_ERR(cmdnode)) {
2125 ret = PTR_ERR(cmdnode);
2126 goto done;
2127 }
2128
Holger Schurig675787e2007-12-05 17:58:11 +01002129 might_sleep();
2130 wait_event_interruptible(cmdnode->cmdwait_q, cmdnode->cmdwaitqwoken);
2131
David Woodhouseaa21c002007-12-08 20:04:36 +00002132 spin_lock_irqsave(&priv->driver_lock, flags);
David Woodhouseae125bf2007-12-15 04:22:52 -05002133 ret = cmdnode->result;
2134 if (ret)
2135 lbs_pr_info("PREP_CMD: command 0x%04x failed: %d\n",
2136 command, ret);
David Woodhouse3399ea52007-12-15 03:09:33 -05002137
David Woodhousead12d0f2007-12-15 02:06:16 -05002138 __lbs_cleanup_and_insert_cmd(priv, cmdnode);
David Woodhouseaa21c002007-12-08 20:04:36 +00002139 spin_unlock_irqrestore(&priv->driver_lock, flags);
Holger Schurig675787e2007-12-05 17:58:11 +01002140
2141done:
2142 lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
2143 return ret;
2144}
Dan Williams14e865b2007-12-10 15:11:23 -05002145EXPORT_SYMBOL_GPL(__lbs_cmd);
Holger Schurig675787e2007-12-05 17:58:11 +01002146
2147