kernel/drivers/net/wireless/brcm80211/brcmfmac/common.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/string.h>
  19 #include <linux/netdevice.h>
  20 #include <brcmu_wifi.h>
  21 #include <brcmu_utils.h>
  22 #include "core.h"
  23 #include "bus.h"
  24 #include "debug.h"
  25 #include "fwil.h"
  26 #include "fwil_types.h"
  27 #include "tracepoint.h"
  28 #include "common.h"
  29
  30 const u8 ALLFFMAC[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
  31
  32 #define BRCMF_DEFAULT_BCN_TIMEOUT       3
  33 #define BRCMF_DEFAULT_SCAN_CHANNEL_TIME 40
  34 #define BRCMF_DEFAULT_SCAN_UNASSOC_TIME 40
  35
  36 /* boost value for RSSI_DELTA in preferred join selection */
  37 #define BRCMF_JOIN_PREF_RSSI_BOOST      8
  38
  39 int brcmf_c_preinit_dcmds(struct brcmf_if *ifp)
  40 {
  41         s8 eventmask[BRCMF_EVENTING_MASK_LEN];
  42         u8 buf[BRCMF_DCMD_SMLEN];
  43         struct brcmf_join_pref_params join_pref_params[2];
  44         struct brcmf_rev_info_le revinfo;
  45         struct brcmf_rev_info *ri;
  46         char *ptr;
  47         s32 err;
  48
  49         /* retreive mac address */
  50         err = brcmf_fil_iovar_data_get(ifp, "cur_etheraddr", ifp->mac_addr,
  51                                        sizeof(ifp->mac_addr));
  52         if (err < 0) {
  53                 brcmf_err("Retreiving cur_etheraddr failed, %d\n", err);
  54                 goto done;
  55         }
  56         memcpy(ifp->drvr->mac, ifp->mac_addr, sizeof(ifp->drvr->mac));
  57
  58         err = brcmf_fil_cmd_data_get(ifp, BRCMF_C_GET_REVINFO,
  59                                      &revinfo, sizeof(revinfo));
  60         ri = &ifp->drvr->revinfo;
  61         if (err < 0) {
  62                 brcmf_err("retrieving revision info failed, %d\n", err);
  63         } else {
  64                 ri->vendorid = le32_to_cpu(revinfo.vendorid);
  65                 ri->deviceid = le32_to_cpu(revinfo.deviceid);
  66                 ri->radiorev = le32_to_cpu(revinfo.radiorev);
  67                 ri->chiprev = le32_to_cpu(revinfo.chiprev);
  68                 ri->corerev = le32_to_cpu(revinfo.corerev);
  69                 ri->boardid = le32_to_cpu(revinfo.boardid);
  70                 ri->boardvendor = le32_to_cpu(revinfo.boardvendor);
  71                 ri->boardrev = le32_to_cpu(revinfo.boardrev);
  72                 ri->driverrev = le32_to_cpu(revinfo.driverrev);
  73                 ri->ucoderev = le32_to_cpu(revinfo.ucoderev);
  74                 ri->bus = le32_to_cpu(revinfo.bus);
  75                 ri->chipnum = le32_to_cpu(revinfo.chipnum);
  76                 ri->phytype = le32_to_cpu(revinfo.phytype);
  77                 ri->phyrev = le32_to_cpu(revinfo.phyrev);
  78                 ri->anarev = le32_to_cpu(revinfo.anarev);
  79                 ri->chippkg = le32_to_cpu(revinfo.chippkg);
  80                 ri->nvramrev = le32_to_cpu(revinfo.nvramrev);
  81         }
  82         ri->result = err;
  83
  84         /* query for 'ver' to get version info from firmware */
  85         memset(buf, 0, sizeof(buf));
  86         strcpy(buf, "ver");
  87         err = brcmf_fil_iovar_data_get(ifp, "ver", buf, sizeof(buf));
  88         if (err < 0) {
  89                 brcmf_err("Retreiving version information failed, %d\n",
  90                           err);
  91                 goto done;
  92         }
  93         ptr = (char *)buf;
  94         strsep(&ptr, "\n");
  95
  96         /* Print fw version info */
  97         brcmf_err("Firmware version = %s\n", buf);
  98
  99         /* locate firmware version number for ethtool */
 100         ptr = strrchr(buf, ' ') + 1;
 101         strlcpy(ifp->drvr->fwver, ptr, sizeof(ifp->drvr->fwver));
 102
 103         /* set mpc */
 104         err = brcmf_fil_iovar_int_set(ifp, "mpc", 1);
 105         if (err) {
 106                 brcmf_err("failed setting mpc\n");
 107                 goto done;
 108         }
 109
 110         /*
 111          * Setup timeout if Beacons are lost and roam is off to report
 112          * link down
 113          */
 114         err = brcmf_fil_iovar_int_set(ifp, "bcn_timeout",
 115                                       BRCMF_DEFAULT_BCN_TIMEOUT);
 116         if (err) {
 117                 brcmf_err("bcn_timeout error (%d)\n", err);
 118                 goto done;
 119         }
 120
 121         /* Enable/Disable build-in roaming to allowed ext supplicant to take
 122          * of romaing
 123          */
 124         err = brcmf_fil_iovar_int_set(ifp, "roam_off", 1);
 125         if (err) {
 126                 brcmf_err("roam_off error (%d)\n", err);
 127                 goto done;
 128         }
 129
 130         /* Setup join_pref to select target by RSSI(with boost on 5GHz) */
 131         join_pref_params[0].type = BRCMF_JOIN_PREF_RSSI_DELTA;
 132         join_pref_params[0].len = 2;
 133         join_pref_params[0].rssi_gain = BRCMF_JOIN_PREF_RSSI_BOOST;
 134         join_pref_params[0].band = WLC_BAND_5G;
 135         join_pref_params[1].type = BRCMF_JOIN_PREF_RSSI;
 136         join_pref_params[1].len = 2;
 137         join_pref_params[1].rssi_gain = 0;
 138         join_pref_params[1].band = 0;
 139         err = brcmf_fil_iovar_data_set(ifp, "join_pref", join_pref_params,
 140                                        sizeof(join_pref_params));
 141         if (err)
 142                 brcmf_err("Set join_pref error (%d)\n", err);
 143
 144         /* Setup event_msgs, enable E_IF */
 145         err = brcmf_fil_iovar_data_get(ifp, "event_msgs", eventmask,
 146                                        BRCMF_EVENTING_MASK_LEN);
 147         if (err) {
 148                 brcmf_err("Get event_msgs error (%d)\n", err);
 149                 goto done;
 150         }
 151         setbit(eventmask, BRCMF_E_IF);
 152         err = brcmf_fil_iovar_data_set(ifp, "event_msgs", eventmask,
 153                                        BRCMF_EVENTING_MASK_LEN);
 154         if (err) {
 155                 brcmf_err("Set event_msgs error (%d)\n", err);
 156                 goto done;
 157         }
 158
 159         /* Setup default scan channel time */
 160         err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_CHANNEL_TIME,
 161                                     BRCMF_DEFAULT_SCAN_CHANNEL_TIME);
 162         if (err) {
 163                 brcmf_err("BRCMF_C_SET_SCAN_CHANNEL_TIME error (%d)\n",
 164                           err);
 165                 goto done;
 166         }
 167
 168         /* Setup default scan unassoc time */
 169         err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_UNASSOC_TIME,
 170                                     BRCMF_DEFAULT_SCAN_UNASSOC_TIME);
 171         if (err) {
 172                 brcmf_err("BRCMF_C_SET_SCAN_UNASSOC_TIME error (%d)\n",
 173                           err);
 174                 goto done;
 175         }
 176
 177         /* do bus specific preinit here */
 178         err = brcmf_bus_preinit(ifp->drvr->bus_if);
 179 done:
 180         return err;
 181 }
 182
 183 #if defined(CONFIG_BRCM_TRACING) || defined(CONFIG_BRCMDBG)
 184 void __brcmf_dbg(u32 level, const char *func, const char *fmt, ...)
 185 {
 186         struct va_format vaf = {
 187                 .fmt = fmt,
 188         };
 189         va_list args;
 190
 191         va_start(args, fmt);
 192         vaf.va = &args;
 193         if (brcmf_msg_level & level)
 194                 pr_debug("%s %pV", func, &vaf);
 195         trace_brcmf_dbg(level, func, &vaf);
 196         va_end(args);
 197 }
 198 #endif