cardslot.c revision 1.29 1 1.29 thorpej /* $NetBSD: cardslot.c,v 1.29 2006/03/29 04:16:48 thorpej Exp $ */
2 1.5 haya
3 1.1 haya /*
4 1.7 haya * Copyright (c) 1999 and 2000
5 1.1 haya * HAYAKAWA Koichi. All rights reserved.
6 1.1 haya *
7 1.1 haya * Redistribution and use in source and binary forms, with or without
8 1.1 haya * modification, are permitted provided that the following conditions
9 1.1 haya * are met:
10 1.1 haya * 1. Redistributions of source code must retain the above copyright
11 1.1 haya * notice, this list of conditions and the following disclaimer.
12 1.1 haya * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 haya * notice, this list of conditions and the following disclaimer in the
14 1.1 haya * documentation and/or other materials provided with the distribution.
15 1.1 haya * 3. All advertising materials mentioning features or use of this software
16 1.1 haya * must display the following acknowledgement:
17 1.1 haya * This product includes software developed by HAYAKAWA Koichi.
18 1.1 haya * 4. The name of the author may not be used to endorse or promote products
19 1.1 haya * derived from this software without specific prior written permission.
20 1.1 haya *
21 1.1 haya *
22 1.1 haya * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23 1.1 haya * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
24 1.1 haya * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
25 1.1 haya * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
26 1.1 haya * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
27 1.1 haya * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
28 1.1 haya * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 1.1 haya * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
30 1.1 haya * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31 1.1 haya * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32 1.1 haya * POSSIBILITY OF SUCH DAMAGE.
33 1.1 haya */
34 1.15 lukem
35 1.15 lukem #include <sys/cdefs.h>
36 1.29 thorpej __KERNEL_RCSID(0, "$NetBSD: cardslot.c,v 1.29 2006/03/29 04:16:48 thorpej Exp $");
37 1.1 haya
38 1.3 haya #include "opt_cardslot.h"
39 1.1 haya
40 1.1 haya #include <sys/param.h>
41 1.1 haya #include <sys/systm.h>
42 1.1 haya #include <sys/device.h>
43 1.1 haya #include <sys/malloc.h>
44 1.1 haya #include <sys/kernel.h>
45 1.1 haya #include <sys/syslog.h>
46 1.1 haya #include <sys/kthread.h>
47 1.1 haya
48 1.1 haya #include <machine/bus.h>
49 1.1 haya
50 1.1 haya #include <dev/cardbus/cardslotvar.h>
51 1.1 haya #include <dev/cardbus/cardbusvar.h>
52 1.1 haya #include <dev/pcmcia/pcmciavar.h>
53 1.1 haya #include <dev/pcmcia/pcmciachip.h>
54 1.1 haya #include <dev/ic/i82365var.h>
55 1.1 haya
56 1.25 drochner #include "locators.h"
57 1.1 haya
58 1.1 haya #if defined CARDSLOT_DEBUG
59 1.1 haya #define STATIC
60 1.1 haya #define DPRINTF(a) printf a
61 1.1 haya #else
62 1.1 haya #define STATIC static
63 1.1 haya #define DPRINTF(a)
64 1.1 haya #endif
65 1.1 haya
66 1.1 haya
67 1.1 haya
68 1.26 perry STATIC void cardslotattach(struct device *, struct device *, void *);
69 1.1 haya
70 1.26 perry STATIC int cardslotmatch(struct device *, struct cfdata *, void *);
71 1.26 perry static void create_slot_manager(void *);
72 1.26 perry static void cardslot_event_thread(void *arg);
73 1.26 perry
74 1.26 perry STATIC int cardslot_cb_print(void *aux, const char *pcic);
75 1.26 perry static int cardslot_16_print(void *, const char *);
76 1.26 perry static int cardslot_16_submatch(struct device *, struct cfdata *,
77 1.27 drochner const int *, void *);
78 1.1 haya
79 1.20 thorpej CFATTACH_DECL(cardslot, sizeof(struct cardslot_softc),
80 1.21 thorpej cardslotmatch, cardslotattach, NULL, NULL);
81 1.1 haya
82 1.1 haya STATIC int
83 1.1 haya cardslotmatch(parent, cf, aux)
84 1.14 haya struct device *parent;
85 1.14 haya struct cfdata *cf;
86 1.14 haya void *aux;
87 1.1 haya {
88 1.14 haya struct cardslot_attach_args *caa = aux;
89 1.1 haya
90 1.14 haya if (caa->caa_cb_attach == NULL && caa->caa_16_attach == NULL) {
91 1.14 haya /* Neither CardBus nor 16-bit PCMCIA are defined. */
92 1.14 haya return 0;
93 1.14 haya }
94 1.1 haya
95 1.14 haya return 1;
96 1.1 haya }
97 1.1 haya
98 1.1 haya
99 1.1 haya
100 1.1 haya STATIC void
101 1.1 haya cardslotattach(parent, self, aux)
102 1.14 haya struct device *parent;
103 1.14 haya struct device *self;
104 1.14 haya void *aux;
105 1.1 haya {
106 1.14 haya struct cardslot_softc *sc = (struct cardslot_softc *)self;
107 1.14 haya struct cardslot_attach_args *caa = aux;
108 1.14 haya
109 1.14 haya struct cbslot_attach_args *cba = caa->caa_cb_attach;
110 1.14 haya struct pcmciabus_attach_args *pa = caa->caa_16_attach;
111 1.14 haya
112 1.23 christos struct cardbus_softc *csc = NULL;
113 1.23 christos struct pcmcia_softc *psc = NULL;
114 1.1 haya
115 1.14 haya sc->sc_slot = sc->sc_dev.dv_unit;
116 1.14 haya sc->sc_cb_softc = NULL;
117 1.14 haya sc->sc_16_softc = NULL;
118 1.14 haya SIMPLEQ_INIT(&sc->sc_events);
119 1.14 haya sc->sc_th_enable = 0;
120 1.14 haya
121 1.25 drochner printf(" slot %d flags %x\n", sc->sc_slot,
122 1.29 thorpej device_cfdata(&sc->sc_dev)->cf_flags);
123 1.14 haya
124 1.14 haya DPRINTF(("%s attaching CardBus bus...\n", sc->sc_dev.dv_xname));
125 1.14 haya if (cba != NULL) {
126 1.25 drochner csc = (void *)config_found_ia(self, "cbbus", cba,
127 1.25 drochner cardslot_cb_print);
128 1.25 drochner if (csc) {
129 1.14 haya /* cardbus found */
130 1.25 drochner DPRINTF(("cardslotattach: found cardbus on %s\n",
131 1.25 drochner sc->sc_dev.dv_xname));
132 1.14 haya sc->sc_cb_softc = csc;
133 1.14 haya }
134 1.14 haya }
135 1.14 haya
136 1.14 haya if (pa != NULL) {
137 1.25 drochner psc = (void *)config_found_sm_loc(self, "pcmciabus", NULL, pa,
138 1.25 drochner cardslot_16_print, cardslot_16_submatch);
139 1.25 drochner if (psc) {
140 1.14 haya /* pcmcia 16-bit bus found */
141 1.14 haya DPRINTF(("cardslotattach: found 16-bit pcmcia bus\n"));
142 1.14 haya sc->sc_16_softc = psc;
143 1.14 haya /*
144 1.14 haya * XXX:
145 1.14 haya * dirty. This code should be removed to achieve MI.
146 1.14 haya */
147 1.14 haya caa->caa_ph->pcmcia = (struct device *)psc;
148 1.14 haya }
149 1.14 haya }
150 1.1 haya
151 1.14 haya if (csc != NULL || psc != NULL) {
152 1.14 haya config_pending_incr();
153 1.14 haya kthread_create(create_slot_manager, (void *)sc);
154 1.14 haya }
155 1.1 haya
156 1.14 haya if (csc && (csc->sc_cf->cardbus_ctrl)(csc->sc_cc, CARDBUS_CD)) {
157 1.14 haya DPRINTF(("cardslotattach: CardBus card found\n"));
158 1.14 haya /* attach deferred */
159 1.14 haya cardslot_event_throw(sc, CARDSLOT_EVENT_INSERTION_CB);
160 1.14 haya }
161 1.1 haya
162 1.14 haya if (psc && (psc->pct->card_detect)(psc->pch)) {
163 1.14 haya DPRINTF(("cardbusattach: 16-bit card found\n"));
164 1.14 haya /* attach deferred */
165 1.14 haya cardslot_event_throw(sc, CARDSLOT_EVENT_INSERTION_16);
166 1.14 haya }
167 1.1 haya }
168 1.1 haya
169 1.1 haya
170 1.1 haya
171 1.1 haya STATIC int
172 1.4 haya cardslot_cb_print(aux, pnp)
173 1.9 haya void *aux;
174 1.9 haya const char *pnp;
175 1.1 haya {
176 1.9 haya struct cbslot_attach_args *cba = aux;
177 1.4 haya
178 1.9 haya if (pnp) {
179 1.22 thorpej aprint_normal("cardbus at %s subordinate bus %d",
180 1.22 thorpej pnp, cba->cba_bus);
181 1.9 haya }
182 1.4 haya
183 1.9 haya return UNCONF;
184 1.1 haya }
185 1.1 haya
186 1.1 haya
187 1.1 haya static int
188 1.25 drochner cardslot_16_submatch(parent, cf, ldesc, aux)
189 1.14 haya struct device *parent;
190 1.14 haya struct cfdata *cf;
191 1.27 drochner const int *ldesc;
192 1.14 haya void *aux;
193 1.1 haya {
194 1.1 haya
195 1.14 haya if (cf->cf_loc[PCMCIABUSCF_CONTROLLER] != PCMCIABUSCF_CONTROLLER_DEFAULT
196 1.14 haya && cf->cf_loc[PCMCIABUSCF_CONTROLLER] != 0) {
197 1.14 haya return 0;
198 1.14 haya }
199 1.14 haya
200 1.14 haya if ((cf->cf_loc[PCMCIABUSCF_CONTROLLER] == PCMCIABUSCF_CONTROLLER_DEFAULT)) {
201 1.18 thorpej return (config_match(parent, cf, aux));
202 1.14 haya }
203 1.14 haya
204 1.14 haya return 0;
205 1.1 haya }
206 1.1 haya
207 1.1 haya
208 1.1 haya
209 1.1 haya static int
210 1.1 haya cardslot_16_print(arg, pnp)
211 1.14 haya void *arg;
212 1.14 haya const char *pnp;
213 1.1 haya {
214 1.4 haya
215 1.14 haya if (pnp) {
216 1.22 thorpej aprint_normal("pcmciabus at %s", pnp);
217 1.14 haya }
218 1.1 haya
219 1.14 haya return UNCONF;
220 1.1 haya }
221 1.1 haya
222 1.1 haya
223 1.1 haya
224 1.1 haya
225 1.1 haya static void
226 1.1 haya create_slot_manager(arg)
227 1.14 haya void *arg;
228 1.1 haya {
229 1.14 haya struct cardslot_softc *sc = (struct cardslot_softc *)arg;
230 1.1 haya
231 1.14 haya sc->sc_th_enable = 1;
232 1.1 haya
233 1.14 haya if (kthread_create1(cardslot_event_thread, sc, &sc->sc_event_thread,
234 1.14 haya "%s", sc->sc_dev.dv_xname)) {
235 1.14 haya printf("%s: unable to create event thread for slot %d\n",
236 1.14 haya sc->sc_dev.dv_xname, sc->sc_slot);
237 1.14 haya panic("create_slot_manager");
238 1.14 haya }
239 1.1 haya }
240 1.1 haya
241 1.1 haya
242 1.1 haya
243 1.1 haya
244 1.1 haya /*
245 1.1 haya * void cardslot_event_throw(struct cardslot_softc *sc, int ev)
246 1.1 haya *
247 1.1 haya * This function throws an event to the event handler. If the state
248 1.1 haya * of a slot is changed, it should be noticed using this function.
249 1.1 haya */
250 1.1 haya void
251 1.1 haya cardslot_event_throw(sc, ev)
252 1.14 haya struct cardslot_softc *sc;
253 1.14 haya int ev;
254 1.1 haya {
255 1.14 haya struct cardslot_event *ce;
256 1.1 haya
257 1.14 haya DPRINTF(("cardslot_event_throw: an event %s comes\n",
258 1.14 haya ev == CARDSLOT_EVENT_INSERTION_CB ? "CardBus Card inserted" :
259 1.14 haya ev == CARDSLOT_EVENT_INSERTION_16 ? "16-bit Card inserted" :
260 1.14 haya ev == CARDSLOT_EVENT_REMOVAL_CB ? "CardBus Card removed" :
261 1.14 haya ev == CARDSLOT_EVENT_REMOVAL_16 ? "16-bit Card removed" : "???"));
262 1.1 haya
263 1.14 haya if (NULL == (ce = (struct cardslot_event *)malloc(sizeof (struct cardslot_event), M_TEMP, M_NOWAIT))) {
264 1.14 haya panic("cardslot_enevt");
265 1.14 haya }
266 1.1 haya
267 1.14 haya ce->ce_type = ev;
268 1.1 haya
269 1.14 haya {
270 1.14 haya int s = spltty();
271 1.14 haya SIMPLEQ_INSERT_TAIL(&sc->sc_events, ce, ce_q);
272 1.14 haya splx(s);
273 1.14 haya }
274 1.1 haya
275 1.14 haya wakeup(&sc->sc_events);
276 1.1 haya
277 1.14 haya return;
278 1.1 haya }
279 1.1 haya
280 1.1 haya
281 1.1 haya /*
282 1.1 haya * static void cardslot_event_thread(void *arg)
283 1.1 haya *
284 1.1 haya * This function is the main routine handing cardslot events such as
285 1.1 haya * insertions and removals.
286 1.1 haya *
287 1.1 haya */
288 1.1 haya static void
289 1.1 haya cardslot_event_thread(arg)
290 1.14 haya void *arg;
291 1.1 haya {
292 1.14 haya struct cardslot_softc *sc = arg;
293 1.14 haya struct cardslot_event *ce;
294 1.14 haya int s, first = 1;
295 1.14 haya static int antonym_ev[4] = {
296 1.14 haya CARDSLOT_EVENT_REMOVAL_16, CARDSLOT_EVENT_INSERTION_16,
297 1.14 haya CARDSLOT_EVENT_REMOVAL_CB, CARDSLOT_EVENT_INSERTION_CB
298 1.14 haya };
299 1.14 haya
300 1.14 haya while (sc->sc_th_enable) {
301 1.14 haya s = spltty();
302 1.14 haya if ((ce = SIMPLEQ_FIRST(&sc->sc_events)) == NULL) {
303 1.14 haya splx(s);
304 1.14 haya if (first) {
305 1.14 haya first = 0;
306 1.14 haya config_pending_decr();
307 1.14 haya }
308 1.14 haya (void) tsleep(&sc->sc_events, PWAIT, "cardslotev", 0);
309 1.14 haya continue;
310 1.14 haya }
311 1.17 lukem SIMPLEQ_REMOVE_HEAD(&sc->sc_events, ce_q);
312 1.14 haya splx(s);
313 1.14 haya
314 1.14 haya if (IS_CARDSLOT_INSERT_REMOVE_EV(ce->ce_type)) {
315 1.24 wiz /* Chattering suppression */
316 1.14 haya s = spltty();
317 1.14 haya while (1) {
318 1.14 haya struct cardslot_event *ce1, *ce2;
319 1.14 haya
320 1.14 haya if ((ce1 = SIMPLEQ_FIRST(&sc->sc_events)) == NULL) {
321 1.14 haya break;
322 1.14 haya }
323 1.14 haya if (ce1->ce_type != antonym_ev[ce->ce_type]) {
324 1.14 haya break;
325 1.14 haya }
326 1.14 haya if ((ce2 = SIMPLEQ_NEXT(ce1, ce_q)) == NULL) {
327 1.14 haya break;
328 1.14 haya }
329 1.14 haya if (ce2->ce_type == ce->ce_type) {
330 1.17 lukem SIMPLEQ_REMOVE_HEAD(&sc->sc_events,
331 1.17 lukem ce_q);
332 1.14 haya free(ce1, M_TEMP);
333 1.17 lukem SIMPLEQ_REMOVE_HEAD(&sc->sc_events,
334 1.17 lukem ce_q);
335 1.14 haya free(ce2, M_TEMP);
336 1.14 haya }
337 1.14 haya }
338 1.14 haya splx(s);
339 1.14 haya }
340 1.14 haya
341 1.14 haya switch (ce->ce_type) {
342 1.14 haya case CARDSLOT_EVENT_INSERTION_CB:
343 1.14 haya if ((CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB)
344 1.14 haya || (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_16)) {
345 1.14 haya if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
346 1.14 haya /*
347 1.14 haya * A card has already been
348 1.14 haya * inserted and works.
349 1.14 haya */
350 1.14 haya break;
351 1.14 haya }
352 1.14 haya }
353 1.14 haya
354 1.14 haya if (sc->sc_cb_softc) {
355 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status,
356 1.14 haya CARDSLOT_STATUS_CARD_CB);
357 1.14 haya if (cardbus_attach_card(sc->sc_cb_softc) > 0) {
358 1.14 haya /* at least one function works */
359 1.14 haya CARDSLOT_SET_WORK(sc->sc_status, CARDSLOT_STATUS_WORKING);
360 1.14 haya } else {
361 1.14 haya /*
362 1.14 haya * no functions work or this
363 1.14 haya * card is not known
364 1.14 haya */
365 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
366 1.14 haya CARDSLOT_STATUS_NOTWORK);
367 1.14 haya }
368 1.14 haya } else {
369 1.14 haya panic("no cardbus on %s", sc->sc_dev.dv_xname);
370 1.14 haya }
371 1.14 haya
372 1.14 haya break;
373 1.14 haya
374 1.14 haya case CARDSLOT_EVENT_INSERTION_16:
375 1.14 haya if ((CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB)
376 1.14 haya || (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_16)) {
377 1.14 haya if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
378 1.14 haya /*
379 1.14 haya * A card has already been
380 1.14 haya * inserted and work.
381 1.14 haya */
382 1.14 haya break;
383 1.14 haya }
384 1.14 haya }
385 1.14 haya if (sc->sc_16_softc) {
386 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_16);
387 1.14 haya if (pcmcia_card_attach((struct device *)sc->sc_16_softc)) {
388 1.14 haya /* Do not attach */
389 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
390 1.14 haya CARDSLOT_STATUS_NOTWORK);
391 1.14 haya } else {
392 1.14 haya /* working */
393 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
394 1.14 haya CARDSLOT_STATUS_WORKING);
395 1.14 haya }
396 1.14 haya } else {
397 1.14 haya panic("no 16-bit pcmcia on %s", sc->sc_dev.dv_xname);
398 1.14 haya }
399 1.14 haya
400 1.14 haya break;
401 1.14 haya
402 1.14 haya case CARDSLOT_EVENT_REMOVAL_CB:
403 1.14 haya if (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB) {
404 1.14 haya /* CardBus card has not been inserted. */
405 1.14 haya if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
406 1.14 haya cardbus_detach_card(sc->sc_cb_softc);
407 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
408 1.14 haya CARDSLOT_STATUS_NOTWORK);
409 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
410 1.14 haya CARDSLOT_STATUS_CARD_NONE);
411 1.14 haya }
412 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status,
413 1.14 haya CARDSLOT_STATUS_CARD_NONE);
414 1.14 haya } else if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_16) {
415 1.14 haya /* Unknown card... */
416 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status,
417 1.14 haya CARDSLOT_STATUS_CARD_NONE);
418 1.14 haya }
419 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
420 1.14 haya CARDSLOT_STATUS_NOTWORK);
421 1.14 haya break;
422 1.14 haya
423 1.14 haya case CARDSLOT_EVENT_REMOVAL_16:
424 1.14 haya DPRINTF(("%s: removal event\n", sc->sc_dev.dv_xname));
425 1.14 haya if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_16) {
426 1.14 haya /* 16-bit card has not been inserted. */
427 1.14 haya break;
428 1.14 haya }
429 1.14 haya if ((sc->sc_16_softc != NULL)
430 1.14 haya && (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING)) {
431 1.14 haya struct pcmcia_softc *psc = sc->sc_16_softc;
432 1.14 haya
433 1.14 haya pcmcia_card_deactivate((struct device *)psc);
434 1.14 haya pcmcia_chip_socket_disable(psc->pct, psc->pch);
435 1.14 haya pcmcia_card_detach((struct device *)psc, DETACH_FORCE);
436 1.14 haya }
437 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_NONE);
438 1.14 haya CARDSLOT_SET_WORK(sc->sc_status, CARDSLOT_STATUS_NOTWORK);
439 1.14 haya break;
440 1.14 haya
441 1.14 haya default:
442 1.14 haya panic("cardslot_event_thread: unknown event %d", ce->ce_type);
443 1.14 haya }
444 1.14 haya free(ce, M_TEMP);
445 1.14 haya }
446 1.1 haya
447 1.14 haya sc->sc_event_thread = NULL;
448 1.1 haya
449 1.14 haya /* In case the parent device is waiting for us to exit. */
450 1.14 haya wakeup(sc);
451 1.1 haya
452 1.14 haya kthread_exit(0);
453 1.1 haya }
454