1 /* $NetBSD: pcmcia.c,v 1.23 2000/07/28 19:17:02 drochner Exp $ */
2
3 /*-
4 * Copyright (c) 1997 Marc Horowitz. All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following 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 * 3. All advertising materials mentioning features or use of this software
15 * must display the following acknowledgement:
16 * This product includes software developed by Marc Horowitz.
17 * 4. The name of the author may not be used to endorse or promote products
18 * derived from this software without specific prior written permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #include <sys/cdefs.h>
33 __FBSDID("$FreeBSD: releng/6.1/sys/dev/pccard/pccard.c 155116 2006-01-31 17:10:02Z imp $");
34
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/malloc.h>
38 #include <sys/module.h>
39 #include <sys/kernel.h>
40 #include <sys/queue.h>
41 #include <sys/sysctl.h>
42 #include <sys/types.h>
43
44 #include <sys/bus.h>
45 #include <machine/bus.h>
46 #include <sys/rman.h>
47 #include <machine/resource.h>
48
49 #include <net/ethernet.h>
50
51 #include <dev/pccard/pccardreg.h>
52 #include <dev/pccard/pccardvar.h>
53 #include <dev/pccard/pccardvarp.h>
54 #include <dev/pccard/pccard_cis.h>
55
56 #include "power_if.h"
57 #include "card_if.h"
58
59 #define PCCARDDEBUG
60
61 /* sysctl vars */
62 SYSCTL_NODE(_hw, OID_AUTO, pccard, CTLFLAG_RD, 0, "PCCARD parameters");
63
64 int pccard_debug = 0;
65 TUNABLE_INT("hw.pccard.debug", &pccard_debug);
66 SYSCTL_INT(_hw_pccard, OID_AUTO, debug, CTLFLAG_RW,
67 &pccard_debug, 0,
68 "pccard debug");
69
70 int pccard_cis_debug = 0;
71 TUNABLE_INT("hw.pccard.cis_debug", &pccard_cis_debug);
72 SYSCTL_INT(_hw_pccard, OID_AUTO, cis_debug, CTLFLAG_RW,
73 &pccard_cis_debug, 0, "pccard CIS debug");
74
75 #ifdef PCCARDDEBUG
76 #define DPRINTF(arg) if (pccard_debug) printf arg
77 #define DEVPRINTF(arg) if (pccard_debug) device_printf arg
78 #define PRVERBOSE(arg) printf arg
79 #define DEVPRVERBOSE(arg) device_printf arg
80 #else
81 #define DPRINTF(arg)
82 #define DEVPRINTF(arg)
83 #define PRVERBOSE(arg) if (bootverbose) printf arg
84 #define DEVPRVERBOSE(arg) if (bootverbose) device_printf arg
85 #endif
86
87 static int pccard_ccr_read(struct pccard_function *pf, int ccr);
88 static void pccard_ccr_write(struct pccard_function *pf, int ccr, int val);
89 static int pccard_attach_card(device_t dev);
90 static int pccard_detach_card(device_t dev);
91 static void pccard_function_init(struct pccard_function *pf);
92 static void pccard_function_free(struct pccard_function *pf);
93 static int pccard_function_enable(struct pccard_function *pf);
94 static void pccard_function_disable(struct pccard_function *pf);
95 static int pccard_compat_do_probe(device_t bus, device_t dev);
96 static int pccard_compat_do_attach(device_t bus, device_t dev);
97 static int pccard_probe(device_t dev);
98 static int pccard_attach(device_t dev);
99 static int pccard_detach(device_t dev);
100 static void pccard_print_resources(struct resource_list *rl,
101 const char *name, int type, int count, const char *format);
102 static int pccard_print_child(device_t dev, device_t child);
103 static int pccard_set_resource(device_t dev, device_t child, int type,
104 int rid, u_long start, u_long count);
105 static int pccard_get_resource(device_t dev, device_t child, int type,
106 int rid, u_long *startp, u_long *countp);
107 static void pccard_delete_resource(device_t dev, device_t child, int type,
108 int rid);
109 static int pccard_set_res_flags(device_t dev, device_t child, int type,
110 int rid, uint32_t flags);
111 static int pccard_set_memory_offset(device_t dev, device_t child, int rid,
112 uint32_t offset, uint32_t *deltap);
113 static void pccard_probe_nomatch(device_t cbdev, device_t child);
114 static int pccard_read_ivar(device_t bus, device_t child, int which,
115 u_char *result);
116 static void pccard_driver_added(device_t dev, driver_t *driver);
117 static struct resource *pccard_alloc_resource(device_t dev,
118 device_t child, int type, int *rid, u_long start,
119 u_long end, u_long count, u_int flags);
120 static int pccard_release_resource(device_t dev, device_t child, int type,
121 int rid, struct resource *r);
122 static void pccard_child_detached(device_t parent, device_t dev);
123 static void pccard_intr(void *arg);
124 static int pccard_setup_intr(device_t dev, device_t child,
125 struct resource *irq, int flags, driver_intr_t *intr,
126 void *arg, void **cookiep);
127 static int pccard_teardown_intr(device_t dev, device_t child,
128 struct resource *r, void *cookie);
129
130 static const struct pccard_product *
131 pccard_do_product_lookup(device_t bus, device_t dev,
132 const struct pccard_product *tab, size_t ent_size,
133 pccard_product_match_fn matchfn);
134
135
136 static int
137 pccard_ccr_read(struct pccard_function *pf, int ccr)
138 {
139 return (bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh,
140 pf->pf_ccr_offset + ccr));
141 }
142
143 static void
144 pccard_ccr_write(struct pccard_function *pf, int ccr, int val)
145 {
146 if ((pf->ccr_mask) & (1 << (ccr / 2))) {
147 bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh,
148 pf->pf_ccr_offset + ccr, val);
149 }
150 }
151
152 static int
153 pccard_set_default_descr(device_t dev)
154 {
155 const char *vendorstr, *prodstr;
156 uint32_t vendor, prod;
157 char *str;
158
159 if (pccard_get_vendor_str(dev, &vendorstr))
160 return (0);
161 if (pccard_get_product_str(dev, &prodstr))
162 return (0);
163 if (vendorstr != NULL && prodstr != NULL) {
164 str = malloc(strlen(vendorstr) + strlen(prodstr) + 2, M_DEVBUF,
165 M_WAITOK);
166 sprintf(str, "%s %s", vendorstr, prodstr);
167 device_set_desc_copy(dev, str);
168 free(str, M_DEVBUF);
169 } else {
170 if (pccard_get_vendor(dev, &vendor))
171 return (0);
172 if (pccard_get_product(dev, &prod))
173 return (0);
174 str = malloc(100, M_DEVBUF, M_WAITOK);
175 snprintf(str, 100, "vendor=0x%x product=0x%x", vendor, prod);
176 device_set_desc_copy(dev, str);
177 free(str, M_DEVBUF);
178 }
179 return (0);
180 }
181
182 static int
183 pccard_attach_card(device_t dev)
184 {
185 struct pccard_softc *sc = PCCARD_SOFTC(dev);
186 struct pccard_function *pf;
187 struct pccard_ivar *ivar;
188 device_t child;
189 int i;
190
191 if (!STAILQ_EMPTY(&sc->card.pf_head)) {
192 if (bootverbose || pccard_debug)
193 device_printf(dev, "Card already inserted.\n");
194 }
195
196 DEVPRINTF((dev, "chip_socket_enable\n"));
197 POWER_ENABLE_SOCKET(device_get_parent(dev), dev);
198
199 DEVPRINTF((dev, "read_cis\n"));
200 pccard_read_cis(sc);
201
202 DEVPRINTF((dev, "check_cis_quirks\n"));
203 pccard_check_cis_quirks(dev);
204
205 /*
206 * bail now if the card has no functions, or if there was an error in
207 * the cis.
208 */
209
210 if (sc->card.error) {
211 device_printf(dev, "CARD ERROR!\n");
212 return (1);
213 }
214 if (STAILQ_EMPTY(&sc->card.pf_head)) {
215 device_printf(dev, "Card has no functions!\n");
216 return (1);
217 }
218
219 if (bootverbose || pccard_debug)
220 pccard_print_cis(dev);
221
222 DEVPRINTF((dev, "functions scanning\n"));
223 i = -1;
224 STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
225 i++;
226 if (STAILQ_EMPTY(&pf->cfe_head)) {
227 device_printf(dev,
228 "Function %d has no config entries.!\n", i);
229 continue;
230 }
231 pf->sc = sc;
232 pf->cfe = NULL;
233 pf->dev = NULL;
234 }
235 DEVPRINTF((dev, "Card has %d functions. pccard_mfc is %d\n", i + 1,
236 pccard_mfc(sc)));
237
238 STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
239 if (STAILQ_EMPTY(&pf->cfe_head))
240 continue;
241 /*
242 * In NetBSD, the drivers are responsible for activating
243 * each function of a card. I think that in FreeBSD we
244 * want to activate them enough for the usual bus_*_resource
245 * routines will do the right thing. This many mean a
246 * departure from the current NetBSD model.
247 *
248 * This seems to work well in practice for most cards.
249 * However, there are two cases that are problematic.
250 * If a driver wishes to pick and chose which config
251 * entry to use, then this method falls down. These
252 * are usually older cards. In addition, there are
253 * some cards that have multiple hardware units on the
254 * cards, but presents only one CIS chain. These cards
255 * are combination cards, but only one of these units
256 * can be on at a time.
257 */
258 ivar = malloc(sizeof(struct pccard_ivar), M_DEVBUF,
259 M_WAITOK | M_ZERO);
260 resource_list_init(&ivar->resources);
261 child = device_add_child(dev, NULL, -1);
262 device_set_ivars(child, ivar);
263 ivar->pf = pf;
264 pf->dev = child;
265 /*
266 * XXX We might want to move the next three lines into
267 * XXX the pccard interface layer. For the moment, this
268 * XXX is OK, but some drivers want to pick the config
269 * XXX entry to use as well as some address tweaks (mostly
270 * XXX due to bugs in decode logic that makes some
271 * XXX addresses illegal or broken).
272 */
273 pccard_function_init(pf);
274 if (sc->sc_enabled_count == 0)
275 POWER_ENABLE_SOCKET(device_get_parent(dev), dev);
276 if (pccard_function_enable(pf) == 0 &&
277 pccard_set_default_descr(child) == 0 &&
278 device_probe_and_attach(child) == 0) {
279 DEVPRINTF((sc->dev, "function %d CCR at %d "
280 "offset %x mask %x: "
281 "%x %x %x %x, %x %x %x %x, %x\n",
282 pf->number, pf->pf_ccr_window, pf->pf_ccr_offset,
283 pf->ccr_mask, pccard_ccr_read(pf, 0x00),
284 pccard_ccr_read(pf, 0x02), pccard_ccr_read(pf, 0x04),
285 pccard_ccr_read(pf, 0x06), pccard_ccr_read(pf, 0x0A),
286 pccard_ccr_read(pf, 0x0C), pccard_ccr_read(pf, 0x0E),
287 pccard_ccr_read(pf, 0x10), pccard_ccr_read(pf, 0x12)));
288 } else {
289 if (pf->cfe != NULL)
290 pccard_function_disable(pf);
291 }
292 }
293 return (0);
294 }
295
296 static int
297 pccard_detach_card(device_t dev)
298 {
299 struct pccard_softc *sc = PCCARD_SOFTC(dev);
300 struct pccard_function *pf;
301 struct pccard_config_entry *cfe;
302 int state;
303
304 /*
305 * We are running on either the PCCARD socket's event thread
306 * or in user context detaching a device by user request.
307 */
308 STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
309 if (pf->dev == NULL)
310 continue;
311 state = device_get_state(pf->dev);
312 if (state == DS_ATTACHED || state == DS_BUSY)
313 device_detach(pf->dev);
314 if (pf->cfe != NULL)
315 pccard_function_disable(pf);
316 pccard_function_free(pf);
317 device_delete_child(dev, pf->dev);
318 }
319 if (sc->sc_enabled_count == 0)
320 POWER_DISABLE_SOCKET(device_get_parent(dev), dev);
321
322 while (NULL != (pf = STAILQ_FIRST(&sc->card.pf_head))) {
323 while (NULL != (cfe = STAILQ_FIRST(&pf->cfe_head))) {
324 STAILQ_REMOVE_HEAD(&pf->cfe_head, cfe_list);
325 free(cfe, M_DEVBUF);
326 }
327 STAILQ_REMOVE_HEAD(&sc->card.pf_head, pf_list);
328 free(pf, M_DEVBUF);
329 }
330 STAILQ_INIT(&sc->card.pf_head);
331 return (0);
332 }
333
334 static const struct pccard_product *
335 pccard_do_product_lookup(device_t bus, device_t dev,
336 const struct pccard_product *tab, size_t ent_size,
337 pccard_product_match_fn matchfn)
338 {
339 const struct pccard_product *ent;
340 int matches;
341 uint32_t vendor;
342 uint32_t prod;
343 const char *vendorstr;
344 const char *prodstr;
345 const char *cis3str;
346 const char *cis4str;
347
348 #ifdef DIAGNOSTIC
349 if (sizeof *ent > ent_size)
350 panic("pccard_product_lookup: bogus ent_size %jd",
351 (intmax_t) ent_size);
352 #endif
353 if (pccard_get_vendor(dev, &vendor))
354 return (NULL);
355 if (pccard_get_product(dev, &prod))
356 return (NULL);
357 if (pccard_get_vendor_str(dev, &vendorstr))
358 return (NULL);
359 if (pccard_get_product_str(dev, &prodstr))
360 return (NULL);
361 if (pccard_get_cis3_str(dev, &cis3str))
362 return (NULL);
363 if (pccard_get_cis4_str(dev, &cis4str))
364 return (NULL);
365 for (ent = tab; ent->pp_vendor != 0; ent =
366 (const struct pccard_product *) ((const char *) ent + ent_size)) {
367 matches = 1;
368 if (ent->pp_vendor == PCCARD_VENDOR_ANY &&
369 ent->pp_product == PCCARD_PRODUCT_ANY &&
370 ent->pp_cis[0] == NULL &&
371 ent->pp_cis[1] == NULL) {
372 if (ent->pp_name)
373 device_printf(dev,
374 "Total wildcard entry ignored for %s\n",
375 ent->pp_name);
376 continue;
377 }
378 if (matches && ent->pp_vendor != PCCARD_VENDOR_ANY &&
379 vendor != ent->pp_vendor)
380 matches = 0;
381 if (matches && ent->pp_product != PCCARD_PRODUCT_ANY &&
382 prod != ent->pp_product)
383 matches = 0;
384 if (matches && ent->pp_cis[0] &&
385 (vendorstr == NULL ||
386 strcmp(ent->pp_cis[0], vendorstr) != 0))
387 matches = 0;
388 if (matches && ent->pp_cis[1] &&
389 (prodstr == NULL ||
390 strcmp(ent->pp_cis[1], prodstr) != 0))
391 matches = 0;
392 if (matches && ent->pp_cis[2] &&
393 (cis3str == NULL ||
394 strcmp(ent->pp_cis[2], cis3str) != 0))
395 matches = 0;
396 if (matches && ent->pp_cis[3] &&
397 (cis4str == NULL ||
398 strcmp(ent->pp_cis[3], cis4str) != 0))
399 matches = 0;
400 if (matchfn != NULL)
401 matches = (*matchfn)(dev, ent, matches);
402 if (matches)
403 return (ent);
404 }
405 return (NULL);
406 }
407
408 /*
409 * Initialize a PCCARD function. May be called as long as the function is
410 * disabled.
411 *
412 * Note: pccard_function_init should not keep resources allocated. It should
413 * only set them up ala isa pnp, set the values in the rl lists, and return.
414 * Any resource held after pccard_function_init is called is a bug. However,
415 * the bus routines to get the resources also assume that pccard_function_init
416 * does this, so they need to be fixed too.
417 */
418 static void
419 pccard_function_init(struct pccard_function *pf)
420 {
421 struct pccard_config_entry *cfe;
422 struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
423 struct resource_list *rl = &devi->resources;
424 struct resource_list_entry *rle;
425 struct resource *r = 0;
426 device_t bus;
427 u_long start, end, len;
428 int i, rid, spaces;
429
430 if (pf->pf_flags & PFF_ENABLED) {
431 printf("pccard_function_init: function is enabled");
432 return;
433 }
434 bus = device_get_parent(pf->dev);
435 /* Remember which configuration entry we are using. */
436 STAILQ_FOREACH(cfe, &pf->cfe_head, cfe_list) {
437 if (cfe->iftype != PCCARD_IFTYPE_IO)
438 continue;
439 spaces = 0;
440 for (i = 0; i < cfe->num_iospace; i++) {
441 start = cfe->iospace[i].start;
442 if (start)
443 end = start + cfe->iospace[i].length - 1;
444 else
445 end = ~0UL;
446 DEVPRINTF((bus, "I/O rid %d start %lx end %lx\n",
447 i, start, end));
448 rid = i;
449 len = cfe->iospace[i].length;
450 r = bus_alloc_resource(bus, SYS_RES_IOPORT, &rid,
451 start, end, len, rman_make_alignment_flags(len));
452 if (r == NULL)
453 goto not_this_one;
454 rle = resource_list_add(rl, SYS_RES_IOPORT,
455 rid, rman_get_start(r), rman_get_end(r),
456 cfe->iospace[i].length);
457 if (rle == NULL)
458 panic("Cannot add resource rid %d IOPORT", rid);
459 rle->res = r;
460 spaces++;
461 }
462 for (i = 0; i < cfe->num_memspace; i++) {
463 start = cfe->memspace[i].hostaddr;
464 if (start)
465 end = start + cfe->memspace[i].length - 1;
466 else
467 end = ~0UL;
468 DEVPRINTF((bus, "Memory rid %d start %lx end %lx\n",
469 i, start, end));
470 rid = i;
471 len = cfe->memspace[i].length;
472 r = bus_alloc_resource(bus, SYS_RES_MEMORY, &rid,
473 start, end, len, rman_make_alignment_flags(len));
474 if (r == NULL)
475 goto not_this_one;
476 rle = resource_list_add(rl, SYS_RES_MEMORY,
477 rid, rman_get_start(r), rman_get_end(r),
478 cfe->memspace[i].length);
479 if (rle == NULL)
480 panic("Cannot add resource rid %d MEM", rid);
481 rle->res = r;
482 spaces++;
483 }
484 if (spaces == 0) {
485 DEVPRINTF((bus, "Neither memory nor I/O mapped\n"));
486 goto not_this_one;
487 }
488 if (cfe->irqmask) {
489 rid = 0;
490 r = bus_alloc_resource_any(bus, SYS_RES_IRQ, &rid,
491 RF_SHAREABLE);
492 if (r == NULL)
493 goto not_this_one;
494 rle = resource_list_add(rl, SYS_RES_IRQ, rid,
495 rman_get_start(r), rman_get_end(r), 1);
496 if (rle == NULL)
497 panic("Cannot add resource rid %d IRQ", rid);
498 rle->res = r;
499 }
500 /* If we get to here, we've allocated all we need */
501 pf->cfe = cfe;
502 break;
503 not_this_one:;
504 DEVPRVERBOSE((bus, "Allocation failed for cfe %d\n",
505 cfe->number));
506 resource_list_purge(rl);
507 }
508 }
509
510 /*
511 * Free resources allocated by pccard_function_init(), May be called as long
512 * as the function is disabled.
513 *
514 * NOTE: This function should be unnecessary. pccard_function_init should
515 * never keep resources initialized.
516 */
517 static void
518 pccard_function_free(struct pccard_function *pf)
519 {
520 struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
521 struct resource_list_entry *rle;
522
523 if (pf->pf_flags & PFF_ENABLED) {
524 printf("pccard_function_init: function is enabled");
525 return;
526 }
527
528 STAILQ_FOREACH(rle, &devi->resources, link) {
529 if (rle->res) {
530 if (rman_get_device(rle->res) != pf->sc->dev)
531 device_printf(pf->sc->dev,
532 "function_free: Resource still owned by "
533 "child, oops. "
534 "(type=%d, rid=%d, addr=%lx)\n",
535 rle->type, rle->rid,
536 rman_get_start(rle->res));
537 BUS_RELEASE_RESOURCE(device_get_parent(pf->sc->dev),
538 pf->sc->dev, rle->type, rle->rid, rle->res);
539 rle->res = NULL;
540 }
541 }
542 resource_list_free(&devi->resources);
543 }
544
545 static void
546 pccard_mfc_adjust_iobase(struct pccard_function *pf, bus_addr_t addr,
547 bus_addr_t offset, bus_size_t size)
548 {
549 bus_size_t iosize, tmp;
550
551 if (addr != 0) {
552 if (pf->pf_mfc_iomax == 0) {
553 pf->pf_mfc_iobase = addr + offset;
554 pf->pf_mfc_iomax = pf->pf_mfc_iobase + size;
555 } else {
556 /* this makes the assumption that nothing overlaps */
557 if (pf->pf_mfc_iobase > addr + offset)
558 pf->pf_mfc_iobase = addr + offset;
559 if (pf->pf_mfc_iomax < addr + offset + size)
560 pf->pf_mfc_iomax = addr + offset + size;
561 }
562 }
563
564 tmp = pf->pf_mfc_iomax - pf->pf_mfc_iobase;
565 /* round up to nearest (2^n)-1 */
566 for (iosize = 1; iosize < tmp; iosize <<= 1)
567 ;
568 iosize--;
569
570 DEVPRINTF((pf->dev, "MFC: I/O base %#jx IOSIZE %#jx\n",
571 (uintmax_t)pf->pf_mfc_iobase, (uintmax_t)(iosize + 1)));
572 pccard_ccr_write(pf, PCCARD_CCR_IOBASE0,
573 pf->pf_mfc_iobase & 0xff);
574 pccard_ccr_write(pf, PCCARD_CCR_IOBASE1,
575 (pf->pf_mfc_iobase >> 8) & 0xff);
576 pccard_ccr_write(pf, PCCARD_CCR_IOBASE2, 0);
577 pccard_ccr_write(pf, PCCARD_CCR_IOBASE3, 0);
578 pccard_ccr_write(pf, PCCARD_CCR_IOSIZE, iosize);
579 }
580
581 /* Enable a PCCARD function */
582 static int
583 pccard_function_enable(struct pccard_function *pf)
584 {
585 struct pccard_function *tmp;
586 int reg;
587 device_t dev = pf->sc->dev;
588
589 if (pf->cfe == NULL) {
590 DEVPRVERBOSE((dev, "No config entry could be allocated.\n"));
591 return (ENOMEM);
592 }
593
594 /*
595 * Increase the reference count on the socket, enabling power, if
596 * necessary.
597 */
598 pf->sc->sc_enabled_count++;
599
600 if (pf->pf_flags & PFF_ENABLED) {
601 /*
602 * Don't do anything if we're already enabled.
603 */
604 return (0);
605 }
606
607 /*
608 * it's possible for different functions' CCRs to be in the same
609 * underlying page. Check for that.
610 */
611 STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
612 if ((tmp->pf_flags & PFF_ENABLED) &&
613 (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
614 ((pf->ccr_base + PCCARD_CCR_SIZE) <=
615 (tmp->ccr_base - tmp->pf_ccr_offset +
616 tmp->pf_ccr_realsize))) {
617 pf->pf_ccrt = tmp->pf_ccrt;
618 pf->pf_ccrh = tmp->pf_ccrh;
619 pf->pf_ccr_realsize = tmp->pf_ccr_realsize;
620
621 /*
622 * pf->pf_ccr_offset = (tmp->pf_ccr_offset -
623 * tmp->ccr_base) + pf->ccr_base;
624 */
625 /* pf->pf_ccr_offset =
626 (tmp->pf_ccr_offset + pf->ccr_base) -
627 tmp->ccr_base; */
628 pf->pf_ccr_window = tmp->pf_ccr_window;
629 break;
630 }
631 }
632 if (tmp == NULL) {
633 pf->ccr_rid = 0;
634 pf->ccr_res = bus_alloc_resource(dev, SYS_RES_MEMORY,
635 &pf->ccr_rid, 0, ~0, PCCARD_MEM_PAGE_SIZE, RF_ACTIVE);
636 if (!pf->ccr_res)
637 goto bad;
638 DEVPRINTF((dev, "ccr_res == %lx-%lx, base=%x\n",
639 rman_get_start(pf->ccr_res), rman_get_end(pf->ccr_res),
640 pf->ccr_base));
641 CARD_SET_RES_FLAGS(device_get_parent(dev), dev, SYS_RES_MEMORY,
642 pf->ccr_rid, PCCARD_A_MEM_ATTR);
643 CARD_SET_MEMORY_OFFSET(device_get_parent(dev), dev,
644 pf->ccr_rid, pf->ccr_base, &pf->pf_ccr_offset);
645 pf->pf_ccrt = rman_get_bustag(pf->ccr_res);
646 pf->pf_ccrh = rman_get_bushandle(pf->ccr_res);
647 pf->pf_ccr_realsize = 1;
648 }
649
650 reg = (pf->cfe->number & PCCARD_CCR_OPTION_CFINDEX);
651 reg |= PCCARD_CCR_OPTION_LEVIREQ;
652 if (pccard_mfc(pf->sc)) {
653 reg |= (PCCARD_CCR_OPTION_FUNC_ENABLE |
654 PCCARD_CCR_OPTION_ADDR_DECODE);
655 /* PCCARD_CCR_OPTION_IRQ_ENABLE set elsewhere as needed */
656 }
657 pccard_ccr_write(pf, PCCARD_CCR_OPTION, reg);
658
659 reg = 0;
660 if ((pf->cfe->flags & PCCARD_CFE_IO16) == 0)
661 reg |= PCCARD_CCR_STATUS_IOIS8;
662 if (pf->cfe->flags & PCCARD_CFE_AUDIO)
663 reg |= PCCARD_CCR_STATUS_AUDIO;
664 pccard_ccr_write(pf, PCCARD_CCR_STATUS, reg);
665
666 pccard_ccr_write(pf, PCCARD_CCR_SOCKETCOPY, 0);
667
668 if (pccard_mfc(pf->sc))
669 pccard_mfc_adjust_iobase(pf, 0, 0, 0);
670
671 #ifdef PCCARDDEBUG
672 if (pccard_debug) {
673 STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
674 device_printf(tmp->sc->dev,
675 "function %d CCR at %d offset %x: "
676 "%x %x %x %x, %x %x %x %x, %x\n",
677 tmp->number, tmp->pf_ccr_window,
678 tmp->pf_ccr_offset,
679 pccard_ccr_read(tmp, 0x00),
680 pccard_ccr_read(tmp, 0x02),
681 pccard_ccr_read(tmp, 0x04),
682 pccard_ccr_read(tmp, 0x06),
683 pccard_ccr_read(tmp, 0x0A),
684 pccard_ccr_read(tmp, 0x0C),
685 pccard_ccr_read(tmp, 0x0E),
686 pccard_ccr_read(tmp, 0x10),
687 pccard_ccr_read(tmp, 0x12));
688 }
689 }
690 #endif
691 pf->pf_flags |= PFF_ENABLED;
692 return (0);
693
694 bad:
695 /*
696 * Decrement the reference count, and power down the socket, if
697 * necessary.
698 */
699 pf->sc->sc_enabled_count--;
700 DEVPRINTF((dev, "bad --enabled_count = %d\n", pf->sc->sc_enabled_count));
701
702 return (1);
703 }
704
705 /* Disable PCCARD function. */
706 static void
707 pccard_function_disable(struct pccard_function *pf)
708 {
709 struct pccard_function *tmp;
710 device_t dev = pf->sc->dev;
711
712 if (pf->cfe == NULL)
713 panic("pccard_function_disable: function not initialized");
714
715 if ((pf->pf_flags & PFF_ENABLED) == 0) {
716 /*
717 * Don't do anything if we're already disabled.
718 */
719 return;
720 }
721
722 if (pf->intr_handler != NULL) {
723 struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
724 struct resource_list_entry *rle =
725 resource_list_find(&devi->resources, SYS_RES_IRQ, 0);
726 if (rle == NULL)
727 panic("Can't disable an interrupt with no IRQ res\n");
728 BUS_TEARDOWN_INTR(dev, pf->dev, rle->res,
729 pf->intr_handler_cookie);
730 }
731
732 /*
733 * it's possible for different functions' CCRs to be in the same
734 * underlying page. Check for that. Note we mark us as disabled
735 * first to avoid matching ourself.
736 */
737
738 pf->pf_flags &= ~PFF_ENABLED;
739 STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
740 if ((tmp->pf_flags & PFF_ENABLED) &&
741 (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
742 ((pf->ccr_base + PCCARD_CCR_SIZE) <=
743 (tmp->ccr_base - tmp->pf_ccr_offset +
744 tmp->pf_ccr_realsize)))
745 break;
746 }
747
748 /* Not used by anyone else; unmap the CCR. */
749 if (tmp == NULL) {
750 bus_release_resource(dev, SYS_RES_MEMORY, pf->ccr_rid,
751 pf->ccr_res);
752 pf->ccr_res = NULL;
753 }
754
755 /*
756 * Decrement the reference count, and power down the socket, if
757 * necessary.
758 */
759 pf->sc->sc_enabled_count--;
760 }
761
762 /*
763 * simulate the old "probe" routine. In the new world order, the driver
764 * needs to grab devices while in the old they were assigned to the device by
765 * the pccardd process. These symbols are exported to the upper layers.
766 */
767 static int
768 pccard_compat_do_probe(device_t bus, device_t dev)
769 {
770 return (CARD_COMPAT_MATCH(dev));
771 }
772
773 static int
774 pccard_compat_do_attach(device_t bus, device_t dev)
775 {
776 int err;
777
778 err = CARD_COMPAT_PROBE(dev);
779 if (err <= 0)
780 err = CARD_COMPAT_ATTACH(dev);
781 return (err);
782 }
783
784 #define PCCARD_NPORT 2
785 #define PCCARD_NMEM 5
786 #define PCCARD_NIRQ 1
787 #define PCCARD_NDRQ 0
788
789 static int
790 pccard_probe(device_t dev)
791 {
792 device_set_desc(dev, "16-bit PCCard bus");
793 return (0);
794 }
795
796 static int
797 pccard_attach(device_t dev)
798 {
799 struct pccard_softc *sc = PCCARD_SOFTC(dev);
800 int err;
801
802 sc->dev = dev;
803 sc->sc_enabled_count = 0;
804 if ((err = pccard_device_create(sc)) != 0)
805 return (err);
806 STAILQ_INIT(&sc->card.pf_head);
807 return (bus_generic_attach(dev));
808 }
809
810 static int
811 pccard_detach(device_t dev)
812 {
813 pccard_detach_card(dev);
814 pccard_device_destroy(device_get_softc(dev));
815 return (0);
816 }
817
818 static int
819 pccard_suspend(device_t self)
820 {
821 pccard_detach_card(self);
822 return (0);
823 }
824
825 static
826 int
827 pccard_resume(device_t self)
828 {
829 return (0);
830 }
831
832 static void
833 pccard_print_resources(struct resource_list *rl, const char *name, int type,
834 int count, const char *format)
835 {
836 struct resource_list_entry *rle;
837 int printed;
838 int i;
839
840 printed = 0;
841 for (i = 0; i < count; i++) {
842 rle = resource_list_find(rl, type, i);
843 if (rle != NULL) {
844 if (printed == 0)
845 printf(" %s ", name);
846 else if (printed > 0)
847 printf(",");
848 printed++;
849 printf(format, rle->start);
850 if (rle->count > 1) {
851 printf("-");
852 printf(format, rle->start + rle->count - 1);
853 }
854 } else if (i > 3) {
855 /* check the first few regardless */
856 break;
857 }
858 }
859 }
860
861 static int
862 pccard_print_child(device_t dev, device_t child)
863 {
864 struct pccard_ivar *devi = PCCARD_IVAR(child);
865 struct resource_list *rl = &devi->resources;
866 int retval = 0;
867
868 retval += bus_print_child_header(dev, child);
869 retval += printf(" at");
870
871 if (devi != NULL) {
872 pccard_print_resources(rl, "port", SYS_RES_IOPORT,
873 PCCARD_NPORT, "%#lx");
874 pccard_print_resources(rl, "iomem", SYS_RES_MEMORY,
875 PCCARD_NMEM, "%#lx");
876 pccard_print_resources(rl, "irq", SYS_RES_IRQ, PCCARD_NIRQ,
877 "%ld");
878 pccard_print_resources(rl, "drq", SYS_RES_DRQ, PCCARD_NDRQ,
879 "%ld");
880 retval += printf(" function %d config %d", devi->pf->number,
881 devi->pf->cfe->number);
882 }
883
884 retval += bus_print_child_footer(dev, child);
885
886 return (retval);
887 }
888
889 static int
890 pccard_set_resource(device_t dev, device_t child, int type, int rid,
891 u_long start, u_long count)
892 {
893 struct pccard_ivar *devi = PCCARD_IVAR(child);
894 struct resource_list *rl = &devi->resources;
895
896 if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY
897 && type != SYS_RES_IRQ && type != SYS_RES_DRQ)
898 return (EINVAL);
899 if (rid < 0)
900 return (EINVAL);
901 if (type == SYS_RES_IOPORT && rid >= PCCARD_NPORT)
902 return (EINVAL);
903 if (type == SYS_RES_MEMORY && rid >= PCCARD_NMEM)
904 return (EINVAL);
905 if (type == SYS_RES_IRQ && rid >= PCCARD_NIRQ)
906 return (EINVAL);
907 if (type == SYS_RES_DRQ && rid >= PCCARD_NDRQ)
908 return (EINVAL);
909
910 resource_list_add(rl, type, rid, start, start + count - 1, count);
911 if (NULL != resource_list_alloc(rl, device_get_parent(dev), dev,
912 type, &rid, start, start + count - 1, count, 0))
913 return 0;
914 else
915 return ENOMEM;
916 }
917
918 static int
919 pccard_get_resource(device_t dev, device_t child, int type, int rid,
920 u_long *startp, u_long *countp)
921 {
922 struct pccard_ivar *devi = PCCARD_IVAR(child);
923 struct resource_list *rl = &devi->resources;
924 struct resource_list_entry *rle;
925
926 rle = resource_list_find(rl, type, rid);
927 if (rle == NULL)
928 return (ENOENT);
929
930 if (startp != NULL)
931 *startp = rle->start;
932 if (countp != NULL)
933 *countp = rle->count;
934
935 return (0);
936 }
937
938 static void
939 pccard_delete_resource(device_t dev, device_t child, int type, int rid)
940 {
941 struct pccard_ivar *devi = PCCARD_IVAR(child);
942 struct resource_list *rl = &devi->resources;
943 resource_list_delete(rl, type, rid);
944 }
945
946 static int
947 pccard_set_res_flags(device_t dev, device_t child, int type, int rid,
948 uint32_t flags)
949 {
950 return (CARD_SET_RES_FLAGS(device_get_parent(dev), child, type,
951 rid, flags));
952 }
953
954 static int
955 pccard_set_memory_offset(device_t dev, device_t child, int rid,
956 uint32_t offset, uint32_t *deltap)
957
958 {
959 return (CARD_SET_MEMORY_OFFSET(device_get_parent(dev), child, rid,
960 offset, deltap));
961 }
962
963 static void
964 pccard_probe_nomatch(device_t bus, device_t child)
965 {
966 struct pccard_ivar *devi = PCCARD_IVAR(child);
967 struct pccard_function *pf = devi->pf;
968 struct pccard_softc *sc = PCCARD_SOFTC(bus);
969 int i;
970
971 device_printf(bus, "<unknown card>");
972 printf(" (manufacturer=0x%04x, product=0x%04x, function_type=%d) "
973 "at function %d\n", sc->card.manufacturer, sc->card.product,
974 pf->function, pf->number);
975 device_printf(bus, " CIS info: ");
976 for (i = 0; sc->card.cis1_info[i] != NULL && i < 4; i++)
977 printf("%s%s", i > 0 ? ", " : "", sc->card.cis1_info[i]);
978 printf("\n");
979 return;
980 }
981
982 static int
983 pccard_child_location_str(device_t bus, device_t child, char *buf,
984 size_t buflen)
985 {
986 struct pccard_ivar *devi = PCCARD_IVAR(child);
987 struct pccard_function *pf = devi->pf;
988
989 snprintf(buf, buflen, "function=%d", pf->number);
990 return (0);
991 }
992
993 /* XXX Maybe this should be in subr_bus? */
994 static void
995 pccard_safe_quote(char *dst, const char *src, size_t len)
996 {
997 char *walker = dst, *ep = dst + len - 1;
998
999 if (len == 0)
1000 return;
1001 while (walker < ep)
1002 {
1003 if (*src == '"') {
1004 if (ep - walker < 2)
1005 break;
1006 *walker++ = '\\';
1007 }
1008 *walker++ = *src++;
1009 }
1010 *walker = '\0';
1011 }
1012
1013 static int
1014 pccard_child_pnpinfo_str(device_t bus, device_t child, char *buf,
1015 size_t buflen)
1016 {
1017 struct pccard_ivar *devi = PCCARD_IVAR(child);
1018 struct pccard_function *pf = devi->pf;
1019 struct pccard_softc *sc = PCCARD_SOFTC(bus);
1020 char cis0[128], cis1[128];
1021
1022 pccard_safe_quote(cis0, sc->card.cis1_info[0], sizeof(cis0));
1023 pccard_safe_quote(cis1, sc->card.cis1_info[1], sizeof(cis1));
1024 snprintf(buf, buflen, "manufacturer=0x%04x product=0x%04x "
1025 "cisvendor=\"%s\" cisproduct=\"%s\" function_type=%d",
1026 sc->card.manufacturer, sc->card.product, cis0, cis1, pf->function);
1027 return (0);
1028 }
1029
1030 static int
1031 pccard_read_ivar(device_t bus, device_t child, int which, u_char *result)
1032 {
1033 struct pccard_ivar *devi = PCCARD_IVAR(child);
1034 struct pccard_function *pf = devi->pf;
1035 struct pccard_softc *sc = PCCARD_SOFTC(bus);
1036
1037 if (!pf)
1038 panic("No pccard function pointer");
1039 switch (which) {
1040 default:
1041 return (EINVAL);
1042 case PCCARD_IVAR_ETHADDR:
1043 bcopy(pf->pf_funce_lan_nid, result, ETHER_ADDR_LEN);
1044 break;
1045 case PCCARD_IVAR_VENDOR:
1046 *(uint32_t *)result = sc->card.manufacturer;
1047 break;
1048 case PCCARD_IVAR_PRODUCT:
1049 *(uint32_t *)result = sc->card.product;
1050 break;
1051 case PCCARD_IVAR_PRODEXT:
1052 *(uint16_t *)result = sc->card.prodext;
1053 break;
1054 case PCCARD_IVAR_FUNCTION:
1055 *(uint32_t *)result = pf->function;
1056 break;
1057 case PCCARD_IVAR_FUNCTION_NUMBER:
1058 *(uint32_t *)result = pf->number;
1059 break;
1060 case PCCARD_IVAR_VENDOR_STR:
1061 *(const char **)result = sc->card.cis1_info[0];
1062 break;
1063 case PCCARD_IVAR_PRODUCT_STR:
1064 *(const char **)result = sc->card.cis1_info[1];
1065 break;
1066 case PCCARD_IVAR_CIS3_STR:
1067 *(const char **)result = sc->card.cis1_info[2];
1068 break;
1069 case PCCARD_IVAR_CIS4_STR:
1070 *(const char **)result = sc->card.cis1_info[3];
1071 break;
1072 }
1073 return (0);
1074 }
1075
1076 static void
1077 pccard_driver_added(device_t dev, driver_t *driver)
1078 {
1079 struct pccard_softc *sc = PCCARD_SOFTC(dev);
1080 struct pccard_function *pf;
1081 device_t child;
1082
1083 STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
1084 if (STAILQ_EMPTY(&pf->cfe_head))
1085 continue;
1086 child = pf->dev;
1087 if (device_get_state(child) != DS_NOTPRESENT)
1088 continue;
1089 if (pccard_function_enable(pf) == 0 &&
1090 device_probe_and_attach(child) == 0) {
1091 DEVPRINTF((sc->dev, "function %d CCR at %d "
1092 "offset %x: %x %x %x %x, %x %x %x %x, %x\n",
1093 pf->number, pf->pf_ccr_window, pf->pf_ccr_offset,
1094 pccard_ccr_read(pf, 0x00),
1095 pccard_ccr_read(pf, 0x02), pccard_ccr_read(pf, 0x04),
1096 pccard_ccr_read(pf, 0x06), pccard_ccr_read(pf, 0x0A),
1097 pccard_ccr_read(pf, 0x0C), pccard_ccr_read(pf, 0x0E),
1098 pccard_ccr_read(pf, 0x10), pccard_ccr_read(pf, 0x12)));
1099 } else {
1100 if (pf->cfe != NULL)
1101 pccard_function_disable(pf);
1102 }
1103 }
1104 return;
1105 }
1106
1107 static struct resource *
1108 pccard_alloc_resource(device_t dev, device_t child, int type, int *rid,
1109 u_long start, u_long end, u_long count, u_int flags)
1110 {
1111 struct pccard_ivar *dinfo;
1112 struct resource_list_entry *rle = 0;
1113 int passthrough = (device_get_parent(child) != dev);
1114 int isdefault = (start == 0 && end == ~0UL && count == 1);
1115 struct resource *r = NULL;
1116
1117 /* XXX I'm no longer sure this is right */
1118 if (passthrough) {
1119 return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child,
1120 type, rid, start, end, count, flags));
1121 }
1122
1123 dinfo = device_get_ivars(child);
1124 rle = resource_list_find(&dinfo->resources, type, *rid);
1125
1126 if (rle == NULL && isdefault)
1127 return (NULL); /* no resource of that type/rid */
1128 if (rle == NULL || rle->res == NULL) {
1129 /* XXX Need to adjust flags */
1130 r = bus_alloc_resource(dev, type, rid, start, end,
1131 count, flags);
1132 if (r == NULL)
1133 goto bad;
1134 resource_list_add(&dinfo->resources, type, *rid,
1135 rman_get_start(r), rman_get_end(r), count);
1136 rle = resource_list_find(&dinfo->resources, type, *rid);
1137 if (!rle)
1138 goto bad;
1139 rle->res = r;
1140 }
1141 /*
1142 * If dev doesn't own the device, then we can't give this device
1143 * out.
1144 */
1145 if (rman_get_device(rle->res) != dev)
1146 return (NULL);
1147 rman_set_device(rle->res, child);
1148 if (flags & RF_ACTIVE)
1149 BUS_ACTIVATE_RESOURCE(dev, child, type, *rid, rle->res);
1150 return (rle->res);
1151 bad:;
1152 device_printf(dev, "WARNING: Resource not reserved by pccard\n");
1153 return (NULL);
1154 }
1155
1156 static int
1157 pccard_release_resource(device_t dev, device_t child, int type, int rid,
1158 struct resource *r)
1159 {
1160 struct pccard_ivar *dinfo;
1161 int passthrough = (device_get_parent(child) != dev);
1162 struct resource_list_entry *rle = 0;
1163
1164 if (passthrough)
1165 return BUS_RELEASE_RESOURCE(device_get_parent(dev), child,
1166 type, rid, r);
1167
1168 dinfo = device_get_ivars(child);
1169
1170 rle = resource_list_find(&dinfo->resources, type, rid);
1171
1172 if (!rle) {
1173 device_printf(dev, "Allocated resource not found, "
1174 "%d %x %lx %lx\n",
1175 type, rid, rman_get_start(r), rman_get_size(r));
1176 return ENOENT;
1177 }
1178 if (!rle->res) {
1179 device_printf(dev, "Allocated resource not recorded\n");
1180 return ENOENT;
1181 }
1182 /*
1183 * Deactivate the resource (since it is being released), and
1184 * assign it to the bus.
1185 */
1186 BUS_DEACTIVATE_RESOURCE(dev, child, type, rid, rle->res);
1187 rman_set_device(rle->res, dev);
1188 return (0);
1189 }
1190
1191 static void
1192 pccard_child_detached(device_t parent, device_t dev)
1193 {
1194 struct pccard_ivar *ivar = PCCARD_IVAR(dev);
1195 struct pccard_function *pf = ivar->pf;
1196
1197 pccard_function_disable(pf);
1198 }
1199
1200 static void
1201 pccard_intr(void *arg)
1202 {
1203 struct pccard_function *pf = (struct pccard_function*) arg;
1204 int reg;
1205 int doisr = 1;
1206
1207 /*
1208 * MFC cards know if they interrupted, so we have to ack the
1209 * interrupt and call the ISR. Non-MFC cards don't have these
1210 * bits, so they always get called. Many non-MFC cards have
1211 * this bit set always upon read, but some do not.
1212 *
1213 * We always ack the interrupt, even if there's no ISR
1214 * for the card. This is done on the theory that acking
1215 * the interrupt will pacify the card enough to keep an
1216 * interrupt storm from happening. Of course this won't
1217 * help in the non-MFC case.
1218 *
1219 * This has no impact for MPSAFEness of the client drivers.
1220 * We register this with whatever flags the intr_handler
1221 * was registered with. All these functions are MPSAFE.
1222 */
1223 if (pccard_mfc(pf->sc)) {
1224 reg = pccard_ccr_read(pf, PCCARD_CCR_STATUS);
1225 if (reg & PCCARD_CCR_STATUS_INTR)
1226 pccard_ccr_write(pf, PCCARD_CCR_STATUS,
1227 reg & ~PCCARD_CCR_STATUS_INTR);
1228 else
1229 doisr = 0;
1230 }
1231 if (pf->intr_handler != NULL && doisr)
1232 pf->intr_handler(pf->intr_handler_arg);
1233 }
1234
1235 static int
1236 pccard_setup_intr(device_t dev, device_t child, struct resource *irq,
1237 int flags, driver_intr_t *intr, void *arg, void **cookiep)
1238 {
1239 struct pccard_softc *sc = PCCARD_SOFTC(dev);
1240 struct pccard_ivar *ivar = PCCARD_IVAR(child);
1241 struct pccard_function *pf = ivar->pf;
1242 int err;
1243
1244 if (pf->intr_handler != NULL)
1245 panic("Only one interrupt handler per function allowed");
1246 err = bus_generic_setup_intr(dev, child, irq, flags, pccard_intr,
1247 pf, cookiep);
1248 if (err != 0)
1249 return (err);
1250 pf->intr_handler = intr;
1251 pf->intr_handler_arg = arg;
1252 pf->intr_handler_cookie = *cookiep;
1253 if (pccard_mfc(sc)) {
1254 pccard_ccr_write(pf, PCCARD_CCR_OPTION,
1255 pccard_ccr_read(pf, PCCARD_CCR_OPTION) |
1256 PCCARD_CCR_OPTION_IREQ_ENABLE);
1257 }
1258 return (0);
1259 }
1260
1261 static int
1262 pccard_teardown_intr(device_t dev, device_t child, struct resource *r,
1263 void *cookie)
1264 {
1265 struct pccard_softc *sc = PCCARD_SOFTC(dev);
1266 struct pccard_ivar *ivar = PCCARD_IVAR(child);
1267 struct pccard_function *pf = ivar->pf;
1268 int ret;
1269
1270 if (pccard_mfc(sc)) {
1271 pccard_ccr_write(pf, PCCARD_CCR_OPTION,
1272 pccard_ccr_read(pf, PCCARD_CCR_OPTION) &
1273 ~PCCARD_CCR_OPTION_IREQ_ENABLE);
1274 }
1275 ret = bus_generic_teardown_intr(dev, child, r, cookie);
1276 if (ret == 0) {
1277 pf->intr_handler = NULL;
1278 pf->intr_handler_arg = NULL;
1279 pf->intr_handler_cookie = NULL;
1280 }
1281
1282 return (ret);
1283 }
1284
1285 static int
1286 pccard_activate_resource(device_t brdev, device_t child, int type, int rid,
1287 struct resource *r)
1288 {
1289 struct pccard_ivar *ivar = PCCARD_IVAR(child);
1290 struct pccard_function *pf = ivar->pf;
1291
1292 switch(type) {
1293 case SYS_RES_IOPORT:
1294 /*
1295 * We need to adjust IOBASE[01] and IOSIZE if we're an MFC
1296 * card.
1297 */
1298 if (pccard_mfc(pf->sc))
1299 pccard_mfc_adjust_iobase(pf, rman_get_start(r), 0,
1300 rman_get_size(r));
1301 break;
1302 default:
1303 break;
1304 }
1305 return (bus_generic_activate_resource(brdev, child, type, rid, r));
1306 }
1307
1308 static int
1309 pccard_deactivate_resource(device_t brdev, device_t child, int type,
1310 int rid, struct resource *r)
1311 {
1312 /* XXX undo pccard_activate_resource? XXX */
1313 return (bus_generic_deactivate_resource(brdev, child, type, rid, r));
1314 }
1315
1316 static int
1317 pccard_attr_read_impl(device_t brdev, device_t child, uint32_t offset,
1318 uint8_t *val)
1319 {
1320 struct pccard_ivar *devi = PCCARD_IVAR(child);
1321 struct pccard_function *pf = devi->pf;
1322
1323 /*
1324 * Optimization. Most of the time, devices want to access
1325 * the same page of the attribute memory that the CCR is in.
1326 * We take advantage of this fact here.
1327 */
1328 if (offset / PCCARD_MEM_PAGE_SIZE ==
1329 pf->ccr_base / PCCARD_MEM_PAGE_SIZE)
1330 *val = bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh,
1331 offset % PCCARD_MEM_PAGE_SIZE);
1332 else {
1333 CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, offset,
1334 &offset);
1335 *val = bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh, offset);
1336 CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, pf->ccr_base,
1337 &offset);
1338 }
1339 return 0;
1340 }
1341
1342 static int
1343 pccard_attr_write_impl(device_t brdev, device_t child, uint32_t offset,
1344 uint8_t val)
1345 {
1346 struct pccard_ivar *devi = PCCARD_IVAR(child);
1347 struct pccard_function *pf = devi->pf;
1348
1349 /*
1350 * Optimization. Most of the time, devices want to access
1351 * the same page of the attribute memory that the CCR is in.
1352 * We take advantage of this fact here.
1353 */
1354 if (offset / PCCARD_MEM_PAGE_SIZE ==
1355 pf->ccr_base / PCCARD_MEM_PAGE_SIZE)
1356 bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh,
1357 offset % PCCARD_MEM_PAGE_SIZE, val);
1358 else {
1359 CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, offset,
1360 &offset);
1361 bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh, offset, val);
1362 CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, pf->ccr_base,
1363 &offset);
1364 }
1365
1366 return 0;
1367 }
1368
1369 static int
1370 pccard_ccr_read_impl(device_t brdev, device_t child, uint32_t offset,
1371 uint8_t *val)
1372 {
1373 struct pccard_ivar *devi = PCCARD_IVAR(child);
1374
1375 *val = pccard_ccr_read(devi->pf, offset);
1376 device_printf(child, "ccr_read of %#x (%#x) is %#x\n", offset,
1377 devi->pf->pf_ccr_offset, *val);
1378 return 0;
1379 }
1380
1381 static int
1382 pccard_ccr_write_impl(device_t brdev, device_t child, uint32_t offset,
1383 uint8_t val)
1384 {
1385 struct pccard_ivar *devi = PCCARD_IVAR(child);
1386 struct pccard_function *pf = devi->pf;
1387
1388 /*
1389 * Can't use pccard_ccr_write since client drivers may access
1390 * registers not contained in the 'mask' if they are non-standard.
1391 */
1392 device_printf(child, "ccr_write of %#x to %#x (%#x)\n", val, offset,
1393 devi->pf->pf_ccr_offset);
1394 bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh, pf->pf_ccr_offset + offset,
1395 val);
1396 return 0;
1397 }
1398
1399
1400 static device_method_t pccard_methods[] = {
1401 /* Device interface */
1402 DEVMETHOD(device_probe, pccard_probe),
1403 DEVMETHOD(device_attach, pccard_attach),
1404 DEVMETHOD(device_detach, pccard_detach),
1405 DEVMETHOD(device_shutdown, bus_generic_shutdown),
1406 DEVMETHOD(device_suspend, pccard_suspend),
1407 DEVMETHOD(device_resume, pccard_resume),
1408
1409 /* Bus interface */
1410 DEVMETHOD(bus_print_child, pccard_print_child),
1411 DEVMETHOD(bus_driver_added, pccard_driver_added),
1412 DEVMETHOD(bus_child_detached, pccard_child_detached),
1413 DEVMETHOD(bus_alloc_resource, pccard_alloc_resource),
1414 DEVMETHOD(bus_release_resource, pccard_release_resource),
1415 DEVMETHOD(bus_activate_resource, pccard_activate_resource),
1416 DEVMETHOD(bus_deactivate_resource, pccard_deactivate_resource),
1417 DEVMETHOD(bus_setup_intr, pccard_setup_intr),
1418 DEVMETHOD(bus_teardown_intr, pccard_teardown_intr),
1419 DEVMETHOD(bus_set_resource, pccard_set_resource),
1420 DEVMETHOD(bus_get_resource, pccard_get_resource),
1421 DEVMETHOD(bus_delete_resource, pccard_delete_resource),
1422 DEVMETHOD(bus_probe_nomatch, pccard_probe_nomatch),
1423 DEVMETHOD(bus_read_ivar, pccard_read_ivar),
1424 DEVMETHOD(bus_child_pnpinfo_str, pccard_child_pnpinfo_str),
1425 DEVMETHOD(bus_child_location_str, pccard_child_location_str),
1426
1427 /* Card Interface */
1428 DEVMETHOD(card_set_res_flags, pccard_set_res_flags),
1429 DEVMETHOD(card_set_memory_offset, pccard_set_memory_offset),
1430 DEVMETHOD(card_attach_card, pccard_attach_card),
1431 DEVMETHOD(card_detach_card, pccard_detach_card),
1432 DEVMETHOD(card_do_product_lookup, pccard_do_product_lookup),
1433 DEVMETHOD(card_compat_do_probe, pccard_compat_do_probe),
1434 DEVMETHOD(card_compat_do_attach, pccard_compat_do_attach),
1435 DEVMETHOD(card_cis_scan, pccard_scan_cis),
1436 DEVMETHOD(card_attr_read, pccard_attr_read_impl),
1437 DEVMETHOD(card_attr_write, pccard_attr_write_impl),
1438 DEVMETHOD(card_ccr_read, pccard_ccr_read_impl),
1439 DEVMETHOD(card_ccr_write, pccard_ccr_write_impl),
1440
1441 { 0, 0 }
1442 };
1443
1444 static driver_t pccard_driver = {
1445 "pccard",
1446 pccard_methods,
1447 sizeof(struct pccard_softc)
1448 };
1449
1450 devclass_t pccard_devclass;
1451
1452 /* Maybe we need to have a slot device? */
1453 DRIVER_MODULE(pccard, pcic, pccard_driver, pccard_devclass, 0, 0);
1454 DRIVER_MODULE(pccard, cbb, pccard_driver, pccard_devclass, 0, 0);
1455 MODULE_VERSION(pccard, 1);
Cache object: 186eb781131925b0637561d7c66147b4
|