| /* |
| * This file is part of wl1271 |
| * |
| * Copyright (C) 2008-2009 Nokia Corporation |
| * |
| * Contact: Luciano Coelho <luciano.coelho@nokia.com> |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License |
| * version 2 as published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that it will be useful, but |
| * WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| * General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA |
| * 02110-1301 USA |
| * |
| */ |
| |
| #include "acx.h" |
| |
| #include <linux/module.h> |
| #include <linux/platform_device.h> |
| #include <linux/crc7.h> |
| #include <linux/spi/spi.h> |
| #include <linux/slab.h> |
| |
| #include "wl12xx.h" |
| #include "wl12xx_80211.h" |
| #include "reg.h" |
| #include "ps.h" |
| |
| int wl1271_acx_wake_up_conditions(struct wl1271 *wl) |
| { |
| struct acx_wake_up_condition *wake_up; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx wake up conditions"); |
| |
| wake_up = kzalloc(sizeof(*wake_up), GFP_KERNEL); |
| if (!wake_up) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| wake_up->wake_up_event = wl->conf.conn.wake_up_event; |
| wake_up->listen_interval = wl->conf.conn.listen_interval; |
| |
| ret = wl1271_cmd_configure(wl, ACX_WAKE_UP_CONDITIONS, |
| wake_up, sizeof(*wake_up)); |
| if (ret < 0) { |
| wl1271_warning("could not set wake up conditions: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(wake_up); |
| return ret; |
| } |
| |
| int wl1271_acx_sleep_auth(struct wl1271 *wl, u8 sleep_auth) |
| { |
| struct acx_sleep_auth *auth; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx sleep auth"); |
| |
| auth = kzalloc(sizeof(*auth), GFP_KERNEL); |
| if (!auth) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| auth->sleep_auth = sleep_auth; |
| |
| ret = wl1271_cmd_configure(wl, ACX_SLEEP_AUTH, auth, sizeof(*auth)); |
| if (ret < 0) |
| return ret; |
| |
| out: |
| kfree(auth); |
| return ret; |
| } |
| |
| int wl1271_acx_tx_power(struct wl1271 *wl, int power) |
| { |
| struct acx_current_tx_power *acx; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx dot11_cur_tx_pwr"); |
| |
| if (power < 0 || power > 25) |
| return -EINVAL; |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->current_tx_power = power * 10; |
| |
| ret = wl1271_cmd_configure(wl, DOT11_CUR_TX_PWR, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("configure of tx power failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_feature_cfg(struct wl1271 *wl) |
| { |
| struct acx_feature_config *feature; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx feature cfg"); |
| |
| feature = kzalloc(sizeof(*feature), GFP_KERNEL); |
| if (!feature) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* DF_ENCRYPTION_DISABLE and DF_SNIFF_MODE_ENABLE are disabled */ |
| feature->data_flow_options = 0; |
| feature->options = 0; |
| |
| ret = wl1271_cmd_configure(wl, ACX_FEATURE_CFG, |
| feature, sizeof(*feature)); |
| if (ret < 0) { |
| wl1271_error("Couldnt set HW encryption"); |
| goto out; |
| } |
| |
| out: |
| kfree(feature); |
| return ret; |
| } |
| |
| int wl1271_acx_mem_map(struct wl1271 *wl, struct acx_header *mem_map, |
| size_t len) |
| { |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx mem map"); |
| |
| ret = wl1271_cmd_interrogate(wl, ACX_MEM_MAP, mem_map, len); |
| if (ret < 0) |
| return ret; |
| |
| return 0; |
| } |
| |
| int wl1271_acx_rx_msdu_life_time(struct wl1271 *wl) |
| { |
| struct acx_rx_msdu_lifetime *acx; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx rx msdu life time"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->lifetime = cpu_to_le32(wl->conf.rx.rx_msdu_life_time); |
| ret = wl1271_cmd_configure(wl, DOT11_RX_MSDU_LIFE_TIME, |
| acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("failed to set rx msdu life time: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_rx_config(struct wl1271 *wl, u32 config, u32 filter) |
| { |
| struct acx_rx_config *rx_config; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx rx config"); |
| |
| rx_config = kzalloc(sizeof(*rx_config), GFP_KERNEL); |
| if (!rx_config) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| rx_config->config_options = cpu_to_le32(config); |
| rx_config->filter_options = cpu_to_le32(filter); |
| |
| ret = wl1271_cmd_configure(wl, ACX_RX_CFG, |
| rx_config, sizeof(*rx_config)); |
| if (ret < 0) { |
| wl1271_warning("failed to set rx config: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(rx_config); |
| return ret; |
| } |
| |
| int wl1271_acx_pd_threshold(struct wl1271 *wl) |
| { |
| struct acx_packet_detection *pd; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx data pd threshold"); |
| |
| pd = kzalloc(sizeof(*pd), GFP_KERNEL); |
| if (!pd) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| pd->threshold = cpu_to_le32(wl->conf.rx.packet_detection_threshold); |
| |
| ret = wl1271_cmd_configure(wl, ACX_PD_THRESHOLD, pd, sizeof(*pd)); |
| if (ret < 0) { |
| wl1271_warning("failed to set pd threshold: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(pd); |
| return ret; |
| } |
| |
| int wl1271_acx_slot(struct wl1271 *wl, enum acx_slot_type slot_time) |
| { |
| struct acx_slot *slot; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx slot"); |
| |
| slot = kzalloc(sizeof(*slot), GFP_KERNEL); |
| if (!slot) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| slot->wone_index = STATION_WONE_INDEX; |
| slot->slot_time = slot_time; |
| |
| ret = wl1271_cmd_configure(wl, ACX_SLOT, slot, sizeof(*slot)); |
| if (ret < 0) { |
| wl1271_warning("failed to set slot time: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(slot); |
| return ret; |
| } |
| |
| int wl1271_acx_group_address_tbl(struct wl1271 *wl, bool enable, |
| void *mc_list, u32 mc_list_len) |
| { |
| struct acx_dot11_grp_addr_tbl *acx; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx group address tbl"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* MAC filtering */ |
| acx->enabled = enable; |
| acx->num_groups = mc_list_len; |
| memcpy(acx->mac_table, mc_list, mc_list_len * ETH_ALEN); |
| |
| ret = wl1271_cmd_configure(wl, DOT11_GROUP_ADDRESS_TBL, |
| acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("failed to set group addr table: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_service_period_timeout(struct wl1271 *wl) |
| { |
| struct acx_rx_timeout *rx_timeout; |
| int ret; |
| |
| rx_timeout = kzalloc(sizeof(*rx_timeout), GFP_KERNEL); |
| if (!rx_timeout) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| wl1271_debug(DEBUG_ACX, "acx service period timeout"); |
| |
| rx_timeout->ps_poll_timeout = cpu_to_le16(wl->conf.rx.ps_poll_timeout); |
| rx_timeout->upsd_timeout = cpu_to_le16(wl->conf.rx.upsd_timeout); |
| |
| ret = wl1271_cmd_configure(wl, ACX_SERVICE_PERIOD_TIMEOUT, |
| rx_timeout, sizeof(*rx_timeout)); |
| if (ret < 0) { |
| wl1271_warning("failed to set service period timeout: %d", |
| ret); |
| goto out; |
| } |
| |
| out: |
| kfree(rx_timeout); |
| return ret; |
| } |
| |
| int wl1271_acx_rts_threshold(struct wl1271 *wl, u16 rts_threshold) |
| { |
| struct acx_rts_threshold *rts; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx rts threshold"); |
| |
| rts = kzalloc(sizeof(*rts), GFP_KERNEL); |
| if (!rts) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| rts->threshold = cpu_to_le16(rts_threshold); |
| |
| ret = wl1271_cmd_configure(wl, DOT11_RTS_THRESHOLD, rts, sizeof(*rts)); |
| if (ret < 0) { |
| wl1271_warning("failed to set rts threshold: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(rts); |
| return ret; |
| } |
| |
| int wl1271_acx_dco_itrim_params(struct wl1271 *wl) |
| { |
| struct acx_dco_itrim_params *dco; |
| struct conf_itrim_settings *c = &wl->conf.itrim; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx dco itrim parameters"); |
| |
| dco = kzalloc(sizeof(*dco), GFP_KERNEL); |
| if (!dco) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| dco->enable = c->enable; |
| dco->timeout = cpu_to_le32(c->timeout); |
| |
| ret = wl1271_cmd_configure(wl, ACX_SET_DCO_ITRIM_PARAMS, |
| dco, sizeof(*dco)); |
| if (ret < 0) { |
| wl1271_warning("failed to set dco itrim parameters: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(dco); |
| return ret; |
| } |
| |
| int wl1271_acx_beacon_filter_opt(struct wl1271 *wl, bool enable_filter) |
| { |
| struct acx_beacon_filter_option *beacon_filter = NULL; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx beacon filter opt"); |
| |
| if (enable_filter && |
| wl->conf.conn.bcn_filt_mode == CONF_BCN_FILT_MODE_DISABLED) |
| goto out; |
| |
| beacon_filter = kzalloc(sizeof(*beacon_filter), GFP_KERNEL); |
| if (!beacon_filter) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| beacon_filter->enable = enable_filter; |
| |
| /* |
| * When set to zero, and the filter is enabled, beacons |
| * without the unicast TIM bit set are dropped. |
| */ |
| beacon_filter->max_num_beacons = 0; |
| |
| ret = wl1271_cmd_configure(wl, ACX_BEACON_FILTER_OPT, |
| beacon_filter, sizeof(*beacon_filter)); |
| if (ret < 0) { |
| wl1271_warning("failed to set beacon filter opt: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(beacon_filter); |
| return ret; |
| } |
| |
| int wl1271_acx_beacon_filter_table(struct wl1271 *wl) |
| { |
| struct acx_beacon_filter_ie_table *ie_table; |
| int i, idx = 0; |
| int ret; |
| bool vendor_spec = false; |
| |
| wl1271_debug(DEBUG_ACX, "acx beacon filter table"); |
| |
| ie_table = kzalloc(sizeof(*ie_table), GFP_KERNEL); |
| if (!ie_table) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* configure default beacon pass-through rules */ |
| ie_table->num_ie = 0; |
| for (i = 0; i < wl->conf.conn.bcn_filt_ie_count; i++) { |
| struct conf_bcn_filt_rule *r = &(wl->conf.conn.bcn_filt_ie[i]); |
| ie_table->table[idx++] = r->ie; |
| ie_table->table[idx++] = r->rule; |
| |
| if (r->ie == WLAN_EID_VENDOR_SPECIFIC) { |
| /* only one vendor specific ie allowed */ |
| if (vendor_spec) |
| continue; |
| |
| /* for vendor specific rules configure the |
| additional fields */ |
| memcpy(&(ie_table->table[idx]), r->oui, |
| CONF_BCN_IE_OUI_LEN); |
| idx += CONF_BCN_IE_OUI_LEN; |
| ie_table->table[idx++] = r->type; |
| memcpy(&(ie_table->table[idx]), r->version, |
| CONF_BCN_IE_VER_LEN); |
| idx += CONF_BCN_IE_VER_LEN; |
| vendor_spec = true; |
| } |
| |
| ie_table->num_ie++; |
| } |
| |
| ret = wl1271_cmd_configure(wl, ACX_BEACON_FILTER_TABLE, |
| ie_table, sizeof(*ie_table)); |
| if (ret < 0) { |
| wl1271_warning("failed to set beacon filter table: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(ie_table); |
| return ret; |
| } |
| |
| #define ACX_CONN_MONIT_DISABLE_VALUE 0xffffffff |
| |
| int wl1271_acx_conn_monit_params(struct wl1271 *wl, bool enable) |
| { |
| struct acx_conn_monit_params *acx; |
| u32 threshold = ACX_CONN_MONIT_DISABLE_VALUE; |
| u32 timeout = ACX_CONN_MONIT_DISABLE_VALUE; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx connection monitor parameters: %s", |
| enable ? "enabled" : "disabled"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| if (enable) { |
| threshold = wl->conf.conn.synch_fail_thold; |
| timeout = wl->conf.conn.bss_lose_timeout; |
| } |
| |
| acx->synch_fail_thold = cpu_to_le32(threshold); |
| acx->bss_lose_timeout = cpu_to_le32(timeout); |
| |
| ret = wl1271_cmd_configure(wl, ACX_CONN_MONIT_PARAMS, |
| acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("failed to set connection monitor " |
| "parameters: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| |
| int wl1271_acx_sg_enable(struct wl1271 *wl, bool enable) |
| { |
| struct acx_bt_wlan_coex *pta; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx sg enable"); |
| |
| pta = kzalloc(sizeof(*pta), GFP_KERNEL); |
| if (!pta) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| if (enable) |
| pta->enable = wl->conf.sg.state; |
| else |
| pta->enable = CONF_SG_DISABLE; |
| |
| ret = wl1271_cmd_configure(wl, ACX_SG_ENABLE, pta, sizeof(*pta)); |
| if (ret < 0) { |
| wl1271_warning("failed to set softgemini enable: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(pta); |
| return ret; |
| } |
| |
| int wl1271_acx_sg_cfg(struct wl1271 *wl) |
| { |
| struct acx_bt_wlan_coex_param *param; |
| struct conf_sg_settings *c = &wl->conf.sg; |
| int i, ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx sg cfg"); |
| |
| param = kzalloc(sizeof(*param), GFP_KERNEL); |
| if (!param) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* BT-WLAN coext parameters */ |
| for (i = 0; i < CONF_SG_PARAMS_MAX; i++) |
| param->params[i] = cpu_to_le32(c->params[i]); |
| param->param_idx = CONF_SG_PARAMS_ALL; |
| |
| ret = wl1271_cmd_configure(wl, ACX_SG_CFG, param, sizeof(*param)); |
| if (ret < 0) { |
| wl1271_warning("failed to set sg config: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(param); |
| return ret; |
| } |
| |
| int wl1271_acx_cca_threshold(struct wl1271 *wl) |
| { |
| struct acx_energy_detection *detection; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx cca threshold"); |
| |
| detection = kzalloc(sizeof(*detection), GFP_KERNEL); |
| if (!detection) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| detection->rx_cca_threshold = cpu_to_le16(wl->conf.rx.rx_cca_threshold); |
| detection->tx_energy_detection = wl->conf.tx.tx_energy_detection; |
| |
| ret = wl1271_cmd_configure(wl, ACX_CCA_THRESHOLD, |
| detection, sizeof(*detection)); |
| if (ret < 0) { |
| wl1271_warning("failed to set cca threshold: %d", ret); |
| return ret; |
| } |
| |
| out: |
| kfree(detection); |
| return ret; |
| } |
| |
| int wl1271_acx_bcn_dtim_options(struct wl1271 *wl) |
| { |
| struct acx_beacon_broadcast *bb; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx bcn dtim options"); |
| |
| bb = kzalloc(sizeof(*bb), GFP_KERNEL); |
| if (!bb) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| bb->beacon_rx_timeout = cpu_to_le16(wl->conf.conn.beacon_rx_timeout); |
| bb->broadcast_timeout = cpu_to_le16(wl->conf.conn.broadcast_timeout); |
| bb->rx_broadcast_in_ps = wl->conf.conn.rx_broadcast_in_ps; |
| bb->ps_poll_threshold = wl->conf.conn.ps_poll_threshold; |
| |
| ret = wl1271_cmd_configure(wl, ACX_BCN_DTIM_OPTIONS, bb, sizeof(*bb)); |
| if (ret < 0) { |
| wl1271_warning("failed to set rx config: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(bb); |
| return ret; |
| } |
| |
| int wl1271_acx_aid(struct wl1271 *wl, u16 aid) |
| { |
| struct acx_aid *acx_aid; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx aid"); |
| |
| acx_aid = kzalloc(sizeof(*acx_aid), GFP_KERNEL); |
| if (!acx_aid) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx_aid->aid = cpu_to_le16(aid); |
| |
| ret = wl1271_cmd_configure(wl, ACX_AID, acx_aid, sizeof(*acx_aid)); |
| if (ret < 0) { |
| wl1271_warning("failed to set aid: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx_aid); |
| return ret; |
| } |
| |
| int wl1271_acx_event_mbox_mask(struct wl1271 *wl, u32 event_mask) |
| { |
| struct acx_event_mask *mask; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx event mbox mask"); |
| |
| mask = kzalloc(sizeof(*mask), GFP_KERNEL); |
| if (!mask) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* high event mask is unused */ |
| mask->high_event_mask = cpu_to_le32(0xffffffff); |
| mask->event_mask = cpu_to_le32(event_mask); |
| |
| ret = wl1271_cmd_configure(wl, ACX_EVENT_MBOX_MASK, |
| mask, sizeof(*mask)); |
| if (ret < 0) { |
| wl1271_warning("failed to set acx_event_mbox_mask: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(mask); |
| return ret; |
| } |
| |
| int wl1271_acx_set_preamble(struct wl1271 *wl, enum acx_preamble_type preamble) |
| { |
| struct acx_preamble *acx; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx_set_preamble"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->preamble = preamble; |
| |
| ret = wl1271_cmd_configure(wl, ACX_PREAMBLE_TYPE, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("Setting of preamble failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_cts_protect(struct wl1271 *wl, |
| enum acx_ctsprotect_type ctsprotect) |
| { |
| struct acx_ctsprotect *acx; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx_set_ctsprotect"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->ctsprotect = ctsprotect; |
| |
| ret = wl1271_cmd_configure(wl, ACX_CTS_PROTECTION, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("Setting of ctsprotect failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_statistics(struct wl1271 *wl, struct acx_statistics *stats) |
| { |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx statistics"); |
| |
| ret = wl1271_cmd_interrogate(wl, ACX_STATISTICS, stats, |
| sizeof(*stats)); |
| if (ret < 0) { |
| wl1271_warning("acx statistics failed: %d", ret); |
| return -ENOMEM; |
| } |
| |
| return 0; |
| } |
| |
| int wl1271_acx_sta_rate_policies(struct wl1271 *wl) |
| { |
| struct acx_sta_rate_policy *acx; |
| struct conf_tx_rate_class *c = &wl->conf.tx.sta_rc_conf; |
| int idx = 0; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx rate policies"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* configure one basic rate class */ |
| idx = ACX_TX_BASIC_RATE; |
| acx->rate_class[idx].enabled_rates = cpu_to_le32(wl->basic_rate); |
| acx->rate_class[idx].short_retry_limit = c->short_retry_limit; |
| acx->rate_class[idx].long_retry_limit = c->long_retry_limit; |
| acx->rate_class[idx].aflags = c->aflags; |
| |
| /* configure one AP supported rate class */ |
| idx = ACX_TX_AP_FULL_RATE; |
| acx->rate_class[idx].enabled_rates = cpu_to_le32(wl->rate_set); |
| acx->rate_class[idx].short_retry_limit = c->short_retry_limit; |
| acx->rate_class[idx].long_retry_limit = c->long_retry_limit; |
| acx->rate_class[idx].aflags = c->aflags; |
| |
| acx->rate_class_cnt = cpu_to_le32(ACX_TX_RATE_POLICY_CNT); |
| |
| wl1271_debug(DEBUG_ACX, "basic_rate: 0x%x, full_rate: 0x%x", |
| acx->rate_class[ACX_TX_BASIC_RATE].enabled_rates, |
| acx->rate_class[ACX_TX_AP_FULL_RATE].enabled_rates); |
| |
| ret = wl1271_cmd_configure(wl, ACX_RATE_POLICY, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("Setting of rate policies failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_ap_rate_policy(struct wl1271 *wl, struct conf_tx_rate_class *c, |
| u8 idx) |
| { |
| struct acx_ap_rate_policy *acx; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx ap rate policy"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->rate_policy.enabled_rates = cpu_to_le32(c->enabled_rates); |
| acx->rate_policy.short_retry_limit = c->short_retry_limit; |
| acx->rate_policy.long_retry_limit = c->long_retry_limit; |
| acx->rate_policy.aflags = c->aflags; |
| |
| acx->rate_policy_idx = cpu_to_le32(idx); |
| |
| ret = wl1271_cmd_configure(wl, ACX_RATE_POLICY, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("Setting of ap rate policy failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_ac_cfg(struct wl1271 *wl, u8 ac, u8 cw_min, u16 cw_max, |
| u8 aifsn, u16 txop) |
| { |
| struct acx_ac_cfg *acx; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx ac cfg %d cw_ming %d cw_max %d " |
| "aifs %d txop %d", ac, cw_min, cw_max, aifsn, txop); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->ac = ac; |
| acx->cw_min = cw_min; |
| acx->cw_max = cpu_to_le16(cw_max); |
| acx->aifsn = aifsn; |
| acx->tx_op_limit = cpu_to_le16(txop); |
| |
| ret = wl1271_cmd_configure(wl, ACX_AC_CFG, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx ac cfg failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_tid_cfg(struct wl1271 *wl, u8 queue_id, u8 channel_type, |
| u8 tsid, u8 ps_scheme, u8 ack_policy, |
| u32 apsd_conf0, u32 apsd_conf1) |
| { |
| struct acx_tid_config *acx; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx tid config"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->queue_id = queue_id; |
| acx->channel_type = channel_type; |
| acx->tsid = tsid; |
| acx->ps_scheme = ps_scheme; |
| acx->ack_policy = ack_policy; |
| acx->apsd_conf[0] = cpu_to_le32(apsd_conf0); |
| acx->apsd_conf[1] = cpu_to_le32(apsd_conf1); |
| |
| ret = wl1271_cmd_configure(wl, ACX_TID_CFG, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("Setting of tid config failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_frag_threshold(struct wl1271 *wl, u16 frag_threshold) |
| { |
| struct acx_frag_threshold *acx; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx frag threshold"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->frag_threshold = cpu_to_le16(frag_threshold); |
| ret = wl1271_cmd_configure(wl, ACX_FRAG_CFG, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("Setting of frag threshold failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_tx_config_options(struct wl1271 *wl) |
| { |
| struct acx_tx_config_options *acx; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx tx config options"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->tx_compl_timeout = cpu_to_le16(wl->conf.tx.tx_compl_timeout); |
| acx->tx_compl_threshold = cpu_to_le16(wl->conf.tx.tx_compl_threshold); |
| ret = wl1271_cmd_configure(wl, ACX_TX_CONFIG_OPT, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("Setting of tx options failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_ap_mem_cfg(struct wl1271 *wl) |
| { |
| struct wl1271_acx_ap_config_memory *mem_conf; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "wl1271 mem cfg"); |
| |
| mem_conf = kzalloc(sizeof(*mem_conf), GFP_KERNEL); |
| if (!mem_conf) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* memory config */ |
| /* FIXME: for now we always use mem_wl127x for AP, because it |
| * doesn't support dynamic memory and we don't have the |
| * optimal values for wl128x without dynamic memory yet */ |
| mem_conf->num_stations = wl->conf.mem_wl127x.num_stations; |
| mem_conf->rx_mem_block_num = wl->conf.mem_wl127x.rx_block_num; |
| mem_conf->tx_min_mem_block_num = wl->conf.mem_wl127x.tx_min_block_num; |
| mem_conf->num_ssid_profiles = wl->conf.mem_wl127x.ssid_profiles; |
| mem_conf->total_tx_descriptors = cpu_to_le32(ACX_TX_DESCRIPTORS); |
| |
| ret = wl1271_cmd_configure(wl, ACX_MEM_CFG, mem_conf, |
| sizeof(*mem_conf)); |
| if (ret < 0) { |
| wl1271_warning("wl1271 mem config failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(mem_conf); |
| return ret; |
| } |
| |
| int wl1271_acx_sta_mem_cfg(struct wl1271 *wl) |
| { |
| struct wl1271_acx_sta_config_memory *mem_conf; |
| struct conf_memory_settings *mem; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "wl1271 mem cfg"); |
| |
| mem_conf = kzalloc(sizeof(*mem_conf), GFP_KERNEL); |
| if (!mem_conf) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| if (wl->chip.id == CHIP_ID_1283_PG20) |
| mem = &wl->conf.mem_wl128x; |
| else |
| mem = &wl->conf.mem_wl127x; |
| |
| /* memory config */ |
| mem_conf->num_stations = mem->num_stations; |
| mem_conf->rx_mem_block_num = mem->rx_block_num; |
| mem_conf->tx_min_mem_block_num = mem->tx_min_block_num; |
| mem_conf->num_ssid_profiles = mem->ssid_profiles; |
| mem_conf->total_tx_descriptors = cpu_to_le32(ACX_TX_DESCRIPTORS); |
| mem_conf->dyn_mem_enable = mem->dynamic_memory; |
| mem_conf->tx_free_req = mem->min_req_tx_blocks; |
| mem_conf->rx_free_req = mem->min_req_rx_blocks; |
| mem_conf->tx_min = mem->tx_min; |
| |
| ret = wl1271_cmd_configure(wl, ACX_MEM_CFG, mem_conf, |
| sizeof(*mem_conf)); |
| if (ret < 0) { |
| wl1271_warning("wl1271 mem config failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(mem_conf); |
| return ret; |
| } |
| |
| int wl1271_acx_host_if_cfg_bitmap(struct wl1271 *wl, u32 host_cfg_bitmap) |
| { |
| struct wl1271_acx_host_config_bitmap *bitmap_conf; |
| int ret; |
| |
| bitmap_conf = kzalloc(sizeof(*bitmap_conf), GFP_KERNEL); |
| if (!bitmap_conf) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| bitmap_conf->host_cfg_bitmap = cpu_to_le32(host_cfg_bitmap); |
| |
| ret = wl1271_cmd_configure(wl, ACX_HOST_IF_CFG_BITMAP, |
| bitmap_conf, sizeof(*bitmap_conf)); |
| if (ret < 0) { |
| wl1271_warning("wl1271 bitmap config opt failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(bitmap_conf); |
| |
| return ret; |
| } |
| |
| int wl1271_acx_init_mem_config(struct wl1271 *wl) |
| { |
| int ret; |
| |
| wl->target_mem_map = kzalloc(sizeof(struct wl1271_acx_mem_map), |
| GFP_KERNEL); |
| if (!wl->target_mem_map) { |
| wl1271_error("couldn't allocate target memory map"); |
| return -ENOMEM; |
| } |
| |
| /* we now ask for the firmware built memory map */ |
| ret = wl1271_acx_mem_map(wl, (void *)wl->target_mem_map, |
| sizeof(struct wl1271_acx_mem_map)); |
| if (ret < 0) { |
| wl1271_error("couldn't retrieve firmware memory map"); |
| kfree(wl->target_mem_map); |
| wl->target_mem_map = NULL; |
| return ret; |
| } |
| |
| /* initialize TX block book keeping */ |
| wl->tx_blocks_available = |
| le32_to_cpu(wl->target_mem_map->num_tx_mem_blocks); |
| wl1271_debug(DEBUG_TX, "available tx blocks: %d", |
| wl->tx_blocks_available); |
| |
| return 0; |
| } |
| |
| int wl1271_acx_init_rx_interrupt(struct wl1271 *wl) |
| { |
| struct wl1271_acx_rx_config_opt *rx_conf; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "wl1271 rx interrupt config"); |
| |
| rx_conf = kzalloc(sizeof(*rx_conf), GFP_KERNEL); |
| if (!rx_conf) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| rx_conf->threshold = cpu_to_le16(wl->conf.rx.irq_pkt_threshold); |
| rx_conf->timeout = cpu_to_le16(wl->conf.rx.irq_timeout); |
| rx_conf->mblk_threshold = cpu_to_le16(wl->conf.rx.irq_blk_threshold); |
| rx_conf->queue_type = wl->conf.rx.queue_type; |
| |
| ret = wl1271_cmd_configure(wl, ACX_RX_CONFIG_OPT, rx_conf, |
| sizeof(*rx_conf)); |
| if (ret < 0) { |
| wl1271_warning("wl1271 rx config opt failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(rx_conf); |
| return ret; |
| } |
| |
| int wl1271_acx_bet_enable(struct wl1271 *wl, bool enable) |
| { |
| struct wl1271_acx_bet_enable *acx = NULL; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx bet enable"); |
| |
| if (enable && wl->conf.conn.bet_enable == CONF_BET_MODE_DISABLE) |
| goto out; |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->enable = enable ? CONF_BET_MODE_ENABLE : CONF_BET_MODE_DISABLE; |
| acx->max_consecutive = wl->conf.conn.bet_max_consecutive; |
| |
| ret = wl1271_cmd_configure(wl, ACX_BET_ENABLE, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx bet enable failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_arp_ip_filter(struct wl1271 *wl, u8 enable, __be32 address) |
| { |
| struct wl1271_acx_arp_filter *acx; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx arp ip filter, enable: %d", enable); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->version = ACX_IPV4_VERSION; |
| acx->enable = enable; |
| |
| if (enable) |
| memcpy(acx->address, &address, ACX_IPV4_ADDR_SIZE); |
| |
| ret = wl1271_cmd_configure(wl, ACX_ARP_IP_FILTER, |
| acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("failed to set arp ip filter: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_pm_config(struct wl1271 *wl) |
| { |
| struct wl1271_acx_pm_config *acx = NULL; |
| struct conf_pm_config_settings *c = &wl->conf.pm_config; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx pm config"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->host_clk_settling_time = cpu_to_le32(c->host_clk_settling_time); |
| acx->host_fast_wakeup_support = c->host_fast_wakeup_support; |
| |
| ret = wl1271_cmd_configure(wl, ACX_PM_CONFIG, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx pm config failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_keep_alive_mode(struct wl1271 *wl, bool enable) |
| { |
| struct wl1271_acx_keep_alive_mode *acx = NULL; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx keep alive mode: %d", enable); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->enabled = enable; |
| |
| ret = wl1271_cmd_configure(wl, ACX_KEEP_ALIVE_MODE, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx keep alive mode failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_keep_alive_config(struct wl1271 *wl, u8 index, u8 tpl_valid) |
| { |
| struct wl1271_acx_keep_alive_config *acx = NULL; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx keep alive config"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->period = cpu_to_le32(wl->conf.conn.keep_alive_interval); |
| acx->index = index; |
| acx->tpl_validation = tpl_valid; |
| acx->trigger = ACX_KEEP_ALIVE_NO_TX; |
| |
| ret = wl1271_cmd_configure(wl, ACX_SET_KEEP_ALIVE_CONFIG, |
| acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx keep alive config failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_rssi_snr_trigger(struct wl1271 *wl, bool enable, |
| s16 thold, u8 hyst) |
| { |
| struct wl1271_acx_rssi_snr_trigger *acx = NULL; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx rssi snr trigger"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| wl->last_rssi_event = -1; |
| |
| acx->pacing = cpu_to_le16(wl->conf.roam_trigger.trigger_pacing); |
| acx->metric = WL1271_ACX_TRIG_METRIC_RSSI_BEACON; |
| acx->type = WL1271_ACX_TRIG_TYPE_EDGE; |
| if (enable) |
| acx->enable = WL1271_ACX_TRIG_ENABLE; |
| else |
| acx->enable = WL1271_ACX_TRIG_DISABLE; |
| |
| acx->index = WL1271_ACX_TRIG_IDX_RSSI; |
| acx->dir = WL1271_ACX_TRIG_DIR_BIDIR; |
| acx->threshold = cpu_to_le16(thold); |
| acx->hysteresis = hyst; |
| |
| ret = wl1271_cmd_configure(wl, ACX_RSSI_SNR_TRIGGER, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx rssi snr trigger setting failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_rssi_snr_avg_weights(struct wl1271 *wl) |
| { |
| struct wl1271_acx_rssi_snr_avg_weights *acx = NULL; |
| struct conf_roam_trigger_settings *c = &wl->conf.roam_trigger; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx rssi snr avg weights"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->rssi_beacon = c->avg_weight_rssi_beacon; |
| acx->rssi_data = c->avg_weight_rssi_data; |
| acx->snr_beacon = c->avg_weight_snr_beacon; |
| acx->snr_data = c->avg_weight_snr_data; |
| |
| ret = wl1271_cmd_configure(wl, ACX_RSSI_SNR_WEIGHTS, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx rssi snr trigger weights failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_set_ht_capabilities(struct wl1271 *wl, |
| struct ieee80211_sta_ht_cap *ht_cap, |
| bool allow_ht_operation) |
| { |
| struct wl1271_acx_ht_capabilities *acx; |
| u8 mac_address[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; |
| int ret = 0; |
| u32 ht_capabilites = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx ht capabilities setting"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* Allow HT Operation ? */ |
| if (allow_ht_operation) { |
| ht_capabilites = |
| WL1271_ACX_FW_CAP_HT_OPERATION; |
| if (ht_cap->cap & IEEE80211_HT_CAP_GRN_FLD) |
| ht_capabilites |= |
| WL1271_ACX_FW_CAP_GREENFIELD_FRAME_FORMAT; |
| if (ht_cap->cap & IEEE80211_HT_CAP_SGI_20) |
| ht_capabilites |= |
| WL1271_ACX_FW_CAP_SHORT_GI_FOR_20MHZ_PACKETS; |
| if (ht_cap->cap & IEEE80211_HT_CAP_LSIG_TXOP_PROT) |
| ht_capabilites |= |
| WL1271_ACX_FW_CAP_LSIG_TXOP_PROTECTION; |
| |
| /* get data from A-MPDU parameters field */ |
| acx->ampdu_max_length = ht_cap->ampdu_factor; |
| acx->ampdu_min_spacing = ht_cap->ampdu_density; |
| } |
| |
| memcpy(acx->mac_address, mac_address, ETH_ALEN); |
| acx->ht_capabilites = cpu_to_le32(ht_capabilites); |
| |
| ret = wl1271_cmd_configure(wl, ACX_PEER_HT_CAP, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx ht capabilities setting failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_set_ht_information(struct wl1271 *wl, |
| u16 ht_operation_mode) |
| { |
| struct wl1271_acx_ht_information *acx; |
| int ret = 0; |
| |
| wl1271_debug(DEBUG_ACX, "acx ht information setting"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| acx->ht_protection = |
| (u8)(ht_operation_mode & IEEE80211_HT_OP_MODE_PROTECTION); |
| acx->rifs_mode = 0; |
| acx->gf_protection = |
| !!(ht_operation_mode & IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT); |
| acx->ht_tx_burst_limit = 0; |
| acx->dual_cts_protection = 0; |
| |
| ret = wl1271_cmd_configure(wl, ACX_HT_BSS_OPERATION, acx, sizeof(*acx)); |
| |
| if (ret < 0) { |
| wl1271_warning("acx ht information setting failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| /* Configure BA session initiator/receiver parameters setting in the FW. */ |
| int wl1271_acx_set_ba_session(struct wl1271 *wl, |
| enum ieee80211_back_parties direction, |
| u8 tid_index, u8 policy) |
| { |
| struct wl1271_acx_ba_session_policy *acx; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx ba session setting"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* ANY role */ |
| acx->role_id = 0xff; |
| acx->tid = tid_index; |
| acx->enable = policy; |
| acx->ba_direction = direction; |
| |
| switch (direction) { |
| case WLAN_BACK_INITIATOR: |
| acx->win_size = wl->conf.ht.tx_ba_win_size; |
| acx->inactivity_timeout = wl->conf.ht.inactivity_timeout; |
| break; |
| case WLAN_BACK_RECIPIENT: |
| acx->win_size = RX_BA_WIN_SIZE; |
| acx->inactivity_timeout = 0; |
| break; |
| default: |
| wl1271_error("Incorrect acx command id=%x\n", direction); |
| ret = -EINVAL; |
| goto out; |
| } |
| |
| ret = wl1271_cmd_configure(wl, |
| ACX_BA_SESSION_POLICY_CFG, |
| acx, |
| sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx ba session setting failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| /* setup BA session receiver setting in the FW. */ |
| int wl1271_acx_set_ba_receiver_session(struct wl1271 *wl, u8 tid_index, u16 ssn, |
| bool enable) |
| { |
| struct wl1271_acx_ba_receiver_setup *acx; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx ba receiver session setting"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| /* Single link for now */ |
| acx->link_id = 1; |
| acx->tid = tid_index; |
| acx->enable = enable; |
| acx->win_size = 0; |
| acx->ssn = ssn; |
| |
| ret = wl1271_cmd_configure(wl, ACX_BA_SESSION_RX_SETUP, acx, |
| sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx ba receiver session failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_tsf_info(struct wl1271 *wl, u64 *mactime) |
| { |
| struct wl1271_acx_fw_tsf_information *tsf_info; |
| int ret; |
| |
| tsf_info = kzalloc(sizeof(*tsf_info), GFP_KERNEL); |
| if (!tsf_info) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| ret = wl1271_cmd_interrogate(wl, ACX_TSF_INFO, |
| tsf_info, sizeof(*tsf_info)); |
| if (ret < 0) { |
| wl1271_warning("acx tsf info interrogate failed"); |
| goto out; |
| } |
| |
| *mactime = le32_to_cpu(tsf_info->current_tsf_low) | |
| ((u64) le32_to_cpu(tsf_info->current_tsf_high) << 32); |
| |
| out: |
| kfree(tsf_info); |
| return ret; |
| } |
| |
| int wl1271_acx_max_tx_retry(struct wl1271 *wl) |
| { |
| struct wl1271_acx_max_tx_retry *acx = NULL; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx max tx retry"); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) |
| return -ENOMEM; |
| |
| acx->max_tx_retry = cpu_to_le16(wl->conf.tx.ap_max_tx_retries); |
| |
| ret = wl1271_cmd_configure(wl, ACX_MAX_TX_FAILURE, acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx max tx retry failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |
| |
| int wl1271_acx_config_ps(struct wl1271 *wl) |
| { |
| struct wl1271_acx_config_ps *config_ps; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx config ps"); |
| |
| config_ps = kzalloc(sizeof(*config_ps), GFP_KERNEL); |
| if (!config_ps) { |
| ret = -ENOMEM; |
| goto out; |
| } |
| |
| config_ps->exit_retries = wl->conf.conn.psm_exit_retries; |
| config_ps->enter_retries = wl->conf.conn.psm_entry_retries; |
| config_ps->null_data_rate = cpu_to_le32(wl->basic_rate); |
| |
| ret = wl1271_cmd_configure(wl, ACX_CONFIG_PS, config_ps, |
| sizeof(*config_ps)); |
| |
| if (ret < 0) { |
| wl1271_warning("acx config ps failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(config_ps); |
| return ret; |
| } |
| |
| int wl1271_acx_set_inconnection_sta(struct wl1271 *wl, u8 *addr) |
| { |
| struct wl1271_acx_inconnection_sta *acx = NULL; |
| int ret; |
| |
| wl1271_debug(DEBUG_ACX, "acx set inconnaction sta %pM", addr); |
| |
| acx = kzalloc(sizeof(*acx), GFP_KERNEL); |
| if (!acx) |
| return -ENOMEM; |
| |
| memcpy(acx->addr, addr, ETH_ALEN); |
| |
| ret = wl1271_cmd_configure(wl, ACX_UPDATE_INCONNECTION_STA_LIST, |
| acx, sizeof(*acx)); |
| if (ret < 0) { |
| wl1271_warning("acx set inconnaction sta failed: %d", ret); |
| goto out; |
| } |
| |
| out: |
| kfree(acx); |
| return ret; |
| } |