| /* |
| * Copyright (c) 2010 Broadcom Corporation |
| * |
| * Permission to use, copy, modify, and/or distribute this software for any |
| * purpose with or without fee is hereby granted, provided that the above |
| * copyright notice and this permission notice appear in all copies. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
| * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
| * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY |
| * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION |
| * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN |
| * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| */ |
| |
| #include <wlc_cfg.h> |
| |
| #ifdef WLANTSEL |
| |
| #include <typedefs.h> |
| #include <qmath.h> |
| #include <bcmdefs.h> |
| #include <osl.h> |
| #include <bcmutils.h> |
| #include <siutils.h> |
| #include <bcmendian.h> |
| #include <wlioctl.h> |
| #include <wlc_phy_radio.h> |
| #include <bitfuncs.h> |
| |
| #include <proto/802.11.h> |
| #include <d11.h> |
| #include <wlc_rate.h> |
| #include <wlc_key.h> |
| #include <wlc_pub.h> |
| #include <wlc_bsscfg.h> |
| #include <wl_dbg.h> |
| #include <wlc_mac80211.h> |
| #include <wlc_bmac.h> |
| #include <wlc_phy_hal.h> |
| #include <wl_export.h> |
| #include <wlc_antsel.h> |
| #include <wlc_phy_shim.h> |
| |
| /* useful macros */ |
| #define WLC_ANTSEL_11N_0(ant) ((((ant) & ANT_SELCFG_MASK) >> 4) & 0xf) |
| #define WLC_ANTSEL_11N_1(ant) (((ant) & ANT_SELCFG_MASK) & 0xf) |
| #define WLC_ANTIDX_11N(ant) (((WLC_ANTSEL_11N_0(ant)) << 2) + (WLC_ANTSEL_11N_1(ant))) |
| #define WLC_ANT_ISAUTO_11N(ant) (((ant) & ANT_SELCFG_AUTO) == ANT_SELCFG_AUTO) |
| #define WLC_ANTSEL_11N(ant) ((ant) & ANT_SELCFG_MASK) |
| |
| /* antenna switch */ |
| /* defines for no boardlevel antenna diversity */ |
| #define ANT_SELCFG_DEF_2x2 0x01 /* default antenna configuration */ |
| |
| /* 2x3 antdiv defines and tables for GPIO communication */ |
| #define ANT_SELCFG_NUM_2x3 3 |
| #define ANT_SELCFG_DEF_2x3 0x01 /* default antenna configuration */ |
| |
| /* 2x4 antdiv rev4 defines and tables for GPIO communication */ |
| #define ANT_SELCFG_NUM_2x4 4 |
| #define ANT_SELCFG_DEF_2x4 0x02 /* default antenna configuration */ |
| |
| /* static functions */ |
| static int wlc_antsel_cfgupd(antsel_info_t * asi, wlc_antselcfg_t * antsel); |
| static uint8 wlc_antsel_id2antcfg(antsel_info_t * asi, uint8 id); |
| static uint16 wlc_antsel_antcfg2antsel(antsel_info_t * asi, uint8 ant_cfg); |
| static void wlc_antsel_init_cfg(antsel_info_t * asi, wlc_antselcfg_t * antsel, |
| bool auto_sel); |
| |
| const uint16 mimo_2x4_div_antselpat_tbl[] = { |
| 0, 0, 0x9, 0xa, /* ant0: 0 ant1: 2,3 */ |
| 0, 0, 0x5, 0x6, /* ant0: 1 ant1: 2,3 */ |
| 0, 0, 0, 0, /* n.a. */ |
| 0, 0, 0, 0 /* n.a. */ |
| }; |
| |
| const uint8 mimo_2x4_div_antselid_tbl[16] = { |
| 0, 0, 0, 0, 0, 2, 3, 0, |
| 0, 0, 1, 0, 0, 0, 0, 0 /* pat to antselid */ |
| }; |
| |
| const uint16 mimo_2x3_div_antselpat_tbl[] = { |
| 16, 0, 1, 16, /* ant0: 0 ant1: 1,2 */ |
| 16, 16, 16, 16, /* n.a. */ |
| 16, 2, 16, 16, /* ant0: 2 ant1: 1 */ |
| 16, 16, 16, 16 /* n.a. */ |
| }; |
| |
| const uint8 mimo_2x3_div_antselid_tbl[16] = { |
| 0, 1, 2, 0, 0, 0, 0, 0, |
| 0, 0, 0, 0, 0, 0, 0, 0 /* pat to antselid */ |
| }; |
| |
| antsel_info_t *BCMNMIATTACHFN(wlc_antsel_attach) (wlc_info_t * wlc, osl_t * osh, |
| wlc_pub_t * pub, |
| wlc_hw_info_t * wlc_hw) { |
| antsel_info_t *asi; |
| |
| if (!(asi = (antsel_info_t *) MALLOC(osh, sizeof(antsel_info_t)))) { |
| WL_ERROR(("wl%d: wlc_antsel_attach: out of mem, malloced %d bytes\n", pub->unit, MALLOCED(osh))); |
| return NULL; |
| } |
| |
| bzero((char *)asi, sizeof(antsel_info_t)); |
| |
| asi->wlc = wlc; |
| asi->pub = pub; |
| asi->antsel_type = ANTSEL_NA; |
| asi->antsel_avail = FALSE; |
| asi->antsel_antswitch = (uint8) getintvar(asi->pub->vars, "antswitch"); |
| |
| if ((asi->pub->sromrev >= 4) && (asi->antsel_antswitch != 0)) { |
| switch (asi->antsel_antswitch) { |
| case ANTSWITCH_TYPE_1: |
| case ANTSWITCH_TYPE_2: |
| case ANTSWITCH_TYPE_3: |
| /* 4321/2 board with 2x3 switch logic */ |
| asi->antsel_type = ANTSEL_2x3; |
| /* Antenna selection availability */ |
| if (((uint16) getintvar(asi->pub->vars, "aa2g") == 7) || |
| ((uint16) getintvar(asi->pub->vars, "aa5g") == 7)) { |
| asi->antsel_avail = TRUE; |
| } else |
| if (((uint16) getintvar(asi->pub->vars, "aa2g") == |
| 3) |
| || ((uint16) getintvar(asi->pub->vars, "aa5g") |
| == 3)) { |
| asi->antsel_avail = FALSE; |
| } else { |
| asi->antsel_avail = FALSE; |
| WL_ERROR(("wlc_antsel_attach: 2o3 board cfg invalid\n")); |
| ASSERT(0); |
| } |
| break; |
| default: |
| break; |
| } |
| } else if ((asi->pub->sromrev == 4) && |
| ((uint16) getintvar(asi->pub->vars, "aa2g") == 7) && |
| ((uint16) getintvar(asi->pub->vars, "aa5g") == 0)) { |
| /* hack to match old 4321CB2 cards with 2of3 antenna switch */ |
| asi->antsel_type = ANTSEL_2x3; |
| asi->antsel_avail = TRUE; |
| } else if (asi->pub->boardflags2 & BFL2_2X4_DIV) { |
| asi->antsel_type = ANTSEL_2x4; |
| asi->antsel_avail = TRUE; |
| } |
| |
| /* Set the antenna selection type for the low driver */ |
| wlc_bmac_antsel_type_set(wlc_hw, asi->antsel_type); |
| |
| /* Init (auto/manual) antenna selection */ |
| wlc_antsel_init_cfg(asi, &asi->antcfg_11n, TRUE); |
| wlc_antsel_init_cfg(asi, &asi->antcfg_cur, TRUE); |
| |
| return asi; |
| } |
| |
| void BCMATTACHFN(wlc_antsel_detach) (antsel_info_t * asi) { |
| if (!asi) |
| return; |
| |
| MFREE(asi->pub->osh, asi, sizeof(antsel_info_t)); |
| } |
| |
| void wlc_antsel_init(antsel_info_t * asi) |
| { |
| if ((asi->antsel_type == ANTSEL_2x3) || |
| (asi->antsel_type == ANTSEL_2x4)) |
| wlc_antsel_cfgupd(asi, &asi->antcfg_11n); |
| } |
| |
| /* boardlevel antenna selection: init antenna selection structure */ |
| static void |
| wlc_antsel_init_cfg(antsel_info_t * asi, wlc_antselcfg_t * antsel, |
| bool auto_sel) |
| { |
| if (asi->antsel_type == ANTSEL_2x3) { |
| uint8 antcfg_def = ANT_SELCFG_DEF_2x3 | |
| ((asi->antsel_avail && auto_sel) ? ANT_SELCFG_AUTO : 0); |
| antsel->ant_config[ANT_SELCFG_TX_DEF] = antcfg_def; |
| antsel->ant_config[ANT_SELCFG_TX_UNICAST] = antcfg_def; |
| antsel->ant_config[ANT_SELCFG_RX_DEF] = antcfg_def; |
| antsel->ant_config[ANT_SELCFG_RX_UNICAST] = antcfg_def; |
| antsel->num_antcfg = ANT_SELCFG_NUM_2x3; |
| |
| } else if (asi->antsel_type == ANTSEL_2x4) { |
| |
| antsel->ant_config[ANT_SELCFG_TX_DEF] = ANT_SELCFG_DEF_2x4; |
| antsel->ant_config[ANT_SELCFG_TX_UNICAST] = ANT_SELCFG_DEF_2x4; |
| antsel->ant_config[ANT_SELCFG_RX_DEF] = ANT_SELCFG_DEF_2x4; |
| antsel->ant_config[ANT_SELCFG_RX_UNICAST] = ANT_SELCFG_DEF_2x4; |
| antsel->num_antcfg = ANT_SELCFG_NUM_2x4; |
| |
| } else { /* no antenna selection available */ |
| |
| antsel->ant_config[ANT_SELCFG_TX_DEF] = ANT_SELCFG_DEF_2x2; |
| antsel->ant_config[ANT_SELCFG_TX_UNICAST] = ANT_SELCFG_DEF_2x2; |
| antsel->ant_config[ANT_SELCFG_RX_DEF] = ANT_SELCFG_DEF_2x2; |
| antsel->ant_config[ANT_SELCFG_RX_UNICAST] = ANT_SELCFG_DEF_2x2; |
| antsel->num_antcfg = 0; |
| } |
| } |
| |
| void BCMFASTPATH |
| wlc_antsel_antcfg_get(antsel_info_t * asi, bool usedef, bool sel, |
| uint8 antselid, uint8 fbantselid, uint8 * antcfg, |
| uint8 * fbantcfg) |
| { |
| uint8 ant; |
| |
| /* if use default, assign it and return */ |
| if (usedef) { |
| *antcfg = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_DEF]; |
| *fbantcfg = *antcfg; |
| return; |
| } |
| |
| if (!sel) { |
| *antcfg = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST]; |
| *fbantcfg = *antcfg; |
| |
| } else { |
| ant = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST]; |
| if ((ant & ANT_SELCFG_AUTO) == ANT_SELCFG_AUTO) { |
| *antcfg = wlc_antsel_id2antcfg(asi, antselid); |
| *fbantcfg = wlc_antsel_id2antcfg(asi, fbantselid); |
| } else { |
| *antcfg = |
| asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST]; |
| *fbantcfg = *antcfg; |
| } |
| } |
| return; |
| } |
| |
| /* boardlevel antenna selection: convert mimo_antsel (ucode interface) to id */ |
| uint8 wlc_antsel_antsel2id(antsel_info_t * asi, uint16 antsel) |
| { |
| uint8 antselid = 0; |
| |
| if (asi->antsel_type == ANTSEL_2x4) { |
| /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */ |
| antselid = mimo_2x4_div_antselid_tbl[(antsel & 0xf)]; |
| return antselid; |
| |
| } else if (asi->antsel_type == ANTSEL_2x3) { |
| /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */ |
| antselid = mimo_2x3_div_antselid_tbl[(antsel & 0xf)]; |
| return antselid; |
| } |
| |
| return antselid; |
| } |
| |
| /* boardlevel antenna selection: convert id to ant_cfg */ |
| static uint8 wlc_antsel_id2antcfg(antsel_info_t * asi, uint8 id) |
| { |
| uint8 antcfg = ANT_SELCFG_DEF_2x2; |
| |
| if (asi->antsel_type == ANTSEL_2x4) { |
| /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */ |
| antcfg = (((id & 0x2) << 3) | ((id & 0x1) + 2)); |
| return antcfg; |
| |
| } else if (asi->antsel_type == ANTSEL_2x3) { |
| /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */ |
| antcfg = (((id & 0x02) << 4) | ((id & 0x1) + 1)); |
| return antcfg; |
| } |
| |
| return antcfg; |
| } |
| |
| /* boardlevel antenna selection: convert ant_cfg to mimo_antsel (ucode interface) */ |
| static uint16 wlc_antsel_antcfg2antsel(antsel_info_t * asi, uint8 ant_cfg) |
| { |
| uint8 idx = WLC_ANTIDX_11N(WLC_ANTSEL_11N(ant_cfg)); |
| uint16 mimo_antsel = 0; |
| |
| if (asi->antsel_type == ANTSEL_2x4) { |
| /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */ |
| mimo_antsel = (mimo_2x4_div_antselpat_tbl[idx] & 0xf); |
| return mimo_antsel; |
| |
| } else if (asi->antsel_type == ANTSEL_2x3) { |
| /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */ |
| mimo_antsel = (mimo_2x3_div_antselpat_tbl[idx] & 0xf); |
| return mimo_antsel; |
| } |
| |
| return mimo_antsel; |
| } |
| |
| /* boardlevel antenna selection: ucode interface control */ |
| static int wlc_antsel_cfgupd(antsel_info_t * asi, wlc_antselcfg_t * antsel) |
| { |
| wlc_info_t *wlc = asi->wlc; |
| uint8 ant_cfg; |
| uint16 mimo_antsel; |
| |
| ASSERT(asi->antsel_type != ANTSEL_NA); |
| |
| /* 1) Update TX antconfig for all frames that are not unicast data |
| * (aka default TX) |
| */ |
| ant_cfg = antsel->ant_config[ANT_SELCFG_TX_DEF]; |
| mimo_antsel = wlc_antsel_antcfg2antsel(asi, ant_cfg); |
| wlc_write_shm(wlc, M_MIMO_ANTSEL_TXDFLT, mimo_antsel); |
| /* Update driver stats for currently selected default tx/rx antenna config */ |
| asi->antcfg_cur.ant_config[ANT_SELCFG_TX_DEF] = ant_cfg; |
| |
| /* 2) Update RX antconfig for all frames that are not unicast data |
| * (aka default RX) |
| */ |
| ant_cfg = antsel->ant_config[ANT_SELCFG_RX_DEF]; |
| mimo_antsel = wlc_antsel_antcfg2antsel(asi, ant_cfg); |
| wlc_write_shm(wlc, M_MIMO_ANTSEL_RXDFLT, mimo_antsel); |
| /* Update driver stats for currently selected default tx/rx antenna config */ |
| asi->antcfg_cur.ant_config[ANT_SELCFG_RX_DEF] = ant_cfg; |
| |
| return 0; |
| } |
| |
| #endif /* WLANTSEL */ |