1098ca2bdSWarner Losh /*- 277ee030bSHidetoshi Shimokawa * Copyright (c) 2002-2003 33c60ba66SKatsushi Kobayashi * Hidetoshi Shimokawa. All rights reserved. 43c60ba66SKatsushi Kobayashi * 53c60ba66SKatsushi Kobayashi * Redistribution and use in source and binary forms, with or without 63c60ba66SKatsushi Kobayashi * modification, are permitted provided that the following conditions 73c60ba66SKatsushi Kobayashi * are met: 83c60ba66SKatsushi Kobayashi * 1. Redistributions of source code must retain the above copyright 93c60ba66SKatsushi Kobayashi * notice, this list of conditions and the following disclaimer. 103c60ba66SKatsushi Kobayashi * 2. Redistributions in binary form must reproduce the above copyright 113c60ba66SKatsushi Kobayashi * notice, this list of conditions and the following disclaimer in the 123c60ba66SKatsushi Kobayashi * documentation and/or other materials provided with the distribution. 133c60ba66SKatsushi Kobayashi * 3. All advertising materials mentioning features or use of this software 143c60ba66SKatsushi Kobayashi * must display the following acknowledgement: 153c60ba66SKatsushi Kobayashi * 163c60ba66SKatsushi Kobayashi * This product includes software developed by Hidetoshi Shimokawa. 173c60ba66SKatsushi Kobayashi * 183c60ba66SKatsushi Kobayashi * 4. Neither the name of the author nor the names of its contributors 193c60ba66SKatsushi Kobayashi * may be used to endorse or promote products derived from this software 203c60ba66SKatsushi Kobayashi * without specific prior written permission. 213c60ba66SKatsushi Kobayashi * 223c60ba66SKatsushi Kobayashi * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 233c60ba66SKatsushi Kobayashi * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 243c60ba66SKatsushi Kobayashi * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 253c60ba66SKatsushi Kobayashi * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 263c60ba66SKatsushi Kobayashi * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 273c60ba66SKatsushi Kobayashi * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 283c60ba66SKatsushi Kobayashi * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 293c60ba66SKatsushi Kobayashi * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 303c60ba66SKatsushi Kobayashi * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 313c60ba66SKatsushi Kobayashi * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 323c60ba66SKatsushi Kobayashi * SUCH DAMAGE. 333c60ba66SKatsushi Kobayashi * 343c60ba66SKatsushi Kobayashi */ 353c60ba66SKatsushi Kobayashi 3610d3ed64SHidetoshi Shimokawa #ifdef __FreeBSD__ 37aad970f1SDavid E. O'Brien #include <sys/cdefs.h> 38aad970f1SDavid E. O'Brien __FBSDID("$FreeBSD$"); 3910d3ed64SHidetoshi Shimokawa #endif 40aad970f1SDavid E. O'Brien 413c60ba66SKatsushi Kobayashi #include <sys/param.h> 423c60ba66SKatsushi Kobayashi #include <sys/systm.h> 433c60ba66SKatsushi Kobayashi #include <sys/types.h> 443c60ba66SKatsushi Kobayashi 453c60ba66SKatsushi Kobayashi #include <sys/kernel.h> 463c60ba66SKatsushi Kobayashi #include <sys/malloc.h> 473c60ba66SKatsushi Kobayashi #include <sys/conf.h> 483c60ba66SKatsushi Kobayashi #include <sys/sysctl.h> 4910d3ed64SHidetoshi Shimokawa #if defined(__DragonFly__) || __FreeBSD_version < 500000 50c4778b5dSHidetoshi Shimokawa #include <sys/buf.h> 51c4778b5dSHidetoshi Shimokawa #else 52c4778b5dSHidetoshi Shimokawa #include <sys/bio.h> 53c4778b5dSHidetoshi Shimokawa #endif 543c60ba66SKatsushi Kobayashi 553c60ba66SKatsushi Kobayashi #include <sys/bus.h> 5677ee030bSHidetoshi Shimokawa #include <machine/bus.h> 573c60ba66SKatsushi Kobayashi 583c60ba66SKatsushi Kobayashi #include <sys/signal.h> 593c60ba66SKatsushi Kobayashi #include <sys/mman.h> 603c60ba66SKatsushi Kobayashi #include <sys/ioccom.h> 61132e28bdSHidetoshi Shimokawa #include <sys/fcntl.h> 623c60ba66SKatsushi Kobayashi 6310d3ed64SHidetoshi Shimokawa #ifdef __DragonFly__ 6410d3ed64SHidetoshi Shimokawa #include "firewire.h" 6510d3ed64SHidetoshi Shimokawa #include "firewirereg.h" 6610d3ed64SHidetoshi Shimokawa #include "fwmem.h" 6710d3ed64SHidetoshi Shimokawa #else 683c60ba66SKatsushi Kobayashi #include <dev/firewire/firewire.h> 693c60ba66SKatsushi Kobayashi #include <dev/firewire/firewirereg.h> 703c60ba66SKatsushi Kobayashi #include <dev/firewire/fwmem.h> 7110d3ed64SHidetoshi Shimokawa #endif 723c60ba66SKatsushi Kobayashi 73f90ce7b1SHidetoshi Shimokawa static int fwmem_speed=2, fwmem_debug=0; 74f90ce7b1SHidetoshi Shimokawa static struct fw_eui64 fwmem_eui64; 753c60ba66SKatsushi Kobayashi SYSCTL_DECL(_hw_firewire); 763c60ba66SKatsushi Kobayashi SYSCTL_NODE(_hw_firewire, OID_AUTO, fwmem, CTLFLAG_RD, 0, 77ee126d67SHidetoshi Shimokawa "FireWire Memory Access"); 78f90ce7b1SHidetoshi Shimokawa SYSCTL_UINT(_hw_firewire_fwmem, OID_AUTO, eui64_hi, CTLFLAG_RW, 79f90ce7b1SHidetoshi Shimokawa &fwmem_eui64.hi, 0, "Fwmem target EUI64 high"); 80233b1b97SHidetoshi Shimokawa SYSCTL_UINT(_hw_firewire_fwmem, OID_AUTO, eui64_lo, CTLFLAG_RW, 81f90ce7b1SHidetoshi Shimokawa &fwmem_eui64.lo, 0, "Fwmem target EUI64 low"); 823c60ba66SKatsushi Kobayashi SYSCTL_INT(_hw_firewire_fwmem, OID_AUTO, speed, CTLFLAG_RW, &fwmem_speed, 0, 833c60ba66SKatsushi Kobayashi "Fwmem link speed"); 843c60ba66SKatsushi Kobayashi SYSCTL_INT(_debug, OID_AUTO, fwmem_debug, CTLFLAG_RW, &fwmem_debug, 0, 853c60ba66SKatsushi Kobayashi "Fwmem driver debug flag"); 863c60ba66SKatsushi Kobayashi 875b50d9adSHidetoshi Shimokawa MALLOC_DEFINE(M_FWMEM, "fwmem", "fwmem/FireWire"); 885b50d9adSHidetoshi Shimokawa 89c4778b5dSHidetoshi Shimokawa #define MAXLEN (512 << fwmem_speed) 90c4778b5dSHidetoshi Shimokawa 91132e28bdSHidetoshi Shimokawa struct fwmem_softc { 92132e28bdSHidetoshi Shimokawa struct fw_eui64 eui; 93132e28bdSHidetoshi Shimokawa int refcount; 94132e28bdSHidetoshi Shimokawa }; 95132e28bdSHidetoshi Shimokawa 96d6ec5885SHidetoshi Shimokawa static struct fw_xfer * 97d6ec5885SHidetoshi Shimokawa fwmem_xfer_req( 98d6ec5885SHidetoshi Shimokawa struct fw_device *fwdev, 99d6ec5885SHidetoshi Shimokawa caddr_t sc, 100d6ec5885SHidetoshi Shimokawa int spd, 10177ee030bSHidetoshi Shimokawa int slen, 10277ee030bSHidetoshi Shimokawa int rlen, 103d6ec5885SHidetoshi Shimokawa void *hand) 104d6ec5885SHidetoshi Shimokawa { 105d6ec5885SHidetoshi Shimokawa struct fw_xfer *xfer; 106d6ec5885SHidetoshi Shimokawa 1075b50d9adSHidetoshi Shimokawa xfer = fw_xfer_alloc(M_FWMEM); 108d6ec5885SHidetoshi Shimokawa if (xfer == NULL) 109d6ec5885SHidetoshi Shimokawa return NULL; 110d6ec5885SHidetoshi Shimokawa 111d6ec5885SHidetoshi Shimokawa xfer->fc = fwdev->fc; 112c4778b5dSHidetoshi Shimokawa xfer->send.hdr.mode.hdr.dst = FWLOCALBUS | fwdev->dst; 113d6ec5885SHidetoshi Shimokawa if (spd < 0) 114c4778b5dSHidetoshi Shimokawa xfer->send.spd = fwdev->speed; 115d6ec5885SHidetoshi Shimokawa else 116c4778b5dSHidetoshi Shimokawa xfer->send.spd = min(spd, fwdev->speed); 117801167a8SHidetoshi Shimokawa xfer->hand = hand; 118d6ec5885SHidetoshi Shimokawa xfer->sc = sc; 119c4778b5dSHidetoshi Shimokawa xfer->send.pay_len = slen; 120c4778b5dSHidetoshi Shimokawa xfer->recv.pay_len = rlen; 121d6ec5885SHidetoshi Shimokawa 122d6ec5885SHidetoshi Shimokawa return xfer; 123d6ec5885SHidetoshi Shimokawa } 124d6ec5885SHidetoshi Shimokawa 1253c60ba66SKatsushi Kobayashi struct fw_xfer * 1263c60ba66SKatsushi Kobayashi fwmem_read_quad( 127f90ce7b1SHidetoshi Shimokawa struct fw_device *fwdev, 128f90ce7b1SHidetoshi Shimokawa caddr_t sc, 12903161bbcSDoug Rabson uint8_t spd, 13003161bbcSDoug Rabson uint16_t dst_hi, 13103161bbcSDoug Rabson uint32_t dst_lo, 132c4778b5dSHidetoshi Shimokawa void *data, 133c3b09522SHidetoshi Shimokawa void (*hand)(struct fw_xfer *)) 1343c60ba66SKatsushi Kobayashi { 1353c60ba66SKatsushi Kobayashi struct fw_xfer *xfer; 1363c60ba66SKatsushi Kobayashi struct fw_pkt *fp; 1373c60ba66SKatsushi Kobayashi 138c4778b5dSHidetoshi Shimokawa xfer = fwmem_xfer_req(fwdev, (void *)sc, spd, 0, 4, hand); 139c4778b5dSHidetoshi Shimokawa if (xfer == NULL) { 1403c60ba66SKatsushi Kobayashi return NULL; 141c4778b5dSHidetoshi Shimokawa } 142c3b09522SHidetoshi Shimokawa 143c4778b5dSHidetoshi Shimokawa fp = &xfer->send.hdr; 1443c60ba66SKatsushi Kobayashi fp->mode.rreqq.tcode = FWTCODE_RREQQ; 14577ee030bSHidetoshi Shimokawa fp->mode.rreqq.dest_hi = dst_hi; 14677ee030bSHidetoshi Shimokawa fp->mode.rreqq.dest_lo = dst_lo; 1473c60ba66SKatsushi Kobayashi 148c4778b5dSHidetoshi Shimokawa xfer->send.payload = NULL; 14903161bbcSDoug Rabson xfer->recv.payload = (uint32_t *)data; 150c4778b5dSHidetoshi Shimokawa 1513c60ba66SKatsushi Kobayashi if (fwmem_debug) 152d6ec5885SHidetoshi Shimokawa printf("fwmem_read_quad: %d %04x:%08x\n", fwdev->dst, 153d6ec5885SHidetoshi Shimokawa dst_hi, dst_lo); 154c3b09522SHidetoshi Shimokawa 155f90ce7b1SHidetoshi Shimokawa if (fw_asyreq(xfer->fc, -1, xfer) == 0) 156f90ce7b1SHidetoshi Shimokawa return xfer; 157f90ce7b1SHidetoshi Shimokawa 158f90ce7b1SHidetoshi Shimokawa fw_xfer_free(xfer); 159f90ce7b1SHidetoshi Shimokawa return NULL; 160f90ce7b1SHidetoshi Shimokawa } 161f90ce7b1SHidetoshi Shimokawa 162f90ce7b1SHidetoshi Shimokawa struct fw_xfer * 163f90ce7b1SHidetoshi Shimokawa fwmem_write_quad( 164f90ce7b1SHidetoshi Shimokawa struct fw_device *fwdev, 165f90ce7b1SHidetoshi Shimokawa caddr_t sc, 16603161bbcSDoug Rabson uint8_t spd, 16703161bbcSDoug Rabson uint16_t dst_hi, 16803161bbcSDoug Rabson uint32_t dst_lo, 169c4778b5dSHidetoshi Shimokawa void *data, 170f90ce7b1SHidetoshi Shimokawa void (*hand)(struct fw_xfer *)) 171f90ce7b1SHidetoshi Shimokawa { 172f90ce7b1SHidetoshi Shimokawa struct fw_xfer *xfer; 173f90ce7b1SHidetoshi Shimokawa struct fw_pkt *fp; 174f90ce7b1SHidetoshi Shimokawa 175c4778b5dSHidetoshi Shimokawa xfer = fwmem_xfer_req(fwdev, sc, spd, 0, 0, hand); 176f90ce7b1SHidetoshi Shimokawa if (xfer == NULL) 177f90ce7b1SHidetoshi Shimokawa return NULL; 178f90ce7b1SHidetoshi Shimokawa 179c4778b5dSHidetoshi Shimokawa fp = &xfer->send.hdr; 180958c7749SHidetoshi Shimokawa fp->mode.wreqq.tcode = FWTCODE_WREQQ; 18177ee030bSHidetoshi Shimokawa fp->mode.wreqq.dest_hi = dst_hi; 18277ee030bSHidetoshi Shimokawa fp->mode.wreqq.dest_lo = dst_lo; 18303161bbcSDoug Rabson fp->mode.wreqq.data = *(uint32_t *)data; 184f90ce7b1SHidetoshi Shimokawa 185c4778b5dSHidetoshi Shimokawa xfer->send.payload = xfer->recv.payload = NULL; 186f90ce7b1SHidetoshi Shimokawa 187f90ce7b1SHidetoshi Shimokawa if (fwmem_debug) 188d6ec5885SHidetoshi Shimokawa printf("fwmem_write_quad: %d %04x:%08x %08x\n", fwdev->dst, 18903161bbcSDoug Rabson dst_hi, dst_lo, *(uint32_t *)data); 190f90ce7b1SHidetoshi Shimokawa 191f90ce7b1SHidetoshi Shimokawa if (fw_asyreq(xfer->fc, -1, xfer) == 0) 1923c60ba66SKatsushi Kobayashi return xfer; 193c3b09522SHidetoshi Shimokawa 1943c60ba66SKatsushi Kobayashi fw_xfer_free(xfer); 1953c60ba66SKatsushi Kobayashi return NULL; 1963c60ba66SKatsushi Kobayashi } 1973c60ba66SKatsushi Kobayashi 1983c60ba66SKatsushi Kobayashi struct fw_xfer * 1993c60ba66SKatsushi Kobayashi fwmem_read_block( 200f90ce7b1SHidetoshi Shimokawa struct fw_device *fwdev, 201f90ce7b1SHidetoshi Shimokawa caddr_t sc, 20203161bbcSDoug Rabson uint8_t spd, 20303161bbcSDoug Rabson uint16_t dst_hi, 20403161bbcSDoug Rabson uint32_t dst_lo, 205c3b09522SHidetoshi Shimokawa int len, 206c4778b5dSHidetoshi Shimokawa void *data, 207c3b09522SHidetoshi Shimokawa void (*hand)(struct fw_xfer *)) 2083c60ba66SKatsushi Kobayashi { 2093c60ba66SKatsushi Kobayashi struct fw_xfer *xfer; 2103c60ba66SKatsushi Kobayashi struct fw_pkt *fp; 2113c60ba66SKatsushi Kobayashi 212c4778b5dSHidetoshi Shimokawa xfer = fwmem_xfer_req(fwdev, sc, spd, 0, roundup2(len, 4), hand); 213c3b09522SHidetoshi Shimokawa if (xfer == NULL) 2143c60ba66SKatsushi Kobayashi return NULL; 215c3b09522SHidetoshi Shimokawa 216c4778b5dSHidetoshi Shimokawa fp = &xfer->send.hdr; 2173c60ba66SKatsushi Kobayashi fp->mode.rreqb.tcode = FWTCODE_RREQB; 21877ee030bSHidetoshi Shimokawa fp->mode.rreqb.dest_hi = dst_hi; 21977ee030bSHidetoshi Shimokawa fp->mode.rreqb.dest_lo = dst_lo; 22077ee030bSHidetoshi Shimokawa fp->mode.rreqb.len = len; 221c4778b5dSHidetoshi Shimokawa fp->mode.rreqb.extcode = 0; 222c4778b5dSHidetoshi Shimokawa 223c4778b5dSHidetoshi Shimokawa xfer->send.payload = NULL; 224c4778b5dSHidetoshi Shimokawa xfer->recv.payload = data; 2253c60ba66SKatsushi Kobayashi 2263c60ba66SKatsushi Kobayashi if (fwmem_debug) 227d6ec5885SHidetoshi Shimokawa printf("fwmem_read_block: %d %04x:%08x %d\n", fwdev->dst, 228f90ce7b1SHidetoshi Shimokawa dst_hi, dst_lo, len); 229f90ce7b1SHidetoshi Shimokawa if (fw_asyreq(xfer->fc, -1, xfer) == 0) 2303c60ba66SKatsushi Kobayashi return xfer; 231c3b09522SHidetoshi Shimokawa 2323c60ba66SKatsushi Kobayashi fw_xfer_free(xfer); 2333c60ba66SKatsushi Kobayashi return NULL; 2343c60ba66SKatsushi Kobayashi } 2353c60ba66SKatsushi Kobayashi 2368a45d99bSHidetoshi Shimokawa struct fw_xfer * 2378a45d99bSHidetoshi Shimokawa fwmem_write_block( 2388a45d99bSHidetoshi Shimokawa struct fw_device *fwdev, 2398a45d99bSHidetoshi Shimokawa caddr_t sc, 24003161bbcSDoug Rabson uint8_t spd, 24103161bbcSDoug Rabson uint16_t dst_hi, 24203161bbcSDoug Rabson uint32_t dst_lo, 2438a45d99bSHidetoshi Shimokawa int len, 244c4778b5dSHidetoshi Shimokawa void *data, 2458a45d99bSHidetoshi Shimokawa void (*hand)(struct fw_xfer *)) 2468a45d99bSHidetoshi Shimokawa { 2478a45d99bSHidetoshi Shimokawa struct fw_xfer *xfer; 2488a45d99bSHidetoshi Shimokawa struct fw_pkt *fp; 2498a45d99bSHidetoshi Shimokawa 250c4778b5dSHidetoshi Shimokawa xfer = fwmem_xfer_req(fwdev, sc, spd, len, 0, hand); 2518a45d99bSHidetoshi Shimokawa if (xfer == NULL) 2528a45d99bSHidetoshi Shimokawa return NULL; 2538a45d99bSHidetoshi Shimokawa 254c4778b5dSHidetoshi Shimokawa fp = &xfer->send.hdr; 2555db3899dSHidetoshi Shimokawa fp->mode.wreqb.tcode = FWTCODE_WREQB; 25677ee030bSHidetoshi Shimokawa fp->mode.wreqb.dest_hi = dst_hi; 25777ee030bSHidetoshi Shimokawa fp->mode.wreqb.dest_lo = dst_lo; 25877ee030bSHidetoshi Shimokawa fp->mode.wreqb.len = len; 259c4778b5dSHidetoshi Shimokawa fp->mode.wreqb.extcode = 0; 260c4778b5dSHidetoshi Shimokawa 261c4778b5dSHidetoshi Shimokawa xfer->send.payload = data; 262c4778b5dSHidetoshi Shimokawa xfer->recv.payload = NULL; 2638a45d99bSHidetoshi Shimokawa 2648a45d99bSHidetoshi Shimokawa if (fwmem_debug) 2658a45d99bSHidetoshi Shimokawa printf("fwmem_write_block: %d %04x:%08x %d\n", fwdev->dst, 2668a45d99bSHidetoshi Shimokawa dst_hi, dst_lo, len); 2678a45d99bSHidetoshi Shimokawa if (fw_asyreq(xfer->fc, -1, xfer) == 0) 2688a45d99bSHidetoshi Shimokawa return xfer; 2698a45d99bSHidetoshi Shimokawa 2708a45d99bSHidetoshi Shimokawa fw_xfer_free(xfer); 2718a45d99bSHidetoshi Shimokawa return NULL; 2728a45d99bSHidetoshi Shimokawa } 2738a45d99bSHidetoshi Shimokawa 2748a45d99bSHidetoshi Shimokawa 2753c60ba66SKatsushi Kobayashi int 27689c9c53dSPoul-Henning Kamp fwmem_open (struct cdev *dev, int flags, int fmt, fw_proc *td) 2773c60ba66SKatsushi Kobayashi { 278132e28bdSHidetoshi Shimokawa struct fwmem_softc *fms; 279233b1b97SHidetoshi Shimokawa 280132e28bdSHidetoshi Shimokawa if (dev->si_drv1 != NULL) { 281132e28bdSHidetoshi Shimokawa if ((flags & FWRITE) != 0) 2821bba1572SHidetoshi Shimokawa return (EBUSY); 283132e28bdSHidetoshi Shimokawa fms = (struct fwmem_softc *)dev->si_drv1; 284132e28bdSHidetoshi Shimokawa fms->refcount ++; 285132e28bdSHidetoshi Shimokawa } else { 286132e28bdSHidetoshi Shimokawa fms = (struct fwmem_softc *)malloc(sizeof(struct fwmem_softc), 2875b50d9adSHidetoshi Shimokawa M_FWMEM, M_WAITOK); 288132e28bdSHidetoshi Shimokawa if (fms == NULL) 289233b1b97SHidetoshi Shimokawa return ENOMEM; 290132e28bdSHidetoshi Shimokawa bcopy(&fwmem_eui64, &fms->eui, sizeof(struct fw_eui64)); 291132e28bdSHidetoshi Shimokawa dev->si_drv1 = (void *)fms; 292c4778b5dSHidetoshi Shimokawa dev->si_iosize_max = DFLTPHYS; 293132e28bdSHidetoshi Shimokawa fms->refcount = 1; 294132e28bdSHidetoshi Shimokawa } 295132e28bdSHidetoshi Shimokawa if (fwmem_debug) 29610d3ed64SHidetoshi Shimokawa printf("%s: refcount=%d\n", __func__, fms->refcount); 297233b1b97SHidetoshi Shimokawa 298233b1b97SHidetoshi Shimokawa return (0); 2993c60ba66SKatsushi Kobayashi } 3003c60ba66SKatsushi Kobayashi 3013c60ba66SKatsushi Kobayashi int 30289c9c53dSPoul-Henning Kamp fwmem_close (struct cdev *dev, int flags, int fmt, fw_proc *td) 3033c60ba66SKatsushi Kobayashi { 304132e28bdSHidetoshi Shimokawa struct fwmem_softc *fms; 305132e28bdSHidetoshi Shimokawa 306132e28bdSHidetoshi Shimokawa fms = (struct fwmem_softc *)dev->si_drv1; 307132e28bdSHidetoshi Shimokawa fms->refcount --; 308132e28bdSHidetoshi Shimokawa if (fwmem_debug) 30910d3ed64SHidetoshi Shimokawa printf("%s: refcount=%d\n", __func__, fms->refcount); 310132e28bdSHidetoshi Shimokawa if (fms->refcount < 1) { 3110fd46672SHidetoshi Shimokawa free(dev->si_drv1, M_FWMEM); 3121bba1572SHidetoshi Shimokawa dev->si_drv1 = NULL; 313132e28bdSHidetoshi Shimokawa } 3141bba1572SHidetoshi Shimokawa 315233b1b97SHidetoshi Shimokawa return (0); 3163c60ba66SKatsushi Kobayashi } 3173c60ba66SKatsushi Kobayashi 318c4778b5dSHidetoshi Shimokawa 319c4778b5dSHidetoshi Shimokawa static void 320c4778b5dSHidetoshi Shimokawa fwmem_biodone(struct fw_xfer *xfer) 321c4778b5dSHidetoshi Shimokawa { 322c4778b5dSHidetoshi Shimokawa struct bio *bp; 323c4778b5dSHidetoshi Shimokawa 324c4778b5dSHidetoshi Shimokawa bp = (struct bio *)xfer->sc; 325c4778b5dSHidetoshi Shimokawa bp->bio_error = xfer->resp; 326c4778b5dSHidetoshi Shimokawa 327c4778b5dSHidetoshi Shimokawa if (bp->bio_error != 0) { 32861ba6580SHidetoshi Shimokawa if (fwmem_debug) 32910d3ed64SHidetoshi Shimokawa printf("%s: err=%d\n", __func__, bp->bio_error); 330c4778b5dSHidetoshi Shimokawa bp->bio_flags |= BIO_ERROR; 331c4778b5dSHidetoshi Shimokawa bp->bio_resid = bp->bio_bcount; 332c4778b5dSHidetoshi Shimokawa } 333c4778b5dSHidetoshi Shimokawa 334c4778b5dSHidetoshi Shimokawa fw_xfer_free(xfer); 335c4778b5dSHidetoshi Shimokawa biodone(bp); 336c4778b5dSHidetoshi Shimokawa } 337c4778b5dSHidetoshi Shimokawa 338c4778b5dSHidetoshi Shimokawa void 339c4778b5dSHidetoshi Shimokawa fwmem_strategy(struct bio *bp) 3403c60ba66SKatsushi Kobayashi { 3413c60ba66SKatsushi Kobayashi struct firewire_softc *sc; 342132e28bdSHidetoshi Shimokawa struct fwmem_softc *fms; 343f90ce7b1SHidetoshi Shimokawa struct fw_device *fwdev; 3443c60ba66SKatsushi Kobayashi struct fw_xfer *xfer; 34589c9c53dSPoul-Henning Kamp struct cdev *dev; 346c4778b5dSHidetoshi Shimokawa int unit, err=0, s, iolen; 3473c60ba66SKatsushi Kobayashi 348c4778b5dSHidetoshi Shimokawa dev = bp->bio_dev; 349c4778b5dSHidetoshi Shimokawa /* XXX check request length */ 350c4778b5dSHidetoshi Shimokawa 351c4778b5dSHidetoshi Shimokawa unit = DEV2UNIT(dev); 3523c60ba66SKatsushi Kobayashi sc = devclass_get_softc(firewire_devclass, unit); 353c4778b5dSHidetoshi Shimokawa 354c4778b5dSHidetoshi Shimokawa s = splfw(); 355132e28bdSHidetoshi Shimokawa fms = (struct fwmem_softc *)dev->si_drv1; 356132e28bdSHidetoshi Shimokawa fwdev = fw_noderesolve_eui64(sc->fc, &fms->eui); 357f90ce7b1SHidetoshi Shimokawa if (fwdev == NULL) { 358864d7e72SHidetoshi Shimokawa if (fwmem_debug) 359f90ce7b1SHidetoshi Shimokawa printf("fwmem: no such device ID:%08x%08x\n", 360132e28bdSHidetoshi Shimokawa fms->eui.hi, fms->eui.lo); 361c4778b5dSHidetoshi Shimokawa err = EINVAL; 362c4778b5dSHidetoshi Shimokawa goto error; 363f90ce7b1SHidetoshi Shimokawa } 3643c60ba66SKatsushi Kobayashi 365c4778b5dSHidetoshi Shimokawa iolen = MIN(bp->bio_bcount, MAXLEN); 366c4778b5dSHidetoshi Shimokawa if ((bp->bio_cmd & BIO_READ) == BIO_READ) { 367c4778b5dSHidetoshi Shimokawa if (iolen == 4 && (bp->bio_offset & 3) == 0) 368c4778b5dSHidetoshi Shimokawa xfer = fwmem_read_quad(fwdev, 369c4778b5dSHidetoshi Shimokawa (void *) bp, fwmem_speed, 370c4778b5dSHidetoshi Shimokawa bp->bio_offset >> 32, bp->bio_offset & 0xffffffff, 371c4778b5dSHidetoshi Shimokawa bp->bio_data, fwmem_biodone); 372c4778b5dSHidetoshi Shimokawa else 373c4778b5dSHidetoshi Shimokawa xfer = fwmem_read_block(fwdev, 374c4778b5dSHidetoshi Shimokawa (void *) bp, fwmem_speed, 375c4778b5dSHidetoshi Shimokawa bp->bio_offset >> 32, bp->bio_offset & 0xffffffff, 376c4778b5dSHidetoshi Shimokawa iolen, bp->bio_data, fwmem_biodone); 3778a45d99bSHidetoshi Shimokawa } else { 378c4778b5dSHidetoshi Shimokawa if (iolen == 4 && (bp->bio_offset & 3) == 0) 379c4778b5dSHidetoshi Shimokawa xfer = fwmem_write_quad(fwdev, 380c4778b5dSHidetoshi Shimokawa (void *)bp, fwmem_speed, 381c4778b5dSHidetoshi Shimokawa bp->bio_offset >> 32, bp->bio_offset & 0xffffffff, 382c4778b5dSHidetoshi Shimokawa bp->bio_data, fwmem_biodone); 383c4778b5dSHidetoshi Shimokawa else 384c4778b5dSHidetoshi Shimokawa xfer = fwmem_write_block(fwdev, 385c4778b5dSHidetoshi Shimokawa (void *)bp, fwmem_speed, 386c4778b5dSHidetoshi Shimokawa bp->bio_offset >> 32, bp->bio_offset & 0xffffffff, 387c4778b5dSHidetoshi Shimokawa iolen, bp->bio_data, fwmem_biodone); 388d3539e97SHidetoshi Shimokawa } 389c4778b5dSHidetoshi Shimokawa if (xfer == NULL) { 3905db3899dSHidetoshi Shimokawa err = EIO; 391c4778b5dSHidetoshi Shimokawa goto error; 3928a45d99bSHidetoshi Shimokawa } 393c4778b5dSHidetoshi Shimokawa /* XXX */ 394c4778b5dSHidetoshi Shimokawa bp->bio_resid = bp->bio_bcount - iolen; 395c4778b5dSHidetoshi Shimokawa error: 3962c56e6e4SHidetoshi Shimokawa splx(s); 397c4778b5dSHidetoshi Shimokawa if (err != 0) { 39861ba6580SHidetoshi Shimokawa if (fwmem_debug) 39910d3ed64SHidetoshi Shimokawa printf("%s: err=%d\n", __func__, err); 400c4778b5dSHidetoshi Shimokawa bp->bio_error = err; 401c4778b5dSHidetoshi Shimokawa bp->bio_flags |= BIO_ERROR; 402c4778b5dSHidetoshi Shimokawa bp->bio_resid = bp->bio_bcount; 403c4778b5dSHidetoshi Shimokawa biodone(bp); 404d3539e97SHidetoshi Shimokawa } 4058a45d99bSHidetoshi Shimokawa } 4068a45d99bSHidetoshi Shimokawa 4073c60ba66SKatsushi Kobayashi int 40889c9c53dSPoul-Henning Kamp fwmem_ioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag, fw_proc *td) 4093c60ba66SKatsushi Kobayashi { 410132e28bdSHidetoshi Shimokawa struct fwmem_softc *fms; 411233b1b97SHidetoshi Shimokawa int err = 0; 412132e28bdSHidetoshi Shimokawa 413132e28bdSHidetoshi Shimokawa fms = (struct fwmem_softc *)dev->si_drv1; 414233b1b97SHidetoshi Shimokawa switch (cmd) { 415233b1b97SHidetoshi Shimokawa case FW_SDEUI64: 416132e28bdSHidetoshi Shimokawa bcopy(data, &fms->eui, sizeof(struct fw_eui64)); 417233b1b97SHidetoshi Shimokawa break; 418233b1b97SHidetoshi Shimokawa case FW_GDEUI64: 419132e28bdSHidetoshi Shimokawa bcopy(&fms->eui, data, sizeof(struct fw_eui64)); 420233b1b97SHidetoshi Shimokawa break; 421233b1b97SHidetoshi Shimokawa default: 422233b1b97SHidetoshi Shimokawa err = EINVAL; 423233b1b97SHidetoshi Shimokawa } 424233b1b97SHidetoshi Shimokawa return(err); 4253c60ba66SKatsushi Kobayashi } 4263c60ba66SKatsushi Kobayashi int 42789c9c53dSPoul-Henning Kamp fwmem_poll (struct cdev *dev, int events, fw_proc *td) 4283c60ba66SKatsushi Kobayashi { 4293c60ba66SKatsushi Kobayashi return EINVAL; 4303c60ba66SKatsushi Kobayashi } 4313c60ba66SKatsushi Kobayashi int 43210d3ed64SHidetoshi Shimokawa #if defined(__DragonFly__) || __FreeBSD_version < 500102 43389c9c53dSPoul-Henning Kamp fwmem_mmap (struct cdev *dev, vm_offset_t offset, int nproto) 43445545499SHidetoshi Shimokawa #else 43589c9c53dSPoul-Henning Kamp fwmem_mmap (struct cdev *dev, vm_offset_t offset, vm_paddr_t *paddr, int nproto) 43645545499SHidetoshi Shimokawa #endif 4373c60ba66SKatsushi Kobayashi { 4383c60ba66SKatsushi Kobayashi return EINVAL; 4393c60ba66SKatsushi Kobayashi } 440