Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [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 | */ |
| 16 | #include <linux/types.h> |
| 17 | #include <linux/if_ether.h> |
| 18 | #include <linux/spinlock.h> |
| 19 | #include <linux/skbuff.h> |
| 20 | #include <linux/netdevice.h> |
| 21 | #include <linux/err.h> |
| 22 | #include <uapi/linux/nl80211.h> |
| 23 | |
| 24 | #include <brcmu_utils.h> |
| 25 | #include <brcmu_wifi.h> |
| 26 | #include "dhd.h" |
| 27 | #include "dhd_dbg.h" |
| 28 | #include "fwil.h" |
| 29 | #include "fweh.h" |
| 30 | #include "fwsignal.h" |
| 31 | |
| 32 | /** |
| 33 | * DOC: Firmware Signalling |
| 34 | * |
| 35 | * Firmware can send signals to host and vice versa, which are passed in the |
| 36 | * data packets using TLV based header. This signalling layer is on top of the |
| 37 | * BDC bus protocol layer. |
| 38 | */ |
| 39 | |
| 40 | /* |
| 41 | * single definition for firmware-driver flow control tlv's. |
| 42 | * |
| 43 | * each tlv is specified by BRCMF_FWS_TLV_DEF(name, ID, length). |
| 44 | * A length value 0 indicates variable length tlv. |
| 45 | */ |
| 46 | #define BRCMF_FWS_TLV_DEFLIST \ |
| 47 | BRCMF_FWS_TLV_DEF(MAC_OPEN, 1, 1) \ |
| 48 | BRCMF_FWS_TLV_DEF(MAC_CLOSE, 2, 1) \ |
| 49 | BRCMF_FWS_TLV_DEF(MAC_REQUEST_CREDIT, 3, 2) \ |
| 50 | BRCMF_FWS_TLV_DEF(TXSTATUS, 4, 4) \ |
| 51 | BRCMF_FWS_TLV_DEF(PKTTAG, 5, 4) \ |
| 52 | BRCMF_FWS_TLV_DEF(MACDESC_ADD, 6, 8) \ |
| 53 | BRCMF_FWS_TLV_DEF(MACDESC_DEL, 7, 8) \ |
| 54 | BRCMF_FWS_TLV_DEF(RSSI, 8, 1) \ |
| 55 | BRCMF_FWS_TLV_DEF(INTERFACE_OPEN, 9, 1) \ |
| 56 | BRCMF_FWS_TLV_DEF(INTERFACE_CLOSE, 10, 1) \ |
| 57 | BRCMF_FWS_TLV_DEF(FIFO_CREDITBACK, 11, 8) \ |
| 58 | BRCMF_FWS_TLV_DEF(PENDING_TRAFFIC_BMP, 12, 2) \ |
| 59 | BRCMF_FWS_TLV_DEF(MAC_REQUEST_PACKET, 13, 3) \ |
| 60 | BRCMF_FWS_TLV_DEF(HOST_REORDER_RXPKTS, 14, 10) \ |
| 61 | BRCMF_FWS_TLV_DEF(TRANS_ID, 18, 6) \ |
| 62 | BRCMF_FWS_TLV_DEF(COMP_TXSTATUS, 19, 1) \ |
| 63 | BRCMF_FWS_TLV_DEF(FILLER, 255, 0) |
| 64 | |
| 65 | /** |
| 66 | * enum brcmf_fws_tlv_type - definition of tlv identifiers. |
| 67 | */ |
| 68 | #define BRCMF_FWS_TLV_DEF(name, id, len) \ |
| 69 | BRCMF_FWS_TYPE_ ## name = id, |
| 70 | enum brcmf_fws_tlv_type { |
| 71 | BRCMF_FWS_TLV_DEFLIST |
| 72 | BRCMF_FWS_TYPE_INVALID |
| 73 | }; |
| 74 | #undef BRCMF_FWS_TLV_DEF |
| 75 | |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 76 | #ifdef DEBUG |
| 77 | /** |
| 78 | * brcmf_fws_tlv_names - array of tlv names. |
| 79 | */ |
| 80 | #define BRCMF_FWS_TLV_DEF(name, id, len) \ |
| 81 | { id, #name }, |
| 82 | static struct { |
| 83 | enum brcmf_fws_tlv_type id; |
| 84 | const char *name; |
| 85 | } brcmf_fws_tlv_names[] = { |
| 86 | BRCMF_FWS_TLV_DEFLIST |
| 87 | }; |
| 88 | #undef BRCMF_FWS_TLV_DEF |
| 89 | |
| 90 | static const char *brcmf_fws_get_tlv_name(enum brcmf_fws_tlv_type id) |
| 91 | { |
| 92 | int i; |
| 93 | |
| 94 | for (i = 0; i < ARRAY_SIZE(brcmf_fws_tlv_names); i++) |
| 95 | if (brcmf_fws_tlv_names[i].id == id) |
| 96 | return brcmf_fws_tlv_names[i].name; |
| 97 | |
| 98 | return "INVALID"; |
| 99 | } |
| 100 | #else |
| 101 | static const char *brcmf_fws_get_tlv_name(enum brcmf_fws_tlv_type id) |
| 102 | { |
| 103 | return "NODEBUG"; |
| 104 | } |
| 105 | #endif /* DEBUG */ |
| 106 | |
| 107 | /** |
| 108 | * flags used to enable tlv signalling from firmware. |
| 109 | */ |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 110 | #define BRCMF_FWS_FLAGS_RSSI_SIGNALS 0x0001 |
| 111 | #define BRCMF_FWS_FLAGS_XONXOFF_SIGNALS 0x0002 |
| 112 | #define BRCMF_FWS_FLAGS_CREDIT_STATUS_SIGNALS 0x0004 |
| 113 | #define BRCMF_FWS_FLAGS_HOST_PROPTXSTATUS_ACTIVE 0x0008 |
| 114 | #define BRCMF_FWS_FLAGS_PSQ_GENERATIONFSM_ENABLE 0x0010 |
| 115 | #define BRCMF_FWS_FLAGS_PSQ_ZERO_BUFFER_ENABLE 0x0020 |
| 116 | #define BRCMF_FWS_FLAGS_HOST_RXREORDER_ACTIVE 0x0040 |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 117 | |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 118 | #define BRCMF_FWS_HANGER_MAXITEMS 1024 |
| 119 | #define BRCMF_FWS_HANGER_ITEM_STATE_FREE 1 |
| 120 | #define BRCMF_FWS_HANGER_ITEM_STATE_INUSE 2 |
| 121 | #define BRCMF_FWS_HANGER_ITEM_STATE_INUSE_SUPPRESSED 3 |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 122 | |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 123 | #define BRCMF_FWS_STATE_OPEN 1 |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 124 | #define BRCMF_FWS_STATE_CLOSE 2 |
| 125 | |
| 126 | #define BRCMF_FWS_FCMODE_NONE 0 |
| 127 | #define BRCMF_FWS_FCMODE_IMPLIED_CREDIT 1 |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 128 | #define BRCMF_FWS_FCMODE_EXPLICIT_CREDIT 2 |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 129 | |
| 130 | #define BRCMF_FWS_MAC_DESC_TABLE_SIZE 32 |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 131 | #define BRCMF_FWS_MAX_IFNUM 16 |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 132 | #define BRCMF_FWS_MAC_DESC_ID_INVALID 0xff |
| 133 | |
| 134 | #define BRCMF_FWS_HOSTIF_FLOWSTATE_OFF 0 |
| 135 | #define BRCMF_FWS_HOSTIF_FLOWSTATE_ON 1 |
| 136 | |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 137 | #define BRCMF_FWS_PSQ_PREC_COUNT ((NL80211_NUM_ACS + 1) * 2) |
| 138 | #define BRCMF_FWS_PSQ_LEN 256 |
| 139 | |
| 140 | /** |
Arend van Spriel | ebb9388 | 2013-04-03 12:40:35 +0200 | [diff] [blame] | 141 | * enum brcmf_fws_skb_state - indicates processing state of skb. |
| 142 | */ |
| 143 | enum brcmf_fws_skb_state { |
| 144 | WLFC_PKTTYPE_NEW, |
| 145 | WLFC_PKTTYPE_DELAYED, |
| 146 | WLFC_PKTTYPE_SUPPRESSED, |
| 147 | WLFC_PKTTYPE_MAX |
| 148 | }; |
| 149 | |
| 150 | /** |
| 151 | * struct brcmf_skbuff_cb - control buffer associated with skbuff. |
| 152 | * |
| 153 | * @if_flags: holds interface index and packet related flags. |
| 154 | * @da: destination MAC address extracted from skbuff once. |
| 155 | * @htod: host to device packet identifier (used in PKTTAG tlv). |
| 156 | * @needs_hdr: the packet does not yet have a BDC header. |
| 157 | * @state: transmit state of the packet. |
| 158 | * @mac: descriptor related to destination for this packet. |
| 159 | * |
| 160 | * This information is stored in control buffer struct sk_buff::cb, which |
| 161 | * provides 48 bytes of storage so this structure should not exceed that. |
| 162 | */ |
| 163 | struct brcmf_skbuff_cb { |
| 164 | u16 if_flags; |
| 165 | u8 da[ETH_ALEN]; |
| 166 | u32 htod; |
| 167 | u8 needs_hdr; |
| 168 | enum brcmf_fws_skb_state state; |
| 169 | struct brcmf_fws_mac_descriptor *mac; |
| 170 | }; |
| 171 | |
| 172 | /** |
| 173 | * macro casting skbuff control buffer to struct brcmf_skbuff_cb. |
| 174 | */ |
| 175 | #define brcmf_skbcb(skb) ((struct brcmf_skbuff_cb *)((skb)->cb)) |
| 176 | |
| 177 | /** |
| 178 | * sk_buff control if flags |
| 179 | * |
| 180 | * b[11] - packet sent upon firmware request. |
| 181 | * b[10] - packet only contains signalling data. |
| 182 | * b[9] - packet is a tx packet. |
| 183 | * b[8] - packet uses FIFO credit (non-pspoll). |
| 184 | * b[7] - interface in AP mode. |
| 185 | * b[6:4] - AC FIFO number. |
| 186 | * b[3:0] - interface index. |
| 187 | */ |
| 188 | #define BRCMF_SKB_IF_FLAGS_REQUESTED_MASK 0x0800 |
| 189 | #define BRCMF_SKB_IF_FLAGS_REQUESTED_SHIFT 11 |
| 190 | #define BRCMF_SKB_IF_FLAGS_SIGNAL_ONLY_MASK 0x0400 |
| 191 | #define BRCMF_SKB_IF_FLAGS_SIGNAL_ONLY_SHIFT 10 |
| 192 | #define BRCMF_SKB_IF_FLAGS_TRANSMIT_MASK 0x0200 |
| 193 | #define BRCMF_SKB_IF_FLAGS_TRANSMIT_SHIFT 9 |
| 194 | #define BRCMF_SKB_IF_FLAGS_CREDITCHECK_MASK 0x0100 |
| 195 | #define BRCMF_SKB_IF_FLAGS_CREDITCHECK_SHIFT 8 |
| 196 | #define BRCMF_SKB_IF_FLAGS_IF_AP_MASK 0x0080 |
| 197 | #define BRCMF_SKB_IF_FLAGS_IF_AP_SHIFT 7 |
| 198 | #define BRCMF_SKB_IF_FLAGS_FIFO_MASK 0x0070 |
| 199 | #define BRCMF_SKB_IF_FLAGS_FIFO_SHIFT 4 |
| 200 | #define BRCMF_SKB_IF_FLAGS_INDEX_MASK 0x000f |
| 201 | #define BRCMF_SKB_IF_FLAGS_INDEX_SHIFT 0 |
| 202 | |
| 203 | #define brcmf_skb_if_flags_set_field(skb, field, value) \ |
| 204 | brcmu_maskset16(&(brcmf_skbcb(skb)->if_flags), \ |
| 205 | BRCMF_SKB_IF_FLAGS_ ## field ## _MASK, \ |
| 206 | BRCMF_SKB_IF_FLAGS_ ## field ## _SHIFT, (value)) |
| 207 | #define brcmf_skb_if_flags_get_field(skb, field) \ |
| 208 | brcmu_maskget16(brcmf_skbcb(skb)->if_flags, \ |
| 209 | BRCMF_SKB_IF_FLAGS_ ## field ## _MASK, \ |
| 210 | BRCMF_SKB_IF_FLAGS_ ## field ## _SHIFT) |
| 211 | |
| 212 | /** |
| 213 | * sk_buff control packet identifier |
| 214 | * |
| 215 | * 32-bit packet identifier used in PKTTAG tlv from host to dongle. |
| 216 | * |
| 217 | * - Generated at the host (e.g. dhd) |
| 218 | * - Seen as a generic sequence number by firmware except for the flags field. |
| 219 | * |
| 220 | * Generation : b[31] => generation number for this packet [host->fw] |
| 221 | * OR, current generation number [fw->host] |
| 222 | * Flags : b[30:27] => command, status flags |
| 223 | * FIFO-AC : b[26:24] => AC-FIFO id |
| 224 | * h-slot : b[23:8] => hanger-slot |
| 225 | * freerun : b[7:0] => A free running counter |
| 226 | */ |
| 227 | #define BRCMF_SKB_HTOD_TAG_GENERATION_MASK 0x80000000 |
| 228 | #define BRCMF_SKB_HTOD_TAG_GENERATION_SHIFT 31 |
| 229 | #define BRCMF_SKB_HTOD_TAG_FLAGS_MASK 0x78000000 |
| 230 | #define BRCMF_SKB_HTOD_TAG_FLAGS_SHIFT 27 |
| 231 | #define BRCMF_SKB_HTOD_TAG_FIFO_MASK 0x07000000 |
| 232 | #define BRCMF_SKB_HTOD_TAG_FIFO_SHIFT 24 |
| 233 | #define BRCMF_SKB_HTOD_TAG_HSLOT_MASK 0x00ffff00 |
| 234 | #define BRCMF_SKB_HTOD_TAG_HSLOT_SHIFT 8 |
| 235 | #define BRCMF_SKB_HTOD_TAG_FREERUN_MASK 0x000000ff |
| 236 | #define BRCMF_SKB_HTOD_TAG_FREERUN_SHIFT 0 |
| 237 | |
| 238 | #define brcmf_skb_htod_tag_set_field(skb, field, value) \ |
| 239 | brcmu_maskset32(&(brcmf_skbcb(skb)->htod_tag), \ |
| 240 | BRCMF_SKB_HTOD_TAG_ ## field ## _MASK, \ |
| 241 | BRCMF_SKB_HTOD_TAG_ ## field ## _SHIFT, (value)) |
| 242 | #define brcmf_skb_htod_tag_get_field(skb, field) \ |
| 243 | brcmu_maskget32(brcmf_skbcb(skb)->htod_tag, \ |
| 244 | BRCMF_SKB_HTOD_TAG_ ## field ## _MASK, \ |
| 245 | BRCMF_SKB_HTOD_TAG_ ## field ## _SHIFT) |
| 246 | |
| 247 | /** |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 248 | * struct brcmf_fws_mac_descriptor - firmware signalling data per node/interface |
| 249 | * |
| 250 | * @occupied: slot is in use. |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 251 | * @mac_handle: handle for mac entry determined by firmware. |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 252 | * @interface_id: interface index. |
| 253 | * @state: current state. |
| 254 | * @ac_bitmap: ac queue bitmap. |
| 255 | * @requested_credit: credits requested by firmware. |
| 256 | * @ea: ethernet address. |
| 257 | * @psq: power-save queue. |
| 258 | */ |
| 259 | struct brcmf_fws_mac_descriptor { |
| 260 | u8 occupied; |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 261 | u8 mac_handle; |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 262 | u8 interface_id; |
| 263 | u8 state; |
| 264 | u8 ac_bitmap; |
| 265 | u8 requested_credit; |
| 266 | u8 ea[ETH_ALEN]; |
| 267 | struct pktq psq; |
| 268 | }; |
| 269 | |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 270 | struct brcmf_fws_info { |
| 271 | struct brcmf_pub *drvr; |
| 272 | struct brcmf_fws_stats stats; |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 273 | struct brcmf_fws_mac_descriptor nodes[BRCMF_FWS_MAC_DESC_TABLE_SIZE]; |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 274 | struct brcmf_fws_mac_descriptor other; |
Arend van Spriel | 43fa635 | 2013-04-03 12:40:32 +0200 | [diff] [blame] | 275 | int fifo_credit[NL80211_NUM_ACS+1+1]; |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 276 | }; |
| 277 | |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 278 | /** |
| 279 | * brcmf_fws_get_tlv_len() - returns defined length for given tlv id. |
| 280 | */ |
| 281 | #define BRCMF_FWS_TLV_DEF(name, id, len) \ |
| 282 | case BRCMF_FWS_TYPE_ ## name: \ |
| 283 | return len; |
| 284 | |
| 285 | static int brcmf_fws_get_tlv_len(struct brcmf_fws_info *fws, |
| 286 | enum brcmf_fws_tlv_type id) |
| 287 | { |
| 288 | switch (id) { |
| 289 | BRCMF_FWS_TLV_DEFLIST |
| 290 | default: |
| 291 | brcmf_err("invalid tlv id: %d\n", id); |
| 292 | fws->stats.tlv_invalid_type++; |
| 293 | break; |
| 294 | } |
| 295 | return -EINVAL; |
| 296 | } |
| 297 | #undef BRCMF_FWS_TLV_DEF |
| 298 | |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 299 | static void brcmf_fws_init_mac_descriptor(struct brcmf_fws_mac_descriptor *desc, |
| 300 | u8 *addr, u8 ifidx) |
| 301 | { |
| 302 | brcmf_dbg(TRACE, "enter: ea=%pM, ifidx=%u\n", addr, ifidx); |
| 303 | desc->occupied = 1; |
| 304 | desc->state = BRCMF_FWS_STATE_OPEN; |
| 305 | desc->requested_credit = 0; |
| 306 | /* depending on use may need ifp->bssidx instead */ |
| 307 | desc->interface_id = ifidx; |
| 308 | desc->ac_bitmap = 0xff; /* update this when handling APSD */ |
| 309 | memcpy(&desc->ea[0], addr, ETH_ALEN); |
| 310 | } |
| 311 | |
| 312 | static |
| 313 | void brcmf_fws_clear_mac_descriptor(struct brcmf_fws_mac_descriptor *desc) |
| 314 | { |
| 315 | brcmf_dbg(TRACE, |
| 316 | "enter: ea=%pM, ifidx=%u\n", desc->ea, desc->interface_id); |
| 317 | desc->occupied = 0; |
| 318 | desc->state = BRCMF_FWS_STATE_CLOSE; |
| 319 | desc->requested_credit = 0; |
| 320 | } |
| 321 | |
| 322 | static struct brcmf_fws_mac_descriptor * |
| 323 | brcmf_fws_mac_descriptor_lookup(struct brcmf_fws_info *fws, u8 *ea) |
| 324 | { |
| 325 | struct brcmf_fws_mac_descriptor *entry; |
| 326 | int i; |
| 327 | |
| 328 | brcmf_dbg(TRACE, "enter: ea=%pM\n", ea); |
| 329 | if (ea == NULL) |
| 330 | return ERR_PTR(-EINVAL); |
| 331 | |
| 332 | entry = &fws->nodes[0]; |
| 333 | for (i = 0; i < ARRAY_SIZE(fws->nodes); i++) { |
| 334 | if (entry->occupied && !memcmp(entry->ea, ea, ETH_ALEN)) |
| 335 | return entry; |
| 336 | entry++; |
| 337 | } |
| 338 | |
| 339 | return ERR_PTR(-ENOENT); |
| 340 | } |
| 341 | |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 342 | static void brcmf_fws_mac_desc_cleanup(struct brcmf_fws_mac_descriptor *entry, |
| 343 | bool (*fn)(struct sk_buff *, void *), |
| 344 | int ifidx) |
| 345 | { |
| 346 | brcmf_dbg(TRACE, "enter: entry=(ea=%pM,ifid=%d), ifidx=%d\n", |
| 347 | entry->ea, entry->interface_id, ifidx); |
| 348 | if (entry->occupied && (fn == NULL || (ifidx == entry->interface_id))) { |
| 349 | brcmf_dbg(TRACE, "flush delayQ: ifidx=%d, qlen=%d\n", |
| 350 | ifidx, entry->psq.len); |
| 351 | /* release packets held in DELAYQ */ |
| 352 | brcmu_pktq_flush(&entry->psq, true, fn, &ifidx); |
| 353 | entry->occupied = !!(entry->psq.len); |
| 354 | } |
| 355 | } |
| 356 | |
Arend van Spriel | a3e993c | 2013-04-03 12:40:36 +0200 | [diff] [blame^] | 357 | static bool brcmf_fws_ifidx_match(struct sk_buff *skb, void *arg) |
| 358 | { |
| 359 | u32 ifidx = brcmf_skb_if_flags_get_field(skb, INDEX); |
| 360 | return ifidx == *(int *)arg; |
| 361 | } |
| 362 | |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 363 | static void brcmf_fws_cleanup(struct brcmf_fws_info *fws, int ifidx) |
| 364 | { |
| 365 | int i; |
| 366 | struct brcmf_fws_mac_descriptor *table; |
Arend van Spriel | a3e993c | 2013-04-03 12:40:36 +0200 | [diff] [blame^] | 367 | bool (*matchfn)(struct sk_buff *, void *) = NULL; |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 368 | |
| 369 | brcmf_dbg(TRACE, "enter: ifidx=%d\n", ifidx); |
| 370 | if (fws == NULL) |
| 371 | return; |
| 372 | |
Arend van Spriel | a3e993c | 2013-04-03 12:40:36 +0200 | [diff] [blame^] | 373 | if (ifidx != -1) |
| 374 | matchfn = brcmf_fws_ifidx_match; |
| 375 | |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 376 | /* cleanup individual nodes */ |
| 377 | table = &fws->nodes[0]; |
| 378 | for (i = 0; i < ARRAY_SIZE(fws->nodes); i++) |
Arend van Spriel | a3e993c | 2013-04-03 12:40:36 +0200 | [diff] [blame^] | 379 | brcmf_fws_mac_desc_cleanup(&table[i], matchfn, ifidx); |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 380 | |
Arend van Spriel | a3e993c | 2013-04-03 12:40:36 +0200 | [diff] [blame^] | 381 | brcmf_fws_mac_desc_cleanup(&fws->other, matchfn, ifidx); |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 382 | } |
| 383 | |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 384 | static int brcmf_fws_rssi_indicate(struct brcmf_fws_info *fws, s8 rssi) |
| 385 | { |
| 386 | brcmf_dbg(CTL, "rssi %d\n", rssi); |
| 387 | return 0; |
| 388 | } |
| 389 | |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 390 | static |
| 391 | int brcmf_fws_macdesc_indicate(struct brcmf_fws_info *fws, u8 type, u8 *data) |
| 392 | { |
| 393 | struct brcmf_fws_mac_descriptor *entry, *existing; |
| 394 | u8 mac_handle; |
| 395 | u8 ifidx; |
| 396 | u8 *addr; |
| 397 | |
| 398 | mac_handle = *data++; |
| 399 | ifidx = *data++; |
| 400 | addr = data; |
| 401 | |
| 402 | entry = &fws->nodes[mac_handle & 0x1F]; |
| 403 | if (type == BRCMF_FWS_TYPE_MACDESC_DEL) { |
| 404 | brcmf_dbg(TRACE, "deleting mac %pM idx %d\n", addr, ifidx); |
| 405 | if (entry->occupied) { |
| 406 | entry->occupied = 0; |
| 407 | entry->state = BRCMF_FWS_STATE_CLOSE; |
| 408 | entry->requested_credit = 0; |
| 409 | } else { |
| 410 | fws->stats.mac_update_failed++; |
| 411 | } |
| 412 | return 0; |
| 413 | } |
| 414 | |
| 415 | brcmf_dbg(TRACE, "add mac %pM idx %d\n", addr, ifidx); |
| 416 | existing = brcmf_fws_mac_descriptor_lookup(fws, addr); |
| 417 | if (IS_ERR(existing)) { |
| 418 | if (!entry->occupied) { |
| 419 | entry->mac_handle = mac_handle; |
| 420 | brcmf_fws_init_mac_descriptor(entry, addr, ifidx); |
| 421 | brcmu_pktq_init(&entry->psq, BRCMF_FWS_PSQ_PREC_COUNT, |
| 422 | BRCMF_FWS_PSQ_LEN); |
| 423 | } else { |
| 424 | fws->stats.mac_update_failed++; |
| 425 | } |
| 426 | } else { |
| 427 | if (entry != existing) { |
| 428 | brcmf_dbg(TRACE, "relocate mac\n"); |
| 429 | memcpy(entry, existing, |
| 430 | offsetof(struct brcmf_fws_mac_descriptor, psq)); |
| 431 | entry->mac_handle = mac_handle; |
| 432 | brcmf_fws_clear_mac_descriptor(existing); |
| 433 | } else { |
| 434 | brcmf_dbg(TRACE, "use existing\n"); |
| 435 | WARN_ON(entry->mac_handle != mac_handle); |
| 436 | /* TODO: what should we do here: continue, reinit, .. */ |
| 437 | } |
| 438 | } |
| 439 | return 0; |
| 440 | } |
| 441 | |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 442 | static int brcmf_fws_dbg_seqnum_check(struct brcmf_fws_info *fws, u8 *data) |
| 443 | { |
| 444 | __le32 timestamp; |
| 445 | |
| 446 | memcpy(×tamp, &data[2], sizeof(timestamp)); |
| 447 | brcmf_dbg(INFO, "received: seq %d, timestamp %d\n", data[1], |
| 448 | le32_to_cpu(timestamp)); |
| 449 | return 0; |
| 450 | } |
| 451 | |
| 452 | /* using macro so sparse checking does not complain |
| 453 | * about locking imbalance. |
| 454 | */ |
| 455 | #define brcmf_fws_lock(drvr, flags) \ |
| 456 | do { \ |
| 457 | flags = 0; \ |
| 458 | spin_lock_irqsave(&((drvr)->fws_spinlock), (flags)); \ |
| 459 | } while (0) |
| 460 | |
| 461 | /* using macro so sparse checking does not complain |
| 462 | * about locking imbalance. |
| 463 | */ |
| 464 | #define brcmf_fws_unlock(drvr, flags) \ |
| 465 | spin_unlock_irqrestore(&((drvr)->fws_spinlock), (flags)) |
| 466 | |
Arend van Spriel | 43fa635 | 2013-04-03 12:40:32 +0200 | [diff] [blame] | 467 | static int brcmf_fws_notify_credit_map(struct brcmf_if *ifp, |
| 468 | const struct brcmf_event_msg *e, |
| 469 | void *data) |
| 470 | { |
| 471 | struct brcmf_fws_info *fws = ifp->drvr->fws; |
| 472 | int i; |
| 473 | ulong flags; |
| 474 | u8 *credits = data; |
| 475 | |
| 476 | brcmf_fws_lock(ifp->drvr, flags); |
| 477 | for (i = 0; i < ARRAY_SIZE(fws->fifo_credit); i++) |
| 478 | fws->fifo_credit[i] = *credits++; |
| 479 | brcmf_fws_unlock(ifp->drvr, flags); |
| 480 | return 0; |
| 481 | } |
| 482 | |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 483 | int brcmf_fws_init(struct brcmf_pub *drvr) |
| 484 | { |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 485 | u32 tlv = 0; |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 486 | int rc; |
| 487 | |
| 488 | /* enable rssi signals */ |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 489 | if (drvr->fw_signals) |
| 490 | tlv = BRCMF_FWS_FLAGS_RSSI_SIGNALS | |
| 491 | BRCMF_FWS_FLAGS_XONXOFF_SIGNALS; |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 492 | |
| 493 | spin_lock_init(&drvr->fws_spinlock); |
| 494 | |
| 495 | drvr->fws = kzalloc(sizeof(*(drvr->fws)), GFP_KERNEL); |
| 496 | if (!drvr->fws) { |
| 497 | rc = -ENOMEM; |
| 498 | goto fail; |
| 499 | } |
| 500 | |
| 501 | /* enable proptxtstatus signaling by default */ |
| 502 | rc = brcmf_fil_iovar_int_set(drvr->iflist[0], "tlv", tlv); |
| 503 | if (rc < 0) { |
| 504 | brcmf_err("failed to set bdcv2 tlv signaling\n"); |
| 505 | goto fail; |
| 506 | } |
Arend van Spriel | 43fa635 | 2013-04-03 12:40:32 +0200 | [diff] [blame] | 507 | |
| 508 | if (brcmf_fweh_register(drvr, BRCMF_E_FIFO_CREDIT_MAP, |
| 509 | brcmf_fws_notify_credit_map)) { |
| 510 | brcmf_err("register credit map handler failed\n"); |
| 511 | goto fail; |
| 512 | } |
| 513 | |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 514 | /* create debugfs file for statistics */ |
| 515 | brcmf_debugfs_create_fws_stats(drvr, &drvr->fws->stats); |
| 516 | |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 517 | /* set linkage back */ |
| 518 | drvr->fws->drvr = drvr; |
| 519 | |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 520 | /* TODO: remove upon feature delivery */ |
| 521 | brcmf_err("%s bdcv2 tlv signaling [%x]\n", |
| 522 | drvr->fw_signals ? "enabled" : "disabled", tlv); |
| 523 | return 0; |
| 524 | |
| 525 | fail: |
| 526 | /* disable flow control entirely */ |
| 527 | drvr->fw_signals = false; |
| 528 | brcmf_fws_deinit(drvr); |
| 529 | return rc; |
| 530 | } |
| 531 | |
| 532 | void brcmf_fws_deinit(struct brcmf_pub *drvr) |
| 533 | { |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 534 | struct brcmf_fws_info *fws = drvr->fws; |
| 535 | ulong flags; |
| 536 | |
| 537 | /* cleanup */ |
| 538 | brcmf_fws_lock(drvr, flags); |
| 539 | brcmf_fws_cleanup(fws, -1); |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 540 | drvr->fws = NULL; |
Arend van Spriel | fba1400 | 2013-04-03 12:40:33 +0200 | [diff] [blame] | 541 | brcmf_fws_unlock(drvr, flags); |
| 542 | |
| 543 | /* free top structure */ |
| 544 | kfree(fws); |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 545 | } |
| 546 | |
| 547 | int brcmf_fws_hdrpull(struct brcmf_pub *drvr, int ifidx, s16 signal_len, |
| 548 | struct sk_buff *skb) |
| 549 | { |
| 550 | struct brcmf_fws_info *fws = drvr->fws; |
| 551 | ulong flags; |
| 552 | u8 *signal_data; |
| 553 | s16 data_len; |
| 554 | u8 type; |
| 555 | u8 len; |
| 556 | u8 *data; |
| 557 | |
| 558 | brcmf_dbg(TRACE, "enter: ifidx %d, skblen %u, sig %d\n", |
| 559 | ifidx, skb->len, signal_len); |
| 560 | |
| 561 | WARN_ON(signal_len > skb->len); |
| 562 | |
| 563 | /* if flow control disabled, skip to packet data and leave */ |
| 564 | if (!signal_len || !drvr->fw_signals) { |
| 565 | skb_pull(skb, signal_len); |
| 566 | return 0; |
| 567 | } |
| 568 | |
| 569 | /* lock during tlv parsing */ |
| 570 | brcmf_fws_lock(drvr, flags); |
| 571 | |
| 572 | fws->stats.header_pulls++; |
| 573 | data_len = signal_len; |
| 574 | signal_data = skb->data; |
| 575 | |
| 576 | while (data_len > 0) { |
| 577 | /* extract tlv info */ |
| 578 | type = signal_data[0]; |
| 579 | |
| 580 | /* FILLER type is actually not a TLV, but |
| 581 | * a single byte that can be skipped. |
| 582 | */ |
| 583 | if (type == BRCMF_FWS_TYPE_FILLER) { |
| 584 | signal_data += 1; |
| 585 | data_len -= 1; |
| 586 | continue; |
| 587 | } |
| 588 | len = signal_data[1]; |
| 589 | data = signal_data + 2; |
| 590 | |
| 591 | /* abort parsing when length invalid */ |
| 592 | if (data_len < len + 2) |
| 593 | break; |
| 594 | |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 595 | if (len != brcmf_fws_get_tlv_len(fws, type)) |
| 596 | break; |
| 597 | |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 598 | brcmf_dbg(INFO, "tlv type=%d (%s), len=%d\n", type, |
| 599 | brcmf_fws_get_tlv_name(type), len); |
| 600 | switch (type) { |
| 601 | case BRCMF_FWS_TYPE_MAC_OPEN: |
| 602 | case BRCMF_FWS_TYPE_MAC_CLOSE: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 603 | case BRCMF_FWS_TYPE_MAC_REQUEST_CREDIT: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 604 | case BRCMF_FWS_TYPE_TXSTATUS: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 605 | case BRCMF_FWS_TYPE_PKTTAG: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 606 | case BRCMF_FWS_TYPE_INTERFACE_OPEN: |
| 607 | case BRCMF_FWS_TYPE_INTERFACE_CLOSE: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 608 | case BRCMF_FWS_TYPE_FIFO_CREDITBACK: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 609 | case BRCMF_FWS_TYPE_PENDING_TRAFFIC_BMP: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 610 | case BRCMF_FWS_TYPE_MAC_REQUEST_PACKET: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 611 | case BRCMF_FWS_TYPE_HOST_REORDER_RXPKTS: |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 612 | case BRCMF_FWS_TYPE_COMP_TXSTATUS: |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 613 | break; |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 614 | case BRCMF_FWS_TYPE_MACDESC_ADD: |
| 615 | case BRCMF_FWS_TYPE_MACDESC_DEL: |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 616 | brcmf_fws_macdesc_indicate(fws, type, data); |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 617 | break; |
| 618 | case BRCMF_FWS_TYPE_RSSI: |
| 619 | brcmf_fws_rssi_indicate(fws, *data); |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 620 | break; |
| 621 | case BRCMF_FWS_TYPE_TRANS_ID: |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 622 | brcmf_fws_dbg_seqnum_check(fws, data); |
| 623 | break; |
Arend van Spriel | 349e710 | 2013-03-03 12:45:28 +0100 | [diff] [blame] | 624 | default: |
| 625 | fws->stats.tlv_invalid_type++; |
| 626 | break; |
| 627 | } |
| 628 | |
| 629 | signal_data += len + 2; |
| 630 | data_len -= len + 2; |
| 631 | } |
| 632 | |
| 633 | if (data_len != 0) |
| 634 | fws->stats.tlv_parse_failed++; |
| 635 | |
| 636 | /* signalling processing result does |
| 637 | * not affect the actual ethernet packet. |
| 638 | */ |
| 639 | skb_pull(skb, signal_len); |
| 640 | |
| 641 | /* this may be a signal-only packet |
| 642 | */ |
| 643 | if (skb->len == 0) |
| 644 | fws->stats.header_only_pkt++; |
| 645 | |
| 646 | brcmf_fws_unlock(drvr, flags); |
| 647 | return 0; |
| 648 | } |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 649 | |
| 650 | void brcmf_fws_reset_interface(struct brcmf_if *ifp) |
| 651 | { |
| 652 | struct brcmf_fws_mac_descriptor *entry = ifp->fws_desc; |
| 653 | |
| 654 | brcmf_dbg(TRACE, "enter: idx=%d\n", ifp->bssidx); |
| 655 | if (!entry) |
| 656 | return; |
| 657 | |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 658 | brcmf_fws_init_mac_descriptor(entry, ifp->mac_addr, ifp->ifidx); |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 659 | } |
| 660 | |
| 661 | void brcmf_fws_add_interface(struct brcmf_if *ifp) |
| 662 | { |
| 663 | struct brcmf_fws_mac_descriptor *entry; |
| 664 | |
| 665 | brcmf_dbg(TRACE, "enter: idx=%d, mac=%pM\n", |
| 666 | ifp->bssidx, ifp->mac_addr); |
| 667 | if (!ifp->drvr->fw_signals) |
| 668 | return; |
| 669 | |
| 670 | entry = kzalloc(sizeof(*entry), GFP_ATOMIC); |
| 671 | if (entry) { |
| 672 | ifp->fws_desc = entry; |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 673 | brcmf_fws_init_mac_descriptor(entry, ifp->mac_addr, ifp->ifidx); |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 674 | brcmu_pktq_init(&entry->psq, BRCMF_FWS_PSQ_PREC_COUNT, |
| 675 | BRCMF_FWS_PSQ_LEN); |
| 676 | } else { |
| 677 | brcmf_err("no firmware signalling\n"); |
| 678 | } |
| 679 | } |
| 680 | |
| 681 | void brcmf_fws_del_interface(struct brcmf_if *ifp) |
| 682 | { |
| 683 | struct brcmf_fws_mac_descriptor *entry = ifp->fws_desc; |
| 684 | |
| 685 | brcmf_dbg(TRACE, "enter: idx=%d\n", ifp->bssidx); |
| 686 | if (!entry) |
| 687 | return; |
| 688 | |
| 689 | ifp->fws_desc = NULL; |
Arend van Spriel | ce814c1 | 2013-04-03 12:40:31 +0200 | [diff] [blame] | 690 | brcmf_fws_clear_mac_descriptor(entry); |
Arend van Spriel | a3e993c | 2013-04-03 12:40:36 +0200 | [diff] [blame^] | 691 | brcmf_fws_cleanup(ifp->drvr->fws, ifp->ifidx); |
Arend van Spriel | bb8c806 | 2013-04-03 12:40:30 +0200 | [diff] [blame] | 692 | kfree(entry); |
| 693 | } |