1 /*- 2 * Copyright (c) 2005, M. Warner Losh 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice unmodified, this list of conditions, and the following 10 * disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 * 27 */ 28 #include <sys/cdefs.h> 29 __FBSDID("$FreeBSD$"); 30 31 #include <sys/param.h> 32 #include <sys/conf.h> 33 #include <sys/malloc.h> 34 #include <sys/systm.h> 35 #include <sys/uio.h> 36 37 #include <sys/bus.h> 38 #include <machine/bus.h> 39 #include <sys/rman.h> 40 #include <machine/resource.h> 41 42 #include <sys/pciio.h> 43 #include <dev/pci/pcivar.h> 44 #include <dev/pci/pcireg.h> 45 #include <dev/pci/pci_private.h> 46 47 #include <dev/cardbus/cardbusreg.h> 48 #include <dev/cardbus/cardbusvar.h> 49 #include <dev/cardbus/cardbus_cis.h> 50 #include <dev/pccard/pccard_cis.h> 51 52 static d_open_t cardbus_open; 53 static d_close_t cardbus_close; 54 static d_read_t cardbus_read; 55 static d_ioctl_t cardbus_ioctl; 56 57 static struct cdevsw cardbus_cdevsw = { 58 .d_version = D_VERSION, 59 .d_open = cardbus_open, 60 .d_close = cardbus_close, 61 .d_read = cardbus_read, 62 .d_ioctl = cardbus_ioctl, 63 .d_name = "cardbus" 64 }; 65 66 int 67 cardbus_device_create(struct cardbus_softc *sc) 68 { 69 uint32_t minor; 70 71 minor = device_get_unit(sc->sc_dev) << 16; 72 sc->sc_cisdev = make_dev(&cardbus_cdevsw, minor, 0, 0, 0666, 73 "cardbus%u.cis", device_get_unit(sc->sc_dev)); 74 sc->sc_cisdev->si_drv1 = sc; 75 return (0); 76 } 77 78 int 79 cardbus_device_destroy(struct cardbus_softc *sc) 80 { 81 if (sc->sc_cisdev) 82 destroy_dev(sc->sc_cisdev); 83 return (0); 84 } 85 86 static int 87 cardbus_build_cis(device_t cbdev, device_t child, int id, 88 int len, uint8_t *tupledata, uint32_t start, uint32_t *off, 89 struct tuple_callbacks *info, void *argp) 90 { 91 struct cis_buffer *cis; 92 int i; 93 94 cis = (struct cis_buffer *)argp; 95 /* 96 * CISTPL_END is a special case, it has no length field. 97 */ 98 if (id == CISTPL_END) { 99 if (cis->len + 1 > sizeof(cis->buffer)) 100 return (ENOSPC); 101 cis->buffer[cis->len++] = id; 102 return (0); 103 } 104 if (cis->len + 2 + len > sizeof(cis->buffer)) 105 return (ENOSPC); 106 cis->buffer[cis->len++] = id; 107 cis->buffer[cis->len++] = len; 108 for (i = 0; i < len; i++) 109 cis->buffer[cis->len++] = tupledata[i]; 110 return (0); 111 } 112 113 static int 114 cardbus_open(struct cdev *dev, int oflags, int devtype, struct thread *td) 115 { 116 device_t parent, child; 117 device_t *kids; 118 int cnt, err; 119 struct cardbus_softc *sc; 120 struct tuple_callbacks cb[] = { 121 {CISTPL_GENERIC, "GENERIC", cardbus_build_cis} 122 }; 123 124 sc = dev->si_drv1; 125 if (sc->sc_cis_open) 126 return (EBUSY); 127 parent = sc->sc_dev; 128 err = device_get_children(parent, &kids, &cnt); 129 if (err) 130 return err; 131 if (cnt == 0) { 132 free(kids, M_TEMP); 133 sc->sc_cis_open++; 134 sc->sc_cis = NULL; 135 return (0); 136 } 137 child = kids[0]; 138 free(kids, M_TEMP); 139 sc->sc_cis = malloc(sizeof(*sc->sc_cis), M_TEMP, M_ZERO | M_WAITOK); 140 err = cardbus_parse_cis(parent, child, cb, sc->sc_cis); 141 if (err) { 142 free(sc->sc_cis, M_TEMP); 143 sc->sc_cis = NULL; 144 return (err); 145 } 146 sc->sc_cis_open++; 147 return (0); 148 } 149 150 static int 151 cardbus_close(struct cdev *dev, int fflags, int devtype, struct thread *td) 152 { 153 struct cardbus_softc *sc; 154 155 sc = dev->si_drv1; 156 free(sc->sc_cis, M_TEMP); 157 sc->sc_cis = NULL; 158 sc->sc_cis_open = 0; 159 return (0); 160 } 161 162 static int 163 cardbus_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag, 164 struct thread *td) 165 { 166 return (ENOTTY); 167 } 168 169 static int 170 cardbus_read(struct cdev *dev, struct uio *uio, int ioflag) 171 { 172 struct cardbus_softc *sc; 173 174 sc = dev->si_drv1; 175 /* EOF */ 176 if (sc->sc_cis == NULL || uio->uio_offset > sc->sc_cis->len) 177 return (0); 178 return (uiomove(sc->sc_cis->buffer + uio->uio_offset, 179 MIN(uio->uio_resid, sc->sc_cis->len - uio->uio_offset), uio)); 180 } 181