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