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