|  | /* | 
|  | * This file is part of wl1271 | 
|  | * | 
|  | * Copyright (C) 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 <linux/kernel.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/slab.h> | 
|  |  | 
|  | #include "init.h" | 
|  | #include "wl12xx_80211.h" | 
|  | #include "acx.h" | 
|  | #include "cmd.h" | 
|  | #include "reg.h" | 
|  |  | 
|  | static int wl1271_init_hwenc_config(struct wl1271 *wl) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = wl1271_acx_feature_cfg(wl); | 
|  | if (ret < 0) { | 
|  | wl1271_warning("couldn't set feature config"); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | ret = wl1271_cmd_set_default_wep_key(wl, wl->default_key); | 
|  | if (ret < 0) { | 
|  | wl1271_warning("couldn't set default key"); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int wl1271_init_templates_config(struct wl1271 *wl) | 
|  | { | 
|  | int ret, i; | 
|  |  | 
|  | /* send empty templates for fw memory reservation */ | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_CFG_PROBE_REQ_2_4, NULL, | 
|  | WL1271_CMD_TEMPL_MAX_SIZE, | 
|  | 0, WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_CFG_PROBE_REQ_5, | 
|  | NULL, WL1271_CMD_TEMPL_MAX_SIZE, 0, | 
|  | WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_NULL_DATA, NULL, | 
|  | sizeof(struct wl12xx_null_data_template), | 
|  | 0, WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_PS_POLL, NULL, | 
|  | sizeof(struct wl12xx_ps_poll_template), | 
|  | 0, WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_QOS_NULL_DATA, NULL, | 
|  | sizeof | 
|  | (struct wl12xx_qos_null_data_template), | 
|  | 0, WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_PROBE_RESPONSE, NULL, | 
|  | sizeof | 
|  | (struct wl12xx_probe_resp_template), | 
|  | 0, WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_BEACON, NULL, | 
|  | sizeof | 
|  | (struct wl12xx_beacon_template), | 
|  | 0, WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_ARP_RSP, NULL, | 
|  | sizeof | 
|  | (struct wl12xx_arp_rsp_template), | 
|  | 0, WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | for (i = 0; i < CMD_TEMPL_KLV_IDX_MAX; i++) { | 
|  | ret = wl1271_cmd_template_set(wl, CMD_TEMPL_KLV, NULL, | 
|  | WL1271_CMD_TEMPL_MAX_SIZE, i, | 
|  | WL1271_RATE_AUTOMATIC); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int wl1271_init_rx_config(struct wl1271 *wl, u32 config, u32 filter) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = wl1271_acx_rx_msdu_life_time(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_acx_rx_config(wl, config, filter); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int wl1271_init_phy_config(struct wl1271 *wl) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = wl1271_acx_pd_threshold(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_acx_slot(wl, DEFAULT_SLOT_TIME); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_acx_group_address_tbl(wl, true, NULL, 0); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_acx_service_period_timeout(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_acx_rts_threshold(wl, wl->conf.rx.rts_threshold); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int wl1271_init_beacon_filter(struct wl1271 *wl) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | /* disable beacon filtering at this stage */ | 
|  | ret = wl1271_acx_beacon_filter_opt(wl, false); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_acx_beacon_filter_table(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int wl1271_init_pta(struct wl1271 *wl) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = wl1271_acx_sg_cfg(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_acx_sg_enable(wl, wl->sg_enabled); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int wl1271_init_energy_detection(struct wl1271 *wl) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = wl1271_acx_cca_threshold(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int wl1271_init_beacon_broadcast(struct wl1271 *wl) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = wl1271_acx_bcn_dtim_options(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int wl1271_hw_init(struct wl1271 *wl) | 
|  | { | 
|  | struct conf_tx_ac_category *conf_ac; | 
|  | struct conf_tx_tid *conf_tid; | 
|  | int ret, i; | 
|  |  | 
|  | ret = wl1271_cmd_general_parms(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_radio_parms(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = wl1271_cmd_ext_radio_parms(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | /* Template settings */ | 
|  | ret = wl1271_init_templates_config(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | /* Default memory configuration */ | 
|  | ret = wl1271_acx_init_mem_config(wl); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | /* RX config */ | 
|  | ret = wl1271_init_rx_config(wl, | 
|  | RX_CFG_PROMISCUOUS | RX_CFG_TSF, | 
|  | RX_FILTER_OPTION_DEF); | 
|  | /* RX_CONFIG_OPTION_ANY_DST_ANY_BSS, | 
|  | RX_FILTER_OPTION_FILTER_ALL); */ | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* PHY layer config */ | 
|  | ret = wl1271_init_phy_config(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | ret = wl1271_acx_dco_itrim_params(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Initialize connection monitoring thresholds */ | 
|  | ret = wl1271_acx_conn_monit_params(wl, false); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Beacon filtering */ | 
|  | ret = wl1271_init_beacon_filter(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Configure TX patch complete interrupt behavior */ | 
|  | ret = wl1271_acx_tx_config_options(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* RX complete interrupt pacing */ | 
|  | ret = wl1271_acx_init_rx_interrupt(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Bluetooth WLAN coexistence */ | 
|  | ret = wl1271_init_pta(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Energy detection */ | 
|  | ret = wl1271_init_energy_detection(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Beacons and boradcast settings */ | 
|  | ret = wl1271_init_beacon_broadcast(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Default fragmentation threshold */ | 
|  | ret = wl1271_acx_frag_threshold(wl, wl->conf.tx.frag_threshold); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Default TID/AC configuration */ | 
|  | BUG_ON(wl->conf.tx.tid_conf_count != wl->conf.tx.ac_conf_count); | 
|  | for (i = 0; i < wl->conf.tx.tid_conf_count; i++) { | 
|  | conf_ac = &wl->conf.tx.ac_conf[i]; | 
|  | ret = wl1271_acx_ac_cfg(wl, conf_ac->ac, conf_ac->cw_min, | 
|  | conf_ac->cw_max, conf_ac->aifsn, | 
|  | conf_ac->tx_op_limit); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | conf_tid = &wl->conf.tx.tid_conf[i]; | 
|  | ret = wl1271_acx_tid_cfg(wl, conf_tid->queue_id, | 
|  | conf_tid->channel_type, | 
|  | conf_tid->tsid, | 
|  | conf_tid->ps_scheme, | 
|  | conf_tid->ack_policy, | 
|  | conf_tid->apsd_conf[0], | 
|  | conf_tid->apsd_conf[1]); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  | } | 
|  |  | 
|  | /* Configure TX rate classes */ | 
|  | ret = wl1271_acx_rate_policies(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Enable data path */ | 
|  | ret = wl1271_cmd_data_path(wl, 1); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Configure for ELP power saving */ | 
|  | ret = wl1271_acx_sleep_auth(wl, WL1271_PSM_ELP); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Configure HW encryption */ | 
|  | ret = wl1271_init_hwenc_config(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* configure PM */ | 
|  | ret = wl1271_acx_pm_config(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* disable all keep-alive templates */ | 
|  | for (i = 0; i < CMD_TEMPL_KLV_IDX_MAX; i++) { | 
|  | ret = wl1271_acx_keep_alive_config(wl, i, | 
|  | ACX_KEEP_ALIVE_TPL_INVALID); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  | } | 
|  |  | 
|  | /* disable the keep-alive feature */ | 
|  | ret = wl1271_acx_keep_alive_mode(wl, false); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | /* Configure rssi/snr averaging weights */ | 
|  | ret = wl1271_acx_rssi_snr_avg_weights(wl); | 
|  | if (ret < 0) | 
|  | goto out_free_memmap; | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | out_free_memmap: | 
|  | kfree(wl->target_mem_map); | 
|  | wl->target_mem_map = NULL; | 
|  |  | 
|  | return ret; | 
|  | } |