OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / net / wireless / wl12xx / acx.c
blob7537c401a4487174a0d50680b1d84e68c3e16675
1 /*
2 * This file is part of wl1271
4 * Copyright (C) 2008-2009 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
20 * 02110-1301 USA
24 #include "acx.h"
26 #include <linux/module.h>
27 #include <linux/platform_device.h>
28 #include <linux/spi/spi.h>
29 #include <linux/slab.h>
31 #include "wl12xx.h"
32 #include "debug.h"
33 #include "wl12xx_80211.h"
34 #include "reg.h"
35 #include "ps.h"
37 int wl1271_acx_wake_up_conditions(struct wl1271 *wl, struct wl12xx_vif *wlvif)
39 struct acx_wake_up_condition *wake_up;
40 int ret;
42 wl1271_debug(DEBUG_ACX, "acx wake up conditions");
44 wake_up = kzalloc(sizeof(*wake_up), GFP_KERNEL);
45 if (!wake_up) {
46 ret = -ENOMEM;
47 goto out;
50 wake_up->role_id = wlvif->role_id;
51 wake_up->wake_up_event = wl->conf.conn.wake_up_event;
52 wake_up->listen_interval = wl->conf.conn.listen_interval;
54 ret = wl1271_cmd_configure(wl, ACX_WAKE_UP_CONDITIONS,
55 wake_up, sizeof(*wake_up));
56 if (ret < 0) {
57 wl1271_warning("could not set wake up conditions: %d", ret);
58 goto out;
61 out:
62 kfree(wake_up);
63 return ret;
66 int wl1271_acx_sleep_auth(struct wl1271 *wl, u8 sleep_auth)
68 struct acx_sleep_auth *auth;
69 int ret;
71 wl1271_debug(DEBUG_ACX, "acx sleep auth");
73 auth = kzalloc(sizeof(*auth), GFP_KERNEL);
74 if (!auth) {
75 ret = -ENOMEM;
76 goto out;
79 auth->sleep_auth = sleep_auth;
81 ret = wl1271_cmd_configure(wl, ACX_SLEEP_AUTH, auth, sizeof(*auth));
83 out:
84 kfree(auth);
85 return ret;
88 int wl1271_acx_tx_power(struct wl1271 *wl, struct wl12xx_vif *wlvif,
89 int power)
91 struct acx_current_tx_power *acx;
92 int ret;
94 wl1271_debug(DEBUG_ACX, "acx dot11_cur_tx_pwr %d", power);
96 if (power < 0 || power > 25)
97 return -EINVAL;
99 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
100 if (!acx) {
101 ret = -ENOMEM;
102 goto out;
105 acx->role_id = wlvif->role_id;
106 acx->current_tx_power = power * 10;
108 ret = wl1271_cmd_configure(wl, DOT11_CUR_TX_PWR, acx, sizeof(*acx));
109 if (ret < 0) {
110 wl1271_warning("configure of tx power failed: %d", ret);
111 goto out;
114 out:
115 kfree(acx);
116 return ret;
119 int wl1271_acx_feature_cfg(struct wl1271 *wl, struct wl12xx_vif *wlvif)
121 struct acx_feature_config *feature;
122 int ret;
124 wl1271_debug(DEBUG_ACX, "acx feature cfg");
126 feature = kzalloc(sizeof(*feature), GFP_KERNEL);
127 if (!feature) {
128 ret = -ENOMEM;
129 goto out;
132 /* DF_ENCRYPTION_DISABLE and DF_SNIFF_MODE_ENABLE are disabled */
133 feature->role_id = wlvif->role_id;
134 feature->data_flow_options = 0;
135 feature->options = 0;
137 ret = wl1271_cmd_configure(wl, ACX_FEATURE_CFG,
138 feature, sizeof(*feature));
139 if (ret < 0) {
140 wl1271_error("Couldnt set HW encryption");
141 goto out;
144 out:
145 kfree(feature);
146 return ret;
149 int wl1271_acx_mem_map(struct wl1271 *wl, struct acx_header *mem_map,
150 size_t len)
152 int ret;
154 wl1271_debug(DEBUG_ACX, "acx mem map");
156 ret = wl1271_cmd_interrogate(wl, ACX_MEM_MAP, mem_map, len);
157 if (ret < 0)
158 return ret;
160 return 0;
163 int wl1271_acx_rx_msdu_life_time(struct wl1271 *wl)
165 struct acx_rx_msdu_lifetime *acx;
166 int ret;
168 wl1271_debug(DEBUG_ACX, "acx rx msdu life time");
170 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
171 if (!acx) {
172 ret = -ENOMEM;
173 goto out;
176 acx->lifetime = cpu_to_le32(wl->conf.rx.rx_msdu_life_time);
177 ret = wl1271_cmd_configure(wl, DOT11_RX_MSDU_LIFE_TIME,
178 acx, sizeof(*acx));
179 if (ret < 0) {
180 wl1271_warning("failed to set rx msdu life time: %d", ret);
181 goto out;
184 out:
185 kfree(acx);
186 return ret;
189 int wl1271_acx_slot(struct wl1271 *wl, struct wl12xx_vif *wlvif,
190 enum acx_slot_type slot_time)
192 struct acx_slot *slot;
193 int ret;
195 wl1271_debug(DEBUG_ACX, "acx slot");
197 slot = kzalloc(sizeof(*slot), GFP_KERNEL);
198 if (!slot) {
199 ret = -ENOMEM;
200 goto out;
203 slot->role_id = wlvif->role_id;
204 slot->wone_index = STATION_WONE_INDEX;
205 slot->slot_time = slot_time;
207 ret = wl1271_cmd_configure(wl, ACX_SLOT, slot, sizeof(*slot));
208 if (ret < 0) {
209 wl1271_warning("failed to set slot time: %d", ret);
210 goto out;
213 out:
214 kfree(slot);
215 return ret;
218 int wl1271_acx_group_address_tbl(struct wl1271 *wl, struct wl12xx_vif *wlvif,
219 bool enable, void *mc_list, u32 mc_list_len)
221 struct acx_dot11_grp_addr_tbl *acx;
222 int ret;
224 wl1271_debug(DEBUG_ACX, "acx group address tbl");
226 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
227 if (!acx) {
228 ret = -ENOMEM;
229 goto out;
232 /* MAC filtering */
233 acx->role_id = wlvif->role_id;
234 acx->enabled = enable;
235 acx->num_groups = mc_list_len;
236 memcpy(acx->mac_table, mc_list, mc_list_len * ETH_ALEN);
238 ret = wl1271_cmd_configure(wl, DOT11_GROUP_ADDRESS_TBL,
239 acx, sizeof(*acx));
240 if (ret < 0) {
241 wl1271_warning("failed to set group addr table: %d", ret);
242 goto out;
245 out:
246 kfree(acx);
247 return ret;
250 int wl1271_acx_service_period_timeout(struct wl1271 *wl,
251 struct wl12xx_vif *wlvif)
253 struct acx_rx_timeout *rx_timeout;
254 int ret;
256 rx_timeout = kzalloc(sizeof(*rx_timeout), GFP_KERNEL);
257 if (!rx_timeout) {
258 ret = -ENOMEM;
259 goto out;
262 wl1271_debug(DEBUG_ACX, "acx service period timeout");
264 rx_timeout->role_id = wlvif->role_id;
265 rx_timeout->ps_poll_timeout = cpu_to_le16(wl->conf.rx.ps_poll_timeout);
266 rx_timeout->upsd_timeout = cpu_to_le16(wl->conf.rx.upsd_timeout);
268 ret = wl1271_cmd_configure(wl, ACX_SERVICE_PERIOD_TIMEOUT,
269 rx_timeout, sizeof(*rx_timeout));
270 if (ret < 0) {
271 wl1271_warning("failed to set service period timeout: %d",
272 ret);
273 goto out;
276 out:
277 kfree(rx_timeout);
278 return ret;
281 int wl1271_acx_rts_threshold(struct wl1271 *wl, struct wl12xx_vif *wlvif,
282 u32 rts_threshold)
284 struct acx_rts_threshold *rts;
285 int ret;
288 * If the RTS threshold is not configured or out of range, use the
289 * default value.
291 if (rts_threshold > IEEE80211_MAX_RTS_THRESHOLD)
292 rts_threshold = wl->conf.rx.rts_threshold;
294 wl1271_debug(DEBUG_ACX, "acx rts threshold: %d", rts_threshold);
296 rts = kzalloc(sizeof(*rts), GFP_KERNEL);
297 if (!rts) {
298 ret = -ENOMEM;
299 goto out;
302 rts->role_id = wlvif->role_id;
303 rts->threshold = cpu_to_le16((u16)rts_threshold);
305 ret = wl1271_cmd_configure(wl, DOT11_RTS_THRESHOLD, rts, sizeof(*rts));
306 if (ret < 0) {
307 wl1271_warning("failed to set rts threshold: %d", ret);
308 goto out;
311 out:
312 kfree(rts);
313 return ret;
316 int wl1271_acx_dco_itrim_params(struct wl1271 *wl)
318 struct acx_dco_itrim_params *dco;
319 struct conf_itrim_settings *c = &wl->conf.itrim;
320 int ret;
322 wl1271_debug(DEBUG_ACX, "acx dco itrim parameters");
324 dco = kzalloc(sizeof(*dco), GFP_KERNEL);
325 if (!dco) {
326 ret = -ENOMEM;
327 goto out;
330 dco->enable = c->enable;
331 dco->timeout = cpu_to_le32(c->timeout);
333 ret = wl1271_cmd_configure(wl, ACX_SET_DCO_ITRIM_PARAMS,
334 dco, sizeof(*dco));
335 if (ret < 0) {
336 wl1271_warning("failed to set dco itrim parameters: %d", ret);
337 goto out;
340 out:
341 kfree(dco);
342 return ret;
345 int wl1271_acx_beacon_filter_opt(struct wl1271 *wl, struct wl12xx_vif *wlvif,
346 bool enable_filter)
348 struct acx_beacon_filter_option *beacon_filter = NULL;
349 int ret = 0;
351 wl1271_debug(DEBUG_ACX, "acx beacon filter opt");
353 if (enable_filter &&
354 wl->conf.conn.bcn_filt_mode == CONF_BCN_FILT_MODE_DISABLED)
355 goto out;
357 beacon_filter = kzalloc(sizeof(*beacon_filter), GFP_KERNEL);
358 if (!beacon_filter) {
359 ret = -ENOMEM;
360 goto out;
363 beacon_filter->role_id = wlvif->role_id;
364 beacon_filter->enable = enable_filter;
367 * When set to zero, and the filter is enabled, beacons
368 * without the unicast TIM bit set are dropped.
370 beacon_filter->max_num_beacons = 0;
372 ret = wl1271_cmd_configure(wl, ACX_BEACON_FILTER_OPT,
373 beacon_filter, sizeof(*beacon_filter));
374 if (ret < 0) {
375 wl1271_warning("failed to set beacon filter opt: %d", ret);
376 goto out;
379 out:
380 kfree(beacon_filter);
381 return ret;
384 int wl1271_acx_beacon_filter_table(struct wl1271 *wl,
385 struct wl12xx_vif *wlvif)
387 struct acx_beacon_filter_ie_table *ie_table;
388 int i, idx = 0;
389 int ret;
390 bool vendor_spec = false;
392 wl1271_debug(DEBUG_ACX, "acx beacon filter table");
394 ie_table = kzalloc(sizeof(*ie_table), GFP_KERNEL);
395 if (!ie_table) {
396 ret = -ENOMEM;
397 goto out;
400 /* configure default beacon pass-through rules */
401 ie_table->role_id = wlvif->role_id;
402 ie_table->num_ie = 0;
403 for (i = 0; i < wl->conf.conn.bcn_filt_ie_count; i++) {
404 struct conf_bcn_filt_rule *r = &(wl->conf.conn.bcn_filt_ie[i]);
405 ie_table->table[idx++] = r->ie;
406 ie_table->table[idx++] = r->rule;
408 if (r->ie == WLAN_EID_VENDOR_SPECIFIC) {
409 /* only one vendor specific ie allowed */
410 if (vendor_spec)
411 continue;
413 /* for vendor specific rules configure the
414 additional fields */
415 memcpy(&(ie_table->table[idx]), r->oui,
416 CONF_BCN_IE_OUI_LEN);
417 idx += CONF_BCN_IE_OUI_LEN;
418 ie_table->table[idx++] = r->type;
419 memcpy(&(ie_table->table[idx]), r->version,
420 CONF_BCN_IE_VER_LEN);
421 idx += CONF_BCN_IE_VER_LEN;
422 vendor_spec = true;
425 ie_table->num_ie++;
428 ret = wl1271_cmd_configure(wl, ACX_BEACON_FILTER_TABLE,
429 ie_table, sizeof(*ie_table));
430 if (ret < 0) {
431 wl1271_warning("failed to set beacon filter table: %d", ret);
432 goto out;
435 out:
436 kfree(ie_table);
437 return ret;
440 #define ACX_CONN_MONIT_DISABLE_VALUE 0xffffffff
442 int wl1271_acx_conn_monit_params(struct wl1271 *wl, struct wl12xx_vif *wlvif,
443 bool enable)
445 struct acx_conn_monit_params *acx;
446 u32 threshold = ACX_CONN_MONIT_DISABLE_VALUE;
447 u32 timeout = ACX_CONN_MONIT_DISABLE_VALUE;
448 int ret;
450 wl1271_debug(DEBUG_ACX, "acx connection monitor parameters: %s",
451 enable ? "enabled" : "disabled");
453 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
454 if (!acx) {
455 ret = -ENOMEM;
456 goto out;
459 if (enable) {
460 threshold = wl->conf.conn.synch_fail_thold;
461 timeout = wl->conf.conn.bss_lose_timeout;
464 acx->role_id = wlvif->role_id;
465 acx->synch_fail_thold = cpu_to_le32(threshold);
466 acx->bss_lose_timeout = cpu_to_le32(timeout);
468 ret = wl1271_cmd_configure(wl, ACX_CONN_MONIT_PARAMS,
469 acx, sizeof(*acx));
470 if (ret < 0) {
471 wl1271_warning("failed to set connection monitor "
472 "parameters: %d", ret);
473 goto out;
476 out:
477 kfree(acx);
478 return ret;
482 int wl1271_acx_sg_enable(struct wl1271 *wl, bool enable)
484 struct acx_bt_wlan_coex *pta;
485 int ret;
487 wl1271_debug(DEBUG_ACX, "acx sg enable");
489 pta = kzalloc(sizeof(*pta), GFP_KERNEL);
490 if (!pta) {
491 ret = -ENOMEM;
492 goto out;
495 if (enable)
496 pta->enable = wl->conf.sg.state;
497 else
498 pta->enable = CONF_SG_DISABLE;
500 ret = wl1271_cmd_configure(wl, ACX_SG_ENABLE, pta, sizeof(*pta));
501 if (ret < 0) {
502 wl1271_warning("failed to set softgemini enable: %d", ret);
503 goto out;
506 out:
507 kfree(pta);
508 return ret;
511 int wl12xx_acx_sg_cfg(struct wl1271 *wl)
513 struct acx_bt_wlan_coex_param *param;
514 struct conf_sg_settings *c = &wl->conf.sg;
515 int i, ret;
517 wl1271_debug(DEBUG_ACX, "acx sg cfg");
519 param = kzalloc(sizeof(*param), GFP_KERNEL);
520 if (!param) {
521 ret = -ENOMEM;
522 goto out;
525 /* BT-WLAN coext parameters */
526 for (i = 0; i < CONF_SG_PARAMS_MAX; i++)
527 param->params[i] = cpu_to_le32(c->params[i]);
528 param->param_idx = CONF_SG_PARAMS_ALL;
530 ret = wl1271_cmd_configure(wl, ACX_SG_CFG, param, sizeof(*param));
531 if (ret < 0) {
532 wl1271_warning("failed to set sg config: %d", ret);
533 goto out;
536 out:
537 kfree(param);
538 return ret;
541 int wl1271_acx_cca_threshold(struct wl1271 *wl)
543 struct acx_energy_detection *detection;
544 int ret;
546 wl1271_debug(DEBUG_ACX, "acx cca threshold");
548 detection = kzalloc(sizeof(*detection), GFP_KERNEL);
549 if (!detection) {
550 ret = -ENOMEM;
551 goto out;
554 detection->rx_cca_threshold = cpu_to_le16(wl->conf.rx.rx_cca_threshold);
555 detection->tx_energy_detection = wl->conf.tx.tx_energy_detection;
557 ret = wl1271_cmd_configure(wl, ACX_CCA_THRESHOLD,
558 detection, sizeof(*detection));
559 if (ret < 0)
560 wl1271_warning("failed to set cca threshold: %d", ret);
562 out:
563 kfree(detection);
564 return ret;
567 int wl1271_acx_bcn_dtim_options(struct wl1271 *wl, struct wl12xx_vif *wlvif)
569 struct acx_beacon_broadcast *bb;
570 int ret;
572 wl1271_debug(DEBUG_ACX, "acx bcn dtim options");
574 bb = kzalloc(sizeof(*bb), GFP_KERNEL);
575 if (!bb) {
576 ret = -ENOMEM;
577 goto out;
580 bb->role_id = wlvif->role_id;
581 bb->beacon_rx_timeout = cpu_to_le16(wl->conf.conn.beacon_rx_timeout);
582 bb->broadcast_timeout = cpu_to_le16(wl->conf.conn.broadcast_timeout);
583 bb->rx_broadcast_in_ps = wl->conf.conn.rx_broadcast_in_ps;
584 bb->ps_poll_threshold = wl->conf.conn.ps_poll_threshold;
586 ret = wl1271_cmd_configure(wl, ACX_BCN_DTIM_OPTIONS, bb, sizeof(*bb));
587 if (ret < 0) {
588 wl1271_warning("failed to set rx config: %d", ret);
589 goto out;
592 out:
593 kfree(bb);
594 return ret;
597 int wl1271_acx_aid(struct wl1271 *wl, struct wl12xx_vif *wlvif, u16 aid)
599 struct acx_aid *acx_aid;
600 int ret;
602 wl1271_debug(DEBUG_ACX, "acx aid");
604 acx_aid = kzalloc(sizeof(*acx_aid), GFP_KERNEL);
605 if (!acx_aid) {
606 ret = -ENOMEM;
607 goto out;
610 acx_aid->role_id = wlvif->role_id;
611 acx_aid->aid = cpu_to_le16(aid);
613 ret = wl1271_cmd_configure(wl, ACX_AID, acx_aid, sizeof(*acx_aid));
614 if (ret < 0) {
615 wl1271_warning("failed to set aid: %d", ret);
616 goto out;
619 out:
620 kfree(acx_aid);
621 return ret;
624 int wl1271_acx_event_mbox_mask(struct wl1271 *wl, u32 event_mask)
626 struct acx_event_mask *mask;
627 int ret;
629 wl1271_debug(DEBUG_ACX, "acx event mbox mask");
631 mask = kzalloc(sizeof(*mask), GFP_KERNEL);
632 if (!mask) {
633 ret = -ENOMEM;
634 goto out;
637 /* high event mask is unused */
638 mask->high_event_mask = cpu_to_le32(0xffffffff);
639 mask->event_mask = cpu_to_le32(event_mask);
641 ret = wl1271_cmd_configure(wl, ACX_EVENT_MBOX_MASK,
642 mask, sizeof(*mask));
643 if (ret < 0) {
644 wl1271_warning("failed to set acx_event_mbox_mask: %d", ret);
645 goto out;
648 out:
649 kfree(mask);
650 return ret;
653 int wl1271_acx_set_preamble(struct wl1271 *wl, struct wl12xx_vif *wlvif,
654 enum acx_preamble_type preamble)
656 struct acx_preamble *acx;
657 int ret;
659 wl1271_debug(DEBUG_ACX, "acx_set_preamble");
661 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
662 if (!acx) {
663 ret = -ENOMEM;
664 goto out;
667 acx->role_id = wlvif->role_id;
668 acx->preamble = preamble;
670 ret = wl1271_cmd_configure(wl, ACX_PREAMBLE_TYPE, acx, sizeof(*acx));
671 if (ret < 0) {
672 wl1271_warning("Setting of preamble failed: %d", ret);
673 goto out;
676 out:
677 kfree(acx);
678 return ret;
681 int wl1271_acx_cts_protect(struct wl1271 *wl, struct wl12xx_vif *wlvif,
682 enum acx_ctsprotect_type ctsprotect)
684 struct acx_ctsprotect *acx;
685 int ret;
687 wl1271_debug(DEBUG_ACX, "acx_set_ctsprotect");
689 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
690 if (!acx) {
691 ret = -ENOMEM;
692 goto out;
695 acx->role_id = wlvif->role_id;
696 acx->ctsprotect = ctsprotect;
698 ret = wl1271_cmd_configure(wl, ACX_CTS_PROTECTION, acx, sizeof(*acx));
699 if (ret < 0) {
700 wl1271_warning("Setting of ctsprotect failed: %d", ret);
701 goto out;
704 out:
705 kfree(acx);
706 return ret;
709 int wl1271_acx_statistics(struct wl1271 *wl, struct acx_statistics *stats)
711 int ret;
713 wl1271_debug(DEBUG_ACX, "acx statistics");
715 ret = wl1271_cmd_interrogate(wl, ACX_STATISTICS, stats,
716 sizeof(*stats));
717 if (ret < 0) {
718 wl1271_warning("acx statistics failed: %d", ret);
719 return -ENOMEM;
722 return 0;
725 int wl1271_acx_sta_rate_policies(struct wl1271 *wl, struct wl12xx_vif *wlvif)
727 struct acx_rate_policy *acx;
728 struct conf_tx_rate_class *c = &wl->conf.tx.sta_rc_conf;
729 int ret = 0;
731 wl1271_debug(DEBUG_ACX, "acx rate policies");
733 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
735 if (!acx) {
736 ret = -ENOMEM;
737 goto out;
740 wl1271_debug(DEBUG_ACX, "basic_rate: 0x%x, full_rate: 0x%x",
741 wlvif->basic_rate, wlvif->rate_set);
743 /* configure one basic rate class */
744 acx->rate_policy_idx = cpu_to_le32(wlvif->sta.basic_rate_idx);
745 acx->rate_policy.enabled_rates = cpu_to_le32(wlvif->basic_rate);
746 acx->rate_policy.short_retry_limit = c->short_retry_limit;
747 acx->rate_policy.long_retry_limit = c->long_retry_limit;
748 acx->rate_policy.aflags = c->aflags;
750 ret = wl1271_cmd_configure(wl, ACX_RATE_POLICY, acx, sizeof(*acx));
751 if (ret < 0) {
752 wl1271_warning("Setting of rate policies failed: %d", ret);
753 goto out;
756 /* configure one AP supported rate class */
757 acx->rate_policy_idx = cpu_to_le32(wlvif->sta.ap_rate_idx);
758 acx->rate_policy.enabled_rates = cpu_to_le32(wlvif->rate_set);
759 acx->rate_policy.short_retry_limit = c->short_retry_limit;
760 acx->rate_policy.long_retry_limit = c->long_retry_limit;
761 acx->rate_policy.aflags = c->aflags;
763 ret = wl1271_cmd_configure(wl, ACX_RATE_POLICY, acx, sizeof(*acx));
764 if (ret < 0) {
765 wl1271_warning("Setting of rate policies failed: %d", ret);
766 goto out;
770 * configure one rate class for basic p2p operations.
771 * (p2p packets should always go out with OFDM rates, even
772 * if we are currently connected to 11b AP)
774 acx->rate_policy_idx = cpu_to_le32(wlvif->sta.p2p_rate_idx);
775 acx->rate_policy.enabled_rates =
776 cpu_to_le32(CONF_TX_RATE_MASK_BASIC_P2P);
777 acx->rate_policy.short_retry_limit = c->short_retry_limit;
778 acx->rate_policy.long_retry_limit = c->long_retry_limit;
779 acx->rate_policy.aflags = c->aflags;
781 ret = wl1271_cmd_configure(wl, ACX_RATE_POLICY, acx, sizeof(*acx));
782 if (ret < 0) {
783 wl1271_warning("Setting of rate policies failed: %d", ret);
784 goto out;
787 out:
788 kfree(acx);
789 return ret;
792 int wl1271_acx_ap_rate_policy(struct wl1271 *wl, struct conf_tx_rate_class *c,
793 u8 idx)
795 struct acx_rate_policy *acx;
796 int ret = 0;
798 wl1271_debug(DEBUG_ACX, "acx ap rate policy %d rates 0x%x",
799 idx, c->enabled_rates);
801 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
802 if (!acx) {
803 ret = -ENOMEM;
804 goto out;
807 acx->rate_policy.enabled_rates = cpu_to_le32(c->enabled_rates);
808 acx->rate_policy.short_retry_limit = c->short_retry_limit;
809 acx->rate_policy.long_retry_limit = c->long_retry_limit;
810 acx->rate_policy.aflags = c->aflags;
812 acx->rate_policy_idx = cpu_to_le32(idx);
814 ret = wl1271_cmd_configure(wl, ACX_RATE_POLICY, acx, sizeof(*acx));
815 if (ret < 0) {
816 wl1271_warning("Setting of ap rate policy failed: %d", ret);
817 goto out;
820 out:
821 kfree(acx);
822 return ret;
825 int wl1271_acx_ac_cfg(struct wl1271 *wl, struct wl12xx_vif *wlvif,
826 u8 ac, u8 cw_min, u16 cw_max, u8 aifsn, u16 txop)
828 struct acx_ac_cfg *acx;
829 int ret = 0;
831 wl1271_debug(DEBUG_ACX, "acx ac cfg %d cw_ming %d cw_max %d "
832 "aifs %d txop %d", ac, cw_min, cw_max, aifsn, txop);
834 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
836 if (!acx) {
837 ret = -ENOMEM;
838 goto out;
841 acx->role_id = wlvif->role_id;
842 acx->ac = ac;
843 acx->cw_min = cw_min;
844 acx->cw_max = cpu_to_le16(cw_max);
845 acx->aifsn = aifsn;
846 acx->tx_op_limit = cpu_to_le16(txop);
848 ret = wl1271_cmd_configure(wl, ACX_AC_CFG, acx, sizeof(*acx));
849 if (ret < 0) {
850 wl1271_warning("acx ac cfg failed: %d", ret);
851 goto out;
854 out:
855 kfree(acx);
856 return ret;
859 int wl1271_acx_tid_cfg(struct wl1271 *wl, struct wl12xx_vif *wlvif,
860 u8 queue_id, u8 channel_type,
861 u8 tsid, u8 ps_scheme, u8 ack_policy,
862 u32 apsd_conf0, u32 apsd_conf1)
864 struct acx_tid_config *acx;
865 int ret = 0;
867 wl1271_debug(DEBUG_ACX, "acx tid config");
869 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
871 if (!acx) {
872 ret = -ENOMEM;
873 goto out;
876 acx->role_id = wlvif->role_id;
877 acx->queue_id = queue_id;
878 acx->channel_type = channel_type;
879 acx->tsid = tsid;
880 acx->ps_scheme = ps_scheme;
881 acx->ack_policy = ack_policy;
882 acx->apsd_conf[0] = cpu_to_le32(apsd_conf0);
883 acx->apsd_conf[1] = cpu_to_le32(apsd_conf1);
885 ret = wl1271_cmd_configure(wl, ACX_TID_CFG, acx, sizeof(*acx));
886 if (ret < 0) {
887 wl1271_warning("Setting of tid config failed: %d", ret);
888 goto out;
891 out:
892 kfree(acx);
893 return ret;
896 int wl1271_acx_frag_threshold(struct wl1271 *wl, u32 frag_threshold)
898 struct acx_frag_threshold *acx;
899 int ret = 0;
902 * If the fragmentation is not configured or out of range, use the
903 * default value.
905 if (frag_threshold > IEEE80211_MAX_FRAG_THRESHOLD)
906 frag_threshold = wl->conf.tx.frag_threshold;
908 wl1271_debug(DEBUG_ACX, "acx frag threshold: %d", frag_threshold);
910 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
912 if (!acx) {
913 ret = -ENOMEM;
914 goto out;
917 acx->frag_threshold = cpu_to_le16((u16)frag_threshold);
918 ret = wl1271_cmd_configure(wl, ACX_FRAG_CFG, acx, sizeof(*acx));
919 if (ret < 0) {
920 wl1271_warning("Setting of frag threshold failed: %d", ret);
921 goto out;
924 out:
925 kfree(acx);
926 return ret;
929 int wl1271_acx_tx_config_options(struct wl1271 *wl)
931 struct acx_tx_config_options *acx;
932 int ret = 0;
934 wl1271_debug(DEBUG_ACX, "acx tx config options");
936 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
938 if (!acx) {
939 ret = -ENOMEM;
940 goto out;
943 acx->tx_compl_timeout = cpu_to_le16(wl->conf.tx.tx_compl_timeout);
944 acx->tx_compl_threshold = cpu_to_le16(wl->conf.tx.tx_compl_threshold);
945 ret = wl1271_cmd_configure(wl, ACX_TX_CONFIG_OPT, acx, sizeof(*acx));
946 if (ret < 0) {
947 wl1271_warning("Setting of tx options failed: %d", ret);
948 goto out;
951 out:
952 kfree(acx);
953 return ret;
956 int wl12xx_acx_mem_cfg(struct wl1271 *wl)
958 struct wl12xx_acx_config_memory *mem_conf;
959 struct conf_memory_settings *mem;
960 int ret;
962 wl1271_debug(DEBUG_ACX, "wl1271 mem cfg");
964 mem_conf = kzalloc(sizeof(*mem_conf), GFP_KERNEL);
965 if (!mem_conf) {
966 ret = -ENOMEM;
967 goto out;
970 if (wl->chip.id == CHIP_ID_1283_PG20)
971 mem = &wl->conf.mem_wl128x;
972 else
973 mem = &wl->conf.mem_wl127x;
975 /* memory config */
976 mem_conf->num_stations = mem->num_stations;
977 mem_conf->rx_mem_block_num = mem->rx_block_num;
978 mem_conf->tx_min_mem_block_num = mem->tx_min_block_num;
979 mem_conf->num_ssid_profiles = mem->ssid_profiles;
980 mem_conf->total_tx_descriptors = cpu_to_le32(ACX_TX_DESCRIPTORS);
981 mem_conf->dyn_mem_enable = mem->dynamic_memory;
982 mem_conf->tx_free_req = mem->min_req_tx_blocks;
983 mem_conf->rx_free_req = mem->min_req_rx_blocks;
984 mem_conf->tx_min = mem->tx_min;
985 mem_conf->fwlog_blocks = wl->conf.fwlog.mem_blocks;
987 ret = wl1271_cmd_configure(wl, ACX_MEM_CFG, mem_conf,
988 sizeof(*mem_conf));
989 if (ret < 0) {
990 wl1271_warning("wl1271 mem config failed: %d", ret);
991 goto out;
994 out:
995 kfree(mem_conf);
996 return ret;
999 int wl1271_acx_host_if_cfg_bitmap(struct wl1271 *wl, u32 host_cfg_bitmap)
1001 struct wl1271_acx_host_config_bitmap *bitmap_conf;
1002 int ret;
1004 bitmap_conf = kzalloc(sizeof(*bitmap_conf), GFP_KERNEL);
1005 if (!bitmap_conf) {
1006 ret = -ENOMEM;
1007 goto out;
1010 bitmap_conf->host_cfg_bitmap = cpu_to_le32(host_cfg_bitmap);
1012 ret = wl1271_cmd_configure(wl, ACX_HOST_IF_CFG_BITMAP,
1013 bitmap_conf, sizeof(*bitmap_conf));
1014 if (ret < 0) {
1015 wl1271_warning("wl1271 bitmap config opt failed: %d", ret);
1016 goto out;
1019 out:
1020 kfree(bitmap_conf);
1022 return ret;
1025 int wl1271_acx_init_mem_config(struct wl1271 *wl)
1027 int ret;
1029 wl->target_mem_map = kzalloc(sizeof(struct wl1271_acx_mem_map),
1030 GFP_KERNEL);
1031 if (!wl->target_mem_map) {
1032 wl1271_error("couldn't allocate target memory map");
1033 return -ENOMEM;
1036 /* we now ask for the firmware built memory map */
1037 ret = wl1271_acx_mem_map(wl, (void *)wl->target_mem_map,
1038 sizeof(struct wl1271_acx_mem_map));
1039 if (ret < 0) {
1040 wl1271_error("couldn't retrieve firmware memory map");
1041 kfree(wl->target_mem_map);
1042 wl->target_mem_map = NULL;
1043 return ret;
1046 /* initialize TX block book keeping */
1047 wl->tx_blocks_available =
1048 le32_to_cpu(wl->target_mem_map->num_tx_mem_blocks);
1049 wl1271_debug(DEBUG_TX, "available tx blocks: %d",
1050 wl->tx_blocks_available);
1052 return 0;
1055 int wl1271_acx_init_rx_interrupt(struct wl1271 *wl)
1057 struct wl1271_acx_rx_config_opt *rx_conf;
1058 int ret;
1060 wl1271_debug(DEBUG_ACX, "wl1271 rx interrupt config");
1062 rx_conf = kzalloc(sizeof(*rx_conf), GFP_KERNEL);
1063 if (!rx_conf) {
1064 ret = -ENOMEM;
1065 goto out;
1068 rx_conf->threshold = cpu_to_le16(wl->conf.rx.irq_pkt_threshold);
1069 rx_conf->timeout = cpu_to_le16(wl->conf.rx.irq_timeout);
1070 rx_conf->mblk_threshold = cpu_to_le16(wl->conf.rx.irq_blk_threshold);
1071 rx_conf->queue_type = wl->conf.rx.queue_type;
1073 ret = wl1271_cmd_configure(wl, ACX_RX_CONFIG_OPT, rx_conf,
1074 sizeof(*rx_conf));
1075 if (ret < 0) {
1076 wl1271_warning("wl1271 rx config opt failed: %d", ret);
1077 goto out;
1080 out:
1081 kfree(rx_conf);
1082 return ret;
1085 int wl1271_acx_bet_enable(struct wl1271 *wl, struct wl12xx_vif *wlvif,
1086 bool enable)
1088 struct wl1271_acx_bet_enable *acx = NULL;
1089 int ret = 0;
1091 wl1271_debug(DEBUG_ACX, "acx bet enable");
1093 if (enable && wl->conf.conn.bet_enable == CONF_BET_MODE_DISABLE)
1094 goto out;
1096 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1097 if (!acx) {
1098 ret = -ENOMEM;
1099 goto out;
1102 acx->role_id = wlvif->role_id;
1103 acx->enable = enable ? CONF_BET_MODE_ENABLE : CONF_BET_MODE_DISABLE;
1104 acx->max_consecutive = wl->conf.conn.bet_max_consecutive;
1106 ret = wl1271_cmd_configure(wl, ACX_BET_ENABLE, acx, sizeof(*acx));
1107 if (ret < 0) {
1108 wl1271_warning("acx bet enable failed: %d", ret);
1109 goto out;
1112 out:
1113 kfree(acx);
1114 return ret;
1117 int wl1271_acx_arp_ip_filter(struct wl1271 *wl, struct wl12xx_vif *wlvif,
1118 u8 enable, __be32 address)
1120 struct wl1271_acx_arp_filter *acx;
1121 int ret;
1123 wl1271_debug(DEBUG_ACX, "acx arp ip filter, enable: %d", enable);
1125 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1126 if (!acx) {
1127 ret = -ENOMEM;
1128 goto out;
1131 acx->role_id = wlvif->role_id;
1132 acx->version = ACX_IPV4_VERSION;
1133 acx->enable = enable;
1135 if (enable)
1136 memcpy(acx->address, &address, ACX_IPV4_ADDR_SIZE);
1138 ret = wl1271_cmd_configure(wl, ACX_ARP_IP_FILTER,
1139 acx, sizeof(*acx));
1140 if (ret < 0) {
1141 wl1271_warning("failed to set arp ip filter: %d", ret);
1142 goto out;
1145 out:
1146 kfree(acx);
1147 return ret;
1150 int wl1271_acx_pm_config(struct wl1271 *wl)
1152 struct wl1271_acx_pm_config *acx = NULL;
1153 struct conf_pm_config_settings *c = &wl->conf.pm_config;
1154 int ret = 0;
1156 wl1271_debug(DEBUG_ACX, "acx pm config");
1158 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1159 if (!acx) {
1160 ret = -ENOMEM;
1161 goto out;
1164 acx->host_clk_settling_time = cpu_to_le32(c->host_clk_settling_time);
1165 acx->host_fast_wakeup_support = c->host_fast_wakeup_support;
1167 ret = wl1271_cmd_configure(wl, ACX_PM_CONFIG, acx, sizeof(*acx));
1168 if (ret < 0) {
1169 wl1271_warning("acx pm config failed: %d", ret);
1170 goto out;
1173 out:
1174 kfree(acx);
1175 return ret;
1178 int wl1271_acx_keep_alive_mode(struct wl1271 *wl, struct wl12xx_vif *wlvif,
1179 bool enable)
1181 struct wl1271_acx_keep_alive_mode *acx = NULL;
1182 int ret = 0;
1184 wl1271_debug(DEBUG_ACX, "acx keep alive mode: %d", enable);
1186 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1187 if (!acx) {
1188 ret = -ENOMEM;
1189 goto out;
1192 acx->role_id = wlvif->role_id;
1193 acx->enabled = enable;
1195 ret = wl1271_cmd_configure(wl, ACX_KEEP_ALIVE_MODE, acx, sizeof(*acx));
1196 if (ret < 0) {
1197 wl1271_warning("acx keep alive mode failed: %d", ret);
1198 goto out;
1201 out:
1202 kfree(acx);
1203 return ret;
1206 int wl1271_acx_keep_alive_config(struct wl1271 *wl, struct wl12xx_vif *wlvif,
1207 u8 index, u8 tpl_valid)
1209 struct wl1271_acx_keep_alive_config *acx = NULL;
1210 int ret = 0;
1212 wl1271_debug(DEBUG_ACX, "acx keep alive config");
1214 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1215 if (!acx) {
1216 ret = -ENOMEM;
1217 goto out;
1220 acx->role_id = wlvif->role_id;
1221 acx->period = cpu_to_le32(wl->conf.conn.keep_alive_interval);
1222 acx->index = index;
1223 acx->tpl_validation = tpl_valid;
1224 acx->trigger = ACX_KEEP_ALIVE_NO_TX;
1226 ret = wl1271_cmd_configure(wl, ACX_SET_KEEP_ALIVE_CONFIG,
1227 acx, sizeof(*acx));
1228 if (ret < 0) {
1229 wl1271_warning("acx keep alive config failed: %d", ret);
1230 goto out;
1233 out:
1234 kfree(acx);
1235 return ret;
1238 int wl1271_acx_rssi_snr_trigger(struct wl1271 *wl, struct wl12xx_vif *wlvif,
1239 bool enable, s16 thold, u8 hyst)
1241 struct wl1271_acx_rssi_snr_trigger *acx = NULL;
1242 int ret = 0;
1244 wl1271_debug(DEBUG_ACX, "acx rssi snr trigger");
1246 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1247 if (!acx) {
1248 ret = -ENOMEM;
1249 goto out;
1252 wlvif->last_rssi_event = -1;
1254 acx->role_id = wlvif->role_id;
1255 acx->pacing = cpu_to_le16(wl->conf.roam_trigger.trigger_pacing);
1256 acx->metric = WL1271_ACX_TRIG_METRIC_RSSI_BEACON;
1257 acx->type = WL1271_ACX_TRIG_TYPE_EDGE;
1258 if (enable)
1259 acx->enable = WL1271_ACX_TRIG_ENABLE;
1260 else
1261 acx->enable = WL1271_ACX_TRIG_DISABLE;
1263 acx->index = WL1271_ACX_TRIG_IDX_RSSI;
1264 acx->dir = WL1271_ACX_TRIG_DIR_BIDIR;
1265 acx->threshold = cpu_to_le16(thold);
1266 acx->hysteresis = hyst;
1268 ret = wl1271_cmd_configure(wl, ACX_RSSI_SNR_TRIGGER, acx, sizeof(*acx));
1269 if (ret < 0) {
1270 wl1271_warning("acx rssi snr trigger setting failed: %d", ret);
1271 goto out;
1274 out:
1275 kfree(acx);
1276 return ret;
1279 int wl1271_acx_rssi_snr_avg_weights(struct wl1271 *wl,
1280 struct wl12xx_vif *wlvif)
1282 struct wl1271_acx_rssi_snr_avg_weights *acx = NULL;
1283 struct conf_roam_trigger_settings *c = &wl->conf.roam_trigger;
1284 int ret = 0;
1286 wl1271_debug(DEBUG_ACX, "acx rssi snr avg weights");
1288 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1289 if (!acx) {
1290 ret = -ENOMEM;
1291 goto out;
1294 acx->role_id = wlvif->role_id;
1295 acx->rssi_beacon = c->avg_weight_rssi_beacon;
1296 acx->rssi_data = c->avg_weight_rssi_data;
1297 acx->snr_beacon = c->avg_weight_snr_beacon;
1298 acx->snr_data = c->avg_weight_snr_data;
1300 ret = wl1271_cmd_configure(wl, ACX_RSSI_SNR_WEIGHTS, acx, sizeof(*acx));
1301 if (ret < 0) {
1302 wl1271_warning("acx rssi snr trigger weights failed: %d", ret);
1303 goto out;
1306 out:
1307 kfree(acx);
1308 return ret;
1311 int wl1271_acx_set_ht_capabilities(struct wl1271 *wl,
1312 struct ieee80211_sta_ht_cap *ht_cap,
1313 bool allow_ht_operation, u8 hlid)
1315 struct wl1271_acx_ht_capabilities *acx;
1316 int ret = 0;
1317 u32 ht_capabilites = 0;
1319 wl1271_debug(DEBUG_ACX, "acx ht capabilities setting "
1320 "sta supp: %d sta cap: %d", ht_cap->ht_supported,
1321 ht_cap->cap);
1323 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1324 if (!acx) {
1325 ret = -ENOMEM;
1326 goto out;
1329 if (allow_ht_operation && ht_cap->ht_supported) {
1330 /* no need to translate capabilities - use the spec values */
1331 ht_capabilites = ht_cap->cap;
1334 * this bit is not employed by the spec but only by FW to
1335 * indicate peer HT support
1337 ht_capabilites |= WL12XX_HT_CAP_HT_OPERATION;
1339 /* get data from A-MPDU parameters field */
1340 acx->ampdu_max_length = ht_cap->ampdu_factor;
1341 acx->ampdu_min_spacing = ht_cap->ampdu_density;
1344 acx->hlid = hlid;
1345 acx->ht_capabilites = cpu_to_le32(ht_capabilites);
1347 ret = wl1271_cmd_configure(wl, ACX_PEER_HT_CAP, acx, sizeof(*acx));
1348 if (ret < 0) {
1349 wl1271_warning("acx ht capabilities setting failed: %d", ret);
1350 goto out;
1353 out:
1354 kfree(acx);
1355 return ret;
1358 int wl1271_acx_set_ht_information(struct wl1271 *wl,
1359 struct wl12xx_vif *wlvif,
1360 u16 ht_operation_mode)
1362 struct wl1271_acx_ht_information *acx;
1363 int ret = 0;
1365 wl1271_debug(DEBUG_ACX, "acx ht information setting");
1367 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1368 if (!acx) {
1369 ret = -ENOMEM;
1370 goto out;
1373 acx->role_id = wlvif->role_id;
1374 acx->ht_protection =
1375 (u8)(ht_operation_mode & IEEE80211_HT_OP_MODE_PROTECTION);
1376 acx->rifs_mode = 0;
1377 acx->gf_protection =
1378 !!(ht_operation_mode & IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT);
1379 acx->ht_tx_burst_limit = 0;
1380 acx->dual_cts_protection = 0;
1382 ret = wl1271_cmd_configure(wl, ACX_HT_BSS_OPERATION, acx, sizeof(*acx));
1384 if (ret < 0) {
1385 wl1271_warning("acx ht information setting failed: %d", ret);
1386 goto out;
1389 out:
1390 kfree(acx);
1391 return ret;
1394 /* Configure BA session initiator/receiver parameters setting in the FW. */
1395 int wl12xx_acx_set_ba_initiator_policy(struct wl1271 *wl,
1396 struct wl12xx_vif *wlvif)
1398 struct wl1271_acx_ba_initiator_policy *acx;
1399 int ret;
1401 wl1271_debug(DEBUG_ACX, "acx ba initiator policy");
1403 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1404 if (!acx) {
1405 ret = -ENOMEM;
1406 goto out;
1409 /* set for the current role */
1410 acx->role_id = wlvif->role_id;
1411 acx->tid_bitmap = wl->conf.ht.tx_ba_tid_bitmap;
1412 acx->win_size = wl->conf.ht.tx_ba_win_size;
1413 acx->inactivity_timeout = wl->conf.ht.inactivity_timeout;
1415 ret = wl1271_cmd_configure(wl,
1416 ACX_BA_SESSION_INIT_POLICY,
1417 acx,
1418 sizeof(*acx));
1419 if (ret < 0) {
1420 wl1271_warning("acx ba initiator policy failed: %d", ret);
1421 goto out;
1424 out:
1425 kfree(acx);
1426 return ret;
1429 /* setup BA session receiver setting in the FW. */
1430 int wl12xx_acx_set_ba_receiver_session(struct wl1271 *wl, u8 tid_index,
1431 u16 ssn, bool enable, u8 peer_hlid)
1433 struct wl1271_acx_ba_receiver_setup *acx;
1434 int ret;
1436 wl1271_debug(DEBUG_ACX, "acx ba receiver session setting");
1438 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1439 if (!acx) {
1440 ret = -ENOMEM;
1441 goto out;
1444 acx->hlid = peer_hlid;
1445 acx->tid = tid_index;
1446 acx->enable = enable;
1447 acx->win_size = wl->conf.ht.rx_ba_win_size;
1448 acx->ssn = ssn;
1450 ret = wl1271_cmd_configure(wl, ACX_BA_SESSION_RX_SETUP, acx,
1451 sizeof(*acx));
1452 if (ret < 0) {
1453 wl1271_warning("acx ba receiver session failed: %d", ret);
1454 goto out;
1457 out:
1458 kfree(acx);
1459 return ret;
1462 int wl1271_acx_tsf_info(struct wl1271 *wl, u64 *mactime)
1464 struct wl1271_acx_fw_tsf_information *tsf_info;
1465 int ret;
1467 tsf_info = kzalloc(sizeof(*tsf_info), GFP_KERNEL);
1468 if (!tsf_info) {
1469 ret = -ENOMEM;
1470 goto out;
1473 ret = wl1271_cmd_interrogate(wl, ACX_TSF_INFO,
1474 tsf_info, sizeof(*tsf_info));
1475 if (ret < 0) {
1476 wl1271_warning("acx tsf info interrogate failed");
1477 goto out;
1480 *mactime = le32_to_cpu(tsf_info->current_tsf_low) |
1481 ((u64) le32_to_cpu(tsf_info->current_tsf_high) << 32);
1483 out:
1484 kfree(tsf_info);
1485 return ret;
1488 int wl1271_acx_ps_rx_streaming(struct wl1271 *wl, struct wl12xx_vif *wlvif,
1489 bool enable)
1491 struct wl1271_acx_ps_rx_streaming *rx_streaming;
1492 u32 conf_queues, enable_queues;
1493 int i, ret = 0;
1495 wl1271_debug(DEBUG_ACX, "acx ps rx streaming");
1497 rx_streaming = kzalloc(sizeof(*rx_streaming), GFP_KERNEL);
1498 if (!rx_streaming) {
1499 ret = -ENOMEM;
1500 goto out;
1503 conf_queues = wl->conf.rx_streaming.queues;
1504 if (enable)
1505 enable_queues = conf_queues;
1506 else
1507 enable_queues = 0;
1509 for (i = 0; i < 8; i++) {
1511 * Skip non-changed queues, to avoid redundant acxs.
1512 * this check assumes conf.rx_streaming.queues can't
1513 * be changed while rx_streaming is enabled.
1515 if (!(conf_queues & BIT(i)))
1516 continue;
1518 rx_streaming->role_id = wlvif->role_id;
1519 rx_streaming->tid = i;
1520 rx_streaming->enable = enable_queues & BIT(i);
1521 rx_streaming->period = wl->conf.rx_streaming.interval;
1522 rx_streaming->timeout = wl->conf.rx_streaming.interval;
1524 ret = wl1271_cmd_configure(wl, ACX_PS_RX_STREAMING,
1525 rx_streaming,
1526 sizeof(*rx_streaming));
1527 if (ret < 0) {
1528 wl1271_warning("acx ps rx streaming failed: %d", ret);
1529 goto out;
1532 out:
1533 kfree(rx_streaming);
1534 return ret;
1537 int wl1271_acx_ap_max_tx_retry(struct wl1271 *wl, struct wl12xx_vif *wlvif)
1539 struct wl1271_acx_ap_max_tx_retry *acx = NULL;
1540 int ret;
1542 wl1271_debug(DEBUG_ACX, "acx ap max tx retry");
1544 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1545 if (!acx)
1546 return -ENOMEM;
1548 acx->role_id = wlvif->role_id;
1549 acx->max_tx_retry = cpu_to_le16(wl->conf.tx.max_tx_retries);
1551 ret = wl1271_cmd_configure(wl, ACX_MAX_TX_FAILURE, acx, sizeof(*acx));
1552 if (ret < 0) {
1553 wl1271_warning("acx ap max tx retry failed: %d", ret);
1554 goto out;
1557 out:
1558 kfree(acx);
1559 return ret;
1562 int wl12xx_acx_config_ps(struct wl1271 *wl, struct wl12xx_vif *wlvif)
1564 struct wl1271_acx_config_ps *config_ps;
1565 int ret;
1567 wl1271_debug(DEBUG_ACX, "acx config ps");
1569 config_ps = kzalloc(sizeof(*config_ps), GFP_KERNEL);
1570 if (!config_ps) {
1571 ret = -ENOMEM;
1572 goto out;
1575 config_ps->exit_retries = wl->conf.conn.psm_exit_retries;
1576 config_ps->enter_retries = wl->conf.conn.psm_entry_retries;
1577 config_ps->null_data_rate = cpu_to_le32(wlvif->basic_rate);
1579 ret = wl1271_cmd_configure(wl, ACX_CONFIG_PS, config_ps,
1580 sizeof(*config_ps));
1582 if (ret < 0) {
1583 wl1271_warning("acx config ps failed: %d", ret);
1584 goto out;
1587 out:
1588 kfree(config_ps);
1589 return ret;
1592 int wl1271_acx_set_inconnection_sta(struct wl1271 *wl, u8 *addr)
1594 struct wl1271_acx_inconnection_sta *acx = NULL;
1595 int ret;
1597 wl1271_debug(DEBUG_ACX, "acx set inconnaction sta %pM", addr);
1599 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1600 if (!acx)
1601 return -ENOMEM;
1603 memcpy(acx->addr, addr, ETH_ALEN);
1605 ret = wl1271_cmd_configure(wl, ACX_UPDATE_INCONNECTION_STA_LIST,
1606 acx, sizeof(*acx));
1607 if (ret < 0) {
1608 wl1271_warning("acx set inconnaction sta failed: %d", ret);
1609 goto out;
1612 out:
1613 kfree(acx);
1614 return ret;
1617 int wl1271_acx_fm_coex(struct wl1271 *wl)
1619 struct wl1271_acx_fm_coex *acx;
1620 int ret;
1622 wl1271_debug(DEBUG_ACX, "acx fm coex setting");
1624 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1625 if (!acx) {
1626 ret = -ENOMEM;
1627 goto out;
1630 acx->enable = wl->conf.fm_coex.enable;
1631 acx->swallow_period = wl->conf.fm_coex.swallow_period;
1632 acx->n_divider_fref_set_1 = wl->conf.fm_coex.n_divider_fref_set_1;
1633 acx->n_divider_fref_set_2 = wl->conf.fm_coex.n_divider_fref_set_2;
1634 acx->m_divider_fref_set_1 =
1635 cpu_to_le16(wl->conf.fm_coex.m_divider_fref_set_1);
1636 acx->m_divider_fref_set_2 =
1637 cpu_to_le16(wl->conf.fm_coex.m_divider_fref_set_2);
1638 acx->coex_pll_stabilization_time =
1639 cpu_to_le32(wl->conf.fm_coex.coex_pll_stabilization_time);
1640 acx->ldo_stabilization_time =
1641 cpu_to_le16(wl->conf.fm_coex.ldo_stabilization_time);
1642 acx->fm_disturbed_band_margin =
1643 wl->conf.fm_coex.fm_disturbed_band_margin;
1644 acx->swallow_clk_diff = wl->conf.fm_coex.swallow_clk_diff;
1646 ret = wl1271_cmd_configure(wl, ACX_FM_COEX_CFG, acx, sizeof(*acx));
1647 if (ret < 0) {
1648 wl1271_warning("acx fm coex setting failed: %d", ret);
1649 goto out;
1652 out:
1653 kfree(acx);
1654 return ret;
1657 int wl12xx_acx_set_rate_mgmt_params(struct wl1271 *wl)
1659 struct wl12xx_acx_set_rate_mgmt_params *acx = NULL;
1660 struct conf_rate_policy_settings *conf = &wl->conf.rate;
1661 int ret;
1663 wl1271_debug(DEBUG_ACX, "acx set rate mgmt params");
1665 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1666 if (!acx)
1667 return -ENOMEM;
1669 acx->index = ACX_RATE_MGMT_ALL_PARAMS;
1670 acx->rate_retry_score = cpu_to_le16(conf->rate_retry_score);
1671 acx->per_add = cpu_to_le16(conf->per_add);
1672 acx->per_th1 = cpu_to_le16(conf->per_th1);
1673 acx->per_th2 = cpu_to_le16(conf->per_th2);
1674 acx->max_per = cpu_to_le16(conf->max_per);
1675 acx->inverse_curiosity_factor = conf->inverse_curiosity_factor;
1676 acx->tx_fail_low_th = conf->tx_fail_low_th;
1677 acx->tx_fail_high_th = conf->tx_fail_high_th;
1678 acx->per_alpha_shift = conf->per_alpha_shift;
1679 acx->per_add_shift = conf->per_add_shift;
1680 acx->per_beta1_shift = conf->per_beta1_shift;
1681 acx->per_beta2_shift = conf->per_beta2_shift;
1682 acx->rate_check_up = conf->rate_check_up;
1683 acx->rate_check_down = conf->rate_check_down;
1684 memcpy(acx->rate_retry_policy, conf->rate_retry_policy,
1685 sizeof(acx->rate_retry_policy));
1687 ret = wl1271_cmd_configure(wl, ACX_SET_RATE_MGMT_PARAMS,
1688 acx, sizeof(*acx));
1689 if (ret < 0) {
1690 wl1271_warning("acx set rate mgmt params failed: %d", ret);
1691 goto out;
1694 out:
1695 kfree(acx);
1696 return ret;
1699 int wl12xx_acx_config_hangover(struct wl1271 *wl)
1701 struct wl12xx_acx_config_hangover *acx;
1702 struct conf_hangover_settings *conf = &wl->conf.hangover;
1703 int ret;
1705 wl1271_debug(DEBUG_ACX, "acx config hangover");
1707 acx = kzalloc(sizeof(*acx), GFP_KERNEL);
1708 if (!acx) {
1709 ret = -ENOMEM;
1710 goto out;
1713 acx->recover_time = cpu_to_le32(conf->recover_time);
1714 acx->hangover_period = conf->hangover_period;
1715 acx->dynamic_mode = conf->dynamic_mode;
1716 acx->early_termination_mode = conf->early_termination_mode;
1717 acx->max_period = conf->max_period;
1718 acx->min_period = conf->min_period;
1719 acx->increase_delta = conf->increase_delta;
1720 acx->decrease_delta = conf->decrease_delta;
1721 acx->quiet_time = conf->quiet_time;
1722 acx->increase_time = conf->increase_time;
1723 acx->window_size = acx->window_size;
1725 ret = wl1271_cmd_configure(wl, ACX_CONFIG_HANGOVER, acx,
1726 sizeof(*acx));
1728 if (ret < 0) {
1729 wl1271_warning("acx config hangover failed: %d", ret);
1730 goto out;
1733 out:
1734 kfree(acx);
1735 return ret;