2 * This file is part of wl1271
4 * Copyright (C) 2009-2010 Nokia Corporation
6 * Contact: Luciano Coelho <luciano.coelho@nokia.com>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * version 2 as published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
24 #include <linux/module.h>
25 #include <linux/platform_device.h>
26 #include <linux/crc7.h>
27 #include <linux/spi/spi.h>
28 #include <linux/etherdevice.h>
29 #include <linux/ieee80211.h>
30 #include <linux/slab.h>
33 #include "wl1271_reg.h"
34 #include "wl1271_io.h"
35 #include "wl1271_acx.h"
36 #include "wl12xx_80211.h"
37 #include "wl1271_cmd.h"
38 #include "wl1271_event.h"
40 #define WL1271_CMD_FAST_POLL_COUNT 50
43 * send command to firmware
47 * @buf: buffer containing the command, must work with dma
48 * @len: length of the buffer
50 int wl1271_cmd_send(struct wl1271 *wl, u16 id, void *buf, size_t len,
53 struct wl1271_cmd_header *cmd;
54 unsigned long timeout;
61 cmd->id = cpu_to_le16(id);
64 WARN_ON(len % 4 != 0);
66 wl1271_write(wl, wl->cmd_box_addr, buf, len, false);
68 wl1271_write32(wl, ACX_REG_INTERRUPT_TRIG, INTR_TRIG_CMD);
70 timeout = jiffies + msecs_to_jiffies(WL1271_COMMAND_TIMEOUT);
72 intr = wl1271_read32(wl, ACX_REG_INTERRUPT_NO_CLEAR);
73 while (!(intr & WL1271_ACX_INTR_CMD_COMPLETE)) {
74 if (time_after(jiffies, timeout)) {
75 wl1271_error("command complete timeout");
81 if (poll_count < WL1271_CMD_FAST_POLL_COUNT)
86 intr = wl1271_read32(wl, ACX_REG_INTERRUPT_NO_CLEAR);
89 /* read back the status code of the command */
91 res_len = sizeof(struct wl1271_cmd_header);
92 wl1271_read(wl, wl->cmd_box_addr, cmd, res_len, false);
94 status = le16_to_cpu(cmd->status);
95 if (status != CMD_STATUS_SUCCESS) {
96 wl1271_error("command execute failure %d", status);
100 wl1271_write32(wl, ACX_REG_INTERRUPT_ACK,
101 WL1271_ACX_INTR_CMD_COMPLETE);
107 static int wl1271_cmd_cal_channel_tune(struct wl1271 *wl)
109 struct wl1271_cmd_cal_channel_tune *cmd;
112 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
116 cmd->test.id = TEST_CMD_CHANNEL_TUNE;
118 cmd->band = WL1271_CHANNEL_TUNE_BAND_2_4;
119 /* set up any channel, 7 is in the middle of the range */
122 ret = wl1271_cmd_test(wl, cmd, sizeof(*cmd), 0);
124 wl1271_warning("TEST_CMD_CHANNEL_TUNE failed");
130 static int wl1271_cmd_cal_update_ref_point(struct wl1271 *wl)
132 struct wl1271_cmd_cal_update_ref_point *cmd;
135 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
139 cmd->test.id = TEST_CMD_UPDATE_PD_REFERENCE_POINT;
141 /* FIXME: still waiting for the correct values */
143 cmd->ref_detector = 0;
145 cmd->sub_band = WL1271_PD_REFERENCE_POINT_BAND_B_G;
147 ret = wl1271_cmd_test(wl, cmd, sizeof(*cmd), 0);
149 wl1271_warning("TEST_CMD_UPDATE_PD_REFERENCE_POINT failed");
155 static int wl1271_cmd_cal_p2g(struct wl1271 *wl)
157 struct wl1271_cmd_cal_p2g *cmd;
160 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
164 cmd->test.id = TEST_CMD_P2G_CAL;
166 cmd->sub_band_mask = WL1271_CAL_P2G_BAND_B_G;
168 ret = wl1271_cmd_test(wl, cmd, sizeof(*cmd), 0);
170 wl1271_warning("TEST_CMD_P2G_CAL failed");
176 static int wl1271_cmd_cal(struct wl1271 *wl)
179 * FIXME: we must make sure that we're not sleeping when calibration
184 wl1271_notice("performing tx calibration");
186 ret = wl1271_cmd_cal_channel_tune(wl);
190 ret = wl1271_cmd_cal_update_ref_point(wl);
194 ret = wl1271_cmd_cal_p2g(wl);
201 int wl1271_cmd_general_parms(struct wl1271 *wl)
203 struct wl1271_general_parms_cmd *gen_parms;
209 gen_parms = kzalloc(sizeof(*gen_parms), GFP_KERNEL);
213 gen_parms->test.id = TEST_CMD_INI_FILE_GENERAL_PARAM;
215 memcpy(&gen_parms->general_params, &wl->nvs->general_params,
216 sizeof(struct wl1271_ini_general_params));
218 ret = wl1271_cmd_test(wl, gen_parms, sizeof(*gen_parms), 0);
220 wl1271_warning("CMD_INI_FILE_GENERAL_PARAM failed");
226 int wl1271_cmd_radio_parms(struct wl1271 *wl)
228 struct wl1271_radio_parms_cmd *radio_parms;
229 struct conf_radio_parms *rparam = &wl->conf.init.radioparam;
235 radio_parms = kzalloc(sizeof(*radio_parms), GFP_KERNEL);
239 radio_parms->test.id = TEST_CMD_INI_FILE_RADIO_PARAM;
241 /* 2.4GHz parameters */
242 memcpy(&radio_parms->static_params_2, &wl->nvs->stat_radio_params_2,
243 sizeof(struct wl1271_ini_band_params_2));
244 memcpy(&radio_parms->dyn_params_2,
245 &wl->nvs->dyn_radio_params_2[rparam->fem].params,
246 sizeof(struct wl1271_ini_fem_params_2));
248 /* 5GHz parameters */
249 memcpy(&radio_parms->static_params_5,
250 &wl->nvs->stat_radio_params_5,
251 sizeof(struct wl1271_ini_band_params_5));
252 memcpy(&radio_parms->dyn_params_5,
253 &wl->nvs->dyn_radio_params_5[rparam->fem].params,
254 sizeof(struct wl1271_ini_fem_params_5));
256 wl1271_dump(DEBUG_CMD, "TEST_CMD_INI_FILE_RADIO_PARAM: ",
257 radio_parms, sizeof(*radio_parms));
259 ret = wl1271_cmd_test(wl, radio_parms, sizeof(*radio_parms), 0);
261 wl1271_warning("CMD_INI_FILE_RADIO_PARAM failed");
268 * Poll the mailbox event field until any of the bits in the mask is set or a
269 * timeout occurs (WL1271_EVENT_TIMEOUT in msecs)
271 static int wl1271_cmd_wait_for_event(struct wl1271 *wl, u32 mask)
273 u32 events_vector, event;
274 unsigned long timeout;
276 timeout = jiffies + msecs_to_jiffies(WL1271_EVENT_TIMEOUT);
279 if (time_after(jiffies, timeout))
284 /* read from both event fields */
285 wl1271_read(wl, wl->mbox_ptr[0], &events_vector,
286 sizeof(events_vector), false);
287 event = events_vector & mask;
288 wl1271_read(wl, wl->mbox_ptr[1], &events_vector,
289 sizeof(events_vector), false);
290 event |= events_vector & mask;
296 int wl1271_cmd_join(struct wl1271 *wl, u8 bss_type)
298 static bool do_cal = true;
299 struct wl1271_cmd_join *join;
303 /* FIXME: remove when we get calibration from the factory */
305 ret = wl1271_cmd_cal(wl);
307 wl1271_warning("couldn't calibrate");
312 join = kzalloc(sizeof(*join), GFP_KERNEL);
318 wl1271_debug(DEBUG_CMD, "cmd join");
320 /* Reverse order BSSID */
321 bssid = (u8 *) &join->bssid_lsb;
322 for (i = 0; i < ETH_ALEN; i++)
323 bssid[i] = wl->bssid[ETH_ALEN - i - 1];
325 join->rx_config_options = cpu_to_le32(wl->rx_config);
326 join->rx_filter_options = cpu_to_le32(wl->rx_filter);
327 join->bss_type = bss_type;
328 join->basic_rate_set = cpu_to_le32(wl->basic_rate_set);
330 if (wl->band == IEEE80211_BAND_5GHZ)
331 join->bss_type |= WL1271_JOIN_CMD_BSS_TYPE_5GHZ;
333 join->beacon_interval = cpu_to_le16(wl->beacon_int);
334 join->dtim_interval = WL1271_DEFAULT_DTIM_PERIOD;
336 join->channel = wl->channel;
337 join->ssid_len = wl->ssid_len;
338 memcpy(join->ssid, wl->ssid, wl->ssid_len);
340 join->ctrl |= wl->session_counter << WL1271_JOIN_CMD_TX_SESSION_OFFSET;
342 /* reset TX security counters */
343 wl->tx_security_last_seq = 0;
344 wl->tx_security_seq = 0;
346 ret = wl1271_cmd_send(wl, CMD_START_JOIN, join, sizeof(*join), 0);
348 wl1271_error("failed to initiate cmd join");
352 ret = wl1271_cmd_wait_for_event(wl, JOIN_EVENT_COMPLETE_ID);
354 wl1271_error("cmd join event completion error");
364 * send test command to firmware
367 * @buf: buffer containing the command, with all headers, must work with dma
368 * @len: length of the buffer
369 * @answer: is answer needed
371 int wl1271_cmd_test(struct wl1271 *wl, void *buf, size_t buf_len, u8 answer)
376 wl1271_debug(DEBUG_CMD, "cmd test");
381 ret = wl1271_cmd_send(wl, CMD_TEST, buf, buf_len, res_len);
384 wl1271_warning("TEST command failed");
392 * read acx from firmware
396 * @buf: buffer for the response, including all headers, must work with dma
397 * @len: lenght of buf
399 int wl1271_cmd_interrogate(struct wl1271 *wl, u16 id, void *buf, size_t len)
401 struct acx_header *acx = buf;
404 wl1271_debug(DEBUG_CMD, "cmd interrogate");
406 acx->id = cpu_to_le16(id);
408 /* payload length, does not include any headers */
409 acx->len = cpu_to_le16(len - sizeof(*acx));
411 ret = wl1271_cmd_send(wl, CMD_INTERROGATE, acx, sizeof(*acx), len);
413 wl1271_error("INTERROGATE command failed");
419 * write acx value to firmware
423 * @buf: buffer containing acx, including all headers, must work with dma
424 * @len: length of buf
426 int wl1271_cmd_configure(struct wl1271 *wl, u16 id, void *buf, size_t len)
428 struct acx_header *acx = buf;
431 wl1271_debug(DEBUG_CMD, "cmd configure");
433 acx->id = cpu_to_le16(id);
435 /* payload length, does not include any headers */
436 acx->len = cpu_to_le16(len - sizeof(*acx));
438 ret = wl1271_cmd_send(wl, CMD_CONFIGURE, acx, len, 0);
440 wl1271_warning("CONFIGURE command NOK");
447 int wl1271_cmd_data_path(struct wl1271 *wl, bool enable)
449 struct cmd_enabledisable_path *cmd;
453 wl1271_debug(DEBUG_CMD, "cmd data path");
455 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
461 /* the channel here is only used for calibration, so hardcoded to 1 */
465 cmd_rx = CMD_ENABLE_RX;
466 cmd_tx = CMD_ENABLE_TX;
468 cmd_rx = CMD_DISABLE_RX;
469 cmd_tx = CMD_DISABLE_TX;
472 ret = wl1271_cmd_send(wl, cmd_rx, cmd, sizeof(*cmd), 0);
474 wl1271_error("rx %s cmd for channel %d failed",
475 enable ? "start" : "stop", cmd->channel);
479 wl1271_debug(DEBUG_BOOT, "rx %s cmd channel %d",
480 enable ? "start" : "stop", cmd->channel);
482 ret = wl1271_cmd_send(wl, cmd_tx, cmd, sizeof(*cmd), 0);
484 wl1271_error("tx %s cmd for channel %d failed",
485 enable ? "start" : "stop", cmd->channel);
489 wl1271_debug(DEBUG_BOOT, "tx %s cmd channel %d",
490 enable ? "start" : "stop", cmd->channel);
497 int wl1271_cmd_ps_mode(struct wl1271 *wl, u8 ps_mode, bool send)
499 struct wl1271_cmd_ps_params *ps_params = NULL;
502 /* FIXME: this should be in ps.c */
503 ret = wl1271_acx_wake_up_conditions(wl);
505 wl1271_error("couldn't set wake up conditions");
509 wl1271_debug(DEBUG_CMD, "cmd set ps mode");
511 ps_params = kzalloc(sizeof(*ps_params), GFP_KERNEL);
517 ps_params->ps_mode = ps_mode;
518 ps_params->send_null_data = send;
519 ps_params->retries = 5;
520 ps_params->hang_over_period = 1;
521 ps_params->null_data_rate = cpu_to_le32(1); /* 1 Mbps */
523 ret = wl1271_cmd_send(wl, CMD_SET_PS_MODE, ps_params,
524 sizeof(*ps_params), 0);
526 wl1271_error("cmd set_ps_mode failed");
535 int wl1271_cmd_read_memory(struct wl1271 *wl, u32 addr, void *answer,
538 struct cmd_read_write_memory *cmd;
541 wl1271_debug(DEBUG_CMD, "cmd read memory");
543 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
549 WARN_ON(len > MAX_READ_SIZE);
550 len = min_t(size_t, len, MAX_READ_SIZE);
552 cmd->addr = cpu_to_le32(addr);
553 cmd->size = cpu_to_le32(len);
555 ret = wl1271_cmd_send(wl, CMD_READ_MEMORY, cmd, sizeof(*cmd),
558 wl1271_error("read memory command failed: %d", ret);
562 /* the read command got in */
563 memcpy(answer, cmd->value, len);
570 int wl1271_cmd_scan(struct wl1271 *wl, const u8 *ssid, size_t ssid_len,
571 const u8 *ie, size_t ie_len, u8 active_scan,
572 u8 high_prio, u8 band, u8 probe_requests)
575 struct wl1271_cmd_trigger_scan_to *trigger = NULL;
576 struct wl1271_cmd_scan *params = NULL;
577 struct ieee80211_channel *channels;
580 u16 scan_options = 0;
583 if (band == WL1271_SCAN_BAND_2_4_GHZ) {
584 ieee_band = IEEE80211_BAND_2GHZ;
585 rate = wl->conf.tx.basic_rate;
586 } else if (band == WL1271_SCAN_BAND_DUAL && wl1271_11a_enabled()) {
587 ieee_band = IEEE80211_BAND_2GHZ;
588 rate = wl->conf.tx.basic_rate;
589 } else if (band == WL1271_SCAN_BAND_5_GHZ && wl1271_11a_enabled()) {
590 ieee_band = IEEE80211_BAND_5GHZ;
591 rate = wl->conf.tx.basic_rate_5;
595 if (wl->hw->wiphy->bands[ieee_band]->channels == NULL)
598 channels = wl->hw->wiphy->bands[ieee_band]->channels;
599 n_ch = wl->hw->wiphy->bands[ieee_band]->n_channels;
601 if (test_bit(WL1271_FLAG_SCANNING, &wl->flags))
604 params = kzalloc(sizeof(*params), GFP_KERNEL);
608 params->params.rx_config_options = cpu_to_le32(CFG_RX_ALL_GOOD);
609 params->params.rx_filter_options =
610 cpu_to_le32(CFG_RX_PRSP_EN | CFG_RX_MGMT_EN | CFG_RX_BCN_EN);
613 scan_options |= WL1271_SCAN_OPT_PASSIVE;
615 scan_options |= WL1271_SCAN_OPT_PRIORITY_HIGH;
616 params->params.scan_options = cpu_to_le16(scan_options);
618 params->params.num_probe_requests = probe_requests;
619 params->params.tx_rate = cpu_to_le32(rate);
620 params->params.tid_trigger = 0;
621 params->params.scan_tag = WL1271_SCAN_DEFAULT_TAG;
623 if (band == WL1271_SCAN_BAND_DUAL)
624 params->params.band = WL1271_SCAN_BAND_2_4_GHZ;
626 params->params.band = band;
628 for (i = 0, j = 0; i < n_ch && i < WL1271_SCAN_MAX_CHANNELS; i++) {
629 if (!(channels[i].flags & IEEE80211_CHAN_DISABLED)) {
630 params->channels[j].min_duration =
631 cpu_to_le32(WL1271_SCAN_CHAN_MIN_DURATION);
632 params->channels[j].max_duration =
633 cpu_to_le32(WL1271_SCAN_CHAN_MAX_DURATION);
634 memset(¶ms->channels[j].bssid_lsb, 0xff, 4);
635 memset(¶ms->channels[j].bssid_msb, 0xff, 2);
636 params->channels[j].early_termination = 0;
637 params->channels[j].tx_power_att =
638 WL1271_SCAN_CURRENT_TX_PWR;
639 params->channels[j].channel = channels[i].hw_value;
644 params->params.num_channels = j;
646 if (ssid_len && ssid) {
647 params->params.ssid_len = ssid_len;
648 memcpy(params->params.ssid, ssid, ssid_len);
651 ret = wl1271_cmd_build_probe_req(wl, ssid, ssid_len,
652 ie, ie_len, ieee_band);
654 wl1271_error("PROBE request template failed");
658 trigger = kzalloc(sizeof(*trigger), GFP_KERNEL);
664 /* disable the timeout */
665 trigger->timeout = 0;
667 ret = wl1271_cmd_send(wl, CMD_TRIGGER_SCAN_TO, trigger,
668 sizeof(*trigger), 0);
670 wl1271_error("trigger scan to failed for hw scan");
674 wl1271_dump(DEBUG_SCAN, "SCAN: ", params, sizeof(*params));
676 set_bit(WL1271_FLAG_SCANNING, &wl->flags);
677 if (wl1271_11a_enabled()) {
678 wl->scan.state = band;
679 if (band == WL1271_SCAN_BAND_DUAL) {
680 wl->scan.active = active_scan;
681 wl->scan.high_prio = high_prio;
682 wl->scan.probe_requests = probe_requests;
683 if (ssid_len && ssid) {
684 wl->scan.ssid_len = ssid_len;
685 memcpy(wl->scan.ssid, ssid, ssid_len);
687 wl->scan.ssid_len = 0;
691 ret = wl1271_cmd_send(wl, CMD_SCAN, params, sizeof(*params), 0);
693 wl1271_error("SCAN failed");
694 clear_bit(WL1271_FLAG_SCANNING, &wl->flags);
704 int wl1271_cmd_template_set(struct wl1271 *wl, u16 template_id,
705 void *buf, size_t buf_len, int index, u32 rates)
707 struct wl1271_cmd_template_set *cmd;
710 wl1271_debug(DEBUG_CMD, "cmd template_set %d", template_id);
712 WARN_ON(buf_len > WL1271_CMD_TEMPL_MAX_SIZE);
713 buf_len = min_t(size_t, buf_len, WL1271_CMD_TEMPL_MAX_SIZE);
715 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
721 cmd->len = cpu_to_le16(buf_len);
722 cmd->template_type = template_id;
723 cmd->enabled_rates = cpu_to_le32(rates);
724 cmd->short_retry_limit = wl->conf.tx.rc_conf.short_retry_limit;
725 cmd->long_retry_limit = wl->conf.tx.rc_conf.long_retry_limit;
729 memcpy(cmd->template_data, buf, buf_len);
731 ret = wl1271_cmd_send(wl, CMD_SET_TEMPLATE, cmd, sizeof(*cmd), 0);
733 wl1271_warning("cmd set_template failed: %d", ret);
744 int wl1271_cmd_build_null_data(struct wl1271 *wl)
746 struct sk_buff *skb = NULL;
752 if (wl->bss_type == BSS_TYPE_IBSS) {
753 size = sizeof(struct wl12xx_null_data_template);
756 skb = ieee80211_nullfunc_get(wl->hw, wl->vif);
763 ret = wl1271_cmd_template_set(wl, CMD_TEMPL_NULL_DATA, ptr, size, 0,
764 WL1271_RATE_AUTOMATIC);
769 wl1271_warning("cmd buld null data failed %d", ret);
775 int wl1271_cmd_build_klv_null_data(struct wl1271 *wl)
777 struct sk_buff *skb = NULL;
780 skb = ieee80211_nullfunc_get(wl->hw, wl->vif);
784 ret = wl1271_cmd_template_set(wl, CMD_TEMPL_KLV,
786 CMD_TEMPL_KLV_IDX_NULL_DATA,
787 WL1271_RATE_AUTOMATIC);
792 wl1271_warning("cmd build klv null data failed %d", ret);
798 int wl1271_cmd_build_ps_poll(struct wl1271 *wl, u16 aid)
803 skb = ieee80211_pspoll_get(wl->hw, wl->vif);
807 ret = wl1271_cmd_template_set(wl, CMD_TEMPL_PS_POLL, skb->data,
808 skb->len, 0, wl->basic_rate);
815 int wl1271_cmd_build_probe_req(struct wl1271 *wl,
816 const u8 *ssid, size_t ssid_len,
817 const u8 *ie, size_t ie_len, u8 band)
822 skb = ieee80211_probereq_get(wl->hw, wl->vif, ssid, ssid_len,
829 wl1271_dump(DEBUG_SCAN, "PROBE REQ: ", skb->data, skb->len);
831 if (band == IEEE80211_BAND_2GHZ)
832 ret = wl1271_cmd_template_set(wl, CMD_TEMPL_CFG_PROBE_REQ_2_4,
833 skb->data, skb->len, 0,
834 wl->conf.tx.basic_rate);
836 ret = wl1271_cmd_template_set(wl, CMD_TEMPL_CFG_PROBE_REQ_5,
837 skb->data, skb->len, 0,
838 wl->conf.tx.basic_rate_5);
845 int wl1271_build_qos_null_data(struct wl1271 *wl)
847 struct ieee80211_qos_hdr template;
849 memset(&template, 0, sizeof(template));
851 memcpy(template.addr1, wl->bssid, ETH_ALEN);
852 memcpy(template.addr2, wl->mac_addr, ETH_ALEN);
853 memcpy(template.addr3, wl->bssid, ETH_ALEN);
855 template.frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA |
856 IEEE80211_STYPE_QOS_NULLFUNC |
857 IEEE80211_FCTL_TODS);
859 /* FIXME: not sure what priority to use here */
860 template.qos_ctrl = cpu_to_le16(0);
862 return wl1271_cmd_template_set(wl, CMD_TEMPL_QOS_NULL_DATA, &template,
864 WL1271_RATE_AUTOMATIC);
867 int wl1271_cmd_set_default_wep_key(struct wl1271 *wl, u8 id)
869 struct wl1271_cmd_set_keys *cmd;
872 wl1271_debug(DEBUG_CMD, "cmd set_default_wep_key %d", id);
874 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
881 cmd->key_action = cpu_to_le16(KEY_SET_ID);
882 cmd->key_type = KEY_WEP;
884 ret = wl1271_cmd_send(wl, CMD_SET_KEYS, cmd, sizeof(*cmd), 0);
886 wl1271_warning("cmd set_default_wep_key failed: %d", ret);
896 int wl1271_cmd_set_key(struct wl1271 *wl, u16 action, u8 id, u8 key_type,
897 u8 key_size, const u8 *key, const u8 *addr,
898 u32 tx_seq_32, u16 tx_seq_16)
900 struct wl1271_cmd_set_keys *cmd;
903 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
909 if (key_type != KEY_WEP)
910 memcpy(cmd->addr, addr, ETH_ALEN);
912 cmd->key_action = cpu_to_le16(action);
913 cmd->key_size = key_size;
914 cmd->key_type = key_type;
916 cmd->ac_seq_num16[0] = cpu_to_le16(tx_seq_16);
917 cmd->ac_seq_num32[0] = cpu_to_le32(tx_seq_32);
919 /* we have only one SSID profile */
920 cmd->ssid_profile = 0;
924 if (key_type == KEY_TKIP) {
926 * We get the key in the following form:
927 * TKIP (16 bytes) - TX MIC (8 bytes) - RX MIC (8 bytes)
928 * but the target is expecting:
929 * TKIP - RX MIC - TX MIC
931 memcpy(cmd->key, key, 16);
932 memcpy(cmd->key + 16, key + 24, 8);
933 memcpy(cmd->key + 24, key + 16, 8);
936 memcpy(cmd->key, key, key_size);
939 wl1271_dump(DEBUG_CRYPT, "TARGET KEY: ", cmd, sizeof(*cmd));
941 ret = wl1271_cmd_send(wl, CMD_SET_KEYS, cmd, sizeof(*cmd), 0);
943 wl1271_warning("could not set keys");
953 int wl1271_cmd_disconnect(struct wl1271 *wl)
955 struct wl1271_cmd_disconnect *cmd;
958 wl1271_debug(DEBUG_CMD, "cmd disconnect");
960 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
966 cmd->rx_config_options = cpu_to_le32(wl->rx_config);
967 cmd->rx_filter_options = cpu_to_le32(wl->rx_filter);
968 /* disconnect reason is not used in immediate disconnections */
969 cmd->type = DISCONNECT_IMMEDIATE;
971 ret = wl1271_cmd_send(wl, CMD_DISCONNECT, cmd, sizeof(*cmd), 0);
973 wl1271_error("failed to send disconnect command");
977 ret = wl1271_cmd_wait_for_event(wl, DISCONNECT_EVENT_COMPLETE_ID);
979 wl1271_error("cmd disconnect event completion error");