summaryrefslogtreecommitdiff
path: root/drivers/net/wireless/brcm80211/brcmfmac/flowring.c
diff options
context:
space:
mode:
authorAndré Fabian Silva Delgado <emulatorman@parabola.nu>2016-03-25 03:53:42 -0300
committerAndré Fabian Silva Delgado <emulatorman@parabola.nu>2016-03-25 03:53:42 -0300
commit03dd4cb26d967f9588437b0fc9cc0e8353322bb7 (patch)
treefa581f6dc1c0596391690d1f67eceef3af8246dc /drivers/net/wireless/brcm80211/brcmfmac/flowring.c
parentd4e493caf788ef44982e131ff9c786546904d934 (diff)
Linux-libre 4.5-gnu
Diffstat (limited to 'drivers/net/wireless/brcm80211/brcmfmac/flowring.c')
-rw-r--r--drivers/net/wireless/brcm80211/brcmfmac/flowring.c504
1 files changed, 0 insertions, 504 deletions
diff --git a/drivers/net/wireless/brcm80211/brcmfmac/flowring.c b/drivers/net/wireless/brcm80211/brcmfmac/flowring.c
deleted file mode 100644
index 2ca783fa5..000000000
--- a/drivers/net/wireless/brcm80211/brcmfmac/flowring.c
+++ /dev/null
@@ -1,504 +0,0 @@
-/* Copyright (c) 2014 Broadcom Corporation
- *
- * Permission to use, copy, modify, and/or distribute this software for any
- * purpose with or without fee is hereby granted, provided that the above
- * copyright notice and this permission notice appear in all copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
- * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
- * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
- * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- */
-
-
-#include <linux/types.h>
-#include <linux/netdevice.h>
-#include <linux/etherdevice.h>
-#include <brcmu_utils.h>
-
-#include "core.h"
-#include "debug.h"
-#include "bus.h"
-#include "proto.h"
-#include "flowring.h"
-#include "msgbuf.h"
-#include "common.h"
-
-
-#define BRCMF_FLOWRING_HIGH 1024
-#define BRCMF_FLOWRING_LOW (BRCMF_FLOWRING_HIGH - 256)
-#define BRCMF_FLOWRING_INVALID_IFIDX 0xff
-
-#define BRCMF_FLOWRING_HASH_AP(da, fifo, ifidx) (da[5] + fifo + ifidx * 16)
-#define BRCMF_FLOWRING_HASH_STA(fifo, ifidx) (fifo + ifidx * 16)
-
-static const u8 brcmf_flowring_prio2fifo[] = {
- 1,
- 0,
- 0,
- 1,
- 2,
- 2,
- 3,
- 3
-};
-
-
-static bool
-brcmf_flowring_is_tdls_mac(struct brcmf_flowring *flow, u8 mac[ETH_ALEN])
-{
- struct brcmf_flowring_tdls_entry *search;
-
- search = flow->tdls_entry;
-
- while (search) {
- if (memcmp(search->mac, mac, ETH_ALEN) == 0)
- return true;
- search = search->next;
- }
-
- return false;
-}
-
-
-u32 brcmf_flowring_lookup(struct brcmf_flowring *flow, u8 da[ETH_ALEN],
- u8 prio, u8 ifidx)
-{
- struct brcmf_flowring_hash *hash;
- u8 hash_idx;
- u32 i;
- bool found;
- bool sta;
- u8 fifo;
- u8 *mac;
-
- fifo = brcmf_flowring_prio2fifo[prio];
- sta = (flow->addr_mode[ifidx] == ADDR_INDIRECT);
- mac = da;
- if ((!sta) && (is_multicast_ether_addr(da))) {
- mac = (u8 *)ALLFFMAC;
- fifo = 0;
- }
- if ((sta) && (flow->tdls_active) &&
- (brcmf_flowring_is_tdls_mac(flow, da))) {
- sta = false;
- }
- hash_idx = sta ? BRCMF_FLOWRING_HASH_STA(fifo, ifidx) :
- BRCMF_FLOWRING_HASH_AP(mac, fifo, ifidx);
- found = false;
- hash = flow->hash;
- for (i = 0; i < BRCMF_FLOWRING_HASHSIZE; i++) {
- if ((sta || (memcmp(hash[hash_idx].mac, mac, ETH_ALEN) == 0)) &&
- (hash[hash_idx].fifo == fifo) &&
- (hash[hash_idx].ifidx == ifidx)) {
- found = true;
- break;
- }
- hash_idx++;
- }
- if (found)
- return hash[hash_idx].flowid;
-
- return BRCMF_FLOWRING_INVALID_ID;
-}
-
-
-u32 brcmf_flowring_create(struct brcmf_flowring *flow, u8 da[ETH_ALEN],
- u8 prio, u8 ifidx)
-{
- struct brcmf_flowring_ring *ring;
- struct brcmf_flowring_hash *hash;
- u8 hash_idx;
- u32 i;
- bool found;
- u8 fifo;
- bool sta;
- u8 *mac;
-
- fifo = brcmf_flowring_prio2fifo[prio];
- sta = (flow->addr_mode[ifidx] == ADDR_INDIRECT);
- mac = da;
- if ((!sta) && (is_multicast_ether_addr(da))) {
- mac = (u8 *)ALLFFMAC;
- fifo = 0;
- }
- if ((sta) && (flow->tdls_active) &&
- (brcmf_flowring_is_tdls_mac(flow, da))) {
- sta = false;
- }
- hash_idx = sta ? BRCMF_FLOWRING_HASH_STA(fifo, ifidx) :
- BRCMF_FLOWRING_HASH_AP(mac, fifo, ifidx);
- found = false;
- hash = flow->hash;
- for (i = 0; i < BRCMF_FLOWRING_HASHSIZE; i++) {
- if ((hash[hash_idx].ifidx == BRCMF_FLOWRING_INVALID_IFIDX) &&
- (is_zero_ether_addr(hash[hash_idx].mac))) {
- found = true;
- break;
- }
- hash_idx++;
- }
- if (found) {
- for (i = 0; i < flow->nrofrings; i++) {
- if (flow->rings[i] == NULL)
- break;
- }
- if (i == flow->nrofrings)
- return -ENOMEM;
-
- ring = kzalloc(sizeof(*ring), GFP_ATOMIC);
- if (!ring)
- return -ENOMEM;
-
- memcpy(hash[hash_idx].mac, mac, ETH_ALEN);
- hash[hash_idx].fifo = fifo;
- hash[hash_idx].ifidx = ifidx;
- hash[hash_idx].flowid = i;
-
- ring->hash_id = hash_idx;
- ring->status = RING_CLOSED;
- skb_queue_head_init(&ring->skblist);
- flow->rings[i] = ring;
-
- return i;
- }
- return BRCMF_FLOWRING_INVALID_ID;
-}
-
-
-u8 brcmf_flowring_tid(struct brcmf_flowring *flow, u8 flowid)
-{
- struct brcmf_flowring_ring *ring;
-
- ring = flow->rings[flowid];
-
- return flow->hash[ring->hash_id].fifo;
-}
-
-
-static void brcmf_flowring_block(struct brcmf_flowring *flow, u8 flowid,
- bool blocked)
-{
- struct brcmf_flowring_ring *ring;
- struct brcmf_bus *bus_if;
- struct brcmf_pub *drvr;
- struct brcmf_if *ifp;
- bool currently_blocked;
- int i;
- u8 ifidx;
- unsigned long flags;
-
- spin_lock_irqsave(&flow->block_lock, flags);
-
- ring = flow->rings[flowid];
- if (ring->blocked == blocked) {
- spin_unlock_irqrestore(&flow->block_lock, flags);
- return;
- }
- ifidx = brcmf_flowring_ifidx_get(flow, flowid);
-
- currently_blocked = false;
- for (i = 0; i < flow->nrofrings; i++) {
- if ((flow->rings[i]) && (i != flowid)) {
- ring = flow->rings[i];
- if ((ring->status == RING_OPEN) &&
- (brcmf_flowring_ifidx_get(flow, i) == ifidx)) {
- if (ring->blocked) {
- currently_blocked = true;
- break;
- }
- }
- }
- }
- flow->rings[flowid]->blocked = blocked;
- if (currently_blocked) {
- spin_unlock_irqrestore(&flow->block_lock, flags);
- return;
- }
-
- bus_if = dev_get_drvdata(flow->dev);
- drvr = bus_if->drvr;
- ifp = brcmf_get_ifp(drvr, ifidx);
- brcmf_txflowblock_if(ifp, BRCMF_NETIF_STOP_REASON_FLOW, blocked);
-
- spin_unlock_irqrestore(&flow->block_lock, flags);
-}
-
-
-void brcmf_flowring_delete(struct brcmf_flowring *flow, u8 flowid)
-{
- struct brcmf_flowring_ring *ring;
- u8 hash_idx;
- struct sk_buff *skb;
-
- ring = flow->rings[flowid];
- if (!ring)
- return;
- brcmf_flowring_block(flow, flowid, false);
- hash_idx = ring->hash_id;
- flow->hash[hash_idx].ifidx = BRCMF_FLOWRING_INVALID_IFIDX;
- eth_zero_addr(flow->hash[hash_idx].mac);
- flow->rings[flowid] = NULL;
-
- skb = skb_dequeue(&ring->skblist);
- while (skb) {
- brcmu_pkt_buf_free_skb(skb);
- skb = skb_dequeue(&ring->skblist);
- }
-
- kfree(ring);
-}
-
-
-u32 brcmf_flowring_enqueue(struct brcmf_flowring *flow, u8 flowid,
- struct sk_buff *skb)
-{
- struct brcmf_flowring_ring *ring;
-
- ring = flow->rings[flowid];
-
- skb_queue_tail(&ring->skblist, skb);
-
- if (!ring->blocked &&
- (skb_queue_len(&ring->skblist) > BRCMF_FLOWRING_HIGH)) {
- brcmf_flowring_block(flow, flowid, true);
- brcmf_dbg(MSGBUF, "Flowcontrol: BLOCK for ring %d\n", flowid);
- /* To prevent (work around) possible race condition, check
- * queue len again. It is also possible to use locking to
- * protect, but that is undesirable for every enqueue and
- * dequeue. This simple check will solve a possible race
- * condition if it occurs.
- */
- if (skb_queue_len(&ring->skblist) < BRCMF_FLOWRING_LOW)
- brcmf_flowring_block(flow, flowid, false);
- }
- return skb_queue_len(&ring->skblist);
-}
-
-
-struct sk_buff *brcmf_flowring_dequeue(struct brcmf_flowring *flow, u8 flowid)
-{
- struct brcmf_flowring_ring *ring;
- struct sk_buff *skb;
-
- ring = flow->rings[flowid];
- if (ring->status != RING_OPEN)
- return NULL;
-
- skb = skb_dequeue(&ring->skblist);
-
- if (ring->blocked &&
- (skb_queue_len(&ring->skblist) < BRCMF_FLOWRING_LOW)) {
- brcmf_flowring_block(flow, flowid, false);
- brcmf_dbg(MSGBUF, "Flowcontrol: OPEN for ring %d\n", flowid);
- }
-
- return skb;
-}
-
-
-void brcmf_flowring_reinsert(struct brcmf_flowring *flow, u8 flowid,
- struct sk_buff *skb)
-{
- struct brcmf_flowring_ring *ring;
-
- ring = flow->rings[flowid];
-
- skb_queue_head(&ring->skblist, skb);
-}
-
-
-u32 brcmf_flowring_qlen(struct brcmf_flowring *flow, u8 flowid)
-{
- struct brcmf_flowring_ring *ring;
-
- ring = flow->rings[flowid];
- if (!ring)
- return 0;
-
- if (ring->status != RING_OPEN)
- return 0;
-
- return skb_queue_len(&ring->skblist);
-}
-
-
-void brcmf_flowring_open(struct brcmf_flowring *flow, u8 flowid)
-{
- struct brcmf_flowring_ring *ring;
-
- ring = flow->rings[flowid];
- if (!ring) {
- brcmf_err("Ring NULL, for flowid %d\n", flowid);
- return;
- }
-
- ring->status = RING_OPEN;
-}
-
-
-u8 brcmf_flowring_ifidx_get(struct brcmf_flowring *flow, u8 flowid)
-{
- struct brcmf_flowring_ring *ring;
- u8 hash_idx;
-
- ring = flow->rings[flowid];
- hash_idx = ring->hash_id;
-
- return flow->hash[hash_idx].ifidx;
-}
-
-
-struct brcmf_flowring *brcmf_flowring_attach(struct device *dev, u16 nrofrings)
-{
- struct brcmf_flowring *flow;
- u32 i;
-
- flow = kzalloc(sizeof(*flow), GFP_KERNEL);
- if (flow) {
- flow->dev = dev;
- flow->nrofrings = nrofrings;
- spin_lock_init(&flow->block_lock);
- for (i = 0; i < ARRAY_SIZE(flow->addr_mode); i++)
- flow->addr_mode[i] = ADDR_INDIRECT;
- for (i = 0; i < ARRAY_SIZE(flow->hash); i++)
- flow->hash[i].ifidx = BRCMF_FLOWRING_INVALID_IFIDX;
- flow->rings = kcalloc(nrofrings, sizeof(*flow->rings),
- GFP_KERNEL);
- if (!flow->rings) {
- kfree(flow);
- flow = NULL;
- }
- }
-
- return flow;
-}
-
-
-void brcmf_flowring_detach(struct brcmf_flowring *flow)
-{
- struct brcmf_bus *bus_if = dev_get_drvdata(flow->dev);
- struct brcmf_pub *drvr = bus_if->drvr;
- struct brcmf_flowring_tdls_entry *search;
- struct brcmf_flowring_tdls_entry *remove;
- u8 flowid;
-
- for (flowid = 0; flowid < flow->nrofrings; flowid++) {
- if (flow->rings[flowid])
- brcmf_msgbuf_delete_flowring(drvr, flowid);
- }
-
- search = flow->tdls_entry;
- while (search) {
- remove = search;
- search = search->next;
- kfree(remove);
- }
- kfree(flow->rings);
- kfree(flow);
-}
-
-
-void brcmf_flowring_configure_addr_mode(struct brcmf_flowring *flow, int ifidx,
- enum proto_addr_mode addr_mode)
-{
- struct brcmf_bus *bus_if = dev_get_drvdata(flow->dev);
- struct brcmf_pub *drvr = bus_if->drvr;
- u32 i;
- u8 flowid;
-
- if (flow->addr_mode[ifidx] != addr_mode) {
- for (i = 0; i < ARRAY_SIZE(flow->hash); i++) {
- if (flow->hash[i].ifidx == ifidx) {
- flowid = flow->hash[i].flowid;
- if (flow->rings[flowid]->status != RING_OPEN)
- continue;
- flow->rings[flowid]->status = RING_CLOSING;
- brcmf_msgbuf_delete_flowring(drvr, flowid);
- }
- }
- flow->addr_mode[ifidx] = addr_mode;
- }
-}
-
-
-void brcmf_flowring_delete_peer(struct brcmf_flowring *flow, int ifidx,
- u8 peer[ETH_ALEN])
-{
- struct brcmf_bus *bus_if = dev_get_drvdata(flow->dev);
- struct brcmf_pub *drvr = bus_if->drvr;
- struct brcmf_flowring_hash *hash;
- struct brcmf_flowring_tdls_entry *prev;
- struct brcmf_flowring_tdls_entry *search;
- u32 i;
- u8 flowid;
- bool sta;
-
- sta = (flow->addr_mode[ifidx] == ADDR_INDIRECT);
-
- search = flow->tdls_entry;
- prev = NULL;
- while (search) {
- if (memcmp(search->mac, peer, ETH_ALEN) == 0) {
- sta = false;
- break;
- }
- prev = search;
- search = search->next;
- }
-
- hash = flow->hash;
- for (i = 0; i < BRCMF_FLOWRING_HASHSIZE; i++) {
- if ((sta || (memcmp(hash[i].mac, peer, ETH_ALEN) == 0)) &&
- (hash[i].ifidx == ifidx)) {
- flowid = flow->hash[i].flowid;
- if (flow->rings[flowid]->status == RING_OPEN) {
- flow->rings[flowid]->status = RING_CLOSING;
- brcmf_msgbuf_delete_flowring(drvr, flowid);
- }
- }
- }
-
- if (search) {
- if (prev)
- prev->next = search->next;
- else
- flow->tdls_entry = search->next;
- kfree(search);
- if (flow->tdls_entry == NULL)
- flow->tdls_active = false;
- }
-}
-
-
-void brcmf_flowring_add_tdls_peer(struct brcmf_flowring *flow, int ifidx,
- u8 peer[ETH_ALEN])
-{
- struct brcmf_flowring_tdls_entry *tdls_entry;
- struct brcmf_flowring_tdls_entry *search;
-
- tdls_entry = kzalloc(sizeof(*tdls_entry), GFP_ATOMIC);
- if (tdls_entry == NULL)
- return;
-
- memcpy(tdls_entry->mac, peer, ETH_ALEN);
- tdls_entry->next = NULL;
- if (flow->tdls_entry == NULL) {
- flow->tdls_entry = tdls_entry;
- } else {
- search = flow->tdls_entry;
- if (memcmp(search->mac, peer, ETH_ALEN) == 0)
- return;
- while (search->next) {
- search = search->next;
- if (memcmp(search->mac, peer, ETH_ALEN) == 0)
- return;
- }
- search->next = tdls_entry;
- }
-
- flow->tdls_active = true;
-}