Commit 85b84133 authored by Hante Meuleman's avatar Hante Meuleman Committed by John W. Linville
Browse files

brcmfmac: Dynamically register a protocol layer. 



BCDC is the default protocol layer and being called directly. This
patch installs the functions for this layer dynamically. This allows
new protocols to be added and selected dynamically depending on the
hw capabilties. As currently only BCDC is supported this is always
the installed protocol.

Reviewed-by: default avatarArend Van Spriel <arend@broadcom.com>
Reviewed-by: default avatarPieter-Paul Giesberts <pieterpg@broadcom.com>
Signed-off-by: default avatarHante Meuleman <meuleman@broadcom.com>
Signed-off-by: default avatarArend van Spriel <arend@broadcom.com>
Signed-off-by: default avatarJohn W. Linville <linville@tuxdriver.com>
parent e601fb37

drivers/net/wireless/brcm80211/brcmfmac/Makefile

+1 −0
Original line number Diff line number Diff line
@@ -28,6 +28,7 @@ brcmfmac-objs += \ 
		fweh.o \

		fwsignal.o \

		p2p.o \

		proto.o \

		bcdc.o \

		dhd_common.o \

		dhd_linux.o \

drivers/net/wireless/brcm80211/brcmfmac/bcdc.c

+51 −42
Original line number Diff line number Diff line
@@ -30,6 +30,8 @@ 
#include "fwsignal.h"

#include "dhd_dbg.h"

#include "tracepoint.h"

#include "proto.h"

#include "bcdc.h"



struct brcmf_proto_cdc_dcmd {

	__le32 cmd;	/* dongle command value */
@@ -104,7 +106,7 @@ struct brcmf_proto_bdc_header { 
				 * Currently is SDIO

				 */



struct brcmf_proto {

struct brcmf_bcdc {

	u16 reqid;

	u8 bus_header[BUS_HEADER_LEN];

	struct brcmf_proto_cdc_dcmd msg;
@@ -113,8 +115,8 @@ struct brcmf_proto { 


static int brcmf_proto_cdc_msg(struct brcmf_pub *drvr)

{

	struct brcmf_proto *prot = drvr->prot;

	int len = le32_to_cpu(prot->msg.len) +

	struct brcmf_bcdc *bcdc = (struct brcmf_bcdc *)drvr->proto->pd;

	int len = le32_to_cpu(bcdc->msg.len) +

			sizeof(struct brcmf_proto_cdc_dcmd);



	brcmf_dbg(CDC, "Enter\n");
@@ -127,32 +129,32 @@ static int brcmf_proto_cdc_msg(struct brcmf_pub *drvr) 
		len = CDC_MAX_MSG_SIZE;



	/* Send request */

	return brcmf_bus_txctl(drvr->bus_if, (unsigned char *)&prot->msg, len);

	return brcmf_bus_txctl(drvr->bus_if, (unsigned char *)&bcdc->msg, len);

}



static int brcmf_proto_cdc_cmplt(struct brcmf_pub *drvr, u32 id, u32 len)

{

	int ret;

	struct brcmf_proto *prot = drvr->prot;

	struct brcmf_bcdc *bcdc = (struct brcmf_bcdc *)drvr->proto->pd;



	brcmf_dbg(CDC, "Enter\n");

	len += sizeof(struct brcmf_proto_cdc_dcmd);

	do {

		ret = brcmf_bus_rxctl(drvr->bus_if, (unsigned char *)&prot->msg,

		ret = brcmf_bus_rxctl(drvr->bus_if, (unsigned char *)&bcdc->msg,

				      len);

		if (ret < 0)

			break;

	} while (CDC_DCMD_ID(le32_to_cpu(prot->msg.flags)) != id);

	} while (CDC_DCMD_ID(le32_to_cpu(bcdc->msg.flags)) != id);



	return ret;

}



int

brcmf_proto_cdc_query_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd,

static int

brcmf_proto_bcdc_query_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd,

			    void *buf, uint len)

{

	struct brcmf_proto *prot = drvr->prot;

	struct brcmf_proto_cdc_dcmd *msg = &prot->msg;

	struct brcmf_bcdc *bcdc = (struct brcmf_bcdc *)drvr->proto->pd;

	struct brcmf_proto_cdc_dcmd *msg = &bcdc->msg;

	void *info;

	int ret = 0, retries = 0;

	u32 id, flags;
@@ -163,13 +165,13 @@ brcmf_proto_cdc_query_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd, 


	msg->cmd = cpu_to_le32(cmd);

	msg->len = cpu_to_le32(len);

	flags = (++prot->reqid << CDC_DCMD_ID_SHIFT);

	flags = (++bcdc->reqid << CDC_DCMD_ID_SHIFT);

	flags = (flags & ~CDC_DCMD_IF_MASK) |

		(ifidx << CDC_DCMD_IF_SHIFT);

	msg->flags = cpu_to_le32(flags);



	if (buf)

		memcpy(prot->buf, buf, len);

		memcpy(bcdc->buf, buf, len);



	ret = brcmf_proto_cdc_msg(drvr);

	if (ret < 0) {
@@ -180,18 +182,18 @@ brcmf_proto_cdc_query_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd, 


retry:

	/* wait for interrupt and get first fragment */

	ret = brcmf_proto_cdc_cmplt(drvr, prot->reqid, len);

	ret = brcmf_proto_cdc_cmplt(drvr, bcdc->reqid, len);

	if (ret < 0)

		goto done;



	flags = le32_to_cpu(msg->flags);

	id = (flags & CDC_DCMD_ID_MASK) >> CDC_DCMD_ID_SHIFT;



	if ((id < prot->reqid) && (++retries < RETRIES))

	if ((id < bcdc->reqid) && (++retries < RETRIES))

		goto retry;

	if (id != prot->reqid) {

	if (id != bcdc->reqid) {

		brcmf_err("%s: unexpected request id %d (expected %d)\n",

			  brcmf_ifname(drvr, ifidx), id, prot->reqid);

			  brcmf_ifname(drvr, ifidx), id, bcdc->reqid);

		ret = -EINVAL;

		goto done;

	}
@@ -214,11 +216,12 @@ done: 
	return ret;

}



int brcmf_proto_cdc_set_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd,

static int

brcmf_proto_bcdc_set_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd,

			  void *buf, uint len)

{

	struct brcmf_proto *prot = drvr->prot;

	struct brcmf_proto_cdc_dcmd *msg = &prot->msg;

	struct brcmf_bcdc *bcdc = (struct brcmf_bcdc *)drvr->proto->pd;

	struct brcmf_proto_cdc_dcmd *msg = &bcdc->msg;

	int ret = 0;

	u32 flags, id;
@@ -228,28 +231,28 @@ int brcmf_proto_cdc_set_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd, 


	msg->cmd = cpu_to_le32(cmd);

	msg->len = cpu_to_le32(len);

	flags = (++prot->reqid << CDC_DCMD_ID_SHIFT) | CDC_DCMD_SET;

	flags = (++bcdc->reqid << CDC_DCMD_ID_SHIFT) | CDC_DCMD_SET;

	flags = (flags & ~CDC_DCMD_IF_MASK) |

		(ifidx << CDC_DCMD_IF_SHIFT);

	msg->flags = cpu_to_le32(flags);



	if (buf)

		memcpy(prot->buf, buf, len);

		memcpy(bcdc->buf, buf, len);



	ret = brcmf_proto_cdc_msg(drvr);

	if (ret < 0)

		goto done;



	ret = brcmf_proto_cdc_cmplt(drvr, prot->reqid, len);

	ret = brcmf_proto_cdc_cmplt(drvr, bcdc->reqid, len);

	if (ret < 0)

		goto done;



	flags = le32_to_cpu(msg->flags);

	id = (flags & CDC_DCMD_ID_MASK) >> CDC_DCMD_ID_SHIFT;



	if (id != prot->reqid) {

	if (id != bcdc->reqid) {

		brcmf_err("%s: unexpected request id %d (expected %d)\n",

			  brcmf_ifname(drvr, ifidx), id, prot->reqid);

			  brcmf_ifname(drvr, ifidx), id, bcdc->reqid);

		ret = -EINVAL;

		goto done;

	}
@@ -272,7 +275,8 @@ static void pkt_set_sum_good(struct sk_buff *skb, bool x) 
	skb->ip_summed = (x ? CHECKSUM_UNNECESSARY : CHECKSUM_NONE);

}



void brcmf_proto_hdrpush(struct brcmf_pub *drvr, int ifidx, u8 offset,

static void

brcmf_proto_bcdc_hdrpush(struct brcmf_pub *drvr, int ifidx, u8 offset,

			 struct sk_buff *pktbuf)

{

	struct brcmf_proto_bdc_header *h;
@@ -295,7 +299,8 @@ void brcmf_proto_hdrpush(struct brcmf_pub *drvr, int ifidx, u8 offset, 
	trace_brcmf_bdchdr(pktbuf->data);

}



int brcmf_proto_hdrpull(struct brcmf_pub *drvr, bool do_fws, u8 *ifidx,

static int

brcmf_proto_bcdc_hdrpull(struct brcmf_pub *drvr, bool do_fws, u8 *ifidx,

			 struct sk_buff *pktbuf)

{

	struct brcmf_proto_bdc_header *h;
@@ -353,34 +358,38 @@ int brcmf_proto_hdrpull(struct brcmf_pub *drvr, bool do_fws, u8 *ifidx, 
	return 0;

}



int brcmf_proto_attach(struct brcmf_pub *drvr)

int brcmf_proto_bcdc_attach(struct brcmf_pub *drvr)

{

	struct brcmf_proto *cdc;

	struct brcmf_bcdc *bcdc;



	cdc = kzalloc(sizeof(struct brcmf_proto), GFP_ATOMIC);

	if (!cdc)

	bcdc = kzalloc(sizeof(*bcdc), GFP_ATOMIC);

	if (!bcdc)

		goto fail;



	/* ensure that the msg buf directly follows the cdc msg struct */

	if ((unsigned long)(&cdc->msg + 1) != (unsigned long)cdc->buf) {

		brcmf_err("struct brcmf_proto is not correctly defined\n");

	if ((unsigned long)(&bcdc->msg + 1) != (unsigned long)bcdc->buf) {

		brcmf_err("struct brcmf_proto_bcdc is not correctly defined\n");

		goto fail;

	}



	drvr->prot = cdc;

	drvr->proto->hdrpush = brcmf_proto_bcdc_hdrpush;

	drvr->proto->hdrpull = brcmf_proto_bcdc_hdrpull;

	drvr->proto->query_dcmd = brcmf_proto_bcdc_query_dcmd;

	drvr->proto->set_dcmd = brcmf_proto_bcdc_set_dcmd;

	drvr->proto->pd = bcdc;



	drvr->hdrlen += BDC_HEADER_LEN + BRCMF_PROT_FW_SIGNAL_MAX_TXBYTES;

	drvr->bus_if->maxctl = BRCMF_DCMD_MAXLEN +

			sizeof(struct brcmf_proto_cdc_dcmd) + ROUND_UP_MARGIN;

	return 0;



fail:

	kfree(cdc);

	kfree(bcdc);

	return -ENOMEM;

}



/* ~NOTE~ What if another thread is waiting on the semaphore?  Holding it? */

void brcmf_proto_detach(struct brcmf_pub *drvr)

void brcmf_proto_bcdc_detach(struct brcmf_pub *drvr)

{

	kfree(drvr->prot);

	drvr->prot = NULL;

	kfree(drvr->proto->pd);

	drvr->proto->pd = NULL;

}

drivers/net/wireless/brcm80211/brcmfmac/bcdc.h

0 → 100644
+24 −0
Original line number Diff line number Diff line 
/*

 * Copyright (c) 2013 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.

 */

#ifndef BRCMFMAC_BCDC_H

#define BRCMFMAC_BCDC_H





int brcmf_proto_bcdc_attach(struct brcmf_pub *drvr);

void brcmf_proto_bcdc_detach(struct brcmf_pub *drvr);





#endif /* BRCMFMAC_BCDC_H */

drivers/net/wireless/brcm80211/brcmfmac/dhd.h

+1 −23
Original line number Diff line number Diff line
@@ -535,7 +535,7 @@ struct brcmf_fws_info; /* firmware signalling info */ 
struct brcmf_pub {

	/* Linkage ponters */

	struct brcmf_bus *bus_if;

	struct brcmf_proto *prot;

	struct brcmf_proto *proto;

	struct brcmf_cfg80211_info *config;



	/* Internal brcmf items */
@@ -635,28 +635,6 @@ int brcmf_netdev_wait_pend8021x(struct net_device *ndev); 
/* Return pointer to interface name */

char *brcmf_ifname(struct brcmf_pub *drvr, int idx);



/* Linkage, sets prot link and updates hdrlen in pub */

int brcmf_proto_attach(struct brcmf_pub *drvr);



/* Unlink, frees allocated protocol memory (including brcmf_proto) */

void brcmf_proto_detach(struct brcmf_pub *drvr);



/* Add any protocol-specific data header.

 * Caller must reserve prot_hdrlen prepend space.

 */

void brcmf_proto_hdrpush(struct brcmf_pub *, int ifidx, u8 offset,

			 struct sk_buff *txp);



/* Query dongle */

int brcmf_proto_cdc_query_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd,

			       void *buf, uint len);

int brcmf_proto_cdc_set_dcmd(struct brcmf_pub *drvr, int ifidx, uint cmd,

			     void *buf, uint len);



/* Remove any protocol-specific data header. */

int brcmf_proto_hdrpull(struct brcmf_pub *drvr, bool do_fws, u8 *ifidx,

			struct sk_buff *rxp);



int brcmf_net_attach(struct brcmf_if *ifp, bool rtnl_locked);

struct brcmf_if *brcmf_add_if(struct brcmf_pub *drvr, s32 bssidx, s32 ifidx,

			      char *name, u8 *mac_addr);

drivers/net/wireless/brcm80211/brcmfmac/dhd_linux.c

+2 −2
Original line number Diff line number Diff line
@@ -30,6 +30,7 @@ 
#include "wl_cfg80211.h"

#include "fwil.h"

#include "fwsignal.h"

#include "proto.h"



MODULE_AUTHOR("Broadcom Corporation");

MODULE_DESCRIPTION("Broadcom 802.11 wireless LAN fullmac driver.");
@@ -1040,7 +1041,6 @@ void brcmf_detach(struct device *dev) 


	brcmf_bus_detach(drvr);



	if (drvr->prot)

	brcmf_proto_detach(drvr);



	brcmf_fws_deinit(drvr);

CRA Git | Maintained and supported by SUSTech CRA and CCSE