2b4601d10b
Improve if_fwe performance. - Simplify mbuf handling by using bulkxfer. Now, it uses mbuf clusters for RX buffer as usual ethernet drivers. - Recycle struct xfer buffer and don't call malloc at runtime. - Count input and output errors. - Handle a mbuf chain longer than 6 correctly. - Increase queue length.
381 lines
10 KiB
C
381 lines
10 KiB
C
/*
|
|
* Copyright (c) 1998-2002 Katsushi Kobayashi and Hidetoshi Shimokawa
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the acknowledgement as bellow:
|
|
*
|
|
* This product includes software developed by K. Kobayashi and H. Shimokawa
|
|
*
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
|
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
* DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
|
|
* INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
|
|
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
|
|
* STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
|
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
* $FreeBSD$
|
|
*
|
|
*/
|
|
|
|
#if __FreeBSD_version >= 500000
|
|
typedef struct thread fw_proc;
|
|
#include <sys/selinfo.h>
|
|
#else
|
|
typedef struct proc fw_proc;
|
|
#include <sys/select.h>
|
|
#endif
|
|
|
|
#define splfw splimp
|
|
|
|
struct fw_device{
|
|
u_int16_t dst;
|
|
struct fw_eui64 eui;
|
|
#if 0
|
|
u_int32_t spec;
|
|
u_int32_t ver;
|
|
#endif
|
|
u_int8_t speed;
|
|
u_int8_t maxrec;
|
|
u_int8_t nport;
|
|
u_int8_t power;
|
|
#define CSRROMOFF 0x400
|
|
#define CSRROMSIZE 0x400
|
|
int rommax; /* offset from 0xffff f000 0000 */
|
|
u_int32_t csrrom[CSRROMSIZE/4];
|
|
int rcnt;
|
|
struct firewire_comm *fc;
|
|
u_int32_t status;
|
|
#define FWDEVINIT 1
|
|
#define FWDEVATTACHED 2
|
|
#define FWDEVINVAL 3
|
|
STAILQ_ENTRY(fw_device) link;
|
|
#if 0
|
|
LIST_HEAD(, fw_xfer) txqueue;
|
|
LIST_HEAD(, fw_xfer) rxqueue;
|
|
#endif
|
|
};
|
|
|
|
struct firewire_softc {
|
|
#if __FreeBSD_version >= 500000
|
|
dev_t dev;
|
|
#else
|
|
dev_t dev[FWMAXNDMA+1];
|
|
#endif
|
|
struct firewire_comm *fc;
|
|
};
|
|
|
|
#define FW_MAX_DMACH 0x20
|
|
#define FW_MAX_DEVCH FW_MAX_DMACH
|
|
#define FW_XFERTIMEOUT 1
|
|
|
|
struct firewire_dev_comm {
|
|
device_t dev;
|
|
struct firewire_comm *fc;
|
|
void (*post_explore) __P((void *));
|
|
};
|
|
|
|
struct tcode_info {
|
|
u_char hdr_len; /* IEEE1394 header length */
|
|
u_char flag;
|
|
#define FWTI_REQ (1 << 0)
|
|
#define FWTI_RES (1 << 1)
|
|
#define FWTI_TLABEL (1 << 2)
|
|
#define FWTI_BLOCK_STR (1 << 3)
|
|
#define FWTI_BLOCK_ASY (1 << 4)
|
|
};
|
|
|
|
struct firewire_comm{
|
|
device_t dev;
|
|
device_t bdev;
|
|
u_int16_t busid:10,
|
|
nodeid:6;
|
|
u_int mode;
|
|
u_int nport;
|
|
u_int speed;
|
|
u_int maxrec;
|
|
u_int irm;
|
|
u_int max_node;
|
|
u_int max_hop;
|
|
u_int max_asyretry;
|
|
#define FWPHYASYST (1 << 0)
|
|
u_int retry_count;
|
|
u_int32_t ongobus:10,
|
|
ongonode:6,
|
|
ongoaddr:16;
|
|
struct fw_device *ongodev;
|
|
struct fw_eui64 ongoeui;
|
|
#define FWMAXCSRDIR 16
|
|
SLIST_HEAD(, csrdir) ongocsr;
|
|
SLIST_HEAD(, csrdir) csrfree;
|
|
u_int32_t status;
|
|
#define FWBUSRESET 0
|
|
#define FWBUSINIT 1
|
|
#define FWBUSCYMELECT 2
|
|
#define FWBUSMGRELECT 3
|
|
#define FWBUSMGRDONE 4
|
|
#define FWBUSEXPLORE 5
|
|
#define FWBUSPHYCONF 6
|
|
#define FWBUSEXPDONE 7
|
|
#define FWBUSCOMPLETION 10
|
|
int nisodma;
|
|
struct fw_eui64 eui;
|
|
STAILQ_HEAD(fw_queue, fw_xfer);
|
|
struct fw_xferq
|
|
*arq, *atq, *ars, *ats, *it[FW_MAX_DMACH],*ir[FW_MAX_DMACH];
|
|
STAILQ_HEAD(, tlabel) tlabels[0x40];
|
|
STAILQ_HEAD(, fw_bind) binds;
|
|
STAILQ_HEAD(, fw_device) devices;
|
|
STAILQ_HEAD(, fw_xfer) pending;
|
|
volatile u_int32_t *sid_buf;
|
|
u_int sid_cnt;
|
|
#define CSRSIZE 0x4000
|
|
u_int32_t csr_arc[CSRSIZE/4];
|
|
#define CROMSIZE 0x400
|
|
u_int32_t *config_rom;
|
|
struct fw_topology_map *topology_map;
|
|
struct fw_speed_map *speed_map;
|
|
struct callout busprobe_callout;
|
|
struct callout bmr_callout;
|
|
struct callout timeout_callout;
|
|
struct callout retry_probe_callout;
|
|
u_int32_t (*cyctimer) __P((struct firewire_comm *));
|
|
void (*ibr) __P((struct firewire_comm *));
|
|
u_int32_t (*set_bmr) __P((struct firewire_comm *, u_int32_t));
|
|
int (*ioctl) __P((dev_t, u_long, caddr_t, int, fw_proc *));
|
|
int (*irx_enable) __P((struct firewire_comm *, int));
|
|
int (*irx_disable) __P((struct firewire_comm *, int));
|
|
int (*itx_enable) __P((struct firewire_comm *, int));
|
|
int (*itx_disable) __P((struct firewire_comm *, int));
|
|
void (*timeout) __P((void *));
|
|
void (*poll) __P((struct firewire_comm *, int, int));
|
|
void (*set_intr) __P((struct firewire_comm *, int));
|
|
void (*irx_post) __P((struct firewire_comm *, u_int32_t *));
|
|
void (*itx_post) __P((struct firewire_comm *, u_int32_t *));
|
|
struct tcode_info *tcode;
|
|
};
|
|
#define CSRARC(sc, offset) ((sc)->csr_arc[(offset)/4])
|
|
|
|
struct csrdir{
|
|
u_int32_t ongoaddr;
|
|
u_int32_t off;
|
|
SLIST_ENTRY(csrdir) link;
|
|
};
|
|
|
|
struct fw_xferq {
|
|
int flag;
|
|
#define FWXFERQ_CHTAGMASK 0xff
|
|
#define FWXFERQ_RUNNING (1 << 8)
|
|
#define FWXFERQ_STREAM (1 << 9)
|
|
|
|
#define FWXFERQ_PACKET (1 << 10)
|
|
#define FWXFERQ_BULK (1 << 11)
|
|
#if 0 /* BROKEN */
|
|
#define FWXFERQ_DV (1 << 12)
|
|
#endif
|
|
#define FWXFERQ_MODEMASK (7 << 10)
|
|
|
|
#define FWXFERQ_EXTBUF (1 << 13)
|
|
#define FWXFERQ_OPEN (1 << 14)
|
|
|
|
#define FWXFERQ_HANDLER (1 << 16)
|
|
#define FWXFERQ_WAKEUP (1 << 17)
|
|
|
|
void (*start) __P((struct firewire_comm*));
|
|
void (*drain) __P((struct firewire_comm*, struct fw_xfer*));
|
|
struct fw_queue q;
|
|
u_int queued;
|
|
u_int maxq;
|
|
u_int psize;
|
|
u_int packets;
|
|
STAILQ_HEAD(, fw_bind) binds;
|
|
caddr_t buf;
|
|
u_int bnchunk;
|
|
u_int bnpacket;
|
|
struct fw_bulkxfer *bulkxfer;
|
|
STAILQ_HEAD(, fw_bulkxfer) stvalid;
|
|
STAILQ_HEAD(, fw_bulkxfer) stfree;
|
|
STAILQ_HEAD(, fw_bulkxfer) stdma;
|
|
struct fw_bulkxfer *stproc;
|
|
#ifdef FWXFERQ_DV
|
|
int dvdbc, dvdiff, dvsync, dvoffset;
|
|
struct fw_dvbuf *dvbuf;
|
|
STAILQ_HEAD(, fw_dvbuf) dvvalid;
|
|
STAILQ_HEAD(, fw_dvbuf) dvfree;
|
|
struct fw_dvbuf *dvdma;
|
|
struct fw_dvbuf *dvproc;
|
|
u_int dvptr;
|
|
u_int dvpacket;
|
|
#endif
|
|
struct selinfo rsel;
|
|
caddr_t sc;
|
|
void (*hand) __P((struct fw_xferq *));
|
|
};
|
|
|
|
struct fw_bulkxfer{
|
|
caddr_t buf;
|
|
struct mbuf *mbuf;
|
|
STAILQ_ENTRY(fw_bulkxfer) link;
|
|
caddr_t start;
|
|
caddr_t end;
|
|
u_int npacket;
|
|
int resp;
|
|
};
|
|
|
|
struct fw_dvbuf{
|
|
caddr_t buf;
|
|
STAILQ_ENTRY(fw_dvbuf) link;
|
|
};
|
|
|
|
struct tlabel{
|
|
struct fw_xfer *xfer;
|
|
STAILQ_ENTRY(tlabel) link;
|
|
};
|
|
|
|
struct fw_bind{
|
|
u_int32_t start_hi, start_lo, addrlen;
|
|
struct fw_xfer* xfer;
|
|
STAILQ_ENTRY(fw_bind) fclist;
|
|
STAILQ_ENTRY(fw_bind) chlist;
|
|
};
|
|
|
|
struct fw_xfer{
|
|
caddr_t sc;
|
|
struct firewire_comm *fc;
|
|
struct fw_xferq *q;
|
|
#ifdef XFER_TIMEOUT
|
|
struct callout_handle ch;
|
|
#endif
|
|
struct timeval tv;
|
|
struct fw_tlabel *tlabel;
|
|
u_int8_t spd;
|
|
u_int8_t tcode;
|
|
int resp;
|
|
#define FWXF_INIT 0
|
|
#define FWXF_INQ 1
|
|
#define FWXF_START 2
|
|
#define FWXF_SENT 3
|
|
#define FWXF_SENTERR 4
|
|
#define FWXF_BUSY 8
|
|
#define FWXF_RCVD 10
|
|
int state;
|
|
u_int8_t retry;
|
|
u_int8_t tl;
|
|
int sub;
|
|
int32_t dst;
|
|
u_int8_t act_type;
|
|
#define FWACT_NULL 0
|
|
#define FWACT_XFER 2
|
|
#define FWACT_CH 3
|
|
void (*retry_req) __P((struct fw_xfer *));
|
|
union{
|
|
void (*hand) __P((struct fw_xfer *));
|
|
} act;
|
|
#if 0
|
|
union{
|
|
struct {
|
|
struct fw_device *device;
|
|
} req;
|
|
struct {
|
|
struct stch *channel;
|
|
} stream;
|
|
} mode;
|
|
#endif
|
|
struct {
|
|
u_int16_t len, off;
|
|
caddr_t buf;
|
|
} send, recv;
|
|
struct mbuf *mbuf;
|
|
STAILQ_ENTRY(fw_xfer) link;
|
|
struct malloc_type *malloc;
|
|
};
|
|
void fw_sidrcv __P((struct firewire_comm *, caddr_t, u_int, u_int));
|
|
void fw_rcv __P((struct firewire_comm *, caddr_t, u_int, u_int, u_int, u_int));
|
|
void fw_xfer_free __P(( struct fw_xfer*));
|
|
struct fw_xfer *fw_xfer_alloc __P((struct malloc_type *));
|
|
void fw_init __P((struct firewire_comm *));
|
|
int fw_tbuf_update __P((struct firewire_comm *, int, int));
|
|
int fw_rbuf_update __P((struct firewire_comm *, int, int));
|
|
int fw_readreqq __P((struct firewire_comm *, u_int32_t, u_int32_t, u_int32_t *));
|
|
int fw_writereqb __P((struct firewire_comm *, u_int32_t, u_int32_t, u_int32_t, u_int32_t *));
|
|
int fw_readresb __P((struct firewire_comm *, u_int32_t, u_int32_t, u_int32_t, u_int32_t*));
|
|
int fw_writeres __P((struct firewire_comm *, u_int32_t, u_int32_t));
|
|
u_int32_t getcsrdata __P((struct fw_device *, u_int8_t));
|
|
void fw_asybusy __P((struct fw_xfer *));
|
|
int fw_bindadd __P((struct firewire_comm *, struct fw_bind *));
|
|
int fw_bindremove __P((struct firewire_comm *, struct fw_bind *));
|
|
int fw_asyreq __P((struct firewire_comm *, int, struct fw_xfer*));
|
|
void fw_busreset __P((struct firewire_comm *));
|
|
u_int16_t fw_crc16 __P((u_int32_t *, u_int32_t));
|
|
void fw_xfer_timeout __P((void *));
|
|
void fw_xfer_done __P((struct fw_xfer *));
|
|
void fw_asy_callback __P((struct fw_xfer *));
|
|
struct fw_device *fw_noderesolve_nodeid __P((struct firewire_comm *, int));
|
|
struct fw_device *fw_noderesolve_eui64 __P((struct firewire_comm *, struct fw_eui64 *));
|
|
struct fw_bind *fw_bindlookup __P((struct firewire_comm *, u_int32_t, u_int32_t));
|
|
void fw_drain_txq __P((struct firewire_comm *));
|
|
|
|
|
|
extern int firewire_debug;
|
|
extern devclass_t firewire_devclass;
|
|
|
|
#define DV_BROADCAST_ON (1<<30)
|
|
#define IP_CHANNELS 0x0234
|
|
|
|
#define STATE_CLEAR 0x0000
|
|
#define STATE_SET 0x0004
|
|
#define NODE_IDS 0x0008
|
|
#define RESET_START 0x000c
|
|
#define SPLIT_TIMEOUT_HI 0x0018
|
|
#define SPLIT_TIMEOUT_LO 0x001c
|
|
#define CYCLE_TIME 0x0200
|
|
#define BUS_TIME 0x0204
|
|
#define BUSY_TIMEOUT 0x0210
|
|
#define BUS_MGR_ID 0x021c
|
|
#define BANDWIDTH_AV 0x0220
|
|
#define CHANNELS_AV_HI 0x0224
|
|
#define CHANNELS_AV_LO 0x0228
|
|
|
|
#define CONF_ROM 0x0400
|
|
|
|
#define TOPO_MAP 0x1000
|
|
#define SPED_MAP 0x2000
|
|
|
|
#define oMPR 0x900
|
|
#define oPCR 0x904
|
|
|
|
#define iMPR 0x980
|
|
#define iPCR 0x984
|
|
|
|
#define FWPRI ((PZERO+8)|PCATCH)
|
|
|
|
#ifdef __alpha__
|
|
#undef vtophys
|
|
#define vtophys(va) alpha_XXX_dmamap((vm_offset_t)(va))
|
|
#endif /* __alpha__ */
|
|
|
|
#if __FreeBSD_version >= 500000
|
|
#define CALLOUT_INIT(x) callout_init(x, 0 /* mpsafe */)
|
|
#else
|
|
#define CALLOUT_INIT(x) callout_init(x)
|
|
#endif
|
|
|
|
MALLOC_DECLARE(M_FW);
|
|
MALLOC_DECLARE(M_FWXFER);
|