2 * Copyright (c) 2010 Broadcom Corporation
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
14 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
27 #include <bcmendian.h>
29 #include <wlc_phy_radio.h>
32 #include <proto/802.11.h>
37 #include <wlc_bsscfg.h>
39 #include <wlc_mac80211.h>
41 #include <wlc_phy_hal.h>
42 #include <wl_export.h>
43 #include <wlc_antsel.h>
44 #include <wlc_phy_shim.h>
47 #define WLC_ANTSEL_11N_0(ant) ((((ant) & ANT_SELCFG_MASK) >> 4) & 0xf)
48 #define WLC_ANTSEL_11N_1(ant) (((ant) & ANT_SELCFG_MASK) & 0xf)
49 #define WLC_ANTIDX_11N(ant) (((WLC_ANTSEL_11N_0(ant)) << 2) + (WLC_ANTSEL_11N_1(ant)))
50 #define WLC_ANT_ISAUTO_11N(ant) (((ant) & ANT_SELCFG_AUTO) == ANT_SELCFG_AUTO)
51 #define WLC_ANTSEL_11N(ant) ((ant) & ANT_SELCFG_MASK)
54 /* defines for no boardlevel antenna diversity */
55 #define ANT_SELCFG_DEF_2x2 0x01 /* default antenna configuration */
57 /* 2x3 antdiv defines and tables for GPIO communication */
58 #define ANT_SELCFG_NUM_2x3 3
59 #define ANT_SELCFG_DEF_2x3 0x01 /* default antenna configuration */
61 /* 2x4 antdiv rev4 defines and tables for GPIO communication */
62 #define ANT_SELCFG_NUM_2x4 4
63 #define ANT_SELCFG_DEF_2x4 0x02 /* default antenna configuration */
65 /* static functions */
66 static int wlc_antsel_cfgupd(antsel_info_t * asi, wlc_antselcfg_t * antsel);
67 static uint8 wlc_antsel_id2antcfg(antsel_info_t * asi, uint8 id);
68 static uint16 wlc_antsel_antcfg2antsel(antsel_info_t * asi, uint8 ant_cfg);
69 static void wlc_antsel_init_cfg(antsel_info_t * asi, wlc_antselcfg_t * antsel,
72 const uint16 mimo_2x4_div_antselpat_tbl[] = {
73 0, 0, 0x9, 0xa, /* ant0: 0 ant1: 2,3 */
74 0, 0, 0x5, 0x6, /* ant0: 1 ant1: 2,3 */
75 0, 0, 0, 0, /* n.a. */
79 const uint8 mimo_2x4_div_antselid_tbl[16] = {
80 0, 0, 0, 0, 0, 2, 3, 0,
81 0, 0, 1, 0, 0, 0, 0, 0 /* pat to antselid */
84 const uint16 mimo_2x3_div_antselpat_tbl[] = {
85 16, 0, 1, 16, /* ant0: 0 ant1: 1,2 */
86 16, 16, 16, 16, /* n.a. */
87 16, 2, 16, 16, /* ant0: 2 ant1: 1 */
88 16, 16, 16, 16 /* n.a. */
91 const uint8 mimo_2x3_div_antselid_tbl[16] = {
92 0, 1, 2, 0, 0, 0, 0, 0,
93 0, 0, 0, 0, 0, 0, 0, 0 /* pat to antselid */
96 antsel_info_t *BCMNMIATTACHFN(wlc_antsel_attach) (wlc_info_t * wlc, osl_t * osh,
98 wlc_hw_info_t * wlc_hw) {
101 if (!(asi = (antsel_info_t *) MALLOC(osh, sizeof(antsel_info_t)))) {
102 WL_ERROR(("wl%d: wlc_antsel_attach: out of mem, malloced %d bytes\n", pub->unit, MALLOCED(osh)));
106 bzero((char *)asi, sizeof(antsel_info_t));
110 asi->antsel_type = ANTSEL_NA;
111 asi->antsel_avail = FALSE;
112 asi->antsel_antswitch = (uint8) getintvar(asi->pub->vars, "antswitch");
114 if ((asi->pub->sromrev >= 4) && (asi->antsel_antswitch != 0)) {
115 switch (asi->antsel_antswitch) {
116 case ANTSWITCH_TYPE_1:
117 case ANTSWITCH_TYPE_2:
118 case ANTSWITCH_TYPE_3:
119 /* 4321/2 board with 2x3 switch logic */
120 asi->antsel_type = ANTSEL_2x3;
121 /* Antenna selection availability */
122 if (((uint16) getintvar(asi->pub->vars, "aa2g") == 7) ||
123 ((uint16) getintvar(asi->pub->vars, "aa5g") == 7)) {
124 asi->antsel_avail = TRUE;
126 if (((uint16) getintvar(asi->pub->vars, "aa2g") ==
128 || ((uint16) getintvar(asi->pub->vars, "aa5g")
130 asi->antsel_avail = FALSE;
132 asi->antsel_avail = FALSE;
133 WL_ERROR(("wlc_antsel_attach: 2o3 board cfg invalid\n"));
140 } else if ((asi->pub->sromrev == 4) &&
141 ((uint16) getintvar(asi->pub->vars, "aa2g") == 7) &&
142 ((uint16) getintvar(asi->pub->vars, "aa5g") == 0)) {
143 /* hack to match old 4321CB2 cards with 2of3 antenna switch */
144 asi->antsel_type = ANTSEL_2x3;
145 asi->antsel_avail = TRUE;
146 } else if (asi->pub->boardflags2 & BFL2_2X4_DIV) {
147 asi->antsel_type = ANTSEL_2x4;
148 asi->antsel_avail = TRUE;
151 /* Set the antenna selection type for the low driver */
152 wlc_bmac_antsel_type_set(wlc_hw, asi->antsel_type);
154 /* Init (auto/manual) antenna selection */
155 wlc_antsel_init_cfg(asi, &asi->antcfg_11n, TRUE);
156 wlc_antsel_init_cfg(asi, &asi->antcfg_cur, TRUE);
161 void BCMATTACHFN(wlc_antsel_detach) (antsel_info_t * asi) {
165 MFREE(asi->pub->osh, asi, sizeof(antsel_info_t));
168 void wlc_antsel_init(antsel_info_t * asi)
170 if ((asi->antsel_type == ANTSEL_2x3) ||
171 (asi->antsel_type == ANTSEL_2x4))
172 wlc_antsel_cfgupd(asi, &asi->antcfg_11n);
175 /* boardlevel antenna selection: init antenna selection structure */
177 wlc_antsel_init_cfg(antsel_info_t * asi, wlc_antselcfg_t * antsel,
180 if (asi->antsel_type == ANTSEL_2x3) {
181 uint8 antcfg_def = ANT_SELCFG_DEF_2x3 |
182 ((asi->antsel_avail && auto_sel) ? ANT_SELCFG_AUTO : 0);
183 antsel->ant_config[ANT_SELCFG_TX_DEF] = antcfg_def;
184 antsel->ant_config[ANT_SELCFG_TX_UNICAST] = antcfg_def;
185 antsel->ant_config[ANT_SELCFG_RX_DEF] = antcfg_def;
186 antsel->ant_config[ANT_SELCFG_RX_UNICAST] = antcfg_def;
187 antsel->num_antcfg = ANT_SELCFG_NUM_2x3;
189 } else if (asi->antsel_type == ANTSEL_2x4) {
191 antsel->ant_config[ANT_SELCFG_TX_DEF] = ANT_SELCFG_DEF_2x4;
192 antsel->ant_config[ANT_SELCFG_TX_UNICAST] = ANT_SELCFG_DEF_2x4;
193 antsel->ant_config[ANT_SELCFG_RX_DEF] = ANT_SELCFG_DEF_2x4;
194 antsel->ant_config[ANT_SELCFG_RX_UNICAST] = ANT_SELCFG_DEF_2x4;
195 antsel->num_antcfg = ANT_SELCFG_NUM_2x4;
197 } else { /* no antenna selection available */
199 antsel->ant_config[ANT_SELCFG_TX_DEF] = ANT_SELCFG_DEF_2x2;
200 antsel->ant_config[ANT_SELCFG_TX_UNICAST] = ANT_SELCFG_DEF_2x2;
201 antsel->ant_config[ANT_SELCFG_RX_DEF] = ANT_SELCFG_DEF_2x2;
202 antsel->ant_config[ANT_SELCFG_RX_UNICAST] = ANT_SELCFG_DEF_2x2;
203 antsel->num_antcfg = 0;
208 wlc_antsel_antcfg_get(antsel_info_t * asi, bool usedef, bool sel,
209 uint8 antselid, uint8 fbantselid, uint8 * antcfg,
214 /* if use default, assign it and return */
216 *antcfg = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_DEF];
222 *antcfg = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST];
226 ant = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST];
227 if ((ant & ANT_SELCFG_AUTO) == ANT_SELCFG_AUTO) {
228 *antcfg = wlc_antsel_id2antcfg(asi, antselid);
229 *fbantcfg = wlc_antsel_id2antcfg(asi, fbantselid);
232 asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST];
239 /* boardlevel antenna selection: convert mimo_antsel (ucode interface) to id */
240 uint8 wlc_antsel_antsel2id(antsel_info_t * asi, uint16 antsel)
244 if (asi->antsel_type == ANTSEL_2x4) {
245 /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */
246 antselid = mimo_2x4_div_antselid_tbl[(antsel & 0xf)];
249 } else if (asi->antsel_type == ANTSEL_2x3) {
250 /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */
251 antselid = mimo_2x3_div_antselid_tbl[(antsel & 0xf)];
258 /* boardlevel antenna selection: convert id to ant_cfg */
259 static uint8 wlc_antsel_id2antcfg(antsel_info_t * asi, uint8 id)
261 uint8 antcfg = ANT_SELCFG_DEF_2x2;
263 if (asi->antsel_type == ANTSEL_2x4) {
264 /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */
265 antcfg = (((id & 0x2) << 3) | ((id & 0x1) + 2));
268 } else if (asi->antsel_type == ANTSEL_2x3) {
269 /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */
270 antcfg = (((id & 0x02) << 4) | ((id & 0x1) + 1));
277 /* boardlevel antenna selection: convert ant_cfg to mimo_antsel (ucode interface) */
278 static uint16 wlc_antsel_antcfg2antsel(antsel_info_t * asi, uint8 ant_cfg)
280 uint8 idx = WLC_ANTIDX_11N(WLC_ANTSEL_11N(ant_cfg));
281 uint16 mimo_antsel = 0;
283 if (asi->antsel_type == ANTSEL_2x4) {
284 /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */
285 mimo_antsel = (mimo_2x4_div_antselpat_tbl[idx] & 0xf);
288 } else if (asi->antsel_type == ANTSEL_2x3) {
289 /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */
290 mimo_antsel = (mimo_2x3_div_antselpat_tbl[idx] & 0xf);
297 /* boardlevel antenna selection: ucode interface control */
298 static int wlc_antsel_cfgupd(antsel_info_t * asi, wlc_antselcfg_t * antsel)
300 wlc_info_t *wlc = asi->wlc;
304 ASSERT(asi->antsel_type != ANTSEL_NA);
306 /* 1) Update TX antconfig for all frames that are not unicast data
309 ant_cfg = antsel->ant_config[ANT_SELCFG_TX_DEF];
310 mimo_antsel = wlc_antsel_antcfg2antsel(asi, ant_cfg);
311 wlc_write_shm(wlc, M_MIMO_ANTSEL_TXDFLT, mimo_antsel);
312 /* Update driver stats for currently selected default tx/rx antenna config */
313 asi->antcfg_cur.ant_config[ANT_SELCFG_TX_DEF] = ant_cfg;
315 /* 2) Update RX antconfig for all frames that are not unicast data
318 ant_cfg = antsel->ant_config[ANT_SELCFG_RX_DEF];
319 mimo_antsel = wlc_antsel_antcfg2antsel(asi, ant_cfg);
320 wlc_write_shm(wlc, M_MIMO_ANTSEL_RXDFLT, mimo_antsel);
321 /* Update driver stats for currently selected default tx/rx antenna config */
322 asi->antcfg_cur.ant_config[ANT_SELCFG_RX_DEF] = ant_cfg;
327 #endif /* WLANTSEL */