Home | History | Annotate | Line # | Download | only in ieee1394
fwdev.c revision 1.22
      1  1.22  christos /*	$NetBSD: fwdev.c,v 1.22 2010/05/23 18:56:58 christos Exp $	*/
      2   1.1  kiyohara /*-
      3   1.1  kiyohara  * Copyright (c) 2003 Hidetoshi Shimokawa
      4   1.1  kiyohara  * Copyright (c) 1998-2002 Katsushi Kobayashi and Hidetoshi Shimokawa
      5   1.1  kiyohara  * All rights reserved.
      6   1.1  kiyohara  *
      7   1.1  kiyohara  * Redistribution and use in source and binary forms, with or without
      8   1.1  kiyohara  * modification, are permitted provided that the following conditions
      9   1.1  kiyohara  * are met:
     10   1.1  kiyohara  * 1. Redistributions of source code must retain the above copyright
     11   1.1  kiyohara  *    notice, this list of conditions and the following disclaimer.
     12   1.1  kiyohara  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1  kiyohara  *    notice, this list of conditions and the following disclaimer in the
     14   1.1  kiyohara  *    documentation and/or other materials provided with the distribution.
     15   1.1  kiyohara  * 3. All advertising materials mentioning features or use of this software
     16   1.1  kiyohara  *    must display the acknowledgement as bellow:
     17   1.1  kiyohara  *
     18   1.1  kiyohara  *    This product includes software developed by K. Kobayashi and H. Shimokawa
     19   1.1  kiyohara  *
     20   1.1  kiyohara  * 4. The name of the author may not be used to endorse or promote products
     21   1.1  kiyohara  *    derived from this software without specific prior written permission.
     22   1.1  kiyohara  *
     23   1.1  kiyohara  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     24   1.1  kiyohara  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     25   1.1  kiyohara  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     26   1.1  kiyohara  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     27   1.1  kiyohara  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     28   1.1  kiyohara  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     29   1.1  kiyohara  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     30   1.1  kiyohara  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     31   1.1  kiyohara  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     32   1.1  kiyohara  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     33   1.1  kiyohara  * POSSIBILITY OF SUCH DAMAGE.
     34  1.18  kiyohara  *
     35  1.13  kiyohara  * $FreeBSD: src/sys/dev/firewire/fwdev.c,v 1.52 2007/06/06 14:31:36 simokawa Exp $
     36   1.1  kiyohara  *
     37   1.1  kiyohara  */
     38   1.1  kiyohara 
     39  1.14     lukem #include <sys/cdefs.h>
     40  1.22  christos __KERNEL_RCSID(0, "$NetBSD: fwdev.c,v 1.22 2010/05/23 18:56:58 christos Exp $");
     41  1.14     lukem 
     42   1.1  kiyohara #include <sys/param.h>
     43   1.1  kiyohara #include <sys/device.h>
     44   1.1  kiyohara #include <sys/errno.h>
     45   1.1  kiyohara #include <sys/buf.h>
     46  1.18  kiyohara #include <sys/bus.h>
     47   1.1  kiyohara #include <sys/conf.h>
     48   1.1  kiyohara #include <sys/kernel.h>
     49  1.22  christos #include <sys/malloc.h>
     50   1.1  kiyohara #include <sys/mbuf.h>
     51   1.1  kiyohara #include <sys/poll.h>
     52   1.1  kiyohara #include <sys/proc.h>
     53  1.18  kiyohara #include <sys/select.h>
     54   1.1  kiyohara 
     55   1.1  kiyohara #include <dev/ieee1394/firewire.h>
     56   1.1  kiyohara #include <dev/ieee1394/firewirereg.h>
     57   1.1  kiyohara #include <dev/ieee1394/fwdma.h>
     58   1.1  kiyohara #include <dev/ieee1394/fwmem.h>
     59   1.1  kiyohara #include <dev/ieee1394/iec68113.h>
     60  1.18  kiyohara 
     61  1.18  kiyohara #include "ioconf.h"
     62   1.1  kiyohara 
     63   1.1  kiyohara #define	FWNODE_INVAL 0xffff
     64   1.1  kiyohara 
     65   1.1  kiyohara dev_type_open(fw_open);
     66   1.1  kiyohara dev_type_close(fw_close);
     67   1.1  kiyohara dev_type_read(fw_read);
     68   1.1  kiyohara dev_type_write(fw_write);
     69   1.1  kiyohara dev_type_ioctl(fw_ioctl);
     70   1.1  kiyohara dev_type_poll(fw_poll);
     71   1.1  kiyohara dev_type_mmap(fw_mmap);
     72   1.1  kiyohara dev_type_strategy(fw_strategy);
     73   1.1  kiyohara 
     74   1.1  kiyohara const struct bdevsw fw_bdevsw = {
     75   1.4  christos 	fw_open, fw_close, fw_strategy, fw_ioctl, nodump, nosize, D_OTHER,
     76   1.1  kiyohara };
     77   1.1  kiyohara 
     78   1.1  kiyohara const struct cdevsw fw_cdevsw = {
     79   1.1  kiyohara 	fw_open, fw_close, fw_read, fw_write, fw_ioctl,
     80   1.4  christos 	nostop, notty, fw_poll, fw_mmap, nokqfilter, D_OTHER,
     81   1.1  kiyohara };
     82   1.1  kiyohara 
     83   1.1  kiyohara struct fw_drv1 {
     84   1.1  kiyohara 	struct firewire_comm *fc;
     85   1.1  kiyohara 	struct fw_xferq *ir;
     86   1.1  kiyohara 	struct fw_xferq *it;
     87   1.1  kiyohara 	struct fw_isobufreq bufreq;
     88   1.1  kiyohara 	STAILQ_HEAD(, fw_bind) binds;
     89   1.1  kiyohara 	STAILQ_HEAD(, fw_xfer) rq;
     90   1.1  kiyohara };
     91   1.1  kiyohara 
     92  1.18  kiyohara static int fwdev_allocbuf(struct firewire_comm *, struct fw_xferq *,
     93  1.18  kiyohara 			  struct fw_bufspec *);
     94  1.22  christos static int fwdev_freebuf(struct fw_xferq *);
     95  1.18  kiyohara static int fw_read_async(struct fw_drv1 *, struct uio *, int);
     96  1.18  kiyohara static int fw_write_async(struct fw_drv1 *, struct uio *, int);
     97  1.18  kiyohara static void fw_hand(struct fw_xfer *);
     98   1.1  kiyohara 
     99   1.1  kiyohara 
    100  1.18  kiyohara int
    101  1.18  kiyohara fw_open(dev_t dev, int flags, int fmt, struct lwp *td)
    102   1.1  kiyohara {
    103  1.18  kiyohara 	struct firewire_softc *sc;
    104  1.18  kiyohara 	struct fw_drv1 *d;
    105  1.18  kiyohara 	int err = 0;
    106   1.1  kiyohara 
    107  1.18  kiyohara 	sc = device_lookup_private(&ieee1394if_cd, DEV2UNIT(dev));
    108  1.18  kiyohara 	if (sc == NULL)
    109  1.18  kiyohara 		return ENXIO;
    110   1.1  kiyohara 
    111  1.18  kiyohara 	if (DEV_FWMEM(dev))
    112  1.18  kiyohara 		return fwmem_open(dev, flags, fmt, td);
    113   1.1  kiyohara 
    114  1.18  kiyohara 	mutex_enter(&sc->fc->fc_mtx);
    115  1.18  kiyohara 	if (sc->si_drv1 != NULL) {
    116  1.18  kiyohara 		mutex_exit(&sc->fc->fc_mtx);
    117  1.18  kiyohara 		return EBUSY;
    118  1.13  kiyohara 	}
    119  1.13  kiyohara 	/* set dummy value for allocation */
    120  1.18  kiyohara 	sc->si_drv1 = (void *)-1;
    121  1.18  kiyohara 	mutex_exit(&sc->fc->fc_mtx);
    122  1.13  kiyohara 
    123  1.22  christos 	sc->si_drv1 = malloc(sizeof(struct fw_drv1), M_FW, M_WAITOK | M_ZERO);
    124  1.18  kiyohara 	if (sc->si_drv1 == NULL)
    125  1.18  kiyohara 		return ENOMEM;
    126   1.1  kiyohara 
    127  1.18  kiyohara 	d = (struct fw_drv1 *)sc->si_drv1;
    128   1.1  kiyohara 	d->fc = sc->fc;
    129   1.1  kiyohara 	STAILQ_INIT(&d->binds);
    130   1.1  kiyohara 	STAILQ_INIT(&d->rq);
    131   1.1  kiyohara 
    132   1.1  kiyohara 	return err;
    133   1.1  kiyohara }
    134   1.1  kiyohara 
    135  1.18  kiyohara int
    136  1.18  kiyohara fw_close(dev_t dev, int flags, int fmt, struct lwp *td)
    137   1.1  kiyohara {
    138  1.18  kiyohara 	struct firewire_softc *sc;
    139   1.1  kiyohara 	struct firewire_comm *fc;
    140   1.1  kiyohara 	struct fw_drv1 *d;
    141   1.1  kiyohara 	struct fw_xfer *xfer;
    142   1.1  kiyohara 	struct fw_bind *fwb;
    143  1.18  kiyohara         int err = 0;
    144  1.18  kiyohara 
    145  1.18  kiyohara 	sc = device_lookup_private(&ieee1394if_cd, DEV2UNIT(dev));
    146  1.18  kiyohara 	if (sc == NULL)
    147  1.18  kiyohara 		return ENXIO;
    148   1.1  kiyohara 
    149  1.18  kiyohara 	if (DEV_FWMEM(dev))
    150  1.18  kiyohara 		return fwmem_close(dev, flags, fmt, td);
    151   1.1  kiyohara 
    152  1.18  kiyohara 	d = (struct fw_drv1 *)sc->si_drv1;
    153   1.1  kiyohara 	fc = d->fc;
    154   1.1  kiyohara 
    155   1.1  kiyohara 	/* remove binding */
    156   1.1  kiyohara 	for (fwb = STAILQ_FIRST(&d->binds); fwb != NULL;
    157  1.18  kiyohara 	    fwb = STAILQ_FIRST(&d->binds)) {
    158   1.1  kiyohara 		fw_bindremove(fc, fwb);
    159   1.1  kiyohara 		STAILQ_REMOVE_HEAD(&d->binds, chlist);
    160   1.1  kiyohara 		fw_xferlist_remove(&fwb->xferlist);
    161   1.1  kiyohara 		free(fwb, M_FW);
    162   1.1  kiyohara 	}
    163   1.1  kiyohara 	if (d->ir != NULL) {
    164   1.1  kiyohara 		struct fw_xferq *ir = d->ir;
    165   1.1  kiyohara 
    166   1.1  kiyohara 		if ((ir->flag & FWXFERQ_OPEN) == 0)
    167  1.18  kiyohara 			return EINVAL;
    168   1.1  kiyohara 		if (ir->flag & FWXFERQ_RUNNING) {
    169   1.1  kiyohara 			ir->flag &= ~FWXFERQ_RUNNING;
    170   1.1  kiyohara 			fc->irx_disable(fc, ir->dmach);
    171   1.1  kiyohara 		}
    172   1.1  kiyohara 		/* free extbuf */
    173  1.22  christos 		fwdev_freebuf(ir);
    174   1.1  kiyohara 		/* drain receiving buffer */
    175  1.18  kiyohara 		for (xfer = STAILQ_FIRST(&ir->q); xfer != NULL;
    176  1.18  kiyohara 		    xfer = STAILQ_FIRST(&ir->q)) {
    177  1.18  kiyohara 			ir->queued--;
    178   1.1  kiyohara 			STAILQ_REMOVE_HEAD(&ir->q, link);
    179   1.1  kiyohara 
    180   1.1  kiyohara 			xfer->resp = 0;
    181   1.1  kiyohara 			fw_xfer_done(xfer);
    182   1.1  kiyohara 		}
    183  1.18  kiyohara 		ir->flag &=
    184  1.18  kiyohara 		    ~(FWXFERQ_OPEN | FWXFERQ_MODEMASK | FWXFERQ_CHTAGMASK);
    185   1.1  kiyohara 		d->ir = NULL;
    186   1.1  kiyohara 
    187   1.1  kiyohara 	}
    188   1.1  kiyohara 	if (d->it != NULL) {
    189   1.1  kiyohara 		struct fw_xferq *it = d->it;
    190   1.1  kiyohara 
    191   1.1  kiyohara 		if ((it->flag & FWXFERQ_OPEN) == 0)
    192  1.18  kiyohara 			return EINVAL;
    193   1.1  kiyohara 		if (it->flag & FWXFERQ_RUNNING) {
    194   1.1  kiyohara 			it->flag &= ~FWXFERQ_RUNNING;
    195   1.1  kiyohara 			fc->itx_disable(fc, it->dmach);
    196   1.1  kiyohara 		}
    197   1.1  kiyohara 		/* free extbuf */
    198  1.22  christos 		fwdev_freebuf(it);
    199  1.18  kiyohara 		it->flag &=
    200  1.18  kiyohara 		    ~(FWXFERQ_OPEN | FWXFERQ_MODEMASK | FWXFERQ_CHTAGMASK);
    201   1.1  kiyohara 		d->it = NULL;
    202   1.1  kiyohara 	}
    203  1.22  christos 	free(sc->si_drv1, M_FW);
    204  1.18  kiyohara 	sc->si_drv1 = NULL;
    205   1.1  kiyohara 
    206   1.1  kiyohara 	return err;
    207   1.1  kiyohara }
    208   1.1  kiyohara 
    209  1.18  kiyohara int
    210  1.18  kiyohara fw_read(dev_t dev, struct uio *uio, int ioflag)
    211   1.1  kiyohara {
    212  1.18  kiyohara 	struct firewire_softc *sc;
    213  1.18  kiyohara 	struct firewire_comm *fc;
    214   1.1  kiyohara 	struct fw_drv1 *d;
    215   1.1  kiyohara 	struct fw_xferq *ir;
    216   1.1  kiyohara 	struct fw_pkt *fp;
    217  1.18  kiyohara 	int err = 0, slept = 0;
    218   1.1  kiyohara 
    219  1.18  kiyohara 	sc = device_lookup_private(&ieee1394if_cd, DEV2UNIT(dev));
    220  1.18  kiyohara 	if (sc == NULL)
    221  1.18  kiyohara 		return ENXIO;
    222  1.18  kiyohara 
    223  1.18  kiyohara 	if (DEV_FWMEM(dev))
    224  1.18  kiyohara 		return physio(fw_strategy, NULL, dev, ioflag, minphys, uio);
    225   1.1  kiyohara 
    226  1.18  kiyohara 	d = (struct fw_drv1 *)sc->si_drv1;
    227   1.1  kiyohara 	fc = d->fc;
    228   1.1  kiyohara 	ir = d->ir;
    229   1.1  kiyohara 
    230   1.1  kiyohara 	if (ir == NULL)
    231  1.18  kiyohara 		return fw_read_async(d, uio, ioflag);
    232   1.1  kiyohara 
    233   1.1  kiyohara 	if (ir->buf == NULL)
    234  1.18  kiyohara 		return EIO;
    235   1.1  kiyohara 
    236  1.18  kiyohara 	mutex_enter(&fc->fc_mtx);
    237   1.1  kiyohara readloop:
    238   1.1  kiyohara 	if (ir->stproc == NULL) {
    239   1.1  kiyohara 		/* iso bulkxfer */
    240   1.1  kiyohara 		ir->stproc = STAILQ_FIRST(&ir->stvalid);
    241   1.1  kiyohara 		if (ir->stproc != NULL) {
    242   1.1  kiyohara 			STAILQ_REMOVE_HEAD(&ir->stvalid, link);
    243   1.1  kiyohara 			ir->queued = 0;
    244   1.1  kiyohara 		}
    245   1.1  kiyohara 	}
    246   1.1  kiyohara 	if (ir->stproc == NULL) {
    247   1.1  kiyohara 		/* no data avaliable */
    248   1.1  kiyohara 		if (slept == 0) {
    249   1.1  kiyohara 			slept = 1;
    250   1.1  kiyohara 			ir->flag |= FWXFERQ_WAKEUP;
    251  1.18  kiyohara 			err = tsleep(ir, FWPRI, "fw_read", hz);
    252   1.1  kiyohara 			ir->flag &= ~FWXFERQ_WAKEUP;
    253   1.1  kiyohara 			if (err == 0)
    254   1.1  kiyohara 				goto readloop;
    255   1.1  kiyohara 		} else if (slept == 1)
    256   1.1  kiyohara 			err = EIO;
    257  1.18  kiyohara 		mutex_exit(&fc->fc_mtx);
    258   1.1  kiyohara 		return err;
    259  1.18  kiyohara 	} else if (ir->stproc != NULL) {
    260   1.1  kiyohara 		/* iso bulkxfer */
    261  1.18  kiyohara 		mutex_exit(&fc->fc_mtx);
    262  1.18  kiyohara 		fp = (struct fw_pkt *)fwdma_v_addr(ir->buf,
    263  1.18  kiyohara 		    ir->stproc->poffset + ir->queued);
    264  1.18  kiyohara 		if (fc->irx_post != NULL)
    265   1.1  kiyohara 			fc->irx_post(fc, fp->mode.ld);
    266  1.18  kiyohara 		if (fp->mode.stream.len == 0)
    267  1.18  kiyohara 			return EIO;
    268   1.9  christos 		err = uiomove((void *)fp,
    269  1.18  kiyohara 		    fp->mode.stream.len + sizeof(uint32_t), uio);
    270  1.18  kiyohara 		ir->queued++;
    271  1.18  kiyohara 		if (ir->queued >= ir->bnpacket) {
    272   1.1  kiyohara 			STAILQ_INSERT_TAIL(&ir->stfree, ir->stproc, link);
    273   1.1  kiyohara 			fc->irx_enable(fc, ir->dmach);
    274   1.1  kiyohara 			ir->stproc = NULL;
    275   1.1  kiyohara 		}
    276   1.1  kiyohara 		if (uio->uio_resid >= ir->psize) {
    277   1.1  kiyohara 			slept = -1;
    278  1.18  kiyohara 			mutex_enter(&fc->fc_mtx);
    279   1.1  kiyohara 			goto readloop;
    280   1.1  kiyohara 		}
    281  1.18  kiyohara 	} else
    282  1.18  kiyohara 		mutex_exit(&fc->fc_mtx);
    283   1.1  kiyohara 	return err;
    284   1.1  kiyohara }
    285   1.1  kiyohara 
    286  1.18  kiyohara int
    287  1.18  kiyohara fw_write(dev_t dev, struct uio *uio, int ioflag)
    288   1.1  kiyohara {
    289  1.18  kiyohara 	struct firewire_softc *sc;
    290  1.18  kiyohara 	struct firewire_comm *fc;
    291   1.1  kiyohara 	struct fw_drv1 *d;
    292   1.1  kiyohara 	struct fw_pkt *fp;
    293   1.1  kiyohara 	struct fw_xferq *it;
    294  1.18  kiyohara         int slept = 0, err = 0;
    295  1.18  kiyohara 
    296  1.18  kiyohara 	sc = device_lookup_private(&ieee1394if_cd, DEV2UNIT(dev));
    297  1.18  kiyohara 	if (sc == NULL)
    298  1.18  kiyohara 		return ENXIO;
    299  1.18  kiyohara 
    300  1.18  kiyohara 	if (DEV_FWMEM(dev))
    301  1.18  kiyohara 		return physio(fw_strategy, NULL, dev, ioflag, minphys, uio);
    302   1.1  kiyohara 
    303  1.18  kiyohara 	d = (struct fw_drv1 *)sc->si_drv1;
    304   1.1  kiyohara 	fc = d->fc;
    305   1.1  kiyohara 	it = d->it;
    306   1.1  kiyohara 
    307   1.1  kiyohara 	if (it == NULL)
    308  1.18  kiyohara 		return fw_write_async(d, uio, ioflag);
    309   1.1  kiyohara 
    310   1.1  kiyohara 	if (it->buf == NULL)
    311  1.18  kiyohara 		return EIO;
    312  1.13  kiyohara 
    313  1.18  kiyohara 	mutex_enter(&fc->fc_mtx);
    314   1.1  kiyohara isoloop:
    315   1.1  kiyohara 	if (it->stproc == NULL) {
    316   1.1  kiyohara 		it->stproc = STAILQ_FIRST(&it->stfree);
    317   1.1  kiyohara 		if (it->stproc != NULL) {
    318   1.1  kiyohara 			STAILQ_REMOVE_HEAD(&it->stfree, link);
    319   1.1  kiyohara 			it->queued = 0;
    320   1.1  kiyohara 		} else if (slept == 0) {
    321   1.1  kiyohara 			slept = 1;
    322  1.13  kiyohara #if 0   /* XXX to avoid lock recursion */
    323   1.1  kiyohara 			err = fc->itx_enable(fc, it->dmach);
    324   1.1  kiyohara 			if (err)
    325  1.13  kiyohara 				goto out;
    326  1.13  kiyohara #endif
    327  1.18  kiyohara 			err = tsleep(it, FWPRI, "fw_write", hz);
    328   1.1  kiyohara 			if (err)
    329  1.13  kiyohara 				goto out;
    330   1.1  kiyohara 			goto isoloop;
    331   1.1  kiyohara 		} else {
    332   1.1  kiyohara 			err = EIO;
    333  1.13  kiyohara 			goto out;
    334   1.1  kiyohara 		}
    335   1.1  kiyohara 	}
    336  1.18  kiyohara 	mutex_exit(&fc->fc_mtx);
    337   1.1  kiyohara 	fp = (struct fw_pkt *)fwdma_v_addr(it->buf,
    338  1.18  kiyohara 	    it->stproc->poffset + it->queued);
    339   1.9  christos 	err = uiomove((void *)fp, sizeof(struct fw_isohdr), uio);
    340  1.18  kiyohara 	if (err != 0)
    341  1.18  kiyohara 		return err;
    342  1.18  kiyohara 	err =
    343  1.18  kiyohara 	    uiomove((void *)fp->mode.stream.payload, fp->mode.stream.len, uio);
    344  1.18  kiyohara 	it->queued++;
    345   1.1  kiyohara 	if (it->queued >= it->bnpacket) {
    346   1.1  kiyohara 		STAILQ_INSERT_TAIL(&it->stvalid, it->stproc, link);
    347   1.1  kiyohara 		it->stproc = NULL;
    348   1.1  kiyohara 		err = fc->itx_enable(fc, it->dmach);
    349   1.1  kiyohara 	}
    350   1.1  kiyohara 	if (uio->uio_resid >= sizeof(struct fw_isohdr)) {
    351   1.1  kiyohara 		slept = 0;
    352  1.18  kiyohara 		mutex_enter(&fc->fc_mtx);
    353   1.1  kiyohara 		goto isoloop;
    354   1.1  kiyohara 	}
    355   1.1  kiyohara 	return err;
    356  1.13  kiyohara 
    357  1.13  kiyohara out:
    358  1.18  kiyohara 	mutex_exit(&fc->fc_mtx);
    359  1.13  kiyohara 	return err;
    360   1.1  kiyohara }
    361   1.1  kiyohara 
    362  1.18  kiyohara int
    363  1.18  kiyohara fw_ioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *td)
    364   1.1  kiyohara {
    365  1.18  kiyohara 	struct firewire_softc *sc;
    366   1.1  kiyohara 	struct firewire_comm *fc;
    367   1.1  kiyohara 	struct fw_drv1 *d;
    368   1.1  kiyohara 	struct fw_device *fwdev;
    369   1.1  kiyohara 	struct fw_bind *fwb;
    370   1.1  kiyohara 	struct fw_xferq *ir, *it;
    371   1.1  kiyohara 	struct fw_xfer *xfer;
    372   1.1  kiyohara 	struct fw_pkt *fp;
    373   1.1  kiyohara 	struct fw_devinfo *devinfo;
    374   1.1  kiyohara 	struct fw_devlstreq *fwdevlst = (struct fw_devlstreq *)data;
    375   1.1  kiyohara 	struct fw_asyreq *asyreq = (struct fw_asyreq *)data;
    376   1.1  kiyohara 	struct fw_isochreq *ichreq = (struct fw_isochreq *)data;
    377   1.1  kiyohara 	struct fw_isobufreq *ibufreq = (struct fw_isobufreq *)data;
    378   1.1  kiyohara 	struct fw_asybindreq *bindreq = (struct fw_asybindreq *)data;
    379   1.1  kiyohara 	struct fw_crom_buf *crom_buf = (struct fw_crom_buf *)data;
    380  1.18  kiyohara 	int i, len, err = 0;
    381  1.18  kiyohara 	void *ptr;
    382   1.1  kiyohara 
    383  1.18  kiyohara 	sc = device_lookup_private(&ieee1394if_cd, DEV2UNIT(dev));
    384  1.18  kiyohara 	if (sc == NULL)
    385  1.18  kiyohara 		return ENXIO;
    386  1.18  kiyohara 
    387  1.18  kiyohara 	if (DEV_FWMEM(dev))
    388  1.18  kiyohara 		return fwmem_ioctl(dev, cmd, data, flag, td);
    389   1.1  kiyohara 
    390   1.1  kiyohara 	if (!data)
    391  1.18  kiyohara 		return EINVAL;
    392   1.1  kiyohara 
    393  1.18  kiyohara 	d = (struct fw_drv1 *)sc->si_drv1;
    394   1.1  kiyohara 	fc = d->fc;
    395   1.1  kiyohara 	ir = d->ir;
    396   1.1  kiyohara 	it = d->it;
    397   1.1  kiyohara 
    398   1.1  kiyohara 	switch (cmd) {
    399   1.1  kiyohara 	case FW_STSTREAM:
    400   1.1  kiyohara 		if (it == NULL) {
    401  1.13  kiyohara 			i = fw_open_isodma(fc, /* tx */1);
    402  1.13  kiyohara 			if (i < 0) {
    403   1.1  kiyohara 				err = EBUSY;
    404   1.1  kiyohara 				break;
    405   1.1  kiyohara 			}
    406  1.13  kiyohara 			it = fc->it[i];
    407   1.1  kiyohara 			err = fwdev_allocbuf(fc, it, &d->bufreq.tx);
    408  1.13  kiyohara 			if (err) {
    409  1.13  kiyohara 				it->flag &= ~FWXFERQ_OPEN;
    410   1.1  kiyohara 				break;
    411  1.13  kiyohara 			}
    412   1.1  kiyohara 		}
    413   1.1  kiyohara 		it->flag &= ~0xff;
    414   1.1  kiyohara 		it->flag |= (0x3f & ichreq->ch);
    415   1.1  kiyohara 		it->flag |= ((0x3 & ichreq->tag) << 6);
    416   1.1  kiyohara 		d->it = it;
    417   1.1  kiyohara 		break;
    418  1.18  kiyohara 
    419   1.1  kiyohara 	case FW_GTSTREAM:
    420   1.1  kiyohara 		if (it != NULL) {
    421   1.1  kiyohara 			ichreq->ch = it->flag & 0x3f;
    422   1.1  kiyohara 			ichreq->tag = it->flag >> 2 & 0x3;
    423   1.1  kiyohara 		} else
    424   1.1  kiyohara 			err = EINVAL;
    425   1.1  kiyohara 		break;
    426  1.18  kiyohara 
    427   1.1  kiyohara 	case FW_SRSTREAM:
    428   1.1  kiyohara 		if (ir == NULL) {
    429  1.13  kiyohara 			i = fw_open_isodma(fc, /* tx */0);
    430  1.13  kiyohara 			if (i < 0) {
    431   1.1  kiyohara 				err = EBUSY;
    432   1.1  kiyohara 				break;
    433   1.1  kiyohara 			}
    434  1.13  kiyohara 			ir = fc->ir[i];
    435   1.1  kiyohara 			err = fwdev_allocbuf(fc, ir, &d->bufreq.rx);
    436  1.13  kiyohara 			if (err) {
    437  1.13  kiyohara 				ir->flag &= ~FWXFERQ_OPEN;
    438   1.1  kiyohara 				break;
    439  1.13  kiyohara 			}
    440   1.1  kiyohara 		}
    441   1.1  kiyohara 		ir->flag &= ~0xff;
    442   1.1  kiyohara 		ir->flag |= (0x3f & ichreq->ch);
    443   1.1  kiyohara 		ir->flag |= ((0x3 & ichreq->tag) << 6);
    444   1.1  kiyohara 		d->ir = ir;
    445   1.1  kiyohara 		err = fc->irx_enable(fc, ir->dmach);
    446   1.1  kiyohara 		break;
    447  1.18  kiyohara 
    448   1.1  kiyohara 	case FW_GRSTREAM:
    449   1.1  kiyohara 		if (d->ir != NULL) {
    450   1.1  kiyohara 			ichreq->ch = ir->flag & 0x3f;
    451   1.1  kiyohara 			ichreq->tag = ir->flag >> 2 & 0x3;
    452   1.1  kiyohara 		} else
    453   1.1  kiyohara 			err = EINVAL;
    454   1.1  kiyohara 		break;
    455  1.18  kiyohara 
    456   1.1  kiyohara 	case FW_SSTBUF:
    457  1.17   tsutsui 		memcpy(&d->bufreq, ibufreq, sizeof(d->bufreq));
    458   1.1  kiyohara 		break;
    459  1.18  kiyohara 
    460   1.1  kiyohara 	case FW_GSTBUF:
    461  1.15    cegger 		memset(&ibufreq->rx, 0, sizeof(ibufreq->rx));
    462   1.1  kiyohara 		if (ir != NULL) {
    463   1.1  kiyohara 			ibufreq->rx.nchunk = ir->bnchunk;
    464   1.1  kiyohara 			ibufreq->rx.npacket = ir->bnpacket;
    465   1.1  kiyohara 			ibufreq->rx.psize = ir->psize;
    466   1.1  kiyohara 		}
    467  1.15    cegger 		memset(&ibufreq->tx, 0, sizeof(ibufreq->tx));
    468   1.1  kiyohara 		if (it != NULL) {
    469   1.1  kiyohara 			ibufreq->tx.nchunk = it->bnchunk;
    470   1.1  kiyohara 			ibufreq->tx.npacket = it->bnpacket;
    471   1.1  kiyohara 			ibufreq->tx.psize = it->psize;
    472   1.1  kiyohara 		}
    473   1.1  kiyohara 		break;
    474  1.18  kiyohara 
    475   1.1  kiyohara 	case FW_ASYREQ:
    476   1.1  kiyohara 	{
    477   1.2  drochner 		const struct tcode_info *tinfo;
    478   1.1  kiyohara 		int pay_len = 0;
    479   1.1  kiyohara 
    480   1.1  kiyohara 		fp = &asyreq->pkt;
    481   1.1  kiyohara 		tinfo = &fc->tcode[fp->mode.hdr.tcode];
    482   1.1  kiyohara 
    483   1.1  kiyohara 		if ((tinfo->flag & FWTI_BLOCK_ASY) != 0)
    484   1.1  kiyohara 			pay_len = MAX(0, asyreq->req.len - tinfo->hdr_len);
    485   1.1  kiyohara 
    486   1.1  kiyohara 		xfer = fw_xfer_alloc_buf(M_FWXFER, pay_len, PAGE_SIZE/*XXX*/);
    487   1.1  kiyohara 		if (xfer == NULL)
    488  1.18  kiyohara 			return ENOMEM;
    489   1.1  kiyohara 
    490   1.1  kiyohara 		switch (asyreq->req.type) {
    491   1.1  kiyohara 		case FWASREQNODE:
    492   1.1  kiyohara 			break;
    493  1.18  kiyohara 
    494   1.1  kiyohara 		case FWASREQEUI:
    495  1.18  kiyohara 			fwdev = fw_noderesolve_eui64(fc, &asyreq->req.dst.eui);
    496   1.1  kiyohara 			if (fwdev == NULL) {
    497  1.18  kiyohara 				aprint_error_dev(fc->bdev,
    498  1.18  kiyohara 				    "cannot find node\n");
    499   1.1  kiyohara 				err = EINVAL;
    500   1.1  kiyohara 				goto out;
    501   1.1  kiyohara 			}
    502   1.1  kiyohara 			fp->mode.hdr.dst = FWLOCALBUS | fwdev->dst;
    503   1.1  kiyohara 			break;
    504  1.18  kiyohara 
    505   1.1  kiyohara 		case FWASRESTL:
    506   1.1  kiyohara 			/* XXX what's this? */
    507   1.1  kiyohara 			break;
    508  1.18  kiyohara 
    509   1.1  kiyohara 		case FWASREQSTREAM:
    510   1.1  kiyohara 			/* nothing to do */
    511   1.1  kiyohara 			break;
    512   1.1  kiyohara 		}
    513   1.1  kiyohara 
    514  1.19  kiyohara 		memcpy(&xfer->send.hdr, fp, tinfo->hdr_len);
    515   1.1  kiyohara 		if (pay_len > 0)
    516  1.19  kiyohara 			memcpy(xfer->send.payload, (char *)fp + tinfo->hdr_len,
    517  1.19  kiyohara 			    pay_len);
    518   1.1  kiyohara 		xfer->send.spd = asyreq->req.sped;
    519  1.13  kiyohara 		xfer->hand = fw_xferwake;
    520   1.1  kiyohara 
    521   1.1  kiyohara 		if ((err = fw_asyreq(fc, -1, xfer)) != 0)
    522   1.1  kiyohara 			goto out;
    523  1.13  kiyohara 		if ((err = fw_xferwait(xfer)) != 0)
    524   1.1  kiyohara 			goto out;
    525   1.1  kiyohara 		if (xfer->resp != 0) {
    526   1.1  kiyohara 			err = EIO;
    527   1.1  kiyohara 			goto out;
    528   1.1  kiyohara 		}
    529   1.1  kiyohara 		if ((tinfo->flag & FWTI_TLABEL) == 0)
    530   1.1  kiyohara 			goto out;
    531   1.1  kiyohara 
    532   1.1  kiyohara 		/* copy response */
    533   1.1  kiyohara 		tinfo = &fc->tcode[xfer->recv.hdr.mode.hdr.tcode];
    534   1.1  kiyohara 		if (xfer->recv.hdr.mode.hdr.tcode == FWTCODE_RRESB ||
    535   1.1  kiyohara 		    xfer->recv.hdr.mode.hdr.tcode == FWTCODE_LRES) {
    536   1.1  kiyohara 			pay_len = xfer->recv.pay_len;
    537  1.18  kiyohara 			if (asyreq->req.len >=
    538  1.18  kiyohara 			    xfer->recv.pay_len + tinfo->hdr_len)
    539  1.18  kiyohara 				asyreq->req.len =
    540  1.18  kiyohara 				    xfer->recv.pay_len + tinfo->hdr_len;
    541  1.18  kiyohara 			else {
    542   1.1  kiyohara 				err = EINVAL;
    543   1.1  kiyohara 				pay_len = 0;
    544   1.1  kiyohara 			}
    545  1.18  kiyohara 		} else
    546   1.1  kiyohara 			pay_len = 0;
    547  1.17   tsutsui 		memcpy(fp, &xfer->recv.hdr, tinfo->hdr_len);
    548  1.18  kiyohara 		memcpy((char *)fp + tinfo->hdr_len, xfer->recv.payload,
    549  1.18  kiyohara 		    pay_len);
    550   1.1  kiyohara out:
    551   1.1  kiyohara 		fw_xfer_free_buf(xfer);
    552   1.1  kiyohara 		break;
    553   1.1  kiyohara 	}
    554  1.18  kiyohara 
    555   1.1  kiyohara 	case FW_IBUSRST:
    556   1.1  kiyohara 		fc->ibr(fc);
    557   1.1  kiyohara 		break;
    558  1.18  kiyohara 
    559   1.1  kiyohara 	case FW_CBINDADDR:
    560  1.18  kiyohara 		fwb = fw_bindlookup(fc, bindreq->start.hi, bindreq->start.lo);
    561  1.18  kiyohara 		if (fwb == NULL) {
    562   1.1  kiyohara 			err = EINVAL;
    563   1.1  kiyohara 			break;
    564   1.1  kiyohara 		}
    565   1.1  kiyohara 		fw_bindremove(fc, fwb);
    566   1.1  kiyohara 		STAILQ_REMOVE(&d->binds, fwb, fw_bind, chlist);
    567   1.1  kiyohara 		fw_xferlist_remove(&fwb->xferlist);
    568   1.1  kiyohara 		free(fwb, M_FW);
    569   1.1  kiyohara 		break;
    570  1.18  kiyohara 
    571   1.1  kiyohara 	case FW_SBINDADDR:
    572  1.18  kiyohara 		if (bindreq->len <= 0 ) {
    573   1.1  kiyohara 			err = EINVAL;
    574   1.1  kiyohara 			break;
    575   1.1  kiyohara 		}
    576  1.18  kiyohara 		if (bindreq->start.hi > 0xffff ) {
    577   1.1  kiyohara 			err = EINVAL;
    578   1.1  kiyohara 			break;
    579   1.1  kiyohara 		}
    580  1.22  christos 		fwb = (struct fw_bind *)malloc(sizeof(struct fw_bind),
    581  1.22  christos 		    M_FW, M_WAITOK);
    582  1.18  kiyohara 		if (fwb == NULL) {
    583   1.1  kiyohara 			err = ENOMEM;
    584   1.1  kiyohara 			break;
    585   1.1  kiyohara 		}
    586   1.1  kiyohara 		fwb->start = ((u_int64_t)bindreq->start.hi << 32) |
    587   1.1  kiyohara 		    bindreq->start.lo;
    588   1.1  kiyohara 		fwb->end = fwb->start +  bindreq->len;
    589   1.1  kiyohara 		fwb->sc = (void *)d;
    590   1.1  kiyohara 		STAILQ_INIT(&fwb->xferlist);
    591   1.1  kiyohara 		err = fw_bindadd(fc, fwb);
    592   1.1  kiyohara 		if (err == 0) {
    593   1.1  kiyohara 			fw_xferlist_add(&fwb->xferlist, M_FWXFER,
    594   1.1  kiyohara 			    /* XXX */
    595  1.18  kiyohara 			    PAGE_SIZE, PAGE_SIZE, 5, fc, (void *)fwb, fw_hand);
    596   1.1  kiyohara 			STAILQ_INSERT_TAIL(&d->binds, fwb, chlist);
    597   1.1  kiyohara 		}
    598   1.1  kiyohara 		break;
    599  1.18  kiyohara 
    600   1.1  kiyohara 	case FW_GDEVLST:
    601   1.1  kiyohara 		i = len = 1;
    602   1.1  kiyohara 		/* myself */
    603  1.18  kiyohara 		devinfo = fwdevlst->dev;
    604   1.1  kiyohara 		devinfo->dst = fc->nodeid;
    605   1.1  kiyohara 		devinfo->status = 0;	/* XXX */
    606   1.1  kiyohara 		devinfo->eui.hi = fc->eui.hi;
    607   1.1  kiyohara 		devinfo->eui.lo = fc->eui.lo;
    608   1.1  kiyohara 		STAILQ_FOREACH(fwdev, &fc->devices, link) {
    609  1.18  kiyohara 			if (len < FW_MAX_DEVLST) {
    610   1.1  kiyohara 				devinfo = &fwdevlst->dev[len++];
    611   1.1  kiyohara 				devinfo->dst = fwdev->dst;
    612  1.18  kiyohara 				devinfo->status =
    613  1.18  kiyohara 				    (fwdev->status == FWDEVINVAL) ? 0 : 1;
    614   1.1  kiyohara 				devinfo->eui.hi = fwdev->eui.hi;
    615   1.1  kiyohara 				devinfo->eui.lo = fwdev->eui.lo;
    616   1.1  kiyohara 			}
    617   1.1  kiyohara 			i++;
    618   1.1  kiyohara 		}
    619   1.1  kiyohara 		fwdevlst->n = i;
    620   1.1  kiyohara 		fwdevlst->info_len = len;
    621   1.1  kiyohara 		break;
    622  1.18  kiyohara 
    623   1.1  kiyohara 	case FW_GTPMAP:
    624  1.17   tsutsui 		memcpy(data, fc->topology_map,
    625  1.18  kiyohara 		    (fc->topology_map->crc_len + 1) * 4);
    626   1.1  kiyohara 		break;
    627  1.18  kiyohara 
    628   1.1  kiyohara 	case FW_GCROM:
    629   1.1  kiyohara 		STAILQ_FOREACH(fwdev, &fc->devices, link)
    630   1.1  kiyohara 			if (FW_EUI64_EQUAL(fwdev->eui, crom_buf->eui))
    631   1.1  kiyohara 				break;
    632   1.1  kiyohara 		if (fwdev == NULL) {
    633   1.1  kiyohara 			if (!FW_EUI64_EQUAL(fc->eui, crom_buf->eui)) {
    634   1.1  kiyohara 				err = FWNODE_INVAL;
    635   1.1  kiyohara 				break;
    636   1.1  kiyohara 			}
    637   1.1  kiyohara 			/* myself */
    638  1.22  christos 			ptr = malloc(CROMSIZE, M_FW, M_WAITOK);
    639   1.1  kiyohara 			len = CROMSIZE;
    640   1.1  kiyohara 			for (i = 0; i < CROMSIZE/4; i++)
    641  1.18  kiyohara 				((uint32_t *)ptr)[i] = ntohl(fc->config_rom[i]);
    642   1.1  kiyohara 		} else {
    643   1.1  kiyohara 			/* found */
    644  1.18  kiyohara 			ptr = (void *)fwdev->csrrom;
    645   1.1  kiyohara 			if (fwdev->rommax < CSRROMOFF)
    646   1.1  kiyohara 				len = 0;
    647   1.1  kiyohara 			else
    648   1.1  kiyohara 				len = fwdev->rommax - CSRROMOFF + 4;
    649   1.1  kiyohara 		}
    650   1.8  jdolecek 		if (crom_buf->len < len)
    651   1.1  kiyohara 			len = crom_buf->len;
    652   1.1  kiyohara 		else
    653   1.1  kiyohara 			crom_buf->len = len;
    654   1.1  kiyohara 		err = copyout(ptr, crom_buf->ptr, len);
    655   1.1  kiyohara 		if (fwdev == NULL)
    656   1.1  kiyohara 			/* myself */
    657  1.22  christos 			free(ptr, M_FW);
    658   1.1  kiyohara 		break;
    659  1.18  kiyohara 
    660   1.1  kiyohara 	default:
    661  1.18  kiyohara 		fc->ioctl(dev, cmd, data, flag, td);
    662   1.1  kiyohara 		break;
    663   1.1  kiyohara 	}
    664   1.1  kiyohara 	return err;
    665   1.1  kiyohara }
    666   1.1  kiyohara 
    667  1.18  kiyohara int
    668  1.18  kiyohara fw_poll(dev_t dev, int events, struct lwp *td)
    669   1.1  kiyohara {
    670  1.18  kiyohara 	struct firewire_softc *sc;
    671   1.1  kiyohara 	struct fw_xferq *ir;
    672  1.18  kiyohara 	int revents, tmp;
    673   1.1  kiyohara 
    674  1.18  kiyohara 	sc = device_lookup_private(&ieee1394if_cd, DEV2UNIT(dev));
    675  1.18  kiyohara 	if (sc == NULL)
    676  1.18  kiyohara 		return ENXIO;
    677   1.1  kiyohara 
    678  1.18  kiyohara 	ir = ((struct fw_drv1 *)sc->si_drv1)->ir;
    679   1.1  kiyohara 	revents = 0;
    680   1.1  kiyohara 	tmp = POLLIN | POLLRDNORM;
    681   1.1  kiyohara 	if (events & tmp) {
    682   1.1  kiyohara 		if (STAILQ_FIRST(&ir->q) != NULL)
    683   1.1  kiyohara 			revents |= tmp;
    684   1.1  kiyohara 		else
    685   1.1  kiyohara 			selrecord(td, &ir->rsel);
    686   1.1  kiyohara 	}
    687   1.1  kiyohara 	tmp = POLLOUT | POLLWRNORM;
    688  1.18  kiyohara 	if (events & tmp)
    689  1.18  kiyohara 		/* XXX should be fixed */
    690   1.1  kiyohara 		revents |= tmp;
    691   1.1  kiyohara 
    692   1.1  kiyohara 	return revents;
    693   1.1  kiyohara }
    694   1.1  kiyohara 
    695  1.18  kiyohara paddr_t
    696  1.18  kiyohara fw_mmap(dev_t dev, off_t offset, int nproto)
    697  1.18  kiyohara {
    698  1.18  kiyohara 	struct firewire_softc *sc;
    699   1.1  kiyohara 
    700  1.18  kiyohara 	sc = device_lookup_private(&ieee1394if_cd, DEV2UNIT(dev));
    701  1.18  kiyohara 	if (sc == NULL)
    702  1.18  kiyohara 		return ENXIO;
    703   1.1  kiyohara 
    704   1.1  kiyohara 	return EINVAL;
    705   1.1  kiyohara }
    706   1.1  kiyohara 
    707   1.1  kiyohara void
    708   1.1  kiyohara fw_strategy(struct bio *bp)
    709   1.1  kiyohara {
    710  1.18  kiyohara 	struct firewire_softc *sc;
    711  1.18  kiyohara 	dev_t dev = bp->bio_dev;
    712  1.18  kiyohara 
    713  1.18  kiyohara 	sc = device_lookup_private(&ieee1394if_cd, DEV2UNIT(dev));
    714  1.18  kiyohara 	if (sc == NULL)
    715  1.18  kiyohara 		return;
    716   1.1  kiyohara 
    717  1.18  kiyohara 	if (DEV_FWMEM(dev)) {
    718  1.18  kiyohara 		fwmem_strategy(bp);
    719  1.18  kiyohara 		return;
    720  1.18  kiyohara 	}
    721   1.1  kiyohara 
    722   1.1  kiyohara 	bp->bio_error = EOPNOTSUPP;
    723   1.1  kiyohara 	bp->bio_resid = bp->bio_bcount;
    724   1.1  kiyohara 	biodone(bp);
    725   1.1  kiyohara }
    726   1.1  kiyohara 
    727  1.18  kiyohara 
    728  1.18  kiyohara static int
    729  1.18  kiyohara fwdev_allocbuf(struct firewire_comm *fc, struct fw_xferq *q,
    730  1.18  kiyohara 	       struct fw_bufspec *b)
    731   1.1  kiyohara {
    732  1.18  kiyohara 	int i;
    733  1.18  kiyohara 
    734  1.18  kiyohara 	if (q->flag & (FWXFERQ_RUNNING | FWXFERQ_EXTBUF))
    735  1.18  kiyohara 		return EBUSY;
    736  1.18  kiyohara 
    737  1.18  kiyohara 	q->bulkxfer =
    738  1.22  christos 	    (struct fw_bulkxfer *)malloc(sizeof(struct fw_bulkxfer) * b->nchunk,
    739  1.22  christos 								M_FW, M_WAITOK);
    740  1.18  kiyohara 	if (q->bulkxfer == NULL)
    741  1.18  kiyohara 		return ENOMEM;
    742  1.18  kiyohara 
    743  1.18  kiyohara 	b->psize = roundup2(b->psize, sizeof(uint32_t));
    744  1.18  kiyohara 	q->buf = fwdma_malloc_multiseg(fc, sizeof(uint32_t), b->psize,
    745  1.18  kiyohara 	    b->nchunk * b->npacket, BUS_DMA_WAITOK);
    746  1.18  kiyohara 
    747  1.18  kiyohara 	if (q->buf == NULL) {
    748  1.22  christos 		free(q->bulkxfer, M_FW);
    749  1.18  kiyohara 		q->bulkxfer = NULL;
    750  1.18  kiyohara 		return ENOMEM;
    751  1.18  kiyohara 	}
    752  1.18  kiyohara 	q->bnchunk = b->nchunk;
    753  1.18  kiyohara 	q->bnpacket = b->npacket;
    754  1.18  kiyohara 	q->psize = (b->psize + 3) & ~3;
    755  1.18  kiyohara 	q->queued = 0;
    756  1.18  kiyohara 
    757  1.18  kiyohara 	STAILQ_INIT(&q->stvalid);
    758  1.18  kiyohara 	STAILQ_INIT(&q->stfree);
    759  1.18  kiyohara 	STAILQ_INIT(&q->stdma);
    760  1.18  kiyohara 	q->stproc = NULL;
    761  1.18  kiyohara 
    762  1.18  kiyohara 	for (i = 0 ; i < q->bnchunk; i++) {
    763  1.18  kiyohara 		q->bulkxfer[i].poffset = i * q->bnpacket;
    764  1.18  kiyohara 		q->bulkxfer[i].mbuf = NULL;
    765  1.18  kiyohara 		STAILQ_INSERT_TAIL(&q->stfree, &q->bulkxfer[i], link);
    766  1.18  kiyohara 	}
    767  1.18  kiyohara 
    768  1.18  kiyohara 	q->flag &= ~FWXFERQ_MODEMASK;
    769  1.18  kiyohara 	q->flag |= FWXFERQ_STREAM;
    770  1.18  kiyohara 	q->flag |= FWXFERQ_EXTBUF;
    771   1.1  kiyohara 
    772  1.18  kiyohara 	return 0;
    773  1.18  kiyohara }
    774   1.1  kiyohara 
    775  1.18  kiyohara static int
    776  1.22  christos fwdev_freebuf(struct fw_xferq *q)
    777  1.18  kiyohara {
    778   1.1  kiyohara 
    779  1.18  kiyohara 	if (q->flag & FWXFERQ_EXTBUF) {
    780  1.18  kiyohara 		if (q->buf != NULL)
    781  1.18  kiyohara 			fwdma_free_multiseg(q->buf);
    782  1.18  kiyohara 		q->buf = NULL;
    783  1.22  christos 		free(q->bulkxfer, M_FW);
    784  1.18  kiyohara 		q->bulkxfer = NULL;
    785  1.18  kiyohara 		q->flag &= ~FWXFERQ_EXTBUF;
    786  1.18  kiyohara 		q->psize = 0;
    787  1.18  kiyohara 		q->maxq = FWMAXQUEUE;
    788  1.18  kiyohara 	}
    789  1.18  kiyohara 	return 0;
    790   1.1  kiyohara }
    791   1.1  kiyohara 
    792  1.18  kiyohara static int
    793  1.18  kiyohara fw_read_async(struct fw_drv1 *d, struct uio *uio, int ioflag)
    794   1.1  kiyohara {
    795  1.18  kiyohara 	struct fw_xfer *xfer;
    796  1.18  kiyohara 	struct fw_bind *fwb;
    797  1.18  kiyohara 	struct fw_pkt *fp;
    798  1.18  kiyohara 	const struct tcode_info *tinfo;
    799   1.1  kiyohara 	int err = 0;
    800   1.1  kiyohara 
    801  1.18  kiyohara 	mutex_enter(&d->fc->fc_mtx);
    802  1.18  kiyohara 	while ((xfer = STAILQ_FIRST(&d->rq)) == NULL && err == 0)
    803  1.18  kiyohara 		err = tsleep(&d->rq, FWPRI, "fwra", 0);
    804  1.18  kiyohara 
    805  1.18  kiyohara 	if (err != 0) {
    806  1.18  kiyohara 		mutex_exit(&d->fc->fc_mtx);
    807  1.18  kiyohara 		return err;
    808  1.18  kiyohara 	}
    809   1.1  kiyohara 
    810  1.18  kiyohara 	STAILQ_REMOVE_HEAD(&d->rq, link);
    811  1.18  kiyohara 	mutex_exit(&d->fc->fc_mtx);
    812  1.18  kiyohara 	fp = &xfer->recv.hdr;
    813  1.18  kiyohara #if 0 /* for GASP ?? */
    814  1.18  kiyohara 	if (fc->irx_post != NULL)
    815  1.18  kiyohara 		fc->irx_post(fc, fp->mode.ld);
    816   1.1  kiyohara #endif
    817  1.18  kiyohara 	tinfo = &xfer->fc->tcode[fp->mode.hdr.tcode];
    818  1.18  kiyohara 	err = uiomove((void *)fp, tinfo->hdr_len, uio);
    819  1.18  kiyohara 	if (err)
    820  1.18  kiyohara 		goto out;
    821  1.18  kiyohara 	err = uiomove((void *)xfer->recv.payload, xfer->recv.pay_len, uio);
    822  1.18  kiyohara 
    823  1.18  kiyohara out:
    824  1.18  kiyohara 	/* recycle this xfer */
    825  1.18  kiyohara 	fwb = (struct fw_bind *)xfer->sc;
    826  1.18  kiyohara 	fw_xfer_unload(xfer);
    827  1.18  kiyohara 	xfer->recv.pay_len = PAGE_SIZE;
    828  1.18  kiyohara 	mutex_enter(&d->fc->fc_mtx);
    829  1.18  kiyohara 	STAILQ_INSERT_TAIL(&fwb->xferlist, xfer, link);
    830  1.18  kiyohara 	mutex_exit(&d->fc->fc_mtx);
    831  1.18  kiyohara 	return err;
    832   1.1  kiyohara }
    833   1.1  kiyohara 
    834  1.18  kiyohara static int
    835  1.18  kiyohara fw_write_async(struct fw_drv1 *d, struct uio *uio, int ioflag)
    836   1.1  kiyohara {
    837  1.18  kiyohara 	struct fw_xfer *xfer;
    838  1.18  kiyohara 	struct fw_pkt pkt;
    839  1.18  kiyohara 	const struct tcode_info *tinfo;
    840  1.18  kiyohara 	int err;
    841  1.18  kiyohara 
    842  1.18  kiyohara 	memset(&pkt, 0, sizeof(struct fw_pkt));
    843  1.18  kiyohara 	if ((err = uiomove((void *)&pkt, sizeof(uint32_t), uio)))
    844  1.18  kiyohara 		return err;
    845  1.18  kiyohara 	tinfo = &d->fc->tcode[pkt.mode.hdr.tcode];
    846  1.18  kiyohara 	if ((err = uiomove((char *)&pkt + sizeof(uint32_t),
    847  1.18  kiyohara 	    tinfo->hdr_len - sizeof(uint32_t), uio)))
    848  1.18  kiyohara 		return err;
    849  1.18  kiyohara 
    850  1.18  kiyohara 	if ((xfer = fw_xfer_alloc_buf(M_FWXFER, uio->uio_resid,
    851  1.18  kiyohara 	    PAGE_SIZE/*XXX*/)) == NULL)
    852  1.18  kiyohara 		return ENOMEM;
    853  1.18  kiyohara 
    854  1.18  kiyohara 	memcpy(&xfer->send.hdr, &pkt, sizeof(struct fw_pkt));
    855  1.18  kiyohara 	xfer->send.pay_len = uio->uio_resid;
    856  1.18  kiyohara 	if (uio->uio_resid > 0) {
    857  1.18  kiyohara 		if ((err =
    858  1.18  kiyohara 		    uiomove((void *)xfer->send.payload, uio->uio_resid, uio)))
    859  1.18  kiyohara 			goto out;
    860  1.18  kiyohara 	}
    861  1.18  kiyohara 
    862  1.18  kiyohara 	xfer->fc = d->fc;
    863  1.18  kiyohara 	xfer->sc = NULL;
    864  1.18  kiyohara 	xfer->hand = fw_xferwake;
    865  1.18  kiyohara 	xfer->send.spd = 2 /* XXX */;
    866   1.1  kiyohara 
    867  1.18  kiyohara 	if ((err = fw_asyreq(xfer->fc, -1, xfer)))
    868  1.18  kiyohara 		goto out;
    869   1.1  kiyohara 
    870  1.18  kiyohara 	if ((err = fw_xferwait(xfer)))
    871  1.18  kiyohara 		goto out;
    872   1.1  kiyohara 
    873  1.18  kiyohara 	if (xfer->resp != 0) {
    874  1.18  kiyohara 		err = xfer->resp;
    875  1.18  kiyohara 		goto out;
    876  1.18  kiyohara 	}
    877   1.1  kiyohara 
    878  1.18  kiyohara 	if (xfer->flag == FWXF_RCVD) {
    879  1.18  kiyohara 		mutex_enter(&xfer->fc->fc_mtx);
    880  1.18  kiyohara 		STAILQ_INSERT_TAIL(&d->rq, xfer, link);
    881  1.18  kiyohara 		mutex_exit(&xfer->fc->fc_mtx);
    882  1.18  kiyohara 		return 0;
    883   1.1  kiyohara 	}
    884   1.1  kiyohara 
    885  1.18  kiyohara out:
    886  1.18  kiyohara 	fw_xfer_free(xfer);
    887  1.18  kiyohara 	return err;
    888  1.18  kiyohara }
    889  1.18  kiyohara 
    890  1.18  kiyohara static void
    891  1.18  kiyohara fw_hand(struct fw_xfer *xfer)
    892  1.18  kiyohara {
    893  1.18  kiyohara 	struct fw_bind *fwb;
    894  1.18  kiyohara 	struct fw_drv1 *d;
    895  1.18  kiyohara 
    896  1.18  kiyohara 	fwb = (struct fw_bind *)xfer->sc;
    897  1.18  kiyohara 	d = (struct fw_drv1 *)fwb->sc;
    898  1.18  kiyohara 	mutex_enter(&xfer->fc->fc_mtx);
    899  1.18  kiyohara 	STAILQ_INSERT_TAIL(&d->rq, xfer, link);
    900  1.18  kiyohara 	mutex_exit(&xfer->fc->fc_mtx);
    901  1.18  kiyohara 	wakeup(&d->rq);
    902   1.1  kiyohara }
    903