linux/drivers/staging/brcm80211/sys/wlc_antsel.c - nest-guard/1.0/linux - Git at Google

 /*
  * 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 <linux/kernel.h>
 #include <linuxver.h>
 #include <bcmdefs.h>
 #include <osl.h>
 #include <bcmutils.h>
 #include <siutils.h>
 #include <wlioctl.h>

 #include <d11.h>
 #include <wlc_rate.h>
 #include <wlc_key.h>
 #include <wlc_pub.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 u8 wlc_antsel_id2antcfg(antsel_info_t *asi, u8 id);
 static u16 wlc_antsel_antcfg2antsel(antsel_info_t *asi, u8 ant_cfg);
 static void wlc_antsel_init_cfg(antsel_info_t *asi, wlc_antselcfg_t *antsel,
 				bool auto_sel);

 const u16 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 u8 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 u16 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 u8 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 *wlc_antsel_attach(wlc_info_t *wlc, osl_t *osh,
 						  wlc_pub_t *pub,
 						  wlc_hw_info_t *wlc_hw) {
 	antsel_info_t *asi;

 	asi = kzalloc(sizeof(antsel_info_t), GFP_ATOMIC);
 	if (!asi) {
 		WL_ERROR(("wl%d: wlc_antsel_attach: out of mem\n", pub->unit));
 		return NULL;
 	}

 	asi->wlc = wlc;
 	asi->pub = pub;
 	asi->antsel_type = ANTSEL_NA;
 	asi->antsel_avail = false;
 	asi->antsel_antswitch = (u8) 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 (((u16) getintvar(asi->pub->vars, "aa2g") == 7) ||
 			    ((u16) getintvar(asi->pub->vars, "aa5g") == 7)) {
 				asi->antsel_avail = true;
 			} else
 			    if (((u16) getintvar(asi->pub->vars, "aa2g") ==
 				 3)
 				|| ((u16) 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) &&
 		   ((u16) getintvar(asi->pub->vars, "aa2g") == 7) &&
 		   ((u16) 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 wlc_antsel_detach(antsel_info_t *asi)
 {
 	if (!asi)
 		return;

 	kfree(asi);
 }

 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) {
 		u8 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,
 		      u8 antselid, u8 fbantselid, u8 *antcfg,
 		      u8 *fbantcfg)
 {
 	u8 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 */
 u8 wlc_antsel_antsel2id(antsel_info_t *asi, u16 antsel)
 {
 	u8 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 u8 wlc_antsel_id2antcfg(antsel_info_t *asi, u8 id)
 {
 	u8 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 u16 wlc_antsel_antcfg2antsel(antsel_info_t *asi, u8 ant_cfg)
 {
 	u8 idx = WLC_ANTIDX_11N(WLC_ANTSEL_11N(ant_cfg));
 	u16 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;
 	u8 ant_cfg;
 	u16 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 */
	/*
	* 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 <linux/kernel.h>
	#include <linuxver.h>
	#include <bcmdefs.h>
	#include <osl.h>
	#include <bcmutils.h>
	#include <siutils.h>
	#include <wlioctl.h>

	#include <d11.h>
	#include <wlc_rate.h>
	#include <wlc_key.h>
	#include <wlc_pub.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 u8 wlc_antsel_id2antcfg(antsel_info_t *asi, u8 id);
	static u16 wlc_antsel_antcfg2antsel(antsel_info_t *asi, u8 ant_cfg);
	static void wlc_antsel_init_cfg(antsel_info_t asi, wlc_antselcfg_t antsel,
	bool auto_sel);

	const u16 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 u8 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 u16 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 u8 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 wlc_antsel_attach(wlc_info_t wlc, osl_t *osh,
	wlc_pub_t *pub,
	wlc_hw_info_t *wlc_hw) {
	antsel_info_t *asi;

	asi = kzalloc(sizeof(antsel_info_t), GFP_ATOMIC);
	if (!asi) {
	WL_ERROR(("wl%d: wlc_antsel_attach: out of mem\n", pub->unit));
	return NULL;
	}

	asi->wlc = wlc;
	asi->pub = pub;
	asi->antsel_type = ANTSEL_NA;
	asi->antsel_avail = false;
	asi->antsel_antswitch = (u8) 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 (((u16) getintvar(asi->pub->vars, "aa2g") == 7) \|\|
	((u16) getintvar(asi->pub->vars, "aa5g") == 7)) {
	asi->antsel_avail = true;
	} else
	if (((u16) getintvar(asi->pub->vars, "aa2g") ==
	3)
	\|\| ((u16) 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) &&
	((u16) getintvar(asi->pub->vars, "aa2g") == 7) &&
	((u16) 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 wlc_antsel_detach(antsel_info_t *asi)
	{
	if (!asi)
	return;

	kfree(asi);
	}

	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) {
	u8 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,
	u8 antselid, u8 fbantselid, u8 *antcfg,
	u8 *fbantcfg)
	{
	u8 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 */
	u8 wlc_antsel_antsel2id(antsel_info_t *asi, u16 antsel)
	{
	u8 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 u8 wlc_antsel_id2antcfg(antsel_info_t *asi, u8 id)
	{
	u8 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 u16 wlc_antsel_antcfg2antsel(antsel_info_t *asi, u8 ant_cfg)
	{
	u8 idx = WLC_ANTIDX_11N(WLC_ANTSEL_11N(ant_cfg));
	u16 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;
	u8 ant_cfg;
	u16 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 */