9front - general discussion about 9front
 help / color / mirror / Atom feed
From: Stanley Lieber <sl@stanleylieber.com>
To: 9front@9front.org
Subject: [9front] Re: Fwd: [9front-commits] bcm: add wifi driver (keegan@undefinedbehaviour.org)
Date: Sun, 22 Oct 2023 14:45:07 -0400	[thread overview]
Message-ID: <E6C8CA63-C7E0-4B46-8365-C77704004F97@stanleylieber.com> (raw)
In-Reply-To: <4C53B52B-3A22-46DF-8CE1-80BD3543F6EF@stanleylieber.com>

On October 22, 2023 2:43:42 PM EDT, Stanley Lieber <sl@stanleylieber.com> wrote:
>this is for rpi, yes? is there a list of specific hardware this is known to work with?
>
>sl
>
>
>-------- Original Message --------
>From: commits@git.9front.org
>Sent: October 22, 2023 10:53:02 AM EDT
>To: 9front-commits@9front.org
>Subject: [9front-commits] bcm: add wifi driver (keegan@undefinedbehaviour.org)
>
>
>Thanks Richard Miller
>---
>diff f2cfee358f329519e913a20142d96b1e0029633c fb96a050f8a9d5f23da3557ba89251ffb73889bf
>--- a/sys/src/9/bcm/emmc.c	Sun Oct 22 09:21:23 2023
>+++ b/sys/src/9/bcm/emmc.c	Sun Oct 22 10:53:02 2023
>@@ -129,6 +129,7 @@
> 
> typedef struct Ctlr Ctlr;
> struct Ctlr {
>+	Rendez	cardr;
> 	Rendez	r;
> 	int	fastclock;
> 	ulong	extclk;
>@@ -266,6 +267,23 @@
> 	intrenable(IRQmmc, emmcinterrupt, nil, BUSUNKNOWN, io->name);
> }
> 
>+int
>+sdiocardintr(int wait)
>+{
>+	u32int *r = (u32int*)EMMCREGS;
>+	int i;
>+
>+	WR(Interrupt, Cardintr);
>+	while(((i = r[Interrupt]) & Cardintr) == 0){
>+		if(!wait)
>+			return 0;
>+		WR(Irpten, r[Irpten] | Cardintr);
>+		sleep(&emmc.cardr, cardintready, 0);
>+	}
>+	WR(Interrupt, Cardintr);
>+	return i;
>+}
>+
> static int
> emmccmd(SDio*, SDiocmd *cmd, u32int arg, u32int *resp)
> {
>@@ -434,21 +452,25 @@
> 	i = r[Interrupt];
> 	if(i&(Datadone|Err))
> 		wakeup(&emmc.r);
>+	if(i&Cardintr)
>+		wakeup(&emmc.cardr);
> 	WR(Irpten, r[Irpten] & ~i);
> }
> 
>+
>+SDio sdio = {
>+	"emmc",
>+	emmcinit,
>+	emmcenable,
>+	emmcinquiry,
>+	emmccmd,
>+	emmciosetup,
>+	emmcio,
>+	emmcbus,
>+};
>+
> void
> emmclink(void)
> {
>-	static SDio io = {
>-		"emmc",
>-		emmcinit,
>-		emmcenable,
>-		emmcinquiry,
>-		emmccmd,
>-		emmciosetup,
>-		emmcio,
>-		emmcbus,
>-	};
>-	addmmcio(&io);
>+	addmmcio(&sdio);
> }
>--- /dev/null	Sun Aug 27 23:09:05 2023
>+++ b/sys/src/9/bcm/ether4330.c	Sun Oct 22 10:53:02 2023
>@@ -0,0 +1,2411 @@
>+/*
>+ * Broadcom bcm4330 wifi (sdio interface)
>+ */
>+
>+#include "u.h"
>+#include "../port/lib.h"
>+#include "mem.h"
>+#include "dat.h"
>+#include "fns.h"
>+#include "io.h"
>+#include "../port/error.h"
>+#include "../port/netif.h"
>+#include "../port/sd.h"
>+#include "../port/etherif.h"
>+
>+#define CACHELINESZ 64	/* temp */
>+
>+extern SDio	sdio;
>+extern int	sdiocardintr(int);
>+
>+SDiocmd IO_SEND_OP_COND	= {  5, 3, 0, 0, "IO_SEND_OP_COND" };
>+SDiocmd IO_RW_DIRECT	= { 52, 1, 0, 0, "IO_RW_DIRECT" };
>+
>+enum{
>+	SDIODEBUG = 0,
>+	SBDEBUG = 0,
>+	EVENTDEBUG = 0,
>+	VARDEBUG = 0,
>+	FWDEBUG  = 0,
>+
>+	Corescansz = 512,
>+	Uploadsz = 2048,
>+	Sdpcmsz = 12,	/* sizeof(Sdpcmsz) */
>+	Cmdsz = 16,	/* sizeof(Cmd) */
>+
>+	SDfreq = 25*Mhz,	/* standard SD frequency */
>+	SDfreqhs = 50*Mhz,	/* high speed frequency */
>+
>+	Wifichan = 0,		/* default channel */
>+	Firmwarecmp	= 1,
>+
>+	ARMcm3		= 0x82A,
>+	ARM7tdmi	= 0x825,
>+	ARMcr4		= 0x83E,
>+
>+	Fn0	= 0,
>+	Fn1 	= 1,
>+	Fn2	= 2,
>+	Fbr1	= 0x100,
>+	Fbr2	= 0x200,
>+
>+	/* CCCR */
>+	Ioenable	= 0x02,
>+	Ioready		= 0x03,
>+	Intenable	= 0x04,
>+	Intpend		= 0x05,
>+	Ioabort		= 0x06,
>+	Busifc		= 0x07,
>+	Capability	= 0x08,
>+	Blksize		= 0x10,
>+	Highspeed	= 0x13,
>+
>+	/* SELECT_CARD args */
>+	Rcashift	= 16,
>+
>+	/* SEND_OP_COND args */
>+	Hcs	= 1<<30,	/* host supports SDHC & SDXC */
>+	V3_3	= 3<<20,	/* 3.2-3.4 volts */
>+	V2_8	= 3<<15,	/* 2.7-2.9 volts */
>+	V2_0	= 1<<8,		/* 2.0-2.1 volts */
>+	S18R	= 1<<24,	/* switch to 1.8V request */
>+
>+	/* Sonics Silicon Backplane (access to cores on chip) */
>+	Sbwsize	= 0x8000,
>+	Sb32bit	= 0x8000,
>+	Sbaddr	= 0x1000a,
>+		Enumbase	= 	0x18000000,
>+	Framectl= 0x1000d,
>+		Rfhalt		=	0x01,
>+		Wfhalt		=	0x02,
>+	Clkcsr	= 0x1000e,
>+		ForceALP	=	0x01,	/* active low-power clock */
>+		ForceHT		= 	0x02,	/* high throughput clock */
>+		ForceILP	=	0x04,	/* idle low-power clock */
>+		ReqALP		=	0x08,
>+		ReqHT		=	0x10,
>+		Nohwreq		=	0x20,
>+		ALPavail	=	0x40,
>+		HTavail		=	0x80,
>+	Pullups	= 0x1000f,
>+	Wfrmcnt	= 0x10019,
>+	Rfrmcnt	= 0x1001b,
>+		
>+	/* core control regs */
>+	Ioctrl		= 0x408,
>+	Resetctrl	= 0x800,
>+
>+	/* socram regs */
>+	Coreinfo	= 0x00,
>+	Bankidx		= 0x10,
>+	Bankinfo	= 0x40,
>+	Bankpda		= 0x44,
>+
>+	/* armcr4 regs */
>+	Cr4Cap		= 0x04,
>+	Cr4Bankidx	= 0x40,
>+	Cr4Bankinfo	= 0x44,
>+	Cr4Cpuhalt	= 0x20,
>+
>+	/* chipcommon regs */
>+	Gpiopullup	= 0x58,
>+	Gpiopulldown	= 0x5c,
>+	Chipctladdr	= 0x650,
>+	Chipctldata	= 0x654,
>+
>+	/* sdio core regs */
>+	Intstatus	= 0x20,
>+		Fcstate		= 1<<4,
>+		Fcchange	= 1<<5,
>+		FrameInt	= 1<<6,
>+		MailboxInt	= 1<<7,
>+	Intmask		= 0x24,
>+	Sbmbox		= 0x40,
>+	Sbmboxdata	= 0x48,
>+	Hostmboxdata= 0x4c,
>+		Fwready		= 0x80,
>+
>+	/* wifi control commands */
>+	GetVar	= 262,
>+	SetVar	= 263,
>+
>+	/* status */
>+	Disconnected=	0,
>+	Connecting,
>+	Connected,
>+};
>+
>+typedef struct Ctlr Ctlr;
>+
>+enum{
>+	Wpa		= 1,
>+	Wep		= 2,
>+	Wpa2		= 3,
>+	WNameLen	= 32,
>+	WNKeys		= 4,
>+	WKeyLen		= 32,
>+	WMinKeyLen	= 5,
>+	WMaxKeyLen	= 13,
>+};
>+
>+typedef struct WKey WKey;
>+struct WKey
>+{
>+	ushort	len;
>+	char	dat[WKeyLen];
>+};
>+
>+struct Ctlr {
>+	Ether*	edev;
>+	QLock	cmdlock;
>+	QLock	pktlock;
>+	QLock	tlock;
>+	QLock	alock;
>+	Lock	txwinlock;
>+	Rendez	cmdr;
>+	Rendez	joinr;
>+	int	joinstatus;
>+	int	cryptotype;
>+	int	chanid;
>+	char	essid[WNameLen + 1];
>+	WKey	keys[WNKeys];
>+	Block	*rsp;
>+	Block	*scanb;
>+	int	scansecs;
>+	int	status;
>+	int	chipid;
>+	int	chiprev;
>+	int	armcore;
>+	char	*regufile;
>+	union {
>+		u32int i;
>+		uchar c[4];
>+	} resetvec;
>+	ulong	chipcommon;
>+	ulong	armctl;
>+	ulong	armregs;
>+	ulong	d11ctl;
>+	ulong	socramregs;
>+	ulong	socramctl;
>+	ulong	sdregs;
>+	int	sdiorev;
>+	int	socramrev;
>+	ulong	socramsize;
>+	ulong	rambase;
>+	short	reqid;
>+	uchar	fcmask;
>+	uchar	txwindow;
>+	uchar	txseq;
>+	uchar	rxseq;
>+};
>+
>+enum{
>+	CMauth,
>+	CMchannel,
>+	CMcrypt,
>+	CMessid,
>+	CMkey1,
>+	CMkey2,
>+	CMkey3,
>+	CMkey4,
>+	CMrxkey,
>+	CMrxkey0,
>+	CMrxkey1,
>+	CMrxkey2,
>+	CMrxkey3,
>+	CMtxkey,
>+	CMdebug,
>+	CMjoin,
>+};
>+
>+static Cmdtab cmds[] = {
>+	{CMauth,	"auth", 2},
>+	{CMchannel,	"channel", 2},
>+	{CMcrypt,	"crypt", 2},
>+	{CMessid,	"essid", 2},
>+	{CMkey1,	"key1",	2},
>+	{CMkey2,	"key1",	2},
>+	{CMkey3,	"key1",	2},
>+	{CMkey4,	"key1",	2},
>+	{CMrxkey,	"rxkey", 3},
>+	{CMrxkey0,	"rxkey0", 3},
>+	{CMrxkey1,	"rxkey1", 3},
>+	{CMrxkey2,	"rxkey2", 3},
>+	{CMrxkey3,	"rxkey3", 3},
>+	{CMtxkey,	"txkey", 3},
>+	{CMdebug,	"debug", 2},
>+	{CMjoin,	"join", 5},
>+};
>+
>+typedef struct Sdpcm Sdpcm;
>+typedef struct Cmd Cmd;
>+struct Sdpcm {
>+	uchar	len[2];
>+	uchar	lenck[2];
>+	uchar	seq;
>+	uchar	chanflg;
>+	uchar	nextlen;
>+	uchar	doffset;
>+	uchar	fcmask;
>+	uchar	window;
>+	uchar	version;
>+	uchar	pad;
>+};
>+
>+struct Cmd {
>+	uchar	cmd[4];
>+	uchar	len[4];
>+	uchar	flags[2];
>+	uchar	id[2];
>+	uchar	status[4];
>+};
>+
>+static char config40181[] = "bcmdhd.cal.40181";
>+static char config40183[] = "bcmdhd.cal.40183.26MHz";
>+
>+struct {
>+	int chipid;
>+	int chiprev;
>+	char *fwfile;
>+	char *cfgfile;
>+	char *regufile;
>+} firmware[] = {
>+	{ 0x4330, 3,	"fw_bcm40183b1.bin", config40183, 0 },
>+	{ 0x4330, 4,	"fw_bcm40183b2.bin", config40183, 0 },
>+	{ 43362, 0,	"fw_bcm40181a0.bin", config40181, 0 },
>+	{ 43362, 1,	"fw_bcm40181a2.bin", config40181, 0 },
>+	{ 43430, 1,	"brcmfmac43430-sdio.bin", "brcmfmac43430-sdio.txt", 0 },
>+	{ 43430, 2,	"brcmfmac43436-sdio.bin", "brcmfmac43436-sdio.txt",  "brcmfmac43436-sdio.clm_blob" },
>+	{ 0x4345, 6, "brcmfmac43455-sdio.bin", "brcmfmac43455-sdio.txt", "brcmfmac43455-sdio.clm_blob" },
>+	{ 0x4345, 9, "brcmfmac43456-sdio.bin", "brcmfmac43456-sdio.txt", "brcmfmac43456-sdio.clm_blob" },
>+};
>+
>+static QLock sdiolock;
>+static int iodebug;
>+
>+static void etherbcmintr(void *);
>+static void bcmevent(Ctlr*, uchar*, int);
>+static void wlscanresult(Ether*, uchar*, int);
>+static void wlsetvar(Ctlr*, char*, void*, int);
>+
>+static uchar*
>+put2(uchar *p, short v)
>+{
>+	p[0] = v;
>+	p[1] = v >> 8;
>+	return p + 2;
>+}
>+
>+static uchar*
>+put4(uchar *p, long v)
>+{
>+	p[0] = v;
>+	p[1] = v >> 8;
>+	p[2] = v >> 16;
>+	p[3] = v >> 24;
>+	return p + 4;
>+}
>+
>+static ushort
>+get2(uchar *p)
>+{
>+	return p[0] | p[1]<<8;
>+}
>+
>+static ulong
>+get4(uchar *p)
>+{
>+	return p[0] | p[1]<<8 | p[2]<<16 | p[3]<<24;
>+}
>+
>+static void
>+dump(char *s, void *a, int n)
>+{
>+	int i;
>+	uchar *p;
>+
>+	p = a;
>+	print("%s:", s);
>+	for(i = 0; i < n; i++)
>+		print("%c%2.2x", i&15? ' ' : '\n', *p++);
>+	print("\n");
>+}
>+
>+/*
>+ * SDIO communication with dongle
>+ */
>+static ulong
>+sdiocmd_locked(SDiocmd *cmd, ulong arg)
>+{
>+	u32int resp[4];
>+
>+	sdio.cmd(&sdio, cmd, arg, resp);
>+	return resp[0];
>+}
>+
>+static ulong
>+sdiocmd(SDiocmd *cmd, ulong arg)
>+{
>+	ulong r;
>+
>+	qlock(&sdiolock);
>+	if(waserror()){
>+		if(SDIODEBUG) print("sdiocmd error: cmd %s arg %lux\n", cmd->name, arg);
>+		qunlock(&sdiolock);
>+		nexterror();
>+	}
>+	r = sdiocmd_locked(cmd, arg);
>+	qunlock(&sdiolock);
>+	poperror();
>+	return r;
>+
>+}
>+
>+static ulong
>+trysdiocmd(SDiocmd *cmd, ulong arg)
>+{
>+	ulong r;
>+
>+	if(waserror())
>+		return 0;
>+	r = sdiocmd(cmd, arg);
>+	poperror();
>+	return r;
>+}
>+
>+static int
>+sdiord(int fn, int addr)
>+{
>+	int r;
>+
>+	r = sdiocmd(&IO_RW_DIRECT, (0<<31)|((fn&7)<<28)|((addr&0x1FFFF)<<9));
>+	if(r & 0xCF00){
>+		print("ether4330: sdiord(%x, %x) fail: %2.2ux %2.2ux\n", fn, addr, (r>>8)&0xFF, r&0xFF);
>+		error(Eio);
>+	}
>+	return r & 0xFF;
>+}
>+
>+static void
>+sdiowr(int fn, int addr, int data)
>+{
>+	int r;
>+	int retry;
>+	ulong arg;
>+
>+	r = 0;
>+	for(retry = 0; retry < 10; retry++){
>+		arg = (1<<31)|((fn&7)<<28)|((addr&0x1FFFF)<<9)|(data&0xFF);
>+		if((arg & ~0xFF) == (1<<31|0<<28|7<<9)){
>+			switch(arg&3){
>+			case 0:
>+				sdio.bus(&sdio, 1, 0);
>+				break;
>+			case 2:
>+				sdio.bus(&sdio, 4, 0);
>+				break;
>+			}
>+		}
>+		r = sdiocmd(&IO_RW_DIRECT, arg);
>+		if((r & 0xCF00) == 0)
>+			return;
>+	}
>+	print("ether4330: sdiowr(%x, %x, %x) fail: %2.2ux %2.2ux\n", fn, addr, data, (r>>8)&0xFF, r&0xFF);
>+	error(Eio);
>+}
>+
>+static void
>+sdiorwext(int fn, int write, void *a, int len, int addr, int incr)
>+{
>+	int bsize, blk, bcount, m;
>+	SDiocmd cmd = { 53, 1, 0, 0, "IO_RW_EXTENDED" };
>+
>+	bsize = fn == Fn2? 512 : 64;
>+	while(len > 0){
>+		if(len >= 511*bsize){
>+			blk = 1;
>+			bcount = 511;
>+			m = bcount*bsize;
>+		}else if(len > bsize){
>+			blk = 1;
>+			bcount = len/bsize;
>+			m = bcount*bsize;
>+		}else{
>+			blk = 0;
>+			bcount = len;
>+			m = bcount;
>+		}
>+		qlock(&sdiolock);
>+		if(waserror()){
>+			print("ether4330: sdiorwext fail: %s\n", up->errstr);
>+			qunlock(&sdiolock);
>+			nexterror();
>+		}
>+		cmd.data = write? 2 : 1;	/* Host2card : Card2host */
>+		if(blk){
>+			cmd.data += 2;		/* Multiblock | Blkcnten */
>+			sdio.iosetup(&sdio, write, a, bsize, bcount);
>+		}else
>+			sdio.iosetup(&sdio, write, a, bcount, 1);
>+		sdiocmd_locked(&cmd, write<<31 | (fn&7)<<28 | blk<<27 | incr<<26 | (addr&0x1FFFF)<<9 | (bcount&0x1FF));
>+		sdio.io(&sdio, write, a, m);
>+		qunlock(&sdiolock);
>+		poperror();
>+		len -= m;
>+		a = (char*)a + m;
>+		if(incr)
>+			addr += m;
>+	}
>+}
>+
>+static void
>+sdioset(int fn, int addr, int bits)
>+{
>+	sdiowr(fn, addr, sdiord(fn, addr) | bits);
>+}
>+	
>+static void
>+sdioinit(void)
>+{
>+	ulong ocr, rca;
>+	int i;
>+
>+	/* disconnect emmc from SD card (connect sdhost instead) */
>+	for(i = 48; i <= 53; i++)
>+		gpiosel(i, Alt0);
>+	/* connect emmc to wifi */
>+	for(i = 34; i <= 39; i++){
>+		gpiosel(i, Alt3);
>+		if(i == 34)
>+			gpiopulloff(i);
>+		else
>+			gpiopullup(i);
>+	}
>+	sdio.init(&sdio);
>+	sdio.enable(&sdio);
>+	sdiocmd(&GO_IDLE_STATE, 0);
>+	ocr = trysdiocmd(&IO_SEND_OP_COND, 0);
>+	i = 0;
>+	while((ocr & (1<<31)) == 0){
>+		if(++i > 5){
>+			print("ether4330: no response to sdio access: ocr = %lux\n", ocr);
>+			error(Eio);
>+		}
>+		ocr = trysdiocmd(&IO_SEND_OP_COND, V3_3);
>+		tsleep(&up->sleep, return0, nil, 100);
>+	}
>+	rca = sdiocmd(&SEND_RELATIVE_ADDR, 0) >> Rcashift;
>+	sdiocmd(&SELECT_CARD, rca << Rcashift);
>+	sdio.bus(&sdio, 0, SDfreq);
>+	sdioset(Fn0, Highspeed, 2);
>+	sdioset(Fn0, Busifc, 2);	/* bus width 4 */
>+	sdiowr(Fn0, Fbr1+Blksize, 64);
>+	sdiowr(Fn0, Fbr1+Blksize+1, 64>>8);
>+	sdiowr(Fn0, Fbr2+Blksize, 512);
>+	sdiowr(Fn0, Fbr2+Blksize+1, 512>>8);
>+	sdioset(Fn0, Ioenable, 1<<Fn1);
>+	sdiowr(Fn0, Intenable, 0);
>+	for(i = 0; !(sdiord(Fn0, Ioready) & 1<<Fn1); i++){
>+		if(i == 10){
>+			print("ether4330: can't enable SDIO function\n");
>+			error(Eio);
>+		}
>+		tsleep(&up->sleep, return0, nil, 100);
>+	}
>+}
>+
>+static void
>+sdioreset(void)
>+{
>+	sdiowr(Fn0, Ioabort, 1<<3);	/* reset */
>+}
>+
>+static void
>+sdioabort(int fn)
>+{
>+	sdiowr(Fn0, Ioabort, fn);
>+}
>+
>+/*
>+ * Chip register and memory access via SDIO
>+ */
>+
>+static void
>+cfgw(ulong off, int val)
>+{
>+	sdiowr(Fn1, off, val);
>+}
>+
>+static int
>+cfgr(ulong off)
>+{
>+	return sdiord(Fn1, off);
>+}
>+
>+static ulong
>+cfgreadl(int fn, ulong off)
>+{
>+	uchar cbuf[2*CACHELINESZ];
>+	uchar *p;
>+
>+	p = (uchar*)ROUND((uintptr)cbuf, CACHELINESZ);
>+	memset(p, 0, 4);
>+	sdiorwext(fn, 0, p, 4, off|Sb32bit, 1);
>+	if(SDIODEBUG) print("cfgreadl %lux: %2.2x %2.2x %2.2x %2.2x\n", off, p[0], p[1], p[2], p[3]);
>+	return p[0] | p[1]<<8 | p[2]<<16 | p[3]<<24;
>+}
>+
>+static void
>+cfgwritel(int fn, ulong off, u32int data)
>+{
>+	uchar cbuf[2*CACHELINESZ];
>+	uchar *p;
>+	int retry;
>+
>+	p = (uchar*)ROUND((uintptr)cbuf, CACHELINESZ);
>+	put4(p, data);
>+	if(SDIODEBUG) print("cfgwritel %lux: %2.2x %2.2x %2.2x %2.2x\n", off, p[0], p[1], p[2], p[3]);
>+	retry = 0;
>+	while(waserror()){
>+		print("ether4330: cfgwritel retry %lux %ux\n", off, data);
>+		sdioabort(fn);
>+		if(++retry == 3)
>+			nexterror();
>+	}
>+	sdiorwext(fn, 1, p, 4, off|Sb32bit, 1);
>+	poperror();
>+}
>+
>+static void
>+sbwindow(ulong addr)
>+{
>+	addr &= ~(Sbwsize-1);
>+	cfgw(Sbaddr, addr>>8);
>+	cfgw(Sbaddr+1, addr>>16);
>+	cfgw(Sbaddr+2, addr>>24);
>+}
>+
>+static void
>+sbrw(int fn, int write, uchar *buf, int len, ulong off)
>+{
>+	int n;
>+	USED(fn);
>+
>+	if(waserror()){
>+		print("ether4330: sbrw err off %lux len %ud\n", off, len);
>+		nexterror();
>+	}
>+	if(write){
>+		if(len >= 4){
>+			n = len;
>+			n &= ~3;
>+			sdiorwext(Fn1, write, buf, n, off|Sb32bit, 1);
>+			off += n;
>+			buf += n;
>+			len -= n;
>+		}
>+		while(len > 0){
>+			sdiowr(Fn1, off|Sb32bit, *buf);
>+			off++;
>+			buf++;
>+			len--;
>+		}
>+	}else{
>+		if(len >= 4){
>+			n = len;
>+			n &= ~3;
>+			sdiorwext(Fn1, write, buf, n, off|Sb32bit, 1);
>+			off += n;
>+			buf += n;
>+			len -= n;
>+		}
>+		while(len > 0){
>+			*buf = sdiord(Fn1, off|Sb32bit);
>+			off++;
>+			buf++;
>+			len--;
>+		}
>+	}
>+	poperror();
>+}
>+
>+static void
>+sbmem(int write, uchar *buf, int len, ulong off)
>+{
>+	ulong n;
>+
>+	n = ROUNDUP(off, Sbwsize) - off;
>+	if(n == 0)
>+		n = Sbwsize;
>+	while(len > 0){
>+		if(n > len)
>+			n = len;
>+		sbwindow(off);
>+		sbrw(Fn1, write, buf, n, off & (Sbwsize-1));
>+		off += n;
>+		buf += n;
>+		len -= n;
>+		n = Sbwsize;
>+	}
>+}
>+
>+static void
>+packetrw(int write, uchar *buf, int len)
>+{
>+	int n;
>+	int retry;
>+
>+	n = 2048;
>+	while(len > 0){
>+		if(n > len)
>+			n = ROUND(len, 4);
>+		retry = 0;
>+		while(waserror()){
>+			sdioabort(Fn2);
>+			if(++retry == 3)
>+				nexterror();
>+		}
>+		sdiorwext(Fn2, write, buf, n, Enumbase, 0);
>+		poperror();
>+		buf += n;
>+		len -= n;
>+	}
>+}
>+
>+/*
>+ * Configuration and control of chip cores via Silicon Backplane
>+ */
>+
>+static void
>+sbdisable(ulong regs, int pre, int ioctl)
>+{
>+	sbwindow(regs);
>+	if((cfgreadl(Fn1, regs + Resetctrl) & 1) != 0){
>+		cfgwritel(Fn1, regs + Ioctrl, 3|ioctl);
>+		cfgreadl(Fn1, regs + Ioctrl);
>+		return;
>+	}
>+	cfgwritel(Fn1, regs + Ioctrl, 3|pre);
>+	cfgreadl(Fn1, regs + Ioctrl);
>+	cfgwritel(Fn1, regs + Resetctrl, 1);
>+	microdelay(10);
>+	while((cfgreadl(Fn1, regs + Resetctrl) & 1) == 0)
>+		;
>+	cfgwritel(Fn1, regs + Ioctrl, 3|ioctl);
>+	cfgreadl(Fn1, regs + Ioctrl);
>+}
>+
>+static void
>+sbreset(ulong regs, int pre, int ioctl)
>+{
>+	sbdisable(regs, pre, ioctl);
>+	sbwindow(regs);
>+	if(SBDEBUG) print("sbreset %#lux %#lux %#lux ->", regs,
>+		cfgreadl(Fn1, regs+Ioctrl), cfgreadl(Fn1, regs+Resetctrl));
>+	while((cfgreadl(Fn1, regs + Resetctrl) & 1) != 0){
>+		cfgwritel(Fn1, regs + Resetctrl, 0);
>+		microdelay(40);
>+	}
>+	cfgwritel(Fn1, regs + Ioctrl, 1|ioctl);
>+	cfgreadl(Fn1, regs + Ioctrl);
>+	if(SBDEBUG) print("%#lux %#lux\n",
>+		cfgreadl(Fn1, regs+Ioctrl), cfgreadl(Fn1, regs+Resetctrl));
>+}
>+
>+static void
>+corescan(Ctlr *ctl, ulong r)
>+{
>+	uchar *buf;
>+	int i, coreid, corerev;
>+	ulong addr;
>+
>+	buf = sdmalloc(Corescansz);
>+	if(buf == nil)
>+		error(Enomem);
>+	sbmem(0, buf, Corescansz, r);
>+	coreid = 0;
>+	corerev = 0;
>+	for(i = 0; i < Corescansz; i += 4){
>+		switch(buf[i]&0xF){
>+		case 0xF:	/* end */
>+			sdfree(buf);
>+			return;
>+		case 0x1:	/* core info */
>+			if((buf[i+4]&0xF) != 0x1)
>+				break;
>+			coreid = (buf[i+1] | buf[i+2]<<8) & 0xFFF;
>+			i += 4;
>+			corerev = buf[i+3];
>+			break;
>+		case 0x05:	/* address */
>+			addr = buf[i+1]<<8 | buf[i+2]<<16 | buf[i+3]<<24;
>+			addr &= ~0xFFF;
>+			if(SBDEBUG) print("core %x %s %#lux\n", coreid, buf[i]&0xC0? "ctl" : "mem", addr);
>+			switch(coreid){
>+			case 0x800:
>+				if((buf[i] & 0xC0) == 0)
>+					ctl->chipcommon = addr;
>+				break;
>+			case ARMcm3:
>+			case ARM7tdmi:
>+			case ARMcr4:
>+				ctl->armcore = coreid;
>+				if(buf[i] & 0xC0){
>+					if(ctl->armctl == 0)
>+						ctl->armctl = addr;
>+				}else{
>+					if(ctl->armregs == 0)
>+						ctl->armregs = addr;
>+				}
>+				break;
>+			case 0x80E:
>+				if(buf[i] & 0xC0)
>+					ctl->socramctl = addr;
>+				else if(ctl->socramregs == 0)
>+					ctl->socramregs = addr;
>+				ctl->socramrev = corerev;
>+				break;
>+			case 0x829:
>+				if((buf[i] & 0xC0) == 0)
>+					ctl->sdregs = addr;
>+				ctl->sdiorev = corerev;
>+				break;
>+			case 0x812:
>+				if(buf[i] & 0xC0)
>+					ctl->d11ctl = addr;
>+				break;
>+			}
>+		}
>+	}
>+	sdfree(buf);
>+}
>+
>+static void
>+ramscan(Ctlr *ctl)
>+{
>+	ulong r, n, size;
>+	int banks, i;
>+
>+	if(ctl->armcore == ARMcr4){
>+		r = ctl->armregs;
>+		sbwindow(r);
>+		n = cfgreadl(Fn1, r + Cr4Cap);
>+		if(SBDEBUG) print("cr4 banks %lux\n", n);
>+		banks = ((n>>4) & 0xF) + (n & 0xF);
>+		size = 0;
>+		for(i = 0; i < banks; i++){
>+			cfgwritel(Fn1, r + Cr4Bankidx, i);
>+			n = cfgreadl(Fn1, r + Cr4Bankinfo);
>+			if(SBDEBUG) print("bank %d reg %lux size %lud\n", i, n, 8192 * ((n & 0x3F) + 1));
>+			size += 8192 * ((n & 0x3F) + 1);
>+		}
>+		ctl->socramsize = size;
>+		ctl->rambase = 0x198000;
>+		return;
>+	}
>+	if(ctl->socramrev <= 7 || ctl->socramrev == 12){
>+		print("ether4330: SOCRAM rev %d not supported\n", ctl->socramrev);
>+		error(Eio);
>+	}
>+	sbreset(ctl->socramctl, 0, 0);
>+	r = ctl->socramregs;
>+	sbwindow(r);
>+	n = cfgreadl(Fn1, r + Coreinfo);
>+	if(SBDEBUG) print("socramrev %d coreinfo %lux\n", ctl->socramrev, n);
>+	banks = (n>>4) & 0xF;
>+	size = 0;
>+	for(i = 0; i < banks; i++){
>+		cfgwritel(Fn1, r + Bankidx, i);
>+		n = cfgreadl(Fn1, r + Bankinfo);
>+		if(SBDEBUG) print("bank %d reg %lux size %lud\n", i, n, 8192 * ((n & 0x3F) + 1));
>+		size += 8192 * ((n & 0x3F) + 1);
>+	}
>+	ctl->socramsize = size;
>+	ctl->rambase = 0;
>+	if(ctl->chipid == 43430){
>+		cfgwritel(Fn1, r + Bankidx, 3);
>+		cfgwritel(Fn1, r + Bankpda, 0);
>+	}
>+}
>+
>+static void
>+sbinit(Ctlr *ctl)
>+{
>+	ulong r;
>+	int chipid;
>+	char buf[16];
>+
>+	sbwindow(Enumbase);
>+	r = cfgreadl(Fn1, Enumbase);
>+	chipid = r & 0xFFFF;
>+	sprint(buf, chipid > 43000 ? "%d" : "%#x", chipid);
>+	print("ether4330: chip %s rev %ld type %ld\n", buf, (r>>16)&0xF, (r>>28)&0xF);
>+	switch(chipid){
>+		case 0x4330:
>+		case 43362:
>+		case 43430:
>+		case 0x4345:
>+			ctl->chipid = chipid;
>+			ctl->chiprev = (r>>16)&0xF;
>+			break;
>+		default:
>+			print("ether4330: chipid %#x (%d) not supported\n", chipid, chipid);
>+			error(Eio);
>+	}
>+	r = cfgreadl(Fn1, Enumbase + 63*4);
>+	corescan(ctl, r);
>+	if(ctl->armctl == 0 || ctl->d11ctl == 0 ||
>+	   (ctl->armcore == ARMcm3 && (ctl->socramctl == 0 || ctl->socramregs == 0)))
>+		error("corescan didn't find essential cores\n");
>+	if(ctl->armcore == ARMcr4)
>+		sbreset(ctl->armctl, Cr4Cpuhalt, Cr4Cpuhalt);
>+	else	
>+		sbdisable(ctl->armctl, 0, 0);
>+	sbreset(ctl->d11ctl, 8|4, 4);
>+	ramscan(ctl);
>+	if(SBDEBUG) print("ARM %#lux D11 %#lux SOCRAM %#lux,%#lux %lud bytes @ %#lux\n",
>+		ctl->armctl, ctl->d11ctl, ctl->socramctl, ctl->socramregs, ctl->socramsize, ctl->rambase);
>+	cfgw(Clkcsr, 0);
>+	microdelay(10);
>+	if(SBDEBUG) print("chipclk: %x\n", cfgr(Clkcsr));
>+	cfgw(Clkcsr, Nohwreq | ReqALP);
>+	while((cfgr(Clkcsr) & (HTavail|ALPavail)) == 0)
>+		microdelay(10);
>+	cfgw(Clkcsr, Nohwreq | ForceALP);
>+	microdelay(65);
>+	if(SBDEBUG) print("chipclk: %x\n", cfgr(Clkcsr));
>+	cfgw(Pullups, 0);
>+	sbwindow(ctl->chipcommon);
>+	cfgwritel(Fn1, ctl->chipcommon + Gpiopullup, 0);
>+	cfgwritel(Fn1, ctl->chipcommon + Gpiopulldown, 0);
>+	if(ctl->chipid != 0x4330 && ctl->chipid != 43362)
>+		return;
>+	cfgwritel(Fn1, ctl->chipcommon + Chipctladdr, 1);
>+	if(cfgreadl(Fn1, ctl->chipcommon + Chipctladdr) != 1)
>+		print("ether4330: can't set Chipctladdr\n");
>+	else{
>+		r = cfgreadl(Fn1, ctl->chipcommon + Chipctldata);
>+		if(SBDEBUG) print("chipcommon PMU (%lux) %lux", cfgreadl(Fn1, ctl->chipcommon + Chipctladdr), r);
>+		/* set SDIO drive strength >= 6mA */
>+		r &= ~0x3800;
>+		if(ctl->chipid == 0x4330)
>+			r |= 3<<11;
>+		else
>+			r |= 7<<11;
>+		cfgwritel(Fn1, ctl->chipcommon + Chipctldata, r);
>+		if(SBDEBUG) print("-> %lux (= %lux)\n", r, cfgreadl(Fn1, ctl->chipcommon + Chipctldata));
>+	}
>+}
>+
>+static void
>+sbenable(Ctlr *ctl)
>+{
>+	int i;
>+
>+	if(SBDEBUG) print("enabling HT clock...");
>+	cfgw(Clkcsr, 0);
>+	delay(1);
>+	cfgw(Clkcsr, ReqHT);
>+	for(i = 0; (cfgr(Clkcsr) & HTavail) == 0; i++){
>+		if(i == 50){
>+			print("ether4330: can't enable HT clock: csr %x\n", cfgr(Clkcsr));
>+			error(Eio);
>+		}
>+		tsleep(&up->sleep, return0, nil, 100);
>+	}
>+	cfgw(Clkcsr, cfgr(Clkcsr) | ForceHT);
>+	delay(10);
>+	if(SBDEBUG) print("chipclk: %x\n", cfgr(Clkcsr));
>+	sbwindow(ctl->sdregs);
>+	cfgwritel(Fn1, ctl->sdregs + Sbmboxdata, 4 << 16);	/* protocol version */
>+	cfgwritel(Fn1, ctl->sdregs + Intmask, FrameInt | MailboxInt | Fcchange);
>+	sdioset(Fn0, Ioenable, 1<<Fn2);
>+	for(i = 0; !(sdiord(Fn0, Ioready) & 1<<Fn2); i++){
>+		if(i == 10){
>+			print("ether4330: can't enable SDIO function 2 - ioready %x\n", sdiord(Fn0, Ioready));
>+			error(Eio);
>+		}
>+		tsleep(&up->sleep, return0, nil, 100);
>+	}
>+	sdiowr(Fn0, Intenable, (1<<Fn1) | (1<<Fn2) | 1);
>+}
>+
>+
>+/*
>+ * Firmware and config file uploading
>+ */
>+
>+/*
>+ * Condense config file contents (in buffer buf with length n)
>+ * to 'var=value\0' list for firmware:
>+ *	- remove comments (starting with '#') and blank lines
>+ *	- remove carriage returns
>+ *	- convert newlines to nulls
>+ *	- mark end with two nulls
>+ *	- pad with nulls to multiple of 4 bytes total length
>+ */
>+static int
>+condense(uchar *buf, int n)
>+{
>+	uchar *p, *ep, *lp, *op;
>+	int c, skipping;
>+
>+	skipping = 0;	/* true if in a comment */
>+	ep = buf + n;	/* end of input */
>+	op = buf;	/* end of output */
>+	lp = buf;	/* start of current output line */
>+	for(p = buf; p < ep; p++){
>+		switch(c = *p){
>+		case '#':
>+			skipping = 1;
>+			break;
>+		case '\0':
>+		case '\n':
>+			skipping = 0;
>+			if(op != lp){
>+				*op++ = '\0';
>+				lp = op;
>+			}
>+			break;
>+		case '\r':
>+			break;
>+		default:
>+			if(!skipping)
>+				*op++ = c;
>+			break;
>+		}
>+	}
>+	if(!skipping && op != lp)
>+		*op++ = '\0';
>+	*op++ = '\0';
>+	for(n = op - buf; n & 03; n++)
>+		*op++ = '\0';
>+	return n;
>+}
>+
>+/*
>+ * Try to find firmware file in /boot or in /lib/firmware.
>+ * Throw an error if not found.
>+ */
>+static Chan*
>+findfirmware(char *file)
>+{
>+	char nbuf[64];
>+	Chan *c;
>+
>+	if(!waserror()){
>+		snprint(nbuf, sizeof nbuf, "/boot/%s", file);
>+		c = namec(nbuf, Aopen, OREAD, 0);
>+		poperror();
>+	}else if(!waserror()){
>+		snprint(nbuf, sizeof nbuf, "/lib/firmware/%s", file);
>+		c = namec(nbuf, Aopen, OREAD, 0);
>+		poperror();
>+	}else{
>+		c = nil;
>+		snprint(up->genbuf, sizeof up->genbuf, "can't find %s in /boot or /lib/firmware", file);
>+		error(up->genbuf);
>+	}
>+	return c;	
>+}
>+
>+static int
>+upload(Ctlr *ctl, char *file, int isconfig)
>+{
>+	Chan *c;
>+	uchar *buf;
>+	uchar *cbuf;
>+	int off, n;
>+
>+	buf = cbuf = nil;
>+	c = findfirmware(file);
>+	if(waserror()){
>+		cclose(c);
>+		sdfree(buf);
>+		sdfree(cbuf);
>+		nexterror();
>+	}
>+	buf = sdmalloc(Uploadsz);
>+	if(buf == nil)
>+		error(Enomem);
>+	if(Firmwarecmp){
>+		cbuf = sdmalloc(Uploadsz);
>+		if(cbuf == nil)
>+			error(Enomem);
>+	}
>+	off = 0;
>+	for(;;){
>+		n = devtab[c->type]->read(c, buf, Uploadsz, off);
>+		if(n <= 0)
>+			break;
>+		if(isconfig){
>+			n = condense(buf, n);
>+			off = ctl->socramsize - n - 4;
>+		}else if(off == 0)
>+			memmove(ctl->resetvec.c, buf, sizeof(ctl->resetvec.c));
>+		while(n&3)
>+			buf[n++] = 0;
>+		sbmem(1, buf, n, ctl->rambase + off);
>+		if(isconfig)
>+			break;
>+		off += n;
>+	}
>+	if(Firmwarecmp){
>+		if(FWDEBUG) print("compare...");
>+		if(!isconfig)
>+			off = 0;
>+		for(;;){
>+			if(!isconfig){
>+				n = devtab[c->type]->read(c, buf, Uploadsz, off);
>+				if(n <= 0)
>+					break;
>+			while(n&3)
>+				buf[n++] = 0;
>+			}
>+			sbmem(0, cbuf, n, ctl->rambase + off);
>+			if(memcmp(buf, cbuf, n) != 0){
>+				print("ether4330: firmware load failed offset %d\n", off);
>+				error(Eio);
>+			}
>+			if(isconfig)
>+				break;
>+			off += n;
>+		}
>+	}
>+	if(FWDEBUG) print("\n");
>+	poperror();
>+	cclose(c);
>+	sdfree(buf);
>+	sdfree(cbuf);
>+	return n;
>+}
>+
>+/*
>+ * Upload regulatory file (.clm) to firmware.
>+ * Packet format is
>+ *	[2]flag [2]type [4]len [4]crc [len]data
>+ */
>+static void
>+reguload(Ctlr *ctl, char *file)
>+{
>+	Chan *c;
>+	uchar *buf;
>+	int off, n, flag;
>+	enum {
>+		Reguhdr = 2+2+4+4,
>+		Regusz	= 1400,
>+		Regutyp	= 2,
>+		Flagclm	= 1<<12,
>+		Firstpkt= 1<<1,
>+		Lastpkt	= 1<<2,
>+	};
>+
>+	buf = nil;
>+	c = findfirmware(file);
>+	if(waserror()){
>+		cclose(c);
>+		free(buf);
>+		nexterror();
>+	}
>+	buf = malloc(Reguhdr+Regusz+1);
>+	if(buf == nil)
>+		error(Enomem);
>+	put2(buf+2, Regutyp);
>+	put2(buf+8, 0);
>+	off = 0;
>+	flag = Flagclm | Firstpkt;
>+	while((flag&Lastpkt) == 0){
>+		n = devtab[c->type]->read(c, buf+Reguhdr, Regusz+1, off);
>+		if(n <= 0)
>+			break;
>+		if(n == Regusz+1)
>+			--n;
>+		else{
>+			while(n&7)
>+				buf[Reguhdr+n++] = 0;
>+			flag |= Lastpkt;
>+		}
>+		put2(buf+0, flag);
>+		put4(buf+4, n);
>+		wlsetvar(ctl, "clmload", buf, Reguhdr + n);
>+		off += n;
>+		flag &= ~Firstpkt;
>+	}
>+	poperror();
>+	cclose(c);
>+	free(buf);
>+}
>+
>+static void
>+fwload(Ctlr *ctl)
>+{
>+	uchar buf[4];
>+	uint i, n;
>+
>+	i = 0;
>+	while(firmware[i].chipid != ctl->chipid ||
>+		   firmware[i].chiprev != ctl->chiprev){
>+		if(++i == nelem(firmware)){
>+			print("ether4330: no firmware for chipid %x (%d) chiprev %d\n",
>+				ctl->chipid, ctl->chipid, ctl->chiprev);
>+			error("no firmware");
>+		}
>+	}
>+	ctl->regufile = firmware[i].regufile;
>+	cfgw(Clkcsr, ReqALP);
>+	while((cfgr(Clkcsr) & ALPavail) == 0)
>+		microdelay(10);
>+	memset(buf, 0, 4);
>+	sbmem(1, buf, 4, ctl->rambase + ctl->socramsize - 4);
>+	if(FWDEBUG) print("firmware load...");
>+	upload(ctl, firmware[i].fwfile, 0);
>+	if(FWDEBUG) print("config load...");
>+	n = upload(ctl, firmware[i].cfgfile, 1);
>+	n /= 4;
>+	n = (n & 0xFFFF) | (~n << 16);
>+	put4(buf, n);
>+	sbmem(1, buf, 4, ctl->rambase + ctl->socramsize - 4);
>+	if(ctl->armcore == ARMcr4){
>+		sbwindow(ctl->sdregs);
>+		cfgwritel(Fn1, ctl->sdregs + Intstatus, ~0);
>+		if(ctl->resetvec.i != 0){
>+			if(SBDEBUG) print("%ux\n", ctl->resetvec.i);
>+			sbmem(1, ctl->resetvec.c, sizeof(ctl->resetvec.c), 0);
>+		}
>+		sbreset(ctl->armctl, Cr4Cpuhalt, 0);
>+	}else
>+		sbreset(ctl->armctl, 0, 0);
>+}
>+
>+/*
>+ * Communication of data and control packets
>+ */
>+
>+void
>+intwait(Ctlr *ctlr, int wait)
>+{
>+	ulong ints, mbox;
>+	int i;
>+
>+	if(waserror())
>+		return;
>+	for(;;){
>+		sdiocardintr(wait);
>+		sbwindow(ctlr->sdregs);
>+		i = sdiord(Fn0, Intpend);
>+		if(i == 0){
>+			tsleep(&up->sleep, return0, 0, 10);
>+			continue;
>+		}
>+		ints = cfgreadl(Fn1, ctlr->sdregs + Intstatus);
>+		cfgwritel(Fn1, ctlr->sdregs + Intstatus, ints);
>+		if(0) print("INTS: (%x) %lux -> %lux\n", i, ints, cfgreadl(Fn1, ctlr->sdregs + Intstatus));
>+		if(ints & MailboxInt){
>+			mbox = cfgreadl(Fn1, ctlr->sdregs + Hostmboxdata);
>+			cfgwritel(Fn1, ctlr->sdregs + Sbmbox, 2);	/* ack */
>+			if(mbox & 0x8)
>+				print("ether4330: firmware ready\n");
>+		}
>+		if(ints & FrameInt)
>+			break;
>+	}
>+	poperror();
>+}
>+
>+static Block*
>+wlreadpkt(Ctlr *ctl)
>+{
>+	Block *b;
>+	Sdpcm *p;
>+	int len, lenck;
>+
>+	b = allocb(2048);
>+	p = (Sdpcm*)b->wp;
>+	qlock(&ctl->pktlock);
>+	for(;;){
>+		packetrw(0, b->wp, Sdpcmsz);
>+		len = p->len[0] | p->len[1]<<8;
>+		if(len == 0){
>+			freeb(b);
>+			b = nil;
>+			break;
>+		}
>+		lenck = p->lenck[0] | p->lenck[1]<<8;
>+		if(lenck != (len ^ 0xFFFF) ||
>+		   len < Sdpcmsz || len > 2048){
>+			print("ether4330: wlreadpkt error len %.4x lenck %.4x\n", len, lenck);
>+			cfgw(Framectl, Rfhalt);
>+			while(cfgr(Rfrmcnt+1))
>+				;
>+			while(cfgr(Rfrmcnt))
>+				;
>+			continue;
>+		}
>+		if(len > Sdpcmsz)
>+			packetrw(0, b->wp + Sdpcmsz, len - Sdpcmsz);
>+		b->wp += len;
>+		break;
>+	}
>+	qunlock(&ctl->pktlock);
>+	return b;
>+}
>+
>+static void
>+txstart(Ether *edev)
>+{
>+	Ctlr *ctl;
>+	Sdpcm *p;
>+	Block *b;
>+	int len, off;
>+
>+	ctl = edev->ctlr;
>+	if(!canqlock(&ctl->tlock))
>+		return;
>+	if(waserror()){
>+		qunlock(&ctl->tlock);
>+		return;
>+	}
>+	for(;;){
>+		lock(&ctl->txwinlock);
>+		if(ctl->txseq == ctl->txwindow){
>+			//print("f");
>+			unlock(&ctl->txwinlock);
>+			break;
>+		}
>+		if(ctl->fcmask & 1<<2){
>+			//print("x");
>+			unlock(&ctl->txwinlock);
>+			break;
>+		}
>+		unlock(&ctl->txwinlock);
>+		b = qget(edev->oq);
>+		if(b == nil)
>+			break;
>+		off = ((uintptr)b->rp & 3) + Sdpcmsz;
>+		b = padblock(b, off + 4);
>+		len = BLEN(b);
>+		p = (Sdpcm*)b->rp;
>+		memset(p, 0, off);	/* TODO: refactor dup code */
>+		put2(p->len, len);
>+		put2(p->lenck, ~len);
>+		p->chanflg = 2;
>+		p->seq = ctl->txseq;
>+		p->doffset = off;
>+		put4(b->rp + off, 0x20);	/* BDC header */
>+		if(iodebug) dump("send", b->rp, len);
>+		qlock(&ctl->pktlock);
>+		if(waserror()){
>+			if(iodebug) print("halt frame %x %x\n", cfgr(Wfrmcnt+1), cfgr(Wfrmcnt+1));
>+			cfgw(Framectl, Wfhalt);
>+			while(cfgr(Wfrmcnt+1))
>+				;
>+			while(cfgr(Wfrmcnt))
>+				;
>+			qunlock(&ctl->pktlock);
>+			nexterror();
>+		}
>+		packetrw(1, b->rp, len);
>+		ctl->txseq++;
>+		poperror();
>+		qunlock(&ctl->pktlock);
>+		freeb(b);
>+	}
>+	poperror();
>+	qunlock(&ctl->tlock);
>+}
>+
>+static void
>+rproc(void *a)
>+{
>+	Ether *edev;
>+	Ctlr *ctl;
>+	Block *b;
>+	Sdpcm *p;
>+	Cmd *q;
>+	int flowstart;
>+	int bdc;
>+
>+	edev = a;
>+	ctl = edev->ctlr;
>+	flowstart = 0;
>+	for(;;){
>+		if(flowstart){
>+			//print("F");
>+			flowstart = 0;
>+			txstart(edev);
>+		}
>+		b = wlreadpkt(ctl);
>+		if(b == nil){
>+			intwait(ctl, 1);
>+			continue;
>+		}
>+		p = (Sdpcm*)b->rp;
>+		if(p->window != ctl->txwindow || p->fcmask != ctl->fcmask){
>+			lock(&ctl->txwinlock);
>+			if(p->window != ctl->txwindow){
>+				if(ctl->txseq == ctl->txwindow)
>+					flowstart = 1;
>+				ctl->txwindow = p->window;
>+			}
>+			if(p->fcmask != ctl->fcmask){
>+				if((p->fcmask & 1<<2) == 0)
>+					flowstart = 1;
>+				ctl->fcmask = p->fcmask;
>+			}
>+			unlock(&ctl->txwinlock);
>+		}
>+		switch(p->chanflg & 0xF){
>+		case 0:
>+			if(iodebug) dump("rsp", b->rp, BLEN(b));
>+			if(BLEN(b) < Sdpcmsz + Cmdsz)
>+				break;
>+			q = (Cmd*)(b->rp + Sdpcmsz);
>+			if((q->id[0] | q->id[1]<<8) != ctl->reqid)
>+				break;
>+			ctl->rsp = b;
>+			wakeup(&ctl->cmdr);
>+			continue;
>+		case 1:
>+			if(iodebug) dump("event", b->rp, BLEN(b));
>+			if(BLEN(b) > p->doffset + 4){
>+				bdc = 4 + (b->rp[p->doffset + 3] << 2);
>+				if(BLEN(b) > p->doffset + bdc){
>+					b->rp += p->doffset + bdc;	/* skip BDC header */
>+					bcmevent(ctl, b->rp, BLEN(b));
>+					break;
>+				}
>+			}
>+			if(iodebug && BLEN(b) != p->doffset)
>+				print("short event %lld %d\n", BLEN(b), p->doffset);
>+			break;
>+		case 2:
>+			if(iodebug) dump("packet", b->rp, BLEN(b));
>+			if(BLEN(b) > p->doffset + 4){
>+				bdc = 4 + (b->rp[p->doffset + 3] << 2);
>+				if(BLEN(b) >= p->doffset + bdc + ETHERHDRSIZE){
>+					b->rp += p->doffset + bdc;	/* skip BDC header */
>+					etheriq(edev, b);
>+					continue;
>+				}
>+			}
>+			break;
>+		default:
>+			dump("ether4330: bad packet", b->rp, BLEN(b));
>+			break;
>+		}
>+		freeb(b);
>+	}
>+}
>+
>+static void
>+linkdown(Ctlr *ctl)
>+{
>+	Ether *edev;
>+	Netfile *f;
>+	int i;
>+
>+	edev = ctl->edev;
>+	if(edev == nil || ctl->status != Connected)
>+		return;
>+	ctl->status = Disconnected;
>+	/* send eof to aux/wpa */
>+	for(i = 0; i < edev->nfile; i++){
>+		f = edev->f[i];
>+		if(f == nil || f->in == nil || f->inuse == 0 || f->type != 0x888e)
>+			continue;
>+		qwrite(f->in, 0, 0);
>+	}
>+}
>+
>+/*
>+ * Command interface between host and firmware
>+ */
>+
>+static char *eventnames[] = {
>+	[0] = "set ssid",
>+	[1] = "join",
>+	[2] = "start",
>+	[3] = "auth",
>+	[4] = "auth ind",
>+	[5] = "deauth",
>+	[6] = "deauth ind",
>+	[7] = "assoc",
>+	[8] = "assoc ind",
>+	[9] = "reassoc",
>+	[10] = "reassoc ind",
>+	[11] = "disassoc",
>+	[12] = "disassoc ind",
>+	[13] = "quiet start",
>+	[14] = "quiet end",
>+	[15] = "beacon rx",
>+	[16] = "link",
>+	[17] = "mic error",
>+	[18] = "ndis link",
>+	[19] = "roam",
>+	[20] = "txfail",
>+	[21] = "pmkid cache",
>+	[22] = "retrograde tsf",
>+	[23] = "prune",
>+	[24] = "autoauth",
>+	[25] = "eapol msg",
>+	[26] = "scan complete",
>+	[27] = "addts ind",
>+	[28] = "delts ind",
>+	[29] = "bcnsent ind",
>+	[30] = "bcnrx msg",
>+	[31] = "bcnlost msg",
>+	[32] = "roam prep",
>+	[33] = "pfn net found",
>+	[34] = "pfn net lost",
>+	[35] = "reset complete",
>+	[36] = "join start",
>+	[37] = "roam start",
>+	[38] = "assoc start",
>+	[39] = "ibss assoc",
>+	[40] = "radio",
>+	[41] = "psm watchdog",
>+	[44] = "probreq msg",
>+	[45] = "scan confirm ind",
>+	[46] = "psk sup",
>+	[47] = "country code changed",
>+	[48] = "exceeded medium time",
>+	[49] = "icv error",
>+	[50] = "unicast decode error",
>+	[51] = "multicast decode error",
>+	[52] = "trace",
>+	[53] = "bta hci event",
>+	[54] = "if",
>+	[55] = "p2p disc listen complete",
>+	[56] = "rssi",
>+	[57] = "pfn scan complete",
>+	[58] = "extlog msg",
>+	[59] = "action frame",
>+	[60] = "action frame complete",
>+	[61] = "pre assoc ind",
>+	[62] = "pre reassoc ind",
>+	[63] = "channel adopted",
>+	[64] = "ap started",
>+	[65] = "dfs ap stop",
>+	[66] = "dfs ap resume",
>+	[67] = "wai sta event",
>+	[68] = "wai msg",
>+	[69] = "escan result",
>+	[70] = "action frame off chan complete",
>+	[71] = "probresp msg",
>+	[72] = "p2p probreq msg",
>+	[73] = "dcs request",
>+	[74] = "fifo credit map",
>+	[75] = "action frame rx",
>+	[76] = "wake event",
>+	[77] = "rm complete",
>+	[78] = "htsfsync",
>+	[79] = "overlay req",
>+	[80] = "csa complete ind",
>+	[81] = "excess pm wake event",
>+	[82] = "pfn scan none",
>+	[83] = "pfn scan allgone",
>+	[84] = "gtk plumbed",
>+	[85] = "assoc ind ndis",
>+	[86] = "reassoc ind ndis",
>+	[87] = "assoc req ie",
>+	[88] = "assoc resp ie",
>+	[89] = "assoc recreated",
>+	[90] = "action frame rx ndis",
>+	[91] = "auth req",
>+	[92] = "tdls peer event",
>+	[127] = "bcmc credit support"
>+};
>+
>+static char*
>+evstring(uint event)
>+{
>+	static char buf[12];
>+
>+	if(event >= nelem(eventnames) || eventnames[event] == 0){
>+		/* not reentrant but only called from one kproc */
>+		snprint(buf, sizeof buf, "%d", event);
>+		return buf;
>+	}
>+	return eventnames[event];
>+}
>+
>+static void
>+bcmevent(Ctlr *ctl, uchar *p, int len)
>+{
>+	int flags;
>+	long event, status, reason;
>+
>+	if(len < ETHERHDRSIZE + 10 + 46)
>+		return;
>+	p += ETHERHDRSIZE + 10;			/* skip bcm_ether header */
>+	len -= ETHERHDRSIZE + 10;
>+	flags = nhgets(p + 2);
>+	event = nhgets(p + 6);
>+	status = nhgetl(p + 8);
>+	reason = nhgetl(p + 12);
>+	if(EVENTDEBUG)
>+		print("ether4330: [%s] status %ld flags %#x reason %ld\n", 
>+			evstring(event), status, flags, reason);
>+	switch(event){
>+	case 19:	/* E_ROAM */
>+		if(status == 0)
>+			break;
>+	/* fall through */
>+	case 0:		/* E_SET_SSID */
>+		ctl->joinstatus = 1 + status;
>+		wakeup(&ctl->joinr);
>+		break;
>+	case 16:	/* E_LINK */
>+		if(flags&1)	/* link up */
>+			break;
>+	/* fall through */
>+	case 5:		/* E_DEAUTH */
>+	case 6:		/* E_DEAUTH_IND */
>+	case 12:	/* E_DISASSOC_IND */
>+		linkdown(ctl);
>+		break;
>+	case 26:	/* E_SCAN_COMPLETE */
>+		break;
>+	case 69:	/* E_ESCAN_RESULT */
>+		wlscanresult(ctl->edev, p + 48, len - 48);
>+		break;
>+	default:
>+		if(status){
>+			if(!EVENTDEBUG)
>+				print("ether4330: [%s] error status %ld flags %#x reason %ld\n",
>+					evstring(event), status, flags, reason);
>+			dump("event", p, len);
>+		}
>+	}
>+}
>+
>+static int
>+joindone(void *a)
>+{
>+	return ((Ctlr*)a)->joinstatus;
>+}
>+
>+static int
>+waitjoin(Ctlr *ctl)
>+{
>+	int n;
>+
>+	sleep(&ctl->joinr, joindone, ctl);
>+	n = ctl->joinstatus;
>+	ctl->joinstatus = 0;
>+	return n - 1;
>+}
>+
>+static int
>+cmddone(void *a)
>+{
>+	return ((Ctlr*)a)->rsp != nil;
>+}
>+
>+static void
>+wlcmd(Ctlr *ctl, int write, int op, void *data, int dlen, void *res, int rlen)
>+{
>+	Block *b;
>+	Sdpcm *p;
>+	Cmd *q;
>+	int len, tlen;
>+
>+	if(write)
>+		tlen = dlen + rlen;
>+	else
>+		tlen = MAX(dlen, rlen);
>+	len = Sdpcmsz + Cmdsz + tlen;
>+	b = allocb(len);
>+	qlock(&ctl->cmdlock);
>+	if(waserror()){
>+		freeb(b);
>+		qunlock(&ctl->cmdlock);
>+		nexterror();
>+	}
>+	memset(b->wp, 0, len);
>+	qlock(&ctl->pktlock);
>+	p = (Sdpcm*)b->wp;
>+	put2(p->len, len);
>+	put2(p->lenck, ~len);
>+	p->seq = ctl->txseq;
>+	p->doffset = Sdpcmsz;
>+	b->wp += Sdpcmsz;
>+	
>+	q = (Cmd*)b->wp;
>+	put4(q->cmd, op);
>+	put4(q->len, tlen);
>+	put2(q->flags, write? 2 : 0);
>+	put2(q->id, ++ctl->reqid);
>+	put4(q->status, 0);
>+	b->wp += Cmdsz;
>+
>+	if(dlen > 0)
>+		memmove(b->wp, data, dlen);
>+	if(write)
>+		memmove(b->wp + dlen, res, rlen);
>+	b->wp += tlen;
>+
>+	if(iodebug) dump("cmd", b->rp, len);
>+	packetrw(1, b->rp, len);
>+	ctl->txseq++;
>+	qunlock(&ctl->pktlock);
>+	freeb(b);
>+	b = nil;
>+	USED(b);
>+	sleep(&ctl->cmdr, cmddone, ctl);
>+	b = ctl->rsp;
>+	ctl->rsp = nil;
>+	assert(b != nil);
>+	p = (Sdpcm*)b->rp;
>+	q = (Cmd*)(b->rp + p->doffset);
>+	if(q->status[0] | q->status[1] | q->status[2] | q->status[3]){
>+		print("ether4330: cmd %d error status %ld\n", op, get4(q->status));
>+		dump("ether4330: cmd error", b->rp, BLEN(b));
>+		error("wlcmd error");
>+	}
>+	if(!write)
>+		memmove(res, q + 1, rlen);
>+	freeb(b);
>+	qunlock(&ctl->cmdlock);
>+	poperror();
>+}
>+
>+static void
>+wlcmdint(Ctlr *ctl, int op, int val)
>+{
>+	uchar buf[4];
>+
>+	put4(buf, val);
>+	wlcmd(ctl, 1, op, buf, 4, nil, 0);
>+}
>+
>+static void
>+wlgetvar(Ctlr *ctl, char *name, void *val, int len)
>+{
>+	wlcmd(ctl, 0, GetVar, name, strlen(name) + 1, val, len);
>+}
>+
>+static void
>+wlsetvar(Ctlr *ctl, char *name, void *val, int len)
>+{
>+	if(VARDEBUG){
>+		char buf[32];
>+		snprint(buf, sizeof buf, "wlsetvar %s:", name);
>+		dump(buf, val, len);
>+	}
>+	wlcmd(ctl, 1, SetVar, name, strlen(name) + 1, val, len);
>+}
>+
>+static void
>+wlsetint(Ctlr *ctl, char *name, int val)
>+{
>+	uchar buf[4];
>+
>+	put4(buf, val);
>+	wlsetvar(ctl, name, buf, 4);
>+}
>+
>+static void
>+wlwepkey(Ctlr *ctl, int i)
>+{
>+	uchar params[164];
>+	uchar *p;
>+
>+	memset(params, 0, sizeof params);
>+	p = params;
>+	p = put4(p, i);		/* index */
>+	p = put4(p, ctl->keys[i].len);
>+	memmove(p, ctl->keys[i].dat, ctl->keys[i].len);
>+	p += 32 + 18*4;		/* keydata, pad */
>+	if(ctl->keys[i].len == WMinKeyLen)
>+		p = put4(p, 1);		/* algo = WEP1 */
>+	else
>+		p = put4(p, 3);		/* algo = WEP128 */
>+	put4(p, 2);		/* flags = Primarykey */
>+
>+	wlsetvar(ctl, "wsec_key", params, sizeof params);
>+}
>+
>+static void
>+memreverse(char *dst, char *src, int len)
>+{
>+	src += len;
>+	while(len-- > 0)
>+		*dst++ = *--src;
>+}
>+
>+static void
>+wlwpakey(Ctlr *ctl, int id, uvlong iv, uchar *ea)
>+{
>+	uchar params[164];
>+	uchar *p;
>+	int pairwise;
>+
>+	if(id == CMrxkey)
>+		return;
>+	pairwise = (id == CMrxkey || id == CMtxkey);
>+	memset(params, 0, sizeof params);
>+	p = params;
>+	if(pairwise)
>+		p = put4(p, 0);
>+	else
>+		p = put4(p, id - CMrxkey0);	/* group key id */
>+	p = put4(p, ctl->keys[0].len);
>+	memmove((char*)p,  ctl->keys[0].dat, ctl->keys[0].len);
>+	p += 32 + 18*4;		/* keydata, pad */
>+	if(ctl->cryptotype == Wpa)
>+		p = put4(p, 2);	/* algo = TKIP */
>+	else
>+		p = put4(p, 4);	/* algo = AES_CCM */
>+	if(pairwise)
>+		p = put4(p, 0);
>+	else
>+		p = put4(p, 2);		/* flags = Primarykey */
>+	p += 3*4;
>+	p = put4(p, 0); //pairwise);		/* iv initialised */
>+	p += 4;
>+	p = put4(p, iv>>16);	/* iv high */
>+	p = put2(p, iv&0xFFFF);	/* iv low */
>+	p += 2 + 2*4;		/* align, pad */
>+	if(pairwise)
>+		memmove(p, ea, Eaddrlen);
>+
>+	wlsetvar(ctl, "wsec_key", params, sizeof params);
>+}
>+
>+static void
>+wljoin(Ctlr *ctl, char *ssid, int chan)
>+{
>+	uchar params[72];
>+	uchar *p;
>+	int n;
>+
>+	if(chan != 0)
>+		chan |= 0x2b00;		/* 20Mhz channel width */
>+	p = params;
>+	n = strlen(ssid);
>+	n = MIN(n, 32);
>+	p = put4(p, n);
>+	memmove(p, ssid, n);
>+	memset(p + n, 0, 32 - n);
>+	p += 32;
>+	p = put4(p, 0xff);	/* scan type */
>+	if(chan != 0){
>+		p = put4(p, 2);		/* num probes */
>+		p = put4(p, 120);	/* active time */
>+		p = put4(p, 390);	/* passive time */
>+	}else{
>+		p = put4(p, -1);	/* num probes */
>+		p = put4(p, -1);	/* active time */
>+		p = put4(p, -1);	/* passive time */
>+	}
>+	p = put4(p, -1);	/* home time */
>+	memset(p, 0xFF, Eaddrlen);	/* bssid */
>+	p += Eaddrlen;
>+	p = put2(p, 0);		/* pad */
>+	if(chan != 0){
>+		p = put4(p, 1);		/* num chans */
>+		p = put2(p, chan);	/* chan spec */
>+		p = put2(p, 0);		/* pad */
>+		assert(p == params + sizeof(params));
>+	}else{
>+		p = put4(p, 0);		/* num chans */
>+		assert(p == params + sizeof(params) - 4);
>+	}
>+
>+	wlsetvar(ctl, "join", params, chan? sizeof params : sizeof params - 4);
>+	ctl->status = Connecting;
>+	switch(waitjoin(ctl)){
>+		case 0:
>+			ctl->status = Connected;
>+			break;
>+		case 3:
>+			ctl->status = Disconnected;
>+			error("wifi join: network not found");
>+		case 1:
>+			ctl->status = Disconnected;
>+			error("wifi join: failed");
>+		default:
>+			ctl->status = Disconnected;
>+			error("wifi join: error");
>+	}
>+}
>+
>+static void
>+wlscanstart(Ctlr *ctl)
>+{
>+	/* version[4] action[2] sync_id[2] ssidlen[4] ssid[32] bssid[6] bss_type[1]
>+		scan_type[1] nprobes[4] active_time[4] passive_time[4] home_time[4]
>+		nchans[2] nssids[2] chans[nchans][2] ssids[nssids][32] */
>+	/* hack - this is only correct on a little-endian cpu */
>+	static uchar params[4+2+2+4+32+6+1+1+4*4+2+2+14*2+32+4] = {
>+		1,0,0,0,
>+		1,0,
>+		0x34,0x12,
>+		0,0,0,0,
>+		0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
>+		0xff,0xff,0xff,0xff,0xff,0xff,
>+		2,
>+		0,
>+		0xff,0xff,0xff,0xff,
>+		0xff,0xff,0xff,0xff,
>+		0xff,0xff,0xff,0xff,
>+		0xff,0xff,0xff,0xff,
>+		14,0,
>+		1,0,
>+		0x01,0x2b,0x02,0x2b,0x03,0x2b,0x04,0x2b,0x05,0x2e,0x06,0x2e,0x07,0x2e,
>+		0x08,0x2b,0x09,0x2b,0x0a,0x2b,0x0b,0x2b,0x0c,0x2b,0x0d,0x2b,0x0e,0x2b,
>+		0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
>+	};
>+
>+	wlcmdint(ctl, 49, 0);	/* PASSIVE_SCAN */
>+	wlsetvar(ctl, "escan", params, sizeof params);
>+}
>+
>+static uchar*
>+gettlv(uchar *p, uchar *ep, int tag)
>+{
>+	int len;
>+
>+	while(p + 1 < ep){
>+		len = p[1];
>+		if(p + 2 + len > ep)
>+			return nil;
>+		if(p[0] == tag)
>+			return p;
>+		p += 2 + len;
>+	}
>+	return nil;
>+}
>+
>+static void
>+addscan(Block *bp, uchar *p, int len)
>+{
>+	char bssid[24];
>+	char *auth, *auth2;
>+	uchar *t, *et;
>+	int ielen;
>+	static uchar wpaie1[4] = { 0x00, 0x50, 0xf2, 0x01 };
>+
>+	snprint(bssid, sizeof bssid, ";bssid=%E", p + 8);
>+	if(strstr((char*)bp->rp, bssid) != nil)
>+		return;
>+	bp->wp = (uchar*)seprint((char*)bp->wp, (char*)bp->lim,
>+		"ssid=%.*s%s;signal=%d;noise=%d;chan=%d",
>+		p[18], (char*)p+19, bssid,
>+		(short)get2(p+78), (signed char)p[80],
>+		get2(p+72) & 0xF);
>+	auth = auth2 = "";
>+	if(get2(p + 16) & 0x10)
>+		auth = ";wep";
>+	ielen = get4(p + 0x78);
>+	if(ielen > 0){
>+		t = p + get4(p + 0x74);
>+		et = t + ielen;
>+		if(et > p + len)
>+			return;
>+		if(gettlv(t, et, 0x30) != nil){
>+			auth = "";
>+			auth2 = ";wpa2";
>+		}
>+		while((t = gettlv(t, et, 0xdd)) != nil){
>+			if(t[1] > 4 && memcmp(t+2, wpaie1, 4) == 0){
>+				auth = ";wpa";
>+				break;
>+			}
>+			t += 2 + t[1];
>+		}
>+	}
>+	bp->wp = (uchar*)seprint((char*)bp->wp, (char*)bp->lim,
>+		"%s%s\n", auth, auth2);
>+}
>+
>+
>+static void
>+wlscanresult(Ether *edev, uchar *p, int len)
>+{
>+	Ctlr *ctlr;
>+	Netfile **ep, *f, **fp;
>+	Block *bp;
>+	int nbss, i;
>+
>+	ctlr = edev->ctlr;
>+	if(get4(p) > len)
>+		return;
>+	/* TODO: more syntax checking */
>+	bp = ctlr->scanb;
>+	if(bp == nil)
>+		ctlr->scanb = bp = allocb(8192);
>+	nbss = get2(p+10);
>+	p += 12;
>+	len -= 12;
>+	if(0) dump("SCAN", p, len);
>+	if(nbss){
>+		addscan(bp, p, len);
>+		return;
>+	}
>+	i = edev->scan;
>+	ep = &edev->f[Ntypes];
>+	for(fp = edev->f; fp < ep && i > 0; fp++){
>+		f = *fp;
>+		if(f == nil || f->scan == 0)
>+			continue;
>+		if(i == 1)
>+			qpass(f->in, bp);
>+		else
>+			qpass(f->in, copyblock(bp, BLEN(bp)));
>+		i--;
>+	}
>+	if(i)
>+		freeb(bp);
>+	ctlr->scanb = nil;
>+}
>+
>+static void
>+lproc(void *a)
>+{
>+	Ether *edev;
>+	Ctlr *ctlr;
>+	int secs;
>+
>+	edev = a;
>+	ctlr = edev->ctlr;
>+	secs = 0;
>+	for(;;){
>+		tsleep(&up->sleep, return0, 0, 1000);
>+		if(ctlr->scansecs){
>+			if(secs == 0){
>+				if(waserror())
>+					ctlr->scansecs = 0;
>+				else{
>+					wlscanstart(ctlr);
>+					poperror();
>+				}
>+				secs = ctlr->scansecs;
>+			}
>+			--secs;
>+		}else
>+			secs = 0;
>+	}
>+}
>+
>+static void
>+wlinit(Ether *edev, Ctlr *ctlr)
>+{
>+	uchar ea[Eaddrlen];
>+	uchar eventmask[16];
>+	char version[128];
>+	char *p;
>+	static uchar keepalive[12] = {1, 0, 11, 0, 0xd8, 0xd6, 0, 0, 0, 0, 0, 0};
>+
>+	wlgetvar(ctlr, "cur_etheraddr", ea, Eaddrlen);
>+	memmove(edev->ea, ea, Eaddrlen);
>+	memmove(edev->addr, ea, Eaddrlen);
>+	print("ether4330: addr %E\n", edev->ea);
>+	wlsetint(ctlr, "assoc_listen", 10);
>+	if(ctlr->chipid == 43430 || ctlr->chipid == 0x4345)
>+		wlcmdint(ctlr, 0x56, 0);	/* powersave off */
>+	else
>+		wlcmdint(ctlr, 0x56, 2);	/* powersave FAST */
>+	wlsetint(ctlr, "bus:txglom", 0);
>+	wlsetint(ctlr, "bcn_timeout", 10);
>+	wlsetint(ctlr, "assoc_retry_max", 3);
>+	if(ctlr->chipid == 0x4330){
>+		wlsetint(ctlr, "btc_wire", 4);
>+		wlsetint(ctlr, "btc_mode", 1);
>+		wlsetvar(ctlr, "mkeep_alive", keepalive, 11);
>+	}
>+	memset(eventmask, 0xFF, sizeof eventmask);
>+#define ENABLE(n)	eventmask[n/8] |= 1<<(n%8)
>+#define DISABLE(n)	eventmask[n/8] &= ~(1<<(n%8))
>+	DISABLE(40);	/* E_RADIO */
>+	DISABLE(44);	/* E_PROBREQ_MSG */
>+	DISABLE(54);	/* E_IF */
>+	DISABLE(71);	/* E_PROBRESP_MSG */
>+	DISABLE(20);	/* E_TXFAIL */
>+	DISABLE(124);	/* ? */
>+	wlsetvar(ctlr, "event_msgs", eventmask, sizeof eventmask);
>+	wlcmdint(ctlr, 0xb9, 0x28);	/* SET_SCAN_CHANNEL_TIME */
>+	wlcmdint(ctlr, 0xbb, 0x28);	/* SET_SCAN_UNASSOC_TIME */
>+	wlcmdint(ctlr, 0x102, 0x82);	/* SET_SCAN_PASSIVE_TIME */
>+	wlcmdint(ctlr, 2, 0);		/* UP */
>+	memset(version, 0, sizeof version);
>+	wlgetvar(ctlr, "ver", version, sizeof version - 1);
>+	if((p = strchr(version, '\n')) != nil)
>+		*p = '\0';
>+	if(0) print("ether4330: %s\n", version);
>+	wlsetint(ctlr, "roam_off", 1);
>+	wlcmdint(ctlr, 0x14, 1);	/* SET_INFRA 1 */
>+	wlcmdint(ctlr, 10, 0);		/* SET_PROMISC */
>+	//wlcmdint(ctlr, 0x8e, 0);	/* SET_BAND 0 */
>+	//wlsetint(ctlr, "wsec", 1);
>+	wlcmdint(ctlr, 2, 1);		/* UP */
>+	ctlr->keys[0].len = WMinKeyLen;
>+	//wlwepkey(ctlr, 0);
>+}
>+
>+/*
>+ * Plan 9 driver interface
>+ */
>+
>+static long
>+etherbcmifstat(Ether* edev, void* a, long n, ulong offset)
>+{
>+	Ctlr *ctlr;
>+	char *p;
>+	int l;
>+	static char *cryptoname[4] = {
>+		[0]	"off",
>+		[Wep]	"wep",
>+		[Wpa]	"wpa",
>+		[Wpa2]	"wpa2",
>+	};
>+	/* these strings are known by aux/wpa */
>+	static char* connectstate[] = {
>+		[Disconnected]	= "unassociated",
>+		[Connecting] = "connecting",
>+		[Connected] = "associated",
>+	};
>+
>+	ctlr = edev->ctlr;
>+	if(ctlr == nil)
>+		return 0;
>+	p = malloc(READSTR);
>+	l = 0;
>+
>+	l += snprint(p+l, READSTR-l, "channel: %d\n", ctlr->chanid);
>+	l += snprint(p+l, READSTR-l, "essid: %s\n", ctlr->essid);
>+	l += snprint(p+l, READSTR-l, "crypt: %s\n", cryptoname[ctlr->cryptotype]);
>+	l += snprint(p+l, READSTR-l, "oq: %d\n", qlen(edev->oq));
>+	l += snprint(p+l, READSTR-l, "txwin: %d\n", ctlr->txwindow);
>+	l += snprint(p+l, READSTR-l, "txseq: %d\n", ctlr->txseq);
>+	l += snprint(p+l, READSTR-l, "status: %s\n", connectstate[ctlr->status]);
>+	USED(l);
>+	n = readstr(offset, a, n, p);
>+	free(p);
>+	return n;
>+}
>+
>+static void
>+etherbcmtransmit(Ether *edev)
>+{
>+	Ctlr *ctlr;
>+
>+	ctlr = edev->ctlr;
>+	if(ctlr == nil)
>+		return;
>+	txstart(edev);
>+}
>+
>+static int
>+parsehex(char *buf, int buflen, char *a)
>+{
>+	int i, k, n;
>+
>+	k = 0;
>+	for(i = 0;k < buflen && *a; i++){
>+		if(*a >= '0' && *a <= '9')
>+			n = *a++ - '0';
>+		else if(*a >= 'a' && *a <= 'f')
>+			n = *a++ - 'a' + 10;
>+		else if(*a >= 'A' && *a <= 'F')
>+			n = *a++ - 'A' + 10;
>+		else
>+			break;
>+
>+		if(i & 1){
>+			buf[k] |= n;
>+			k++;
>+		}
>+		else
>+			buf[k] = n<<4;
>+	}
>+	if(i & 1)
>+		return -1;
>+	return k;
>+}
>+
>+static int
>+wepparsekey(WKey* key, char* a) 
>+{
>+	int i, k, len, n;
>+	char buf[WMaxKeyLen];
>+
>+	len = strlen(a);
>+	if(len == WMinKeyLen || len == WMaxKeyLen){
>+		memset(key->dat, 0, sizeof(key->dat));
>+		memmove(key->dat, a, len);
>+		key->len = len;
>+
>+		return 0;
>+	}
>+	else if(len == WMinKeyLen*2 || len == WMaxKeyLen*2){
>+		k = 0;
>+		for(i = 0; i < len; i++){
>+			if(*a >= '0' && *a <= '9')
>+				n = *a++ - '0';
>+			else if(*a >= 'a' && *a <= 'f')
>+				n = *a++ - 'a' + 10;
>+			else if(*a >= 'A' && *a <= 'F')
>+				n = *a++ - 'A' + 10;
>+			else
>+				return -1;
>+	
>+			if(i & 1){
>+				buf[k] |= n;
>+				k++;
>+			}
>+			else
>+				buf[k] = n<<4;
>+		}
>+
>+		memset(key->dat, 0, sizeof(key->dat));
>+		memmove(key->dat, buf, k);
>+		key->len = k;
>+
>+		return 0;
>+	}
>+
>+	return -1;
>+}
>+
>+static int
>+wpaparsekey(WKey *key, uvlong *ivp, char *a)
>+{
>+	int len;
>+	char *e;
>+
>+	if(cistrncmp(a, "tkip:", 5) == 0 || cistrncmp(a, "ccmp:", 5) == 0)
>+		a += 5;
>+	else
>+		return 1;
>+	len = parsehex(key->dat, sizeof(key->dat), a);
>+	if(len <= 0)
>+		return 1;
>+	key->len = len;
>+	a += 2*len;
>+	if(*a++ != '@')
>+		return 1;
>+	*ivp = strtoull(a, &e, 16);
>+	if(e == a)
>+		return -1;
>+	return 0;
>+}
>+
>+static void
>+setauth(Ctlr *ctlr, Cmdbuf *cb, char *a)
>+{
>+	uchar wpaie[32];
>+	int i;
>+
>+	i = parsehex((char*)wpaie, sizeof wpaie, a);
>+	if(i < 2 || i != wpaie[1] + 2)
>+		cmderror(cb, "bad wpa ie syntax");
>+	if(wpaie[0] == 0xdd)
>+		ctlr->cryptotype = Wpa;
>+	else if(wpaie[0] == 0x30)
>+		ctlr->cryptotype = Wpa2;
>+	else
>+		cmderror(cb, "bad wpa ie");
>+	wlsetvar(ctlr, "wpaie", wpaie, i);
>+	if(ctlr->cryptotype == Wpa){
>+		wlsetint(ctlr, "wpa_auth", 4|2);	/* auth_psk | auth_unspecified */
>+		wlsetint(ctlr, "auth", 0);
>+		wlsetint(ctlr, "wsec", 2);		/* tkip */
>+		wlsetint(ctlr, "wpa_auth", 4);		/* auth_psk */
>+	}else{
>+		wlsetint(ctlr, "wpa_auth", 0x80|0x40);	/* auth_psk | auth_unspecified */
>+		wlsetint(ctlr, "auth", 0);
>+		wlsetint(ctlr, "wsec", 4);		/* aes */
>+		wlsetint(ctlr, "wpa_auth", 0x80);	/* auth_psk */
>+	}
>+}
>+
>+static int
>+setcrypt(Ctlr *ctlr, Cmdbuf*, char *a)
>+{
>+	if(cistrcmp(a, "wep") == 0 || cistrcmp(a, "on") == 0)
>+		ctlr->cryptotype = Wep;
>+	else if(cistrcmp(a, "off") == 0 || cistrcmp(a, "none") == 0)
>+		ctlr->cryptotype = 0;
>+	else
>+		return 0;
>+	wlsetint(ctlr, "auth", ctlr->cryptotype);
>+	return 1;
>+}
>+
>+static long
>+etherbcmctl(Ether* edev, void* buf, long n)
>+{
>+	Ctlr *ctlr;
>+	Cmdbuf *cb;
>+	Cmdtab *ct;
>+	uchar ea[Eaddrlen];
>+	uvlong iv;
>+	int i;
>+
>+	if((ctlr = edev->ctlr) == nil)
>+		error(Enonexist);
>+	USED(ctlr);
>+
>+	cb = parsecmd(buf, n);
>+	if(waserror()){
>+		free(cb);
>+		nexterror();
>+	}
>+	ct = lookupcmd(cb, cmds, nelem(cmds));
>+	switch(ct->index){
>+	case CMauth:
>+		setauth(ctlr, cb, cb->f[1]);
>+		if(ctlr->essid[0])
>+			wljoin(ctlr, ctlr->essid, ctlr->chanid);
>+		break;
>+	case CMchannel:
>+		if((i = atoi(cb->f[1])) < 0 || i > 16)
>+			cmderror(cb, "bad channel number");
>+		//wlcmdint(ctlr, 30, i);	/* SET_CHANNEL */
>+		ctlr->chanid = i;
>+		break;
>+	case CMcrypt:
>+		if(setcrypt(ctlr, cb, cb->f[1])){
>+			if(ctlr->essid[0])
>+				wljoin(ctlr, ctlr->essid, ctlr->chanid);
>+		}else
>+			cmderror(cb, "bad crypt type");
>+		break;
>+	case CMessid:
>+		if(cistrcmp(cb->f[1], "default") == 0)
>+			memset(ctlr->essid, 0, sizeof(ctlr->essid));
>+		else{
>+			strncpy(ctlr->essid, cb->f[1], sizeof(ctlr->essid) - 1);
>+			ctlr->essid[sizeof(ctlr->essid) - 1] = '\0';
>+		}
>+		if(!waserror()){
>+			wljoin(ctlr, ctlr->essid, ctlr->chanid);
>+			poperror();
>+		}
>+		break;
>+	case CMjoin:	/* join essid channel wep|on|off|wpakey */
>+		if(strcmp(cb->f[1], "") != 0){	/* empty string for no change */
>+			if(cistrcmp(cb->f[1], "default") != 0){
>+				strncpy(ctlr->essid, cb->f[1], sizeof(ctlr->essid)-1);
>+				ctlr->essid[sizeof(ctlr->essid)-1] = 0;
>+			}else
>+				memset(ctlr->essid, 0, sizeof(ctlr->essid));
>+		}else if(ctlr->essid[0] == 0)
>+			cmderror(cb, "essid not set");
>+		if((i = atoi(cb->f[2])) >= 0 && i <= 16)
>+			ctlr->chanid = i;
>+		else
>+			cmderror(cb, "bad channel number");
>+		if(!setcrypt(ctlr, cb, cb->f[3]))
>+			setauth(ctlr, cb, cb->f[3]);
>+		if(ctlr->essid[0])
>+			wljoin(ctlr, ctlr->essid, ctlr->chanid);
>+		break;
>+	case CMkey1:
>+	case CMkey2:
>+	case CMkey3:
>+	case CMkey4:
>+		i = ct->index - CMkey1;
>+		if(wepparsekey(&ctlr->keys[i], cb->f[1]))
>+			cmderror(cb, "bad WEP key syntax");
>+		wlsetint(ctlr, "wsec", 1);	/* wep enabled */
>+		wlwepkey(ctlr, i);
>+		break;
>+	case CMrxkey:
>+	case CMrxkey0:
>+	case CMrxkey1:
>+	case CMrxkey2:
>+	case CMrxkey3:
>+	case CMtxkey:
>+		if(parseether(ea, cb->f[1]) < 0)
>+			cmderror(cb, "bad ether addr");
>+		if(wpaparsekey(&ctlr->keys[0], &iv, cb->f[2]))
>+			cmderror(cb, "bad wpa key");
>+		wlwpakey(ctlr, ct->index, iv, ea);
>+		break;
>+	case CMdebug:
>+		iodebug = atoi(cb->f[1]);
>+		break;
>+	}
>+	poperror();
>+	free(cb);
>+	return n;
>+}
>+
>+static void
>+etherbcmscan(void *a, uint secs)
>+{
>+	Ether* edev;
>+	Ctlr* ctlr;
>+
>+	edev = a;
>+	ctlr = edev->ctlr;
>+	ctlr->scansecs = secs;
>+}
>+
>+static void
>+etherbcmattach(Ether* edev)
>+{
>+	Ctlr *ctlr;
>+
>+	ctlr = edev->ctlr;
>+	qlock(&ctlr->alock);
>+	if(waserror()){
>+		//print("ether4330: attach failed: %s\n", up->errstr);
>+		qunlock(&ctlr->alock);
>+		nexterror();
>+	}
>+	if(ctlr->edev == nil){
>+		if(ctlr->chipid == 0){
>+			sdioinit();
>+			sbinit(ctlr);
>+		}
>+		fwload(ctlr);
>+		sbenable(ctlr);
>+		kproc("wifireader", rproc, edev);
>+		kproc("wifitimer", lproc, edev);
>+		if(ctlr->regufile)
>+			reguload(ctlr, ctlr->regufile);
>+		wlinit(edev, ctlr);
>+		ctlr->edev = edev;
>+	}
>+	qunlock(&ctlr->alock);
>+	poperror();
>+}
>+
>+static void
>+etherbcmshutdown(Ether*)
>+{
>+	sdioreset();
>+}
>+
>+
>+static int
>+etherbcmpnp(Ether* edev)
>+{
>+	static Ctlr *ctlr;
>+
>+	if(ctlr != nil)
>+		return -1;
>+
>+	ctlr = malloc(sizeof(Ctlr));
>+	ctlr->chanid = Wifichan;
>+	edev->ctlr = ctlr;
>+	edev->attach = etherbcmattach;
>+	edev->transmit = etherbcmtransmit;
>+	edev->ifstat = etherbcmifstat;
>+	edev->ctl = etherbcmctl;
>+	edev->scanbs = etherbcmscan;
>+	edev->shutdown = etherbcmshutdown;
>+	edev->arg = edev;
>+
>+	return 0;
>+}
>+
>+void
>+ether4330link(void)
>+{
>+	addethercard("4330", etherbcmpnp);
>+}
>--- a/sys/src/9/bcm64/pi4	Sun Oct 22 09:21:23 2023
>+++ b/sys/src/9/bcm64/pi4	Sun Oct 22 10:53:02 2023
>@@ -32,6 +32,7 @@
> 	archbcm4	pci
> 	usbxhcipci	pci usbxhci archbcm4 
> 	ethergenet	ethermii
>+	ether4330	emmc
> 	ethermedium
> 	loopbackmedium
> 	netdevmedium
>--- a/sys/src/9/port/sd.h	Sun Oct 22 09:21:23 2023
>+++ b/sys/src/9/port/sd.h	Sun Oct 22 10:53:02 2023
>@@ -164,6 +164,31 @@
> 	char	*name;
> };
> 
>+/* Commands */
>+extern SDiocmd GO_IDLE_STATE;
>+extern SDiocmd SEND_OP_COND;
>+extern SDiocmd ALL_SEND_CID;
>+extern SDiocmd SET_RELATIVE_ADDR;
>+extern SDiocmd SEND_RELATIVE_ADDR;
>+extern SDiocmd SWITCH;
>+extern SDiocmd SWITCH_FUNC;
>+extern SDiocmd SELECT_CARD;
>+extern SDiocmd SEND_EXT_CSD;
>+extern SDiocmd SD_SEND_IF_COND;
>+extern SDiocmd SEND_CSD;
>+extern SDiocmd STOP_TRANSMISSION;
>+extern SDiocmd SEND_STATUS;
>+extern SDiocmd SET_BLOCKLEN;
>+extern SDiocmd READ_SINGLE_BLOCK;
>+extern SDiocmd READ_MULTIPLE_BLOCK;
>+extern SDiocmd WRITE_SINGLE_BLOCK;
>+extern SDiocmd WRITE_MULTIPLE_BLOCK;
>+
>+/* prefix for following app-specific commands */
>+extern SDiocmd APP_CMD;
>+extern SDiocmd SD_SET_BUS_WIDTH;
>+extern SDiocmd SD_SEND_OP_COND;
>+
> struct SDio {
> 	char	*name;
> 	int	(*init)(SDio*);
>
>

let me rephrase: is this known to actually work, and which hardware does it actually work with. asking for a fqa.

sl

  reply	other threads:[~2023-10-22 18:47 UTC|newest]

Thread overview: 3+ messages / expand[flat|nested]  mbox.gz  Atom feed  top
     [not found] <1734B8F2A873B2D850DB1C299ECACF8F@9front.org>
2023-10-22 18:43 ` [9front] " Stanley Lieber
2023-10-22 18:45   ` Stanley Lieber [this message]
2023-10-22 19:01     ` [9front] " adventures in9

Reply instructions:

You may reply publicly to this message via plain-text email
using any one of the following methods:

* Save the following mbox file, import it into your mail client,
  and reply-to-all from there: mbox

  Avoid top-posting and favor interleaved quoting:
  https://en.wikipedia.org/wiki/Posting_style#Interleaved_style

* Reply using the --to, --cc, and --in-reply-to
  switches of git-send-email(1):

  git send-email \
    --in-reply-to=E6C8CA63-C7E0-4B46-8365-C77704004F97@stanleylieber.com \
    --to=sl@stanleylieber.com \
    --cc=9front@9front.org \
    /path/to/YOUR_REPLY

  https://kernel.org/pub/software/scm/git/docs/git-send-email.html

* If your mail client supports setting the In-Reply-To header
  via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).