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 }
Cache object: dd12cc628e924de6149f8fe282ab3b4d
|