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