xref: /freebsd/sys/dev/firewire/fwdev.c (revision 23667f089d0aaf2c46f7d80ef5648cfa60f30cd0)
1098ca2bdSWarner Losh /*-
277ee030bSHidetoshi Shimokawa  * Copyright (c) 2003 Hidetoshi Shimokawa
317821895SHidetoshi Shimokawa  * Copyright (c) 1998-2002 Katsushi Kobayashi and Hidetoshi Shimokawa
417821895SHidetoshi Shimokawa  * All rights reserved.
517821895SHidetoshi Shimokawa  *
617821895SHidetoshi Shimokawa  * Redistribution and use in source and binary forms, with or without
717821895SHidetoshi Shimokawa  * modification, are permitted provided that the following conditions
817821895SHidetoshi Shimokawa  * are met:
917821895SHidetoshi Shimokawa  * 1. Redistributions of source code must retain the above copyright
1017821895SHidetoshi Shimokawa  *    notice, this list of conditions and the following disclaimer.
1117821895SHidetoshi Shimokawa  * 2. Redistributions in binary form must reproduce the above copyright
1217821895SHidetoshi Shimokawa  *    notice, this list of conditions and the following disclaimer in the
1317821895SHidetoshi Shimokawa  *    documentation and/or other materials provided with the distribution.
1417821895SHidetoshi Shimokawa  * 3. All advertising materials mentioning features or use of this software
1517821895SHidetoshi Shimokawa  *    must display the acknowledgement as bellow:
1617821895SHidetoshi Shimokawa  *
1717821895SHidetoshi Shimokawa  *    This product includes software developed by K. Kobayashi and H. Shimokawa
1817821895SHidetoshi Shimokawa  *
1917821895SHidetoshi Shimokawa  * 4. The name of the author may not be used to endorse or promote products
2017821895SHidetoshi Shimokawa  *    derived from this software without specific prior written permission.
2117821895SHidetoshi Shimokawa  *
2217821895SHidetoshi Shimokawa  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
2317821895SHidetoshi Shimokawa  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
2417821895SHidetoshi Shimokawa  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
2517821895SHidetoshi Shimokawa  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
2617821895SHidetoshi Shimokawa  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
2717821895SHidetoshi Shimokawa  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
2817821895SHidetoshi Shimokawa  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2917821895SHidetoshi Shimokawa  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
3017821895SHidetoshi Shimokawa  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
3117821895SHidetoshi Shimokawa  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
3217821895SHidetoshi Shimokawa  * POSSIBILITY OF SUCH DAMAGE.
3317821895SHidetoshi Shimokawa  *
3417821895SHidetoshi Shimokawa  * $FreeBSD$
3517821895SHidetoshi Shimokawa  *
3617821895SHidetoshi Shimokawa  */
3717821895SHidetoshi Shimokawa 
3817821895SHidetoshi Shimokawa #include <sys/param.h>
3917821895SHidetoshi Shimokawa #include <sys/systm.h>
4017821895SHidetoshi Shimokawa #include <sys/types.h>
4117821895SHidetoshi Shimokawa #include <sys/mbuf.h>
42c4778b5dSHidetoshi Shimokawa #include <sys/bio.h>
4317821895SHidetoshi Shimokawa 
4417821895SHidetoshi Shimokawa #include <sys/kernel.h>
4517821895SHidetoshi Shimokawa #include <sys/malloc.h>
4617821895SHidetoshi Shimokawa #include <sys/conf.h>
4717821895SHidetoshi Shimokawa #include <sys/poll.h>
4817821895SHidetoshi Shimokawa 
4917821895SHidetoshi Shimokawa #include <sys/bus.h>
50a160e00eSHidetoshi Shimokawa #include <sys/ctype.h>
5177ee030bSHidetoshi Shimokawa #include <machine/bus.h>
5217821895SHidetoshi Shimokawa 
5317821895SHidetoshi Shimokawa #include <sys/ioccom.h>
5417821895SHidetoshi Shimokawa 
5517821895SHidetoshi Shimokawa #include <dev/firewire/firewire.h>
5617821895SHidetoshi Shimokawa #include <dev/firewire/firewirereg.h>
5777ee030bSHidetoshi Shimokawa #include <dev/firewire/fwdma.h>
5817821895SHidetoshi Shimokawa #include <dev/firewire/fwmem.h>
596d6f7f28SHidetoshi Shimokawa #include <dev/firewire/iec68113.h>
6017821895SHidetoshi Shimokawa 
6117821895SHidetoshi Shimokawa #define	FWNODE_INVAL 0xffff
6217821895SHidetoshi Shimokawa 
6317821895SHidetoshi Shimokawa static	d_open_t	fw_open;
6417821895SHidetoshi Shimokawa static	d_close_t	fw_close;
6517821895SHidetoshi Shimokawa static	d_ioctl_t	fw_ioctl;
6617821895SHidetoshi Shimokawa static	d_poll_t	fw_poll;
6717821895SHidetoshi Shimokawa static	d_read_t	fw_read;	/* for Isochronous packet */
6817821895SHidetoshi Shimokawa static	d_write_t	fw_write;
6917821895SHidetoshi Shimokawa static	d_mmap_t	fw_mmap;
70c4778b5dSHidetoshi Shimokawa static	d_strategy_t	fw_strategy;
7117821895SHidetoshi Shimokawa 
72dc08ffecSPoul-Henning Kamp struct cdevsw firewire_cdevsw = {
73dc08ffecSPoul-Henning Kamp 	.d_version =	D_VERSION,
747ac40f5fSPoul-Henning Kamp 	.d_open =	fw_open,
757ac40f5fSPoul-Henning Kamp 	.d_close =	fw_close,
767ac40f5fSPoul-Henning Kamp 	.d_read =	fw_read,
777ac40f5fSPoul-Henning Kamp 	.d_write =	fw_write,
787ac40f5fSPoul-Henning Kamp 	.d_ioctl =	fw_ioctl,
797ac40f5fSPoul-Henning Kamp 	.d_poll =	fw_poll,
807ac40f5fSPoul-Henning Kamp 	.d_mmap =	fw_mmap,
81c4778b5dSHidetoshi Shimokawa 	.d_strategy =	fw_strategy,
827ac40f5fSPoul-Henning Kamp 	.d_name =	"fw",
839950b741SHidetoshi Shimokawa 	.d_flags =	D_MEM
8417821895SHidetoshi Shimokawa };
8517821895SHidetoshi Shimokawa 
866cada79aSHidetoshi Shimokawa struct fw_drv1 {
870892f4c5SHidetoshi Shimokawa 	struct firewire_comm *fc;
886cada79aSHidetoshi Shimokawa 	struct fw_xferq *ir;
896cada79aSHidetoshi Shimokawa 	struct fw_xferq *it;
906cada79aSHidetoshi Shimokawa 	struct fw_isobufreq bufreq;
910892f4c5SHidetoshi Shimokawa 	STAILQ_HEAD(, fw_bind) binds;
920892f4c5SHidetoshi Shimokawa 	STAILQ_HEAD(, fw_xfer) rq;
936cada79aSHidetoshi Shimokawa };
946cada79aSHidetoshi Shimokawa 
956cada79aSHidetoshi Shimokawa static int
966cada79aSHidetoshi Shimokawa fwdev_allocbuf(struct firewire_comm *fc, struct fw_xferq *q,
976cada79aSHidetoshi Shimokawa 	struct fw_bufspec *b)
986cada79aSHidetoshi Shimokawa {
996cada79aSHidetoshi Shimokawa 	int i;
1006cada79aSHidetoshi Shimokawa 
1016cada79aSHidetoshi Shimokawa 	if (q->flag & (FWXFERQ_RUNNING | FWXFERQ_EXTBUF))
1026cada79aSHidetoshi Shimokawa 		return (EBUSY);
1036cada79aSHidetoshi Shimokawa 
104*23667f08SAlexander Kabaev 	q->bulkxfer = malloc(sizeof(struct fw_bulkxfer) * b->nchunk,
1056cada79aSHidetoshi Shimokawa 	    M_FW, M_WAITOK);
1066cada79aSHidetoshi Shimokawa 	if (q->bulkxfer == NULL)
1076cada79aSHidetoshi Shimokawa 		return (ENOMEM);
1086cada79aSHidetoshi Shimokawa 
10903161bbcSDoug Rabson 	b->psize = roundup2(b->psize, sizeof(uint32_t));
11003161bbcSDoug Rabson 	q->buf = fwdma_malloc_multiseg(fc, sizeof(uint32_t),
1116cada79aSHidetoshi Shimokawa 	    b->psize, b->nchunk * b->npacket, BUS_DMA_WAITOK);
1126cada79aSHidetoshi Shimokawa 
1136cada79aSHidetoshi Shimokawa 	if (q->buf == NULL) {
1146cada79aSHidetoshi Shimokawa 		free(q->bulkxfer, M_FW);
1156cada79aSHidetoshi Shimokawa 		q->bulkxfer = NULL;
1166cada79aSHidetoshi Shimokawa 		return (ENOMEM);
1176cada79aSHidetoshi Shimokawa 	}
1186cada79aSHidetoshi Shimokawa 	q->bnchunk = b->nchunk;
1196cada79aSHidetoshi Shimokawa 	q->bnpacket = b->npacket;
1206cada79aSHidetoshi Shimokawa 	q->psize = (b->psize + 3) & ~3;
1216cada79aSHidetoshi Shimokawa 	q->queued = 0;
1226cada79aSHidetoshi Shimokawa 
1236cada79aSHidetoshi Shimokawa 	STAILQ_INIT(&q->stvalid);
1246cada79aSHidetoshi Shimokawa 	STAILQ_INIT(&q->stfree);
1256cada79aSHidetoshi Shimokawa 	STAILQ_INIT(&q->stdma);
1266cada79aSHidetoshi Shimokawa 	q->stproc = NULL;
1276cada79aSHidetoshi Shimokawa 
1286cada79aSHidetoshi Shimokawa 	for (i = 0; i < q->bnchunk; i++) {
1296cada79aSHidetoshi Shimokawa 		q->bulkxfer[i].poffset = i * q->bnpacket;
1306cada79aSHidetoshi Shimokawa 		q->bulkxfer[i].mbuf = NULL;
1316cada79aSHidetoshi Shimokawa 		STAILQ_INSERT_TAIL(&q->stfree, &q->bulkxfer[i], link);
1326cada79aSHidetoshi Shimokawa 	}
1336cada79aSHidetoshi Shimokawa 
1346cada79aSHidetoshi Shimokawa 	q->flag &= ~FWXFERQ_MODEMASK;
1356cada79aSHidetoshi Shimokawa 	q->flag |= FWXFERQ_STREAM;
1366cada79aSHidetoshi Shimokawa 	q->flag |= FWXFERQ_EXTBUF;
1376cada79aSHidetoshi Shimokawa 
1386cada79aSHidetoshi Shimokawa 	return (0);
1396cada79aSHidetoshi Shimokawa }
1406cada79aSHidetoshi Shimokawa 
1416cada79aSHidetoshi Shimokawa static int
1426cada79aSHidetoshi Shimokawa fwdev_freebuf(struct fw_xferq *q)
1436cada79aSHidetoshi Shimokawa {
1446cada79aSHidetoshi Shimokawa 	if (q->flag & FWXFERQ_EXTBUF) {
1456cada79aSHidetoshi Shimokawa 		if (q->buf != NULL)
1466cada79aSHidetoshi Shimokawa 			fwdma_free_multiseg(q->buf);
1476cada79aSHidetoshi Shimokawa 		q->buf = NULL;
1486cada79aSHidetoshi Shimokawa 		free(q->bulkxfer, M_FW);
1496cada79aSHidetoshi Shimokawa 		q->bulkxfer = NULL;
1506cada79aSHidetoshi Shimokawa 		q->flag &= ~FWXFERQ_EXTBUF;
1516cada79aSHidetoshi Shimokawa 		q->psize = 0;
1526cada79aSHidetoshi Shimokawa 		q->maxq = FWMAXQUEUE;
1536cada79aSHidetoshi Shimokawa 	}
1546cada79aSHidetoshi Shimokawa 	return (0);
1556cada79aSHidetoshi Shimokawa }
1566cada79aSHidetoshi Shimokawa 
1576cada79aSHidetoshi Shimokawa 
15817821895SHidetoshi Shimokawa static int
15989c9c53dSPoul-Henning Kamp fw_open(struct cdev *dev, int flags, int fmt, fw_proc *td)
16017821895SHidetoshi Shimokawa {
16117821895SHidetoshi Shimokawa 	int err = 0;
1620892f4c5SHidetoshi Shimokawa 	int unit = DEV2UNIT(dev);
1630892f4c5SHidetoshi Shimokawa 	struct fw_drv1 *d;
1640892f4c5SHidetoshi Shimokawa 	struct firewire_softc *sc;
16517821895SHidetoshi Shimokawa 
16617821895SHidetoshi Shimokawa 	if (DEV_FWMEM(dev))
16717821895SHidetoshi Shimokawa 		return fwmem_open(dev, flags, fmt, td);
16817821895SHidetoshi Shimokawa 
1699950b741SHidetoshi Shimokawa 	sc = devclass_get_softc(firewire_devclass, unit);
1709950b741SHidetoshi Shimokawa 	if (sc == NULL)
1719950b741SHidetoshi Shimokawa 		return (ENXIO);
1729950b741SHidetoshi Shimokawa 
1739950b741SHidetoshi Shimokawa 	FW_GLOCK(sc->fc);
1749950b741SHidetoshi Shimokawa 	if (dev->si_drv1 != NULL) {
1759950b741SHidetoshi Shimokawa 		FW_GUNLOCK(sc->fc);
1763a927c87SHidetoshi Shimokawa 		return (EBUSY);
1779950b741SHidetoshi Shimokawa 	}
1789950b741SHidetoshi Shimokawa 	/* set dummy value for allocation */
1799950b741SHidetoshi Shimokawa 	dev->si_drv1 = (void *)-1;
1809950b741SHidetoshi Shimokawa 	FW_GUNLOCK(sc->fc);
1819950b741SHidetoshi Shimokawa 
1829950b741SHidetoshi Shimokawa 	dev->si_drv1 = malloc(sizeof(struct fw_drv1), M_FW, M_WAITOK | M_ZERO);
1839950b741SHidetoshi Shimokawa 	if (dev->si_drv1 == NULL)
1849950b741SHidetoshi Shimokawa 		return (ENOMEM);
1853a927c87SHidetoshi Shimokawa 
186a160e00eSHidetoshi Shimokawa 	if ((dev->si_flags & SI_NAMED) == 0) {
187a160e00eSHidetoshi Shimokawa 		int unit = DEV2UNIT(dev);
188a160e00eSHidetoshi Shimokawa 		int sub = DEV2SUB(dev);
189a160e00eSHidetoshi Shimokawa 
1906bfa9a2dSEd Schouten 		make_dev(&firewire_cdevsw, dev2unit(dev),
191*23667f08SAlexander Kabaev 		    UID_ROOT, GID_OPERATOR, 0660, "fw%d.%d", unit, sub);
192a160e00eSHidetoshi Shimokawa 	}
193*23667f08SAlexander Kabaev 
194*23667f08SAlexander Kabaev 	d = dev->si_drv1;
1950892f4c5SHidetoshi Shimokawa 	d->fc = sc->fc;
1960892f4c5SHidetoshi Shimokawa 	STAILQ_INIT(&d->binds);
1970892f4c5SHidetoshi Shimokawa 	STAILQ_INIT(&d->rq);
1986cada79aSHidetoshi Shimokawa 
19917821895SHidetoshi Shimokawa 	return err;
20017821895SHidetoshi Shimokawa }
20117821895SHidetoshi Shimokawa 
20217821895SHidetoshi Shimokawa static int
20389c9c53dSPoul-Henning Kamp fw_close(struct cdev *dev, int flags, int fmt, fw_proc *td)
20417821895SHidetoshi Shimokawa {
2056cada79aSHidetoshi Shimokawa 	struct firewire_comm *fc;
2066cada79aSHidetoshi Shimokawa 	struct fw_drv1 *d;
20717821895SHidetoshi Shimokawa 	struct fw_xfer *xfer;
20817821895SHidetoshi Shimokawa 	struct fw_bind *fwb;
20917821895SHidetoshi Shimokawa 	int err = 0;
21017821895SHidetoshi Shimokawa 
21117821895SHidetoshi Shimokawa 	if (DEV_FWMEM(dev))
21217821895SHidetoshi Shimokawa 		return fwmem_close(dev, flags, fmt, td);
21317821895SHidetoshi Shimokawa 
214*23667f08SAlexander Kabaev 	d = dev->si_drv1;
2150892f4c5SHidetoshi Shimokawa 	fc = d->fc;
21617821895SHidetoshi Shimokawa 
2170892f4c5SHidetoshi Shimokawa 	/* remove binding */
2180892f4c5SHidetoshi Shimokawa 	for (fwb = STAILQ_FIRST(&d->binds); fwb != NULL;
2190892f4c5SHidetoshi Shimokawa 	    fwb = STAILQ_FIRST(&d->binds)) {
2200892f4c5SHidetoshi Shimokawa 		fw_bindremove(fc, fwb);
2210892f4c5SHidetoshi Shimokawa 		STAILQ_REMOVE_HEAD(&d->binds, chlist);
2220892f4c5SHidetoshi Shimokawa 		fw_xferlist_remove(&fwb->xferlist);
2230892f4c5SHidetoshi Shimokawa 		free(fwb, M_FW);
2240892f4c5SHidetoshi Shimokawa 	}
2256cada79aSHidetoshi Shimokawa 	if (d->ir != NULL) {
2266cada79aSHidetoshi Shimokawa 		struct fw_xferq *ir = d->ir;
2276cada79aSHidetoshi Shimokawa 
2286cada79aSHidetoshi Shimokawa 		if ((ir->flag & FWXFERQ_OPEN) == 0)
2296cada79aSHidetoshi Shimokawa 			return (EINVAL);
2306cada79aSHidetoshi Shimokawa 		if (ir->flag & FWXFERQ_RUNNING) {
2316cada79aSHidetoshi Shimokawa 			ir->flag &= ~FWXFERQ_RUNNING;
2326cada79aSHidetoshi Shimokawa 			fc->irx_disable(fc, ir->dmach);
23317821895SHidetoshi Shimokawa 		}
2346cada79aSHidetoshi Shimokawa 		/* free extbuf */
2356cada79aSHidetoshi Shimokawa 		fwdev_freebuf(ir);
2366cada79aSHidetoshi Shimokawa 		/* drain receiving buffer */
2376cada79aSHidetoshi Shimokawa 		for (xfer = STAILQ_FIRST(&ir->q);
2386cada79aSHidetoshi Shimokawa 		    xfer != NULL; xfer = STAILQ_FIRST(&ir->q)) {
2396cada79aSHidetoshi Shimokawa 			ir->queued--;
2406cada79aSHidetoshi Shimokawa 			STAILQ_REMOVE_HEAD(&ir->q, link);
24117821895SHidetoshi Shimokawa 
24217821895SHidetoshi Shimokawa 			xfer->resp = 0;
24317821895SHidetoshi Shimokawa 			fw_xfer_done(xfer);
24417821895SHidetoshi Shimokawa 		}
245*23667f08SAlexander Kabaev 		ir->flag &= ~(FWXFERQ_OPEN | FWXFERQ_MODEMASK |
246*23667f08SAlexander Kabaev 		    FWXFERQ_CHTAGMASK);
2476cada79aSHidetoshi Shimokawa 		d->ir = NULL;
2486cada79aSHidetoshi Shimokawa 
2496cada79aSHidetoshi Shimokawa 	}
2506cada79aSHidetoshi Shimokawa 	if (d->it != NULL) {
2516cada79aSHidetoshi Shimokawa 		struct fw_xferq *it = d->it;
2526cada79aSHidetoshi Shimokawa 
2536cada79aSHidetoshi Shimokawa 		if ((it->flag & FWXFERQ_OPEN) == 0)
2546cada79aSHidetoshi Shimokawa 			return (EINVAL);
2556cada79aSHidetoshi Shimokawa 		if (it->flag & FWXFERQ_RUNNING) {
2566cada79aSHidetoshi Shimokawa 			it->flag &= ~FWXFERQ_RUNNING;
2576cada79aSHidetoshi Shimokawa 			fc->itx_disable(fc, it->dmach);
2586cada79aSHidetoshi Shimokawa 		}
2596cada79aSHidetoshi Shimokawa 		/* free extbuf */
2606cada79aSHidetoshi Shimokawa 		fwdev_freebuf(it);
2616cada79aSHidetoshi Shimokawa 		it->flag &= ~(FWXFERQ_OPEN |
2626cada79aSHidetoshi Shimokawa 		    FWXFERQ_MODEMASK | FWXFERQ_CHTAGMASK);
2636cada79aSHidetoshi Shimokawa 		d->it = NULL;
2646cada79aSHidetoshi Shimokawa 	}
2656cada79aSHidetoshi Shimokawa 	free(dev->si_drv1, M_FW);
2666cada79aSHidetoshi Shimokawa 	dev->si_drv1 = NULL;
2676cada79aSHidetoshi Shimokawa 
26817821895SHidetoshi Shimokawa 	return err;
26917821895SHidetoshi Shimokawa }
27017821895SHidetoshi Shimokawa 
2710892f4c5SHidetoshi Shimokawa static int
2720892f4c5SHidetoshi Shimokawa fw_read_async(struct fw_drv1 *d, struct uio *uio, int ioflag)
2730892f4c5SHidetoshi Shimokawa {
2740892f4c5SHidetoshi Shimokawa 	int err = 0, s;
2750892f4c5SHidetoshi Shimokawa 	struct fw_xfer *xfer;
2760892f4c5SHidetoshi Shimokawa 	struct fw_bind *fwb;
2770892f4c5SHidetoshi Shimokawa 	struct fw_pkt *fp;
2780892f4c5SHidetoshi Shimokawa 	struct tcode_info *tinfo;
2790892f4c5SHidetoshi Shimokawa 
2809950b741SHidetoshi Shimokawa 	FW_GLOCK(d->fc);
2810892f4c5SHidetoshi Shimokawa 	while ((xfer = STAILQ_FIRST(&d->rq)) == NULL && err == 0)
2829950b741SHidetoshi Shimokawa 		err = msleep(&d->rq, FW_GMTX(d->fc), FWPRI, "fwra", 0);
2830892f4c5SHidetoshi Shimokawa 
2849950b741SHidetoshi Shimokawa 	if (err != 0) {
2859950b741SHidetoshi Shimokawa 		FW_GUNLOCK(d->fc);
2860892f4c5SHidetoshi Shimokawa 		return (err);
2879950b741SHidetoshi Shimokawa 	}
2880892f4c5SHidetoshi Shimokawa 
2890892f4c5SHidetoshi Shimokawa 	s = splfw();
2900892f4c5SHidetoshi Shimokawa 	STAILQ_REMOVE_HEAD(&d->rq, link);
2919950b741SHidetoshi Shimokawa 	FW_GUNLOCK(xfer->fc);
2920892f4c5SHidetoshi Shimokawa 	splx(s);
2930892f4c5SHidetoshi Shimokawa 	fp = &xfer->recv.hdr;
2940892f4c5SHidetoshi Shimokawa #if 0 /* for GASP ?? */
2950892f4c5SHidetoshi Shimokawa 	if (fc->irx_post != NULL)
2960892f4c5SHidetoshi Shimokawa 		fc->irx_post(fc, fp->mode.ld);
2970892f4c5SHidetoshi Shimokawa #endif
2980892f4c5SHidetoshi Shimokawa 	tinfo = &xfer->fc->tcode[fp->mode.hdr.tcode];
299*23667f08SAlexander Kabaev 	err = uiomove(fp, tinfo->hdr_len, uio);
3000892f4c5SHidetoshi Shimokawa 	if (err)
3010892f4c5SHidetoshi Shimokawa 		goto out;
302*23667f08SAlexander Kabaev 	err = uiomove(xfer->recv.payload, xfer->recv.pay_len, uio);
3030892f4c5SHidetoshi Shimokawa 
3040892f4c5SHidetoshi Shimokawa out:
3050892f4c5SHidetoshi Shimokawa 	/* recycle this xfer */
3060892f4c5SHidetoshi Shimokawa 	fwb = (struct fw_bind *)xfer->sc;
3070892f4c5SHidetoshi Shimokawa 	fw_xfer_unload(xfer);
3080892f4c5SHidetoshi Shimokawa 	xfer->recv.pay_len = PAGE_SIZE;
3099950b741SHidetoshi Shimokawa 	FW_GLOCK(xfer->fc);
3100892f4c5SHidetoshi Shimokawa 	STAILQ_INSERT_TAIL(&fwb->xferlist, xfer, link);
3119950b741SHidetoshi Shimokawa 	FW_GUNLOCK(xfer->fc);
3120892f4c5SHidetoshi Shimokawa 	return (err);
3130892f4c5SHidetoshi Shimokawa }
3140892f4c5SHidetoshi Shimokawa 
31517821895SHidetoshi Shimokawa /*
31617821895SHidetoshi Shimokawa  * read request.
31717821895SHidetoshi Shimokawa  */
31817821895SHidetoshi Shimokawa static int
31989c9c53dSPoul-Henning Kamp fw_read(struct cdev *dev, struct uio *uio, int ioflag)
32017821895SHidetoshi Shimokawa {
3210892f4c5SHidetoshi Shimokawa 	struct fw_drv1 *d;
32217821895SHidetoshi Shimokawa 	struct fw_xferq *ir;
3230892f4c5SHidetoshi Shimokawa 	struct firewire_comm *fc;
32417821895SHidetoshi Shimokawa 	int err = 0, s, slept = 0;
32517821895SHidetoshi Shimokawa 	struct fw_pkt *fp;
32617821895SHidetoshi Shimokawa 
32717821895SHidetoshi Shimokawa 	if (DEV_FWMEM(dev))
3289950b741SHidetoshi Shimokawa 		return (physio(dev, uio, ioflag));
32917821895SHidetoshi Shimokawa 
330*23667f08SAlexander Kabaev 	d = dev->si_drv1;
3310892f4c5SHidetoshi Shimokawa 	fc = d->fc;
3320892f4c5SHidetoshi Shimokawa 	ir = d->ir;
3330892f4c5SHidetoshi Shimokawa 
3340892f4c5SHidetoshi Shimokawa 	if (ir == NULL)
3350892f4c5SHidetoshi Shimokawa 		return (fw_read_async(d, uio, ioflag));
3360892f4c5SHidetoshi Shimokawa 
3370892f4c5SHidetoshi Shimokawa 	if (ir->buf == NULL)
3386cada79aSHidetoshi Shimokawa 		return (EIO);
33917821895SHidetoshi Shimokawa 
3409950b741SHidetoshi Shimokawa 	FW_GLOCK(fc);
34117821895SHidetoshi Shimokawa readloop:
34277ee030bSHidetoshi Shimokawa 	if (ir->stproc == NULL) {
343c3e9e255SHidetoshi Shimokawa 		/* iso bulkxfer */
34417821895SHidetoshi Shimokawa 		ir->stproc = STAILQ_FIRST(&ir->stvalid);
34517821895SHidetoshi Shimokawa 		if (ir->stproc != NULL) {
34617821895SHidetoshi Shimokawa 			s = splfw();
34717821895SHidetoshi Shimokawa 			STAILQ_REMOVE_HEAD(&ir->stvalid, link);
34817821895SHidetoshi Shimokawa 			splx(s);
34917821895SHidetoshi Shimokawa 			ir->queued = 0;
35017821895SHidetoshi Shimokawa 		}
35117821895SHidetoshi Shimokawa 	}
3520892f4c5SHidetoshi Shimokawa 	if (ir->stproc == NULL) {
353c3e9e255SHidetoshi Shimokawa 		/* no data avaliable */
35417821895SHidetoshi Shimokawa 		if (slept == 0) {
35517821895SHidetoshi Shimokawa 			slept = 1;
35617821895SHidetoshi Shimokawa 			ir->flag |= FWXFERQ_WAKEUP;
3579950b741SHidetoshi Shimokawa 			err = msleep(ir, FW_GMTX(fc), FWPRI, "fw_read", hz);
35817821895SHidetoshi Shimokawa 			ir->flag &= ~FWXFERQ_WAKEUP;
359c3e9e255SHidetoshi Shimokawa 			if (err == 0)
36017821895SHidetoshi Shimokawa 				goto readloop;
361c3e9e255SHidetoshi Shimokawa 		} else if (slept == 1)
36217821895SHidetoshi Shimokawa 			err = EIO;
3639950b741SHidetoshi Shimokawa 		FW_GUNLOCK(fc);
36417821895SHidetoshi Shimokawa 		return err;
36517821895SHidetoshi Shimokawa 	} else if (ir->stproc != NULL) {
366c3e9e255SHidetoshi Shimokawa 		/* iso bulkxfer */
3679950b741SHidetoshi Shimokawa 		FW_GUNLOCK(fc);
36877ee030bSHidetoshi Shimokawa 		fp = (struct fw_pkt *)fwdma_v_addr(ir->buf,
36977ee030bSHidetoshi Shimokawa 		    ir->stproc->poffset + ir->queued);
3700892f4c5SHidetoshi Shimokawa 		if (fc->irx_post != NULL)
3710892f4c5SHidetoshi Shimokawa 			fc->irx_post(fc, fp->mode.ld);
37277ee030bSHidetoshi Shimokawa 		if (fp->mode.stream.len == 0) {
37317821895SHidetoshi Shimokawa 			err = EIO;
37417821895SHidetoshi Shimokawa 			return err;
37517821895SHidetoshi Shimokawa 		}
376c3e9e255SHidetoshi Shimokawa 		err = uiomove((caddr_t)fp,
37703161bbcSDoug Rabson 			fp->mode.stream.len + sizeof(uint32_t), uio);
37817821895SHidetoshi Shimokawa 		ir->queued++;
37917821895SHidetoshi Shimokawa 		if (ir->queued >= ir->bnpacket) {
38017821895SHidetoshi Shimokawa 			s = splfw();
38117821895SHidetoshi Shimokawa 			STAILQ_INSERT_TAIL(&ir->stfree, ir->stproc, link);
38217821895SHidetoshi Shimokawa 			splx(s);
3830892f4c5SHidetoshi Shimokawa 			fc->irx_enable(fc, ir->dmach);
38417821895SHidetoshi Shimokawa 			ir->stproc = NULL;
38517821895SHidetoshi Shimokawa 		}
386c3e9e255SHidetoshi Shimokawa 		if (uio->uio_resid >= ir->psize) {
387c3e9e255SHidetoshi Shimokawa 			slept = -1;
3889950b741SHidetoshi Shimokawa 			FW_GLOCK(fc);
389c3e9e255SHidetoshi Shimokawa 			goto readloop;
390c3e9e255SHidetoshi Shimokawa 		}
39117821895SHidetoshi Shimokawa 	}
39217821895SHidetoshi Shimokawa 	return err;
39317821895SHidetoshi Shimokawa }
39417821895SHidetoshi Shimokawa 
39517821895SHidetoshi Shimokawa static int
3960892f4c5SHidetoshi Shimokawa fw_write_async(struct fw_drv1 *d, struct uio *uio, int ioflag)
3970892f4c5SHidetoshi Shimokawa {
3980892f4c5SHidetoshi Shimokawa 	struct fw_xfer *xfer;
3990892f4c5SHidetoshi Shimokawa 	struct fw_pkt pkt;
4000892f4c5SHidetoshi Shimokawa 	struct tcode_info *tinfo;
4010892f4c5SHidetoshi Shimokawa 	int err;
4020892f4c5SHidetoshi Shimokawa 
4030892f4c5SHidetoshi Shimokawa 	bzero(&pkt, sizeof(struct fw_pkt));
4040892f4c5SHidetoshi Shimokawa 	if ((err = uiomove((caddr_t)&pkt, sizeof(uint32_t), uio)))
4050892f4c5SHidetoshi Shimokawa 		return (err);
4060892f4c5SHidetoshi Shimokawa 	tinfo = &d->fc->tcode[pkt.mode.hdr.tcode];
4070892f4c5SHidetoshi Shimokawa 	if ((err = uiomove((caddr_t)&pkt + sizeof(uint32_t),
4080892f4c5SHidetoshi Shimokawa 	    tinfo->hdr_len - sizeof(uint32_t), uio)))
4090892f4c5SHidetoshi Shimokawa 		return (err);
4100892f4c5SHidetoshi Shimokawa 
4110892f4c5SHidetoshi Shimokawa 	if ((xfer = fw_xfer_alloc_buf(M_FWXFER, uio->uio_resid,
4120892f4c5SHidetoshi Shimokawa 	    PAGE_SIZE/*XXX*/)) == NULL)
4130892f4c5SHidetoshi Shimokawa 		return (ENOMEM);
4140892f4c5SHidetoshi Shimokawa 
4150892f4c5SHidetoshi Shimokawa 	bcopy(&pkt, &xfer->send.hdr, sizeof(struct fw_pkt));
4160892f4c5SHidetoshi Shimokawa 	xfer->send.pay_len = uio->uio_resid;
4170892f4c5SHidetoshi Shimokawa 	if (uio->uio_resid > 0) {
4180892f4c5SHidetoshi Shimokawa 		if ((err = uiomove((caddr_t)&xfer->send.payload[0],
41903cd51dfSRoman Divacky 		    uio->uio_resid, uio)))
4200892f4c5SHidetoshi Shimokawa 			goto out;
4210892f4c5SHidetoshi Shimokawa 	}
4220892f4c5SHidetoshi Shimokawa 
4230892f4c5SHidetoshi Shimokawa 	xfer->fc = d->fc;
4240892f4c5SHidetoshi Shimokawa 	xfer->sc = NULL;
4259950b741SHidetoshi Shimokawa 	xfer->hand = fw_xferwake;
4260892f4c5SHidetoshi Shimokawa 	xfer->send.spd = 2 /* XXX */;
4270892f4c5SHidetoshi Shimokawa 
4280892f4c5SHidetoshi Shimokawa 	if ((err = fw_asyreq(xfer->fc, -1, xfer)))
4290892f4c5SHidetoshi Shimokawa 		goto out;
4300892f4c5SHidetoshi Shimokawa 
4319950b741SHidetoshi Shimokawa 	if ((err = fw_xferwait(xfer)))
4320892f4c5SHidetoshi Shimokawa 		goto out;
4330892f4c5SHidetoshi Shimokawa 
4340892f4c5SHidetoshi Shimokawa 	if (xfer->resp != 0) {
4350892f4c5SHidetoshi Shimokawa 		err = xfer->resp;
4360892f4c5SHidetoshi Shimokawa 		goto out;
4370892f4c5SHidetoshi Shimokawa 	}
4380892f4c5SHidetoshi Shimokawa 
4399950b741SHidetoshi Shimokawa 	if (xfer->flag & FWXF_RCVD) {
4409950b741SHidetoshi Shimokawa 		FW_GLOCK(xfer->fc);
4410892f4c5SHidetoshi Shimokawa 		STAILQ_INSERT_TAIL(&d->rq, xfer, link);
4429950b741SHidetoshi Shimokawa 		FW_GUNLOCK(xfer->fc);
4430892f4c5SHidetoshi Shimokawa 		return (0);
4440892f4c5SHidetoshi Shimokawa 	}
4450892f4c5SHidetoshi Shimokawa 
4460892f4c5SHidetoshi Shimokawa out:
4470892f4c5SHidetoshi Shimokawa 	fw_xfer_free(xfer);
4480892f4c5SHidetoshi Shimokawa 	return (err);
4490892f4c5SHidetoshi Shimokawa }
4500892f4c5SHidetoshi Shimokawa 
4510892f4c5SHidetoshi Shimokawa static int
45289c9c53dSPoul-Henning Kamp fw_write(struct cdev *dev, struct uio *uio, int ioflag)
45317821895SHidetoshi Shimokawa {
45417821895SHidetoshi Shimokawa 	int err = 0;
45517821895SHidetoshi Shimokawa 	int s, slept = 0;
4560892f4c5SHidetoshi Shimokawa 	struct fw_drv1 *d;
45717821895SHidetoshi Shimokawa 	struct fw_pkt *fp;
45817821895SHidetoshi Shimokawa 	struct firewire_comm *fc;
45917821895SHidetoshi Shimokawa 	struct fw_xferq *it;
46017821895SHidetoshi Shimokawa 
46117821895SHidetoshi Shimokawa 	if (DEV_FWMEM(dev))
4629950b741SHidetoshi Shimokawa 		return (physio(dev, uio, ioflag));
46317821895SHidetoshi Shimokawa 
464*23667f08SAlexander Kabaev 	d = dev->si_drv1;
4650892f4c5SHidetoshi Shimokawa 	fc = d->fc;
4660892f4c5SHidetoshi Shimokawa 	it = d->it;
4670892f4c5SHidetoshi Shimokawa 
4680892f4c5SHidetoshi Shimokawa 	if (it == NULL)
4690892f4c5SHidetoshi Shimokawa 		return (fw_write_async(d, uio, ioflag));
4700892f4c5SHidetoshi Shimokawa 
4710892f4c5SHidetoshi Shimokawa 	if (it->buf == NULL)
4726cada79aSHidetoshi Shimokawa 		return (EIO);
4739950b741SHidetoshi Shimokawa 
4749950b741SHidetoshi Shimokawa 	FW_GLOCK(fc);
47517821895SHidetoshi Shimokawa isoloop:
47617821895SHidetoshi Shimokawa 	if (it->stproc == NULL) {
47717821895SHidetoshi Shimokawa 		it->stproc = STAILQ_FIRST(&it->stfree);
47817821895SHidetoshi Shimokawa 		if (it->stproc != NULL) {
47917821895SHidetoshi Shimokawa 			s = splfw();
48017821895SHidetoshi Shimokawa 			STAILQ_REMOVE_HEAD(&it->stfree, link);
48117821895SHidetoshi Shimokawa 			splx(s);
48217821895SHidetoshi Shimokawa 			it->queued = 0;
48317821895SHidetoshi Shimokawa 		} else if (slept == 0) {
48417821895SHidetoshi Shimokawa 			slept = 1;
4859950b741SHidetoshi Shimokawa #if 0	/* XXX to avoid lock recursion */
4860892f4c5SHidetoshi Shimokawa 			err = fc->itx_enable(fc, it->dmach);
487c3e9e255SHidetoshi Shimokawa 			if (err)
4889950b741SHidetoshi Shimokawa 				goto out;
4899950b741SHidetoshi Shimokawa #endif
4909950b741SHidetoshi Shimokawa 			err = msleep(it, FW_GMTX(fc), FWPRI, "fw_write", hz);
491c3e9e255SHidetoshi Shimokawa 			if (err)
4929950b741SHidetoshi Shimokawa 				goto out;
49317821895SHidetoshi Shimokawa 			goto isoloop;
49417821895SHidetoshi Shimokawa 		} else {
49517821895SHidetoshi Shimokawa 			err = EIO;
4969950b741SHidetoshi Shimokawa 			goto out;
49717821895SHidetoshi Shimokawa 		}
49817821895SHidetoshi Shimokawa 	}
4999950b741SHidetoshi Shimokawa 	FW_GUNLOCK(fc);
50077ee030bSHidetoshi Shimokawa 	fp = (struct fw_pkt *)fwdma_v_addr(it->buf,
50177ee030bSHidetoshi Shimokawa 			it->stproc->poffset + it->queued);
502c3e9e255SHidetoshi Shimokawa 	err = uiomove((caddr_t)fp, sizeof(struct fw_isohdr), uio);
503c3e9e255SHidetoshi Shimokawa 	err = uiomove((caddr_t)fp->mode.stream.payload,
50477ee030bSHidetoshi Shimokawa 				fp->mode.stream.len, uio);
50517821895SHidetoshi Shimokawa 	it->queued++;
506c3e9e255SHidetoshi Shimokawa 	if (it->queued >= it->bnpacket) {
50717821895SHidetoshi Shimokawa 		s = splfw();
50817821895SHidetoshi Shimokawa 		STAILQ_INSERT_TAIL(&it->stvalid, it->stproc, link);
50917821895SHidetoshi Shimokawa 		splx(s);
51017821895SHidetoshi Shimokawa 		it->stproc = NULL;
5110892f4c5SHidetoshi Shimokawa 		err = fc->itx_enable(fc, it->dmach);
51217821895SHidetoshi Shimokawa 	}
513c3e9e255SHidetoshi Shimokawa 	if (uio->uio_resid >= sizeof(struct fw_isohdr)) {
514c3e9e255SHidetoshi Shimokawa 		slept = 0;
5159950b741SHidetoshi Shimokawa 		FW_GLOCK(fc);
516c3e9e255SHidetoshi Shimokawa 		goto isoloop;
517c3e9e255SHidetoshi Shimokawa 	}
51817821895SHidetoshi Shimokawa 	return err;
5199950b741SHidetoshi Shimokawa 
5209950b741SHidetoshi Shimokawa out:
5219950b741SHidetoshi Shimokawa 	FW_GUNLOCK(fc);
5229950b741SHidetoshi Shimokawa 	return err;
5239190691bSHidetoshi Shimokawa }
5240892f4c5SHidetoshi Shimokawa 
5250892f4c5SHidetoshi Shimokawa static void
5260892f4c5SHidetoshi Shimokawa fw_hand(struct fw_xfer *xfer)
5270892f4c5SHidetoshi Shimokawa {
5280892f4c5SHidetoshi Shimokawa 	struct fw_bind *fwb;
5290892f4c5SHidetoshi Shimokawa 	struct fw_drv1 *d;
5300892f4c5SHidetoshi Shimokawa 
5310892f4c5SHidetoshi Shimokawa 	fwb = (struct fw_bind *)xfer->sc;
532*23667f08SAlexander Kabaev 	d = fwb->sc;
5339950b741SHidetoshi Shimokawa 	FW_GLOCK(xfer->fc);
5340892f4c5SHidetoshi Shimokawa 	STAILQ_INSERT_TAIL(&d->rq, xfer, link);
5359950b741SHidetoshi Shimokawa 	FW_GUNLOCK(xfer->fc);
5360892f4c5SHidetoshi Shimokawa 	wakeup(&d->rq);
5370892f4c5SHidetoshi Shimokawa }
5380892f4c5SHidetoshi Shimokawa 
53917821895SHidetoshi Shimokawa /*
54017821895SHidetoshi Shimokawa  * ioctl support.
54117821895SHidetoshi Shimokawa  */
54217821895SHidetoshi Shimokawa int
54389c9c53dSPoul-Henning Kamp fw_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int flag, fw_proc *td)
54417821895SHidetoshi Shimokawa {
5456cada79aSHidetoshi Shimokawa 	struct firewire_comm *fc;
5466cada79aSHidetoshi Shimokawa 	struct fw_drv1 *d;
5470892f4c5SHidetoshi Shimokawa 	int i, len, err = 0;
54817821895SHidetoshi Shimokawa 	struct fw_device *fwdev;
54917821895SHidetoshi Shimokawa 	struct fw_bind *fwb;
55017821895SHidetoshi Shimokawa 	struct fw_xferq *ir, *it;
55117821895SHidetoshi Shimokawa 	struct fw_xfer *xfer;
55217821895SHidetoshi Shimokawa 	struct fw_pkt *fp;
553c547b896SHidetoshi Shimokawa 	struct fw_devinfo *devinfo;
554d7e486b4SHidetoshi Shimokawa 	void *ptr;
55517821895SHidetoshi Shimokawa 
55617821895SHidetoshi Shimokawa 	struct fw_devlstreq *fwdevlst = (struct fw_devlstreq *)data;
55717821895SHidetoshi Shimokawa 	struct fw_asyreq *asyreq = (struct fw_asyreq *)data;
55817821895SHidetoshi Shimokawa 	struct fw_isochreq *ichreq = (struct fw_isochreq *)data;
55917821895SHidetoshi Shimokawa 	struct fw_isobufreq *ibufreq = (struct fw_isobufreq *)data;
56017821895SHidetoshi Shimokawa 	struct fw_asybindreq *bindreq = (struct fw_asybindreq *)data;
56117821895SHidetoshi Shimokawa 	struct fw_crom_buf *crom_buf = (struct fw_crom_buf *)data;
56217821895SHidetoshi Shimokawa 
56317821895SHidetoshi Shimokawa 	if (DEV_FWMEM(dev))
56417821895SHidetoshi Shimokawa 		return fwmem_ioctl(dev, cmd, data, flag, td);
56517821895SHidetoshi Shimokawa 
56617821895SHidetoshi Shimokawa 	if (!data)
56717821895SHidetoshi Shimokawa 		return (EINVAL);
56817821895SHidetoshi Shimokawa 
569*23667f08SAlexander Kabaev 	d = dev->si_drv1;
5700892f4c5SHidetoshi Shimokawa 	fc = d->fc;
5716cada79aSHidetoshi Shimokawa 	ir = d->ir;
5726cada79aSHidetoshi Shimokawa 	it = d->it;
5736cada79aSHidetoshi Shimokawa 
57417821895SHidetoshi Shimokawa 	switch (cmd) {
57517821895SHidetoshi Shimokawa 	case FW_STSTREAM:
5766cada79aSHidetoshi Shimokawa 		if (it == NULL) {
5779950b741SHidetoshi Shimokawa 			i = fw_open_isodma(fc, /* tx */1);
5789950b741SHidetoshi Shimokawa 			if (i < 0) {
5796cada79aSHidetoshi Shimokawa 				err = EBUSY;
5806cada79aSHidetoshi Shimokawa 				break;
5816cada79aSHidetoshi Shimokawa 			}
5829950b741SHidetoshi Shimokawa 			it = fc->it[i];
5836cada79aSHidetoshi Shimokawa 			err = fwdev_allocbuf(fc, it, &d->bufreq.tx);
5849950b741SHidetoshi Shimokawa 			if (err) {
5859950b741SHidetoshi Shimokawa 				it->flag &= ~FWXFERQ_OPEN;
5866cada79aSHidetoshi Shimokawa 				break;
5879950b741SHidetoshi Shimokawa 			}
5886cada79aSHidetoshi Shimokawa 		}
5896cada79aSHidetoshi Shimokawa 		it->flag &= ~0xff;
5906cada79aSHidetoshi Shimokawa 		it->flag |= (0x3f & ichreq->ch);
5916cada79aSHidetoshi Shimokawa 		it->flag |= ((0x3 & ichreq->tag) << 6);
5926cada79aSHidetoshi Shimokawa 		d->it = it;
59317821895SHidetoshi Shimokawa 		break;
59417821895SHidetoshi Shimokawa 	case FW_GTSTREAM:
5956cada79aSHidetoshi Shimokawa 		if (it != NULL) {
5966cada79aSHidetoshi Shimokawa 			ichreq->ch = it->flag & 0x3f;
5976cada79aSHidetoshi Shimokawa 			ichreq->tag = it->flag >> 2 & 0x3;
5986cada79aSHidetoshi Shimokawa 		} else
5996cada79aSHidetoshi Shimokawa 			err = EINVAL;
60017821895SHidetoshi Shimokawa 		break;
60117821895SHidetoshi Shimokawa 	case FW_SRSTREAM:
6026cada79aSHidetoshi Shimokawa 		if (ir == NULL) {
6039950b741SHidetoshi Shimokawa 			i = fw_open_isodma(fc, /* tx */0);
6049950b741SHidetoshi Shimokawa 			if (i < 0) {
6056cada79aSHidetoshi Shimokawa 				err = EBUSY;
6066cada79aSHidetoshi Shimokawa 				break;
6076cada79aSHidetoshi Shimokawa 			}
6089950b741SHidetoshi Shimokawa 			ir = fc->ir[i];
6096cada79aSHidetoshi Shimokawa 			err = fwdev_allocbuf(fc, ir, &d->bufreq.rx);
6109950b741SHidetoshi Shimokawa 			if (err) {
6119950b741SHidetoshi Shimokawa 				ir->flag &= ~FWXFERQ_OPEN;
6126cada79aSHidetoshi Shimokawa 				break;
6139950b741SHidetoshi Shimokawa 			}
6146cada79aSHidetoshi Shimokawa 		}
6156cada79aSHidetoshi Shimokawa 		ir->flag &= ~0xff;
6166cada79aSHidetoshi Shimokawa 		ir->flag |= (0x3f & ichreq->ch);
6176cada79aSHidetoshi Shimokawa 		ir->flag |= ((0x3 & ichreq->tag) << 6);
6186cada79aSHidetoshi Shimokawa 		d->ir = ir;
6196cada79aSHidetoshi Shimokawa 		err = fc->irx_enable(fc, ir->dmach);
62017821895SHidetoshi Shimokawa 		break;
62117821895SHidetoshi Shimokawa 	case FW_GRSTREAM:
6226cada79aSHidetoshi Shimokawa 		if (d->ir != NULL) {
6236cada79aSHidetoshi Shimokawa 			ichreq->ch = ir->flag & 0x3f;
6246cada79aSHidetoshi Shimokawa 			ichreq->tag = ir->flag >> 2 & 0x3;
6256cada79aSHidetoshi Shimokawa 		} else
6266cada79aSHidetoshi Shimokawa 			err = EINVAL;
62717821895SHidetoshi Shimokawa 		break;
62817821895SHidetoshi Shimokawa 	case FW_SSTBUF:
6296cada79aSHidetoshi Shimokawa 		bcopy(ibufreq, &d->bufreq, sizeof(d->bufreq));
63017821895SHidetoshi Shimokawa 		break;
63117821895SHidetoshi Shimokawa 	case FW_GSTBUF:
6326cada79aSHidetoshi Shimokawa 		bzero(&ibufreq->rx, sizeof(ibufreq->rx));
6336cada79aSHidetoshi Shimokawa 		if (ir != NULL) {
6346cada79aSHidetoshi Shimokawa 			ibufreq->rx.nchunk = ir->bnchunk;
6356cada79aSHidetoshi Shimokawa 			ibufreq->rx.npacket = ir->bnpacket;
6366cada79aSHidetoshi Shimokawa 			ibufreq->rx.psize = ir->psize;
6376cada79aSHidetoshi Shimokawa 		}
6386cada79aSHidetoshi Shimokawa 		bzero(&ibufreq->tx, sizeof(ibufreq->tx));
6396cada79aSHidetoshi Shimokawa 		if (it != NULL) {
6406cada79aSHidetoshi Shimokawa 			ibufreq->tx.nchunk = it->bnchunk;
6416cada79aSHidetoshi Shimokawa 			ibufreq->tx.npacket = it->bnpacket;
6426cada79aSHidetoshi Shimokawa 			ibufreq->tx.psize = it->psize;
6436cada79aSHidetoshi Shimokawa 		}
64417821895SHidetoshi Shimokawa 		break;
64517821895SHidetoshi Shimokawa 	case FW_ASYREQ:
646c4778b5dSHidetoshi Shimokawa 	{
647c4778b5dSHidetoshi Shimokawa 		struct tcode_info *tinfo;
648102ebc1fSHidetoshi Shimokawa 		int pay_len = 0;
649c4778b5dSHidetoshi Shimokawa 
65017821895SHidetoshi Shimokawa 		fp = &asyreq->pkt;
6510892f4c5SHidetoshi Shimokawa 		tinfo = &fc->tcode[fp->mode.hdr.tcode];
652102ebc1fSHidetoshi Shimokawa 
653102ebc1fSHidetoshi Shimokawa 		if ((tinfo->flag & FWTI_BLOCK_ASY) != 0)
654102ebc1fSHidetoshi Shimokawa 			pay_len = MAX(0, asyreq->req.len - tinfo->hdr_len);
655102ebc1fSHidetoshi Shimokawa 
656102ebc1fSHidetoshi Shimokawa 		xfer = fw_xfer_alloc_buf(M_FWXFER, pay_len, PAGE_SIZE/*XXX*/);
657102ebc1fSHidetoshi Shimokawa 		if (xfer == NULL)
658102ebc1fSHidetoshi Shimokawa 			return (ENOMEM);
659102ebc1fSHidetoshi Shimokawa 
66017821895SHidetoshi Shimokawa 		switch (asyreq->req.type) {
66117821895SHidetoshi Shimokawa 		case FWASREQNODE:
66217821895SHidetoshi Shimokawa 			break;
66317821895SHidetoshi Shimokawa 		case FWASREQEUI:
6640892f4c5SHidetoshi Shimokawa 			fwdev = fw_noderesolve_eui64(fc,
665233b1b97SHidetoshi Shimokawa 						&asyreq->req.dst.eui);
66617821895SHidetoshi Shimokawa 			if (fwdev == NULL) {
6670892f4c5SHidetoshi Shimokawa 				device_printf(fc->bdev,
66817faeefcSHidetoshi Shimokawa 					"cannot find node\n");
66917821895SHidetoshi Shimokawa 				err = EINVAL;
670102ebc1fSHidetoshi Shimokawa 				goto out;
67117821895SHidetoshi Shimokawa 			}
672c4778b5dSHidetoshi Shimokawa 			fp->mode.hdr.dst = FWLOCALBUS | fwdev->dst;
67317821895SHidetoshi Shimokawa 			break;
67417821895SHidetoshi Shimokawa 		case FWASRESTL:
67517821895SHidetoshi Shimokawa 			/* XXX what's this? */
67617821895SHidetoshi Shimokawa 			break;
67717821895SHidetoshi Shimokawa 		case FWASREQSTREAM:
67817821895SHidetoshi Shimokawa 			/* nothing to do */
67917821895SHidetoshi Shimokawa 			break;
68017821895SHidetoshi Shimokawa 		}
681102ebc1fSHidetoshi Shimokawa 
682c4778b5dSHidetoshi Shimokawa 		bcopy(fp, (void *)&xfer->send.hdr, tinfo->hdr_len);
683102ebc1fSHidetoshi Shimokawa 		if (pay_len > 0)
684c4778b5dSHidetoshi Shimokawa 			bcopy((char *)fp + tinfo->hdr_len,
685*23667f08SAlexander Kabaev 			    xfer->send.payload, pay_len);
686102ebc1fSHidetoshi Shimokawa 		xfer->send.spd = asyreq->req.sped;
6879950b741SHidetoshi Shimokawa 		xfer->hand = fw_xferwake;
688102ebc1fSHidetoshi Shimokawa 
6890892f4c5SHidetoshi Shimokawa 		if ((err = fw_asyreq(fc, -1, xfer)) != 0)
690102ebc1fSHidetoshi Shimokawa 			goto out;
6919950b741SHidetoshi Shimokawa 		if ((err = fw_xferwait(xfer)) != 0)
692102ebc1fSHidetoshi Shimokawa 			goto out;
693c4778b5dSHidetoshi Shimokawa 		if (xfer->resp != 0) {
694c4778b5dSHidetoshi Shimokawa 			err = EIO;
695102ebc1fSHidetoshi Shimokawa 			goto out;
696c4778b5dSHidetoshi Shimokawa 		}
697102ebc1fSHidetoshi Shimokawa 		if ((tinfo->flag & FWTI_TLABEL) == 0)
698102ebc1fSHidetoshi Shimokawa 			goto out;
699102ebc1fSHidetoshi Shimokawa 
700102ebc1fSHidetoshi Shimokawa 		/* copy response */
7010892f4c5SHidetoshi Shimokawa 		tinfo = &fc->tcode[xfer->recv.hdr.mode.hdr.tcode];
7027b1f6286SDoug Rabson 		if (xfer->recv.hdr.mode.hdr.tcode == FWTCODE_RRESB ||
7037b1f6286SDoug Rabson 		    xfer->recv.hdr.mode.hdr.tcode == FWTCODE_LRES) {
7047b1f6286SDoug Rabson 			pay_len = xfer->recv.pay_len;
7057b1f6286SDoug Rabson 			if (asyreq->req.len >= xfer->recv.pay_len + tinfo->hdr_len) {
7067b1f6286SDoug Rabson 				asyreq->req.len = xfer->recv.pay_len +
7077b1f6286SDoug Rabson 				    tinfo->hdr_len;
7087b1f6286SDoug Rabson 			} else {
70917821895SHidetoshi Shimokawa 				err = EINVAL;
7107b1f6286SDoug Rabson 				pay_len = 0;
7117b1f6286SDoug Rabson 			}
7127b1f6286SDoug Rabson 		} else {
7137b1f6286SDoug Rabson 			pay_len = 0;
7147b1f6286SDoug Rabson 		}
715c4778b5dSHidetoshi Shimokawa 		bcopy(&xfer->recv.hdr, fp, tinfo->hdr_len);
7167b1f6286SDoug Rabson 		bcopy(xfer->recv.payload, (char *)fp + tinfo->hdr_len, pay_len);
717102ebc1fSHidetoshi Shimokawa out:
718c4778b5dSHidetoshi Shimokawa 		fw_xfer_free_buf(xfer);
71917821895SHidetoshi Shimokawa 		break;
720c4778b5dSHidetoshi Shimokawa 	}
72117821895SHidetoshi Shimokawa 	case FW_IBUSRST:
7220892f4c5SHidetoshi Shimokawa 		fc->ibr(fc);
72317821895SHidetoshi Shimokawa 		break;
72417821895SHidetoshi Shimokawa 	case FW_CBINDADDR:
7250892f4c5SHidetoshi Shimokawa 		fwb = fw_bindlookup(fc,
72617821895SHidetoshi Shimokawa 				bindreq->start.hi, bindreq->start.lo);
72717821895SHidetoshi Shimokawa 		if (fwb == NULL) {
72817821895SHidetoshi Shimokawa 			err = EINVAL;
72917821895SHidetoshi Shimokawa 			break;
73017821895SHidetoshi Shimokawa 		}
7310892f4c5SHidetoshi Shimokawa 		fw_bindremove(fc, fwb);
7320892f4c5SHidetoshi Shimokawa 		STAILQ_REMOVE(&d->binds, fwb, fw_bind, chlist);
7330892f4c5SHidetoshi Shimokawa 		fw_xferlist_remove(&fwb->xferlist);
7345166f1dfSHidetoshi Shimokawa 		free(fwb, M_FW);
73517821895SHidetoshi Shimokawa 		break;
73617821895SHidetoshi Shimokawa 	case FW_SBINDADDR:
73717821895SHidetoshi Shimokawa 		if (bindreq->len <= 0) {
73817821895SHidetoshi Shimokawa 			err = EINVAL;
73917821895SHidetoshi Shimokawa 			break;
74017821895SHidetoshi Shimokawa 		}
74117821895SHidetoshi Shimokawa 		if (bindreq->start.hi > 0xffff) {
74217821895SHidetoshi Shimokawa 			err = EINVAL;
74317821895SHidetoshi Shimokawa 			break;
74417821895SHidetoshi Shimokawa 		}
745*23667f08SAlexander Kabaev 		fwb = malloc(sizeof(struct fw_bind), M_FW, M_WAITOK);
74617821895SHidetoshi Shimokawa 		if (fwb == NULL) {
74717821895SHidetoshi Shimokawa 			err = ENOMEM;
74817821895SHidetoshi Shimokawa 			break;
74917821895SHidetoshi Shimokawa 		}
750c4778b5dSHidetoshi Shimokawa 		fwb->start = ((u_int64_t)bindreq->start.hi << 32) |
751c4778b5dSHidetoshi Shimokawa 		    bindreq->start.lo;
752c4778b5dSHidetoshi Shimokawa 		fwb->end = fwb->start +  bindreq->len;
753*23667f08SAlexander Kabaev 		fwb->sc = d;
75477ee030bSHidetoshi Shimokawa 		STAILQ_INIT(&fwb->xferlist);
7550892f4c5SHidetoshi Shimokawa 		err = fw_bindadd(fc, fwb);
7560892f4c5SHidetoshi Shimokawa 		if (err == 0) {
7570892f4c5SHidetoshi Shimokawa 			fw_xferlist_add(&fwb->xferlist, M_FWXFER,
7580892f4c5SHidetoshi Shimokawa 			    /* XXX */
7590892f4c5SHidetoshi Shimokawa 			    PAGE_SIZE, PAGE_SIZE, 5,
760*23667f08SAlexander Kabaev 			    fc, fwb, fw_hand);
7610892f4c5SHidetoshi Shimokawa 			STAILQ_INSERT_TAIL(&d->binds, fwb, chlist);
7620892f4c5SHidetoshi Shimokawa 		}
76317821895SHidetoshi Shimokawa 		break;
76417821895SHidetoshi Shimokawa 	case FW_GDEVLST:
765c547b896SHidetoshi Shimokawa 		i = len = 1;
766c547b896SHidetoshi Shimokawa 		/* myself */
767c547b896SHidetoshi Shimokawa 		devinfo = &fwdevlst->dev[0];
7680892f4c5SHidetoshi Shimokawa 		devinfo->dst = fc->nodeid;
769c547b896SHidetoshi Shimokawa 		devinfo->status = 0;	/* XXX */
7700892f4c5SHidetoshi Shimokawa 		devinfo->eui.hi = fc->eui.hi;
7710892f4c5SHidetoshi Shimokawa 		devinfo->eui.lo = fc->eui.lo;
7720892f4c5SHidetoshi Shimokawa 		STAILQ_FOREACH(fwdev, &fc->devices, link) {
773c547b896SHidetoshi Shimokawa 			if (len < FW_MAX_DEVLST) {
774c547b896SHidetoshi Shimokawa 				devinfo = &fwdevlst->dev[len++];
775c547b896SHidetoshi Shimokawa 				devinfo->dst = fwdev->dst;
776c547b896SHidetoshi Shimokawa 				devinfo->status =
777c547b896SHidetoshi Shimokawa 					(fwdev->status == FWDEVINVAL) ? 0 : 1;
778c547b896SHidetoshi Shimokawa 				devinfo->eui.hi = fwdev->eui.hi;
779c547b896SHidetoshi Shimokawa 				devinfo->eui.lo = fwdev->eui.lo;
78017821895SHidetoshi Shimokawa 			}
78117821895SHidetoshi Shimokawa 			i++;
78217821895SHidetoshi Shimokawa 		}
78317821895SHidetoshi Shimokawa 		fwdevlst->n = i;
784c547b896SHidetoshi Shimokawa 		fwdevlst->info_len = len;
78517821895SHidetoshi Shimokawa 		break;
78617821895SHidetoshi Shimokawa 	case FW_GTPMAP:
7870892f4c5SHidetoshi Shimokawa 		bcopy(fc->topology_map, data,
7880892f4c5SHidetoshi Shimokawa 		    (fc->topology_map->crc_len + 1) * 4);
78917821895SHidetoshi Shimokawa 		break;
79017821895SHidetoshi Shimokawa 	case FW_GCROM:
7910892f4c5SHidetoshi Shimokawa 		STAILQ_FOREACH(fwdev, &fc->devices, link)
7920981f5f0SHidetoshi Shimokawa 			if (FW_EUI64_EQUAL(fwdev->eui, crom_buf->eui))
79317821895SHidetoshi Shimokawa 				break;
79417821895SHidetoshi Shimokawa 		if (fwdev == NULL) {
7950892f4c5SHidetoshi Shimokawa 			if (!FW_EUI64_EQUAL(fc->eui, crom_buf->eui)) {
79617821895SHidetoshi Shimokawa 				err = FWNODE_INVAL;
79717821895SHidetoshi Shimokawa 				break;
79817821895SHidetoshi Shimokawa 			}
799d7e486b4SHidetoshi Shimokawa 			/* myself */
800d7e486b4SHidetoshi Shimokawa 			ptr = malloc(CROMSIZE, M_FW, M_WAITOK);
801d7e486b4SHidetoshi Shimokawa 			len = CROMSIZE;
802d7e486b4SHidetoshi Shimokawa 			for (i = 0; i < CROMSIZE/4; i++)
80303161bbcSDoug Rabson 				((uint32_t *)ptr)[i]
8040892f4c5SHidetoshi Shimokawa 					= ntohl(fc->config_rom[i]);
805d7e486b4SHidetoshi Shimokawa 		} else {
806d7e486b4SHidetoshi Shimokawa 			/* found */
807d7e486b4SHidetoshi Shimokawa 			ptr = (void *)&fwdev->csrrom[0];
80817821895SHidetoshi Shimokawa 			if (fwdev->rommax < CSRROMOFF)
80917821895SHidetoshi Shimokawa 				len = 0;
81017821895SHidetoshi Shimokawa 			else
81117821895SHidetoshi Shimokawa 				len = fwdev->rommax - CSRROMOFF + 4;
812d7e486b4SHidetoshi Shimokawa 		}
813e340a7acSHidetoshi Shimokawa 		if (crom_buf->len < len)
81417821895SHidetoshi Shimokawa 			len = crom_buf->len;
81517821895SHidetoshi Shimokawa 		else
81617821895SHidetoshi Shimokawa 			crom_buf->len = len;
817d7e486b4SHidetoshi Shimokawa 		err = copyout(ptr, crom_buf->ptr, len);
818d7e486b4SHidetoshi Shimokawa 		if (fwdev == NULL)
819d7e486b4SHidetoshi Shimokawa 			/* myself */
820d7e486b4SHidetoshi Shimokawa 			free(ptr, M_FW);
82117821895SHidetoshi Shimokawa 		break;
82217821895SHidetoshi Shimokawa 	default:
8230892f4c5SHidetoshi Shimokawa 		fc->ioctl(dev, cmd, data, flag, td);
82417821895SHidetoshi Shimokawa 		break;
82517821895SHidetoshi Shimokawa 	}
82617821895SHidetoshi Shimokawa 	return err;
82717821895SHidetoshi Shimokawa }
82817821895SHidetoshi Shimokawa int
82989c9c53dSPoul-Henning Kamp fw_poll(struct cdev *dev, int events, fw_proc *td)
83017821895SHidetoshi Shimokawa {
8316cada79aSHidetoshi Shimokawa 	struct fw_xferq *ir;
83217821895SHidetoshi Shimokawa 	int revents;
83317821895SHidetoshi Shimokawa 	int tmp;
83417821895SHidetoshi Shimokawa 
83517821895SHidetoshi Shimokawa 	if (DEV_FWMEM(dev))
83617821895SHidetoshi Shimokawa 		return fwmem_poll(dev, events, td);
83717821895SHidetoshi Shimokawa 
8386cada79aSHidetoshi Shimokawa 	ir = ((struct fw_drv1 *)dev->si_drv1)->ir;
83917821895SHidetoshi Shimokawa 	revents = 0;
84017821895SHidetoshi Shimokawa 	tmp = POLLIN | POLLRDNORM;
84117821895SHidetoshi Shimokawa 	if (events & tmp) {
8426cada79aSHidetoshi Shimokawa 		if (STAILQ_FIRST(&ir->q) != NULL)
84317821895SHidetoshi Shimokawa 			revents |= tmp;
84417821895SHidetoshi Shimokawa 		else
8456cada79aSHidetoshi Shimokawa 			selrecord(td, &ir->rsel);
84617821895SHidetoshi Shimokawa 	}
84717821895SHidetoshi Shimokawa 	tmp = POLLOUT | POLLWRNORM;
84817821895SHidetoshi Shimokawa 	if (events & tmp) {
84917821895SHidetoshi Shimokawa 		/* XXX should be fixed */
85017821895SHidetoshi Shimokawa 		revents |= tmp;
85117821895SHidetoshi Shimokawa 	}
85217821895SHidetoshi Shimokawa 
85317821895SHidetoshi Shimokawa 	return revents;
85417821895SHidetoshi Shimokawa }
85517821895SHidetoshi Shimokawa 
85617821895SHidetoshi Shimokawa static int
857cfd7baceSRobert Noland fw_mmap (struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr,
858cfd7baceSRobert Noland     int nproto, vm_memattr_t *memattr)
85917821895SHidetoshi Shimokawa {
86017821895SHidetoshi Shimokawa 
86117821895SHidetoshi Shimokawa 	if (DEV_FWMEM(dev))
862cfd7baceSRobert Noland 		return fwmem_mmap(dev, offset, paddr, nproto, memattr);
86317821895SHidetoshi Shimokawa 
86417821895SHidetoshi Shimokawa 	return EINVAL;
86517821895SHidetoshi Shimokawa }
866a160e00eSHidetoshi Shimokawa 
867c4778b5dSHidetoshi Shimokawa static void
868c4778b5dSHidetoshi Shimokawa fw_strategy(struct bio *bp)
869c4778b5dSHidetoshi Shimokawa {
87089c9c53dSPoul-Henning Kamp 	struct cdev *dev;
871c4778b5dSHidetoshi Shimokawa 
872c4778b5dSHidetoshi Shimokawa 	dev = bp->bio_dev;
873c4778b5dSHidetoshi Shimokawa 	if (DEV_FWMEM(dev)) {
874c4778b5dSHidetoshi Shimokawa 		fwmem_strategy(bp);
875c4778b5dSHidetoshi Shimokawa 		return;
876c4778b5dSHidetoshi Shimokawa 	}
877c4778b5dSHidetoshi Shimokawa 
878c4778b5dSHidetoshi Shimokawa 	bp->bio_error = EOPNOTSUPP;
879c4778b5dSHidetoshi Shimokawa 	bp->bio_flags |= BIO_ERROR;
880c4778b5dSHidetoshi Shimokawa 	bp->bio_resid = bp->bio_bcount;
881c4778b5dSHidetoshi Shimokawa 	biodone(bp);
882c4778b5dSHidetoshi Shimokawa }
883c4778b5dSHidetoshi Shimokawa 
884a160e00eSHidetoshi Shimokawa int
885a160e00eSHidetoshi Shimokawa fwdev_makedev(struct firewire_softc *sc)
886a160e00eSHidetoshi Shimokawa {
887a160e00eSHidetoshi Shimokawa 	int err = 0;
888a160e00eSHidetoshi Shimokawa 
88989c9c53dSPoul-Henning Kamp 	struct cdev *d;
890a160e00eSHidetoshi Shimokawa 	int unit;
891a160e00eSHidetoshi Shimokawa 
892a160e00eSHidetoshi Shimokawa 	unit = device_get_unit(sc->fc->bdev);
893a160e00eSHidetoshi Shimokawa 	sc->dev = make_dev(&firewire_cdevsw, MAKEMINOR(0, unit, 0),
894*23667f08SAlexander Kabaev 	    UID_ROOT, GID_OPERATOR, 0660, "fw%d.%d", unit, 0);
895*23667f08SAlexander Kabaev 	d = make_dev(&firewire_cdevsw, MAKEMINOR(FWMEM_FLAG, unit, 0),
896*23667f08SAlexander Kabaev 	    UID_ROOT, GID_OPERATOR, 0660, "fwmem%d.%d", unit, 0);
897a160e00eSHidetoshi Shimokawa 	dev_depends(sc->dev, d);
898a160e00eSHidetoshi Shimokawa 	make_dev_alias(sc->dev, "fw%d", unit);
899a160e00eSHidetoshi Shimokawa 	make_dev_alias(d, "fwmem%d", unit);
900a160e00eSHidetoshi Shimokawa 
901a160e00eSHidetoshi Shimokawa 	return (err);
902a160e00eSHidetoshi Shimokawa }
903a160e00eSHidetoshi Shimokawa 
904a160e00eSHidetoshi Shimokawa int
905a160e00eSHidetoshi Shimokawa fwdev_destroydev(struct firewire_softc *sc)
906a160e00eSHidetoshi Shimokawa {
907a160e00eSHidetoshi Shimokawa 	int err = 0;
908a160e00eSHidetoshi Shimokawa 
90910d3ed64SHidetoshi Shimokawa 	destroy_dev(sc->dev);
910a160e00eSHidetoshi Shimokawa 	return (err);
911a160e00eSHidetoshi Shimokawa }
912a160e00eSHidetoshi Shimokawa 
913a160e00eSHidetoshi Shimokawa #define NDEVTYPE 2
914a160e00eSHidetoshi Shimokawa void
9156a113b3dSRobert Watson fwdev_clone(void *arg, struct ucred *cred, char *name, int namelen,
9166a113b3dSRobert Watson     struct cdev **dev)
917a160e00eSHidetoshi Shimokawa {
918a160e00eSHidetoshi Shimokawa 	struct firewire_softc *sc;
919a160e00eSHidetoshi Shimokawa 	char *devnames[NDEVTYPE] = {"fw", "fwmem"};
920a160e00eSHidetoshi Shimokawa 	char *subp = NULL;
921a160e00eSHidetoshi Shimokawa 	int devflag[NDEVTYPE] = {0, FWMEM_FLAG};
922a160e00eSHidetoshi Shimokawa 	int i, unit = 0, sub = 0;
923a160e00eSHidetoshi Shimokawa 
924f3732fd1SPoul-Henning Kamp 	if (*dev != NULL)
925a160e00eSHidetoshi Shimokawa 		return;
926a160e00eSHidetoshi Shimokawa 
927a160e00eSHidetoshi Shimokawa 	for (i = 0; i < NDEVTYPE; i++)
928c727011aSHidetoshi Shimokawa 		if (dev_stdclone(name, &subp, devnames[i], &unit) == 2)
929a160e00eSHidetoshi Shimokawa 			goto found;
930a160e00eSHidetoshi Shimokawa 	/* not match */
931a160e00eSHidetoshi Shimokawa 	return;
932a160e00eSHidetoshi Shimokawa found:
933a160e00eSHidetoshi Shimokawa 
934a160e00eSHidetoshi Shimokawa 	if (subp == NULL || *subp++ != '.')
935a160e00eSHidetoshi Shimokawa 		return;
936a160e00eSHidetoshi Shimokawa 
937a160e00eSHidetoshi Shimokawa 	/* /dev/fwU.S */
938a160e00eSHidetoshi Shimokawa 	while (isdigit(*subp)) {
939a160e00eSHidetoshi Shimokawa 		sub *= 10;
940a160e00eSHidetoshi Shimokawa 		sub += *subp++ - '0';
941a160e00eSHidetoshi Shimokawa 	}
942a160e00eSHidetoshi Shimokawa 	if (*subp != '\0')
943a160e00eSHidetoshi Shimokawa 		return;
944a160e00eSHidetoshi Shimokawa 
945a160e00eSHidetoshi Shimokawa 	sc = devclass_get_softc(firewire_devclass, unit);
946a160e00eSHidetoshi Shimokawa 	if (sc == NULL)
947a160e00eSHidetoshi Shimokawa 		return;
948d56b4cd4SDavide Italiano 	*dev = make_dev_credf(MAKEDEV_REF, &firewire_cdevsw,
949d56b4cd4SDavide Italiano 	    MAKEMINOR(devflag[i], unit, sub), cred, UID_ROOT, GID_OPERATOR,
950d56b4cd4SDavide Italiano 	    0660, "%s%d.%d", devnames[i], unit, sub);
951a160e00eSHidetoshi Shimokawa 	dev_depends(sc->dev, *dev);
952a160e00eSHidetoshi Shimokawa 	return;
953a160e00eSHidetoshi Shimokawa }
954