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 30const 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 39int 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); 179done: 180 return err; 181} 182 183#if defined(CONFIG_BRCM_TRACING) || defined(CONFIG_BRCMDBG) 184void __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 199