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
  29 #define BRCMF_DEFAULT_BCN_TIMEOUT       3
  30 #define BRCMF_DEFAULT_SCAN_CHANNEL_TIME 40
  31 #define BRCMF_DEFAULT_SCAN_UNASSOC_TIME 40
  32
  33 /* boost value for RSSI_DELTA in preferred join selection */
  34 #define BRCMF_JOIN_PREF_RSSI_BOOST      8
  35
  36 int brcmf_c_preinit_dcmds(struct brcmf_if *ifp)
  37 {
  38         s8 eventmask[BRCMF_EVENTING_MASK_LEN];
  39         u8 buf[BRCMF_DCMD_SMLEN];
  40         struct brcmf_join_pref_params join_pref_params[2];
  41         char *ptr;
  42         s32 err;
  43
  44         /* retreive mac address */
  45         err = brcmf_fil_iovar_data_get(ifp, "cur_etheraddr", ifp->mac_addr,
  46                                        sizeof(ifp->mac_addr));
  47         if (err < 0) {
  48                 brcmf_err("Retreiving cur_etheraddr failed, %d\n",
  49                           err);
  50                 goto done;
  51         }
  52         memcpy(ifp->drvr->mac, ifp->mac_addr, sizeof(ifp->drvr->mac));
  53
  54         /* query for 'ver' to get version info from firmware */
  55         memset(buf, 0, sizeof(buf));
  56         strcpy(buf, "ver");
  57         err = brcmf_fil_iovar_data_get(ifp, "ver", buf, sizeof(buf));
  58         if (err < 0) {
  59                 brcmf_err("Retreiving version information failed, %d\n",
  60                           err);
  61                 goto done;
  62         }
  63         ptr = (char *)buf;
  64         strsep(&ptr, "\n");
  65
  66         /* Print fw version info */
  67         brcmf_err("Firmware version = %s\n", buf);
  68
  69         /* locate firmware version number for ethtool */
  70         ptr = strrchr(buf, ' ') + 1;
  71         strlcpy(ifp->drvr->fwver, ptr, sizeof(ifp->drvr->fwver));
  72
  73         /* set mpc */
  74         err = brcmf_fil_iovar_int_set(ifp, "mpc", 1);
  75         if (err) {
  76                 brcmf_err("failed setting mpc\n");
  77                 goto done;
  78         }
  79
  80         /*
  81          * Setup timeout if Beacons are lost and roam is off to report
  82          * link down
  83          */
  84         err = brcmf_fil_iovar_int_set(ifp, "bcn_timeout",
  85                                       BRCMF_DEFAULT_BCN_TIMEOUT);
  86         if (err) {
  87                 brcmf_err("bcn_timeout error (%d)\n", err);
  88                 goto done;
  89         }
  90
  91         /* Enable/Disable build-in roaming to allowed ext supplicant to take
  92          * of romaing
  93          */
  94         err = brcmf_fil_iovar_int_set(ifp, "roam_off", 1);
  95         if (err) {
  96                 brcmf_err("roam_off error (%d)\n", err);
  97                 goto done;
  98         }
  99
 100         /* Setup join_pref to select target by RSSI(with boost on 5GHz) */
 101         join_pref_params[0].type = BRCMF_JOIN_PREF_RSSI_DELTA;
 102         join_pref_params[0].len = 2;
 103         join_pref_params[0].rssi_gain = BRCMF_JOIN_PREF_RSSI_BOOST;
 104         join_pref_params[0].band = WLC_BAND_5G;
 105         join_pref_params[1].type = BRCMF_JOIN_PREF_RSSI;
 106         join_pref_params[1].len = 2;
 107         join_pref_params[1].rssi_gain = 0;
 108         join_pref_params[1].band = 0;
 109         err = brcmf_fil_iovar_data_set(ifp, "join_pref", join_pref_params,
 110                                        sizeof(join_pref_params));
 111         if (err)
 112                 brcmf_err("Set join_pref error (%d)\n", err);
 113
 114         /* Setup event_msgs, enable E_IF */
 115         err = brcmf_fil_iovar_data_get(ifp, "event_msgs", eventmask,
 116                                        BRCMF_EVENTING_MASK_LEN);
 117         if (err) {
 118                 brcmf_err("Get event_msgs error (%d)\n", err);
 119                 goto done;
 120         }
 121         setbit(eventmask, BRCMF_E_IF);
 122         err = brcmf_fil_iovar_data_set(ifp, "event_msgs", eventmask,
 123                                        BRCMF_EVENTING_MASK_LEN);
 124         if (err) {
 125                 brcmf_err("Set event_msgs error (%d)\n", err);
 126                 goto done;
 127         }
 128
 129         /* Setup default scan channel time */
 130         err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_CHANNEL_TIME,
 131                                     BRCMF_DEFAULT_SCAN_CHANNEL_TIME);
 132         if (err) {
 133                 brcmf_err("BRCMF_C_SET_SCAN_CHANNEL_TIME error (%d)\n",
 134                           err);
 135                 goto done;
 136         }
 137
 138         /* Setup default scan unassoc time */
 139         err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_UNASSOC_TIME,
 140                                     BRCMF_DEFAULT_SCAN_UNASSOC_TIME);
 141         if (err) {
 142                 brcmf_err("BRCMF_C_SET_SCAN_UNASSOC_TIME error (%d)\n",
 143                           err);
 144                 goto done;
 145         }
 146
 147         /* do bus specific preinit here */
 148         err = brcmf_bus_preinit(ifp->drvr->bus_if);
 149 done:
 150         return err;
 151 }
 152
 153 #if defined(CONFIG_BRCM_TRACING) || defined(CONFIG_BRCMDBG)
 154 void __brcmf_dbg(u32 level, const char *func, const char *fmt, ...)
 155 {
 156         struct va_format vaf = {
 157                 .fmt = fmt,
 158         };
 159         va_list args;
 160
 161         va_start(args, fmt);
 162         vaf.va = &args;
 163         if (brcmf_msg_level & level)
 164                 pr_debug("%s %pV", func, &vaf);
 165         trace_brcmf_dbg(level, func, &vaf);
 166         va_end(args);
 167 }
 168 #endif