Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 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 | */ |
Joe Perches | 02f7719 | 2012-01-15 00:38:44 -0800 | [diff] [blame] | 16 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 17 | #include <linux/kernel.h> |
| 18 | #include <linux/string.h> |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 19 | #include <linux/netdevice.h> |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 20 | #include <brcmu_wifi.h> |
| 21 | #include <brcmu_utils.h> |
| 22 | #include "dhd.h" |
Hante Meuleman | d14f78b | 2014-10-28 14:56:14 +0100 | [diff] [blame] | 23 | #include "bus.h" |
Hante Meuleman | a8e8ed3 | 2014-10-28 14:56:13 +0100 | [diff] [blame] | 24 | #include "debug.h" |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 25 | #include "fwil.h" |
Arend van Spriel | 6f5838a | 2013-11-29 12:25:19 +0100 | [diff] [blame] | 26 | #include "fwil_types.h" |
Arend van Spriel | e548357 | 2013-03-03 12:45:21 +0100 | [diff] [blame] | 27 | #include "tracepoint.h" |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 28 | |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 29 | #define BRCMF_DEFAULT_BCN_TIMEOUT 3 |
| 30 | #define BRCMF_DEFAULT_SCAN_CHANNEL_TIME 40 |
| 31 | #define BRCMF_DEFAULT_SCAN_UNASSOC_TIME 40 |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 32 | |
Daniel Kim | e09cc63 | 2014-05-12 10:47:26 +0200 | [diff] [blame] | 33 | /* boost value for RSSI_DELTA in preferred join selection */ |
| 34 | #define BRCMF_JOIN_PREF_RSSI_BOOST 8 |
| 35 | |
Alwin Beukers | 53a2277 | 2011-10-12 20:51:30 +0200 | [diff] [blame] | 36 | |
Franky Lin | b63487e | 2011-12-16 18:36:59 -0800 | [diff] [blame] | 37 | bool brcmf_c_prec_enq(struct device *dev, struct pktq *q, |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 38 | struct sk_buff *pkt, int prec) |
| 39 | { |
| 40 | struct sk_buff *p; |
| 41 | int eprec = -1; /* precedence to evict from */ |
| 42 | bool discard_oldest; |
Franky Lin | b63487e | 2011-12-16 18:36:59 -0800 | [diff] [blame] | 43 | struct brcmf_bus *bus_if = dev_get_drvdata(dev); |
| 44 | struct brcmf_pub *drvr = bus_if->drvr; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 45 | |
| 46 | /* Fast case, precedence queue is not full and we are also not |
| 47 | * exceeding total queue length |
| 48 | */ |
| 49 | if (!pktq_pfull(q, prec) && !pktq_full(q)) { |
| 50 | brcmu_pktq_penq(q, prec, pkt); |
| 51 | return true; |
| 52 | } |
| 53 | |
| 54 | /* Determine precedence from which to evict packet, if any */ |
Hante Meuleman | 76b5a96 | 2014-10-28 14:56:15 +0100 | [diff] [blame^] | 55 | if (pktq_pfull(q, prec)) { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 56 | eprec = prec; |
Hante Meuleman | 76b5a96 | 2014-10-28 14:56:15 +0100 | [diff] [blame^] | 57 | } else if (pktq_full(q)) { |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 58 | p = brcmu_pktq_peek_tail(q, &eprec); |
| 59 | if (eprec > prec) |
| 60 | return false; |
| 61 | } |
| 62 | |
| 63 | /* Evict if needed */ |
| 64 | if (eprec >= 0) { |
| 65 | /* Detect queueing to unconfigured precedence */ |
| 66 | discard_oldest = ac_bitmap_tst(drvr->wme_dp, eprec); |
| 67 | if (eprec == prec && !discard_oldest) |
| 68 | return false; /* refuse newer (incoming) packet */ |
| 69 | /* Evict packet according to discard policy */ |
| 70 | p = discard_oldest ? brcmu_pktq_pdeq(q, eprec) : |
| 71 | brcmu_pktq_pdeq_tail(q, eprec); |
| 72 | if (p == NULL) |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 73 | brcmf_err("brcmu_pktq_penq() failed, oldest %d\n", |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 74 | discard_oldest); |
| 75 | |
| 76 | brcmu_pkt_buf_free_skb(p); |
| 77 | } |
| 78 | |
| 79 | /* Enqueue */ |
| 80 | p = brcmu_pktq_penq(q, prec, pkt); |
| 81 | if (p == NULL) |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 82 | brcmf_err("brcmu_pktq_penq() failed\n"); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 83 | |
| 84 | return p != NULL; |
| 85 | } |
| 86 | |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 87 | int brcmf_c_preinit_dcmds(struct brcmf_if *ifp) |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 88 | { |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 89 | s8 eventmask[BRCMF_EVENTING_MASK_LEN]; |
| 90 | u8 buf[BRCMF_DCMD_SMLEN]; |
Daniel Kim | e09cc63 | 2014-05-12 10:47:26 +0200 | [diff] [blame] | 91 | struct brcmf_join_pref_params join_pref_params[2]; |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 92 | char *ptr; |
| 93 | s32 err; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 94 | |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 95 | /* retreive mac address */ |
| 96 | err = brcmf_fil_iovar_data_get(ifp, "cur_etheraddr", ifp->mac_addr, |
| 97 | sizeof(ifp->mac_addr)); |
| 98 | if (err < 0) { |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 99 | brcmf_err("Retreiving cur_etheraddr failed, %d\n", |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 100 | err); |
| 101 | goto done; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 102 | } |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 103 | memcpy(ifp->drvr->mac, ifp->mac_addr, sizeof(ifp->drvr->mac)); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 104 | |
| 105 | /* query for 'ver' to get version info from firmware */ |
| 106 | memset(buf, 0, sizeof(buf)); |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 107 | strcpy(buf, "ver"); |
| 108 | err = brcmf_fil_iovar_data_get(ifp, "ver", buf, sizeof(buf)); |
| 109 | if (err < 0) { |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 110 | brcmf_err("Retreiving version information failed, %d\n", |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 111 | err); |
| 112 | goto done; |
| 113 | } |
| 114 | ptr = (char *)buf; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 115 | strsep(&ptr, "\n"); |
Arend van Spriel | 55685b8 | 2013-11-29 12:25:17 +0100 | [diff] [blame] | 116 | |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 117 | /* Print fw version info */ |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 118 | brcmf_err("Firmware version = %s\n", buf); |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 119 | |
Arend van Spriel | 55685b8 | 2013-11-29 12:25:17 +0100 | [diff] [blame] | 120 | /* locate firmware version number for ethtool */ |
| 121 | ptr = strrchr(buf, ' ') + 1; |
| 122 | strlcpy(ifp->drvr->fwver, ptr, sizeof(ifp->drvr->fwver)); |
| 123 | |
Daniel Kim | 5e787f7 | 2014-06-21 12:11:18 +0200 | [diff] [blame] | 124 | /* set mpc */ |
| 125 | err = brcmf_fil_iovar_int_set(ifp, "mpc", 1); |
| 126 | if (err) { |
| 127 | brcmf_err("failed setting mpc\n"); |
| 128 | goto done; |
| 129 | } |
| 130 | |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 131 | /* |
| 132 | * Setup timeout if Beacons are lost and roam is off to report |
| 133 | * link down |
| 134 | */ |
| 135 | err = brcmf_fil_iovar_int_set(ifp, "bcn_timeout", |
| 136 | BRCMF_DEFAULT_BCN_TIMEOUT); |
| 137 | if (err) { |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 138 | brcmf_err("bcn_timeout error (%d)\n", err); |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 139 | goto done; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 140 | } |
| 141 | |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 142 | /* Enable/Disable build-in roaming to allowed ext supplicant to take |
| 143 | * of romaing |
| 144 | */ |
| 145 | err = brcmf_fil_iovar_int_set(ifp, "roam_off", 1); |
| 146 | if (err) { |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 147 | brcmf_err("roam_off error (%d)\n", err); |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 148 | goto done; |
| 149 | } |
| 150 | |
Daniel Kim | e09cc63 | 2014-05-12 10:47:26 +0200 | [diff] [blame] | 151 | /* Setup join_pref to select target by RSSI(with boost on 5GHz) */ |
| 152 | join_pref_params[0].type = BRCMF_JOIN_PREF_RSSI_DELTA; |
| 153 | join_pref_params[0].len = 2; |
| 154 | join_pref_params[0].rssi_gain = BRCMF_JOIN_PREF_RSSI_BOOST; |
| 155 | join_pref_params[0].band = WLC_BAND_5G; |
| 156 | join_pref_params[1].type = BRCMF_JOIN_PREF_RSSI; |
| 157 | join_pref_params[1].len = 2; |
| 158 | join_pref_params[1].rssi_gain = 0; |
| 159 | join_pref_params[1].band = 0; |
| 160 | err = brcmf_fil_iovar_data_set(ifp, "join_pref", join_pref_params, |
| 161 | sizeof(join_pref_params)); |
| 162 | if (err) |
| 163 | brcmf_err("Set join_pref error (%d)\n", err); |
| 164 | |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 165 | /* Setup event_msgs, enable E_IF */ |
| 166 | err = brcmf_fil_iovar_data_get(ifp, "event_msgs", eventmask, |
| 167 | BRCMF_EVENTING_MASK_LEN); |
| 168 | if (err) { |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 169 | brcmf_err("Get event_msgs error (%d)\n", err); |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 170 | goto done; |
| 171 | } |
| 172 | setbit(eventmask, BRCMF_E_IF); |
| 173 | err = brcmf_fil_iovar_data_set(ifp, "event_msgs", eventmask, |
| 174 | BRCMF_EVENTING_MASK_LEN); |
| 175 | if (err) { |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 176 | brcmf_err("Set event_msgs error (%d)\n", err); |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 177 | goto done; |
| 178 | } |
| 179 | |
| 180 | /* Setup default scan channel time */ |
| 181 | err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_CHANNEL_TIME, |
| 182 | BRCMF_DEFAULT_SCAN_CHANNEL_TIME); |
| 183 | if (err) { |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 184 | brcmf_err("BRCMF_C_SET_SCAN_CHANNEL_TIME error (%d)\n", |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 185 | err); |
| 186 | goto done; |
| 187 | } |
| 188 | |
| 189 | /* Setup default scan unassoc time */ |
| 190 | err = brcmf_fil_cmd_int_set(ifp, BRCMF_C_SET_SCAN_UNASSOC_TIME, |
| 191 | BRCMF_DEFAULT_SCAN_UNASSOC_TIME); |
| 192 | if (err) { |
Arend van Spriel | 5e8149f | 2012-12-07 10:49:57 +0100 | [diff] [blame] | 193 | brcmf_err("BRCMF_C_SET_SCAN_UNASSOC_TIME error (%d)\n", |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 194 | err); |
| 195 | goto done; |
| 196 | } |
| 197 | |
Arend van Spriel | cf45828 | 2013-11-29 11:48:15 +0100 | [diff] [blame] | 198 | /* do bus specific preinit here */ |
| 199 | err = brcmf_bus_preinit(ifp->drvr->bus_if); |
Hante Meuleman | 0af29bf | 2012-10-22 10:36:25 -0700 | [diff] [blame] | 200 | done: |
| 201 | return err; |
Arend van Spriel | 5b435de | 2011-10-05 13:19:03 +0200 | [diff] [blame] | 202 | } |
Arend van Spriel | e548357 | 2013-03-03 12:45:21 +0100 | [diff] [blame] | 203 | |
Arend van Spriel | e548357 | 2013-03-03 12:45:21 +0100 | [diff] [blame] | 204 | #if defined(CONFIG_BRCM_TRACING) || defined(CONFIG_BRCMDBG) |
| 205 | void __brcmf_dbg(u32 level, const char *func, const char *fmt, ...) |
| 206 | { |
| 207 | struct va_format vaf = { |
| 208 | .fmt = fmt, |
| 209 | }; |
| 210 | va_list args; |
| 211 | |
| 212 | va_start(args, fmt); |
| 213 | vaf.va = &args; |
| 214 | if (brcmf_msg_level & level) |
| 215 | pr_debug("%s %pV", func, &vaf); |
| 216 | trace_brcmf_dbg(level, func, &vaf); |
| 217 | va_end(args); |
| 218 | } |
| 219 | #endif |