drivers/staging/brcm80211/brcmsmac/antsel.c

   1 /*
   2  * Copyright (c) 2010 Broadcom Corporation
   3  *
   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.
   7  *
   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.
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include <linux/module.h>
  19 #include <linux/pci.h>
  20
  21 #include <defs.h>
  22 #include <brcmu_utils.h>
  23 #include <aiutils.h>
  24 #include <brcm_hw_ids.h>
  25 #include "dma.h"
  26
  27 #include "d11.h"
  28 #include "rate.h"
  29 #include "scb.h"
  30 #include "pub.h"
  31 #include "phy/phy_hal.h"
  32 #include "bottom_mac.h"
  33 #include "channel.h"
  34 #include "main.h"
  35 #include "antsel.h"
  36
  37 #define ANT_SELCFG_AUTO         0x80    /* bit indicates antenna sel AUTO */
  38 #define ANT_SELCFG_MASK         0x33    /* antenna configuration mask */
  39 #define ANT_SELCFG_TX_UNICAST   0       /* unicast tx antenna configuration */
  40 #define ANT_SELCFG_RX_UNICAST   1       /* unicast rx antenna configuration */
  41 #define ANT_SELCFG_TX_DEF       2       /* default tx antenna configuration */
  42 #define ANT_SELCFG_RX_DEF       3       /* default rx antenna configuration */
  43
  44 /* useful macros */
  45 #define WLC_ANTSEL_11N_0(ant)   ((((ant) & ANT_SELCFG_MASK) >> 4) & 0xf)
  46 #define WLC_ANTSEL_11N_1(ant)   (((ant) & ANT_SELCFG_MASK) & 0xf)
  47 #define WLC_ANTIDX_11N(ant)     (((WLC_ANTSEL_11N_0(ant)) << 2) + (WLC_ANTSEL_11N_1(ant)))
  48 #define WLC_ANT_ISAUTO_11N(ant) (((ant) & ANT_SELCFG_AUTO) == ANT_SELCFG_AUTO)
  49 #define WLC_ANTSEL_11N(ant)     ((ant) & ANT_SELCFG_MASK)
  50
  51 /* antenna switch */
  52 /* defines for no boardlevel antenna diversity */
  53 #define ANT_SELCFG_DEF_2x2      0x01    /* default antenna configuration */
  54
  55 /* 2x3 antdiv defines and tables for GPIO communication */
  56 #define ANT_SELCFG_NUM_2x3      3
  57 #define ANT_SELCFG_DEF_2x3      0x01    /* default antenna configuration */
  58
  59 /* 2x4 antdiv rev4 defines and tables for GPIO communication */
  60 #define ANT_SELCFG_NUM_2x4      4
  61 #define ANT_SELCFG_DEF_2x4      0x02    /* default antenna configuration */
  62
  63 /* static functions */
  64 static int wlc_antsel_cfgupd(struct antsel_info *asi, wlc_antselcfg_t *antsel);
  65 static u8 wlc_antsel_id2antcfg(struct antsel_info *asi, u8 id);
  66 static u16 wlc_antsel_antcfg2antsel(struct antsel_info *asi, u8 ant_cfg);
  67 static void wlc_antsel_init_cfg(struct antsel_info *asi,
  68                                 wlc_antselcfg_t *antsel,
  69                                 bool auto_sel);
  70
  71 const u16 mimo_2x4_div_antselpat_tbl[] = {
  72         0, 0, 0x9, 0xa,         /* ant0: 0 ant1: 2,3 */
  73         0, 0, 0x5, 0x6,         /* ant0: 1 ant1: 2,3 */
  74         0, 0, 0, 0,             /* n.a.              */
  75         0, 0, 0, 0              /* n.a.              */
  76 };
  77
  78 const u8 mimo_2x4_div_antselid_tbl[16] = {
  79         0, 0, 0, 0, 0, 2, 3, 0,
  80         0, 0, 1, 0, 0, 0, 0, 0  /* pat to antselid */
  81 };
  82
  83 const u16 mimo_2x3_div_antselpat_tbl[] = {
  84         16, 0, 1, 16,           /* ant0: 0 ant1: 1,2 */
  85         16, 16, 16, 16,         /* n.a.              */
  86         16, 2, 16, 16,          /* ant0: 2 ant1: 1   */
  87         16, 16, 16, 16          /* n.a.              */
  88 };
  89
  90 const u8 mimo_2x3_div_antselid_tbl[16] = {
  91         0, 1, 2, 0, 0, 0, 0, 0,
  92         0, 0, 0, 0, 0, 0, 0, 0  /* pat to antselid */
  93 };
  94
  95 struct antsel_info *wlc_antsel_attach(struct wlc_info *wlc)
  96 {
  97         struct antsel_info *asi;
  98
  99         asi = kzalloc(sizeof(struct antsel_info), GFP_ATOMIC);
 100         if (!asi) {
 101                 wiphy_err(wlc->wiphy, "wl%d: wlc_antsel_attach: out of mem\n",
 102                           wlc->pub->unit);
 103                 return NULL;
 104         }
 105
 106         asi->wlc = wlc;
 107         asi->pub = wlc->pub;
 108         asi->antsel_type = ANTSEL_NA;
 109         asi->antsel_avail = false;
 110         asi->antsel_antswitch = (u8) getintvar(asi->pub->vars, "antswitch");
 111
 112         if ((asi->pub->sromrev >= 4) && (asi->antsel_antswitch != 0)) {
 113                 switch (asi->antsel_antswitch) {
 114                 case ANTSWITCH_TYPE_1:
 115                 case ANTSWITCH_TYPE_2:
 116                 case ANTSWITCH_TYPE_3:
 117                         /* 4321/2 board with 2x3 switch logic */
 118                         asi->antsel_type = ANTSEL_2x3;
 119                         /* Antenna selection availability */
 120                         if (((u16) getintvar(asi->pub->vars, "aa2g") == 7) ||
 121                             ((u16) getintvar(asi->pub->vars, "aa5g") == 7)) {
 122                                 asi->antsel_avail = true;
 123                         } else
 124                             if (((u16) getintvar(asi->pub->vars, "aa2g") ==
 125                                  3)
 126                                 || ((u16) getintvar(asi->pub->vars, "aa5g")
 127                                     == 3)) {
 128                                 asi->antsel_avail = false;
 129                         } else {
 130                                 asi->antsel_avail = false;
 131                                 wiphy_err(wlc->wiphy, "wlc_antsel_attach: 2o3 "
 132                                           "board cfg invalid\n");
 133                         }
 134                         break;
 135                 default:
 136                         break;
 137                 }
 138         } else if ((asi->pub->sromrev == 4) &&
 139                    ((u16) getintvar(asi->pub->vars, "aa2g") == 7) &&
 140                    ((u16) getintvar(asi->pub->vars, "aa5g") == 0)) {
 141                 /* hack to match old 4321CB2 cards with 2of3 antenna switch */
 142                 asi->antsel_type = ANTSEL_2x3;
 143                 asi->antsel_avail = true;
 144         } else if (asi->pub->boardflags2 & BFL2_2X4_DIV) {
 145                 asi->antsel_type = ANTSEL_2x4;
 146                 asi->antsel_avail = true;
 147         }
 148
 149         /* Set the antenna selection type for the low driver */
 150         wlc_bmac_antsel_type_set(wlc->hw, asi->antsel_type);
 151
 152         /* Init (auto/manual) antenna selection */
 153         wlc_antsel_init_cfg(asi, &asi->antcfg_11n, true);
 154         wlc_antsel_init_cfg(asi, &asi->antcfg_cur, true);
 155
 156         return asi;
 157 }
 158
 159 void wlc_antsel_detach(struct antsel_info *asi)
 160 {
 161         kfree(asi);
 162 }
 163
 164 void wlc_antsel_init(struct antsel_info *asi)
 165 {
 166         if ((asi->antsel_type == ANTSEL_2x3) ||
 167             (asi->antsel_type == ANTSEL_2x4))
 168                 wlc_antsel_cfgupd(asi, &asi->antcfg_11n);
 169 }
 170
 171 /* boardlevel antenna selection: init antenna selection structure */
 172 static void
 173 wlc_antsel_init_cfg(struct antsel_info *asi, wlc_antselcfg_t *antsel,
 174                     bool auto_sel)
 175 {
 176         if (asi->antsel_type == ANTSEL_2x3) {
 177                 u8 antcfg_def = ANT_SELCFG_DEF_2x3 |
 178                     ((asi->antsel_avail && auto_sel) ? ANT_SELCFG_AUTO : 0);
 179                 antsel->ant_config[ANT_SELCFG_TX_DEF] = antcfg_def;
 180                 antsel->ant_config[ANT_SELCFG_TX_UNICAST] = antcfg_def;
 181                 antsel->ant_config[ANT_SELCFG_RX_DEF] = antcfg_def;
 182                 antsel->ant_config[ANT_SELCFG_RX_UNICAST] = antcfg_def;
 183                 antsel->num_antcfg = ANT_SELCFG_NUM_2x3;
 184
 185         } else if (asi->antsel_type == ANTSEL_2x4) {
 186
 187                 antsel->ant_config[ANT_SELCFG_TX_DEF] = ANT_SELCFG_DEF_2x4;
 188                 antsel->ant_config[ANT_SELCFG_TX_UNICAST] = ANT_SELCFG_DEF_2x4;
 189                 antsel->ant_config[ANT_SELCFG_RX_DEF] = ANT_SELCFG_DEF_2x4;
 190                 antsel->ant_config[ANT_SELCFG_RX_UNICAST] = ANT_SELCFG_DEF_2x4;
 191                 antsel->num_antcfg = ANT_SELCFG_NUM_2x4;
 192
 193         } else {                /* no antenna selection available */
 194
 195                 antsel->ant_config[ANT_SELCFG_TX_DEF] = ANT_SELCFG_DEF_2x2;
 196                 antsel->ant_config[ANT_SELCFG_TX_UNICAST] = ANT_SELCFG_DEF_2x2;
 197                 antsel->ant_config[ANT_SELCFG_RX_DEF] = ANT_SELCFG_DEF_2x2;
 198                 antsel->ant_config[ANT_SELCFG_RX_UNICAST] = ANT_SELCFG_DEF_2x2;
 199                 antsel->num_antcfg = 0;
 200         }
 201 }
 202
 203 void
 204 wlc_antsel_antcfg_get(struct antsel_info *asi, bool usedef, bool sel,
 205                       u8 antselid, u8 fbantselid, u8 *antcfg,
 206                       u8 *fbantcfg)
 207 {
 208         u8 ant;
 209
 210         /* if use default, assign it and return */
 211         if (usedef) {
 212                 *antcfg = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_DEF];
 213                 *fbantcfg = *antcfg;
 214                 return;
 215         }
 216
 217         if (!sel) {
 218                 *antcfg = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST];
 219                 *fbantcfg = *antcfg;
 220
 221         } else {
 222                 ant = asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST];
 223                 if ((ant & ANT_SELCFG_AUTO) == ANT_SELCFG_AUTO) {
 224                         *antcfg = wlc_antsel_id2antcfg(asi, antselid);
 225                         *fbantcfg = wlc_antsel_id2antcfg(asi, fbantselid);
 226                 } else {
 227                         *antcfg =
 228                             asi->antcfg_11n.ant_config[ANT_SELCFG_TX_UNICAST];
 229                         *fbantcfg = *antcfg;
 230                 }
 231         }
 232         return;
 233 }
 234
 235 /* boardlevel antenna selection: convert mimo_antsel (ucode interface) to id */
 236 u8 wlc_antsel_antsel2id(struct antsel_info *asi, u16 antsel)
 237 {
 238         u8 antselid = 0;
 239
 240         if (asi->antsel_type == ANTSEL_2x4) {
 241                 /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */
 242                 antselid = mimo_2x4_div_antselid_tbl[(antsel & 0xf)];
 243                 return antselid;
 244
 245         } else if (asi->antsel_type == ANTSEL_2x3) {
 246                 /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */
 247                 antselid = mimo_2x3_div_antselid_tbl[(antsel & 0xf)];
 248                 return antselid;
 249         }
 250
 251         return antselid;
 252 }
 253
 254 /* boardlevel antenna selection: convert id to ant_cfg */
 255 static u8 wlc_antsel_id2antcfg(struct antsel_info *asi, u8 id)
 256 {
 257         u8 antcfg = ANT_SELCFG_DEF_2x2;
 258
 259         if (asi->antsel_type == ANTSEL_2x4) {
 260                 /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */
 261                 antcfg = (((id & 0x2) << 3) | ((id & 0x1) + 2));
 262                 return antcfg;
 263
 264         } else if (asi->antsel_type == ANTSEL_2x3) {
 265                 /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */
 266                 antcfg = (((id & 0x02) << 4) | ((id & 0x1) + 1));
 267                 return antcfg;
 268         }
 269
 270         return antcfg;
 271 }
 272
 273 /* boardlevel antenna selection: convert ant_cfg to mimo_antsel (ucode interface) */
 274 static u16 wlc_antsel_antcfg2antsel(struct antsel_info *asi, u8 ant_cfg)
 275 {
 276         u8 idx = WLC_ANTIDX_11N(WLC_ANTSEL_11N(ant_cfg));
 277         u16 mimo_antsel = 0;
 278
 279         if (asi->antsel_type == ANTSEL_2x4) {
 280                 /* 2x4 antenna diversity board, 4 cfgs: 0-2 0-3 1-2 1-3 */
 281                 mimo_antsel = (mimo_2x4_div_antselpat_tbl[idx] & 0xf);
 282                 return mimo_antsel;
 283
 284         } else if (asi->antsel_type == ANTSEL_2x3) {
 285                 /* 2x3 antenna selection, 3 cfgs: 0-1 0-2 2-1 */
 286                 mimo_antsel = (mimo_2x3_div_antselpat_tbl[idx] & 0xf);
 287                 return mimo_antsel;
 288         }
 289
 290         return mimo_antsel;
 291 }
 292
 293 /* boardlevel antenna selection: ucode interface control */
 294 static int wlc_antsel_cfgupd(struct antsel_info *asi, wlc_antselcfg_t *antsel)
 295 {
 296         struct wlc_info *wlc = asi->wlc;
 297         u8 ant_cfg;
 298         u16 mimo_antsel;
 299
 300         /* 1) Update TX antconfig for all frames that are not unicast data
 301          *    (aka default TX)
 302          */
 303         ant_cfg = antsel->ant_config[ANT_SELCFG_TX_DEF];
 304         mimo_antsel = wlc_antsel_antcfg2antsel(asi, ant_cfg);
 305         wlc_write_shm(wlc, M_MIMO_ANTSEL_TXDFLT, mimo_antsel);
 306         /* Update driver stats for currently selected default tx/rx antenna config */
 307         asi->antcfg_cur.ant_config[ANT_SELCFG_TX_DEF] = ant_cfg;
 308
 309         /* 2) Update RX antconfig for all frames that are not unicast data
 310          *    (aka default RX)
 311          */
 312         ant_cfg = antsel->ant_config[ANT_SELCFG_RX_DEF];
 313         mimo_antsel = wlc_antsel_antcfg2antsel(asi, ant_cfg);
 314         wlc_write_shm(wlc, M_MIMO_ANTSEL_RXDFLT, mimo_antsel);
 315         /* Update driver stats for currently selected default tx/rx antenna config */
 316         asi->antcfg_cur.ant_config[ANT_SELCFG_RX_DEF] = ant_cfg;
 317
 318         return 0;
 319 }