cardslot.c revision 1.41 1 1.41 drochner /* $NetBSD: cardslot.c,v 1.41 2008/06/24 17:32:09 drochner 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.41 drochner __KERNEL_RCSID(0, "$NetBSD: cardslot.c,v 1.41 2008/06/24 17:32:09 drochner 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.36 ad #include <sys/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.39 dyoung STATIC int cardslotdetach(device_t, int);
70 1.1 haya
71 1.26 perry STATIC int cardslotmatch(struct device *, struct cfdata *, 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.39 dyoung cardslotmatch, cardslotattach, cardslotdetach, NULL);
81 1.1 haya
82 1.1 haya STATIC int
83 1.33 christos cardslotmatch(struct device *parent, struct cfdata *cf,
84 1.32 christos void *aux)
85 1.1 haya {
86 1.14 haya struct cardslot_attach_args *caa = aux;
87 1.1 haya
88 1.14 haya if (caa->caa_cb_attach == NULL && caa->caa_16_attach == NULL) {
89 1.14 haya /* Neither CardBus nor 16-bit PCMCIA are defined. */
90 1.14 haya return 0;
91 1.14 haya }
92 1.1 haya
93 1.14 haya return 1;
94 1.1 haya }
95 1.1 haya
96 1.1 haya
97 1.1 haya
98 1.1 haya STATIC void
99 1.33 christos cardslotattach(struct device *parent, struct device *self,
100 1.32 christos void *aux)
101 1.1 haya {
102 1.31 thorpej struct cardslot_softc *sc = device_private(self);
103 1.14 haya struct cardslot_attach_args *caa = aux;
104 1.14 haya
105 1.14 haya struct cbslot_attach_args *cba = caa->caa_cb_attach;
106 1.14 haya struct pcmciabus_attach_args *pa = caa->caa_16_attach;
107 1.14 haya
108 1.23 christos struct cardbus_softc *csc = NULL;
109 1.23 christos struct pcmcia_softc *psc = NULL;
110 1.1 haya
111 1.14 haya sc->sc_cb_softc = NULL;
112 1.14 haya sc->sc_16_softc = NULL;
113 1.14 haya SIMPLEQ_INIT(&sc->sc_events);
114 1.14 haya sc->sc_th_enable = 0;
115 1.14 haya
116 1.37 jmcneill aprint_naive("\n");
117 1.41 drochner aprint_normal("\n");
118 1.14 haya
119 1.40 cegger DPRINTF(("%s attaching CardBus bus...\n", device_xname(&sc->sc_dev)));
120 1.14 haya if (cba != NULL) {
121 1.25 drochner csc = (void *)config_found_ia(self, "cbbus", cba,
122 1.25 drochner cardslot_cb_print);
123 1.25 drochner if (csc) {
124 1.14 haya /* cardbus found */
125 1.34 dyoung DPRINTF(("%s: found cardbus on %s\n", __func__,
126 1.40 cegger device_xname(&sc->sc_dev)));
127 1.14 haya sc->sc_cb_softc = csc;
128 1.14 haya }
129 1.14 haya }
130 1.14 haya
131 1.14 haya if (pa != NULL) {
132 1.25 drochner psc = (void *)config_found_sm_loc(self, "pcmciabus", NULL, pa,
133 1.25 drochner cardslot_16_print, cardslot_16_submatch);
134 1.25 drochner if (psc) {
135 1.14 haya /* pcmcia 16-bit bus found */
136 1.34 dyoung DPRINTF(("%s: found 16-bit pcmcia bus\n", __func__));
137 1.14 haya sc->sc_16_softc = psc;
138 1.14 haya /*
139 1.14 haya * XXX:
140 1.14 haya * dirty. This code should be removed to achieve MI.
141 1.14 haya */
142 1.14 haya caa->caa_ph->pcmcia = (struct device *)psc;
143 1.14 haya }
144 1.14 haya }
145 1.1 haya
146 1.14 haya if (csc != NULL || psc != NULL) {
147 1.14 haya config_pending_incr();
148 1.35 ad if (kthread_create(PRI_NONE, 0, NULL, cardslot_event_thread,
149 1.41 drochner sc, &sc->sc_event_thread, "%s", device_xname(self))) {
150 1.41 drochner aprint_error_dev(&sc->sc_dev,
151 1.41 drochner "unable to create thread\n");
152 1.35 ad panic("cardslotattach");
153 1.35 ad }
154 1.35 ad sc->sc_th_enable = 1;
155 1.14 haya }
156 1.1 haya
157 1.14 haya if (csc && (csc->sc_cf->cardbus_ctrl)(csc->sc_cc, CARDBUS_CD)) {
158 1.34 dyoung DPRINTF(("%s: CardBus card found\n", __func__));
159 1.14 haya /* attach deferred */
160 1.14 haya cardslot_event_throw(sc, CARDSLOT_EVENT_INSERTION_CB);
161 1.14 haya }
162 1.1 haya
163 1.14 haya if (psc && (psc->pct->card_detect)(psc->pch)) {
164 1.34 dyoung DPRINTF(("%s: 16-bit card found\n", __func__));
165 1.14 haya /* attach deferred */
166 1.14 haya cardslot_event_throw(sc, CARDSLOT_EVENT_INSERTION_16);
167 1.14 haya }
168 1.38 jmcneill
169 1.38 jmcneill if (!pmf_device_register(self, NULL, NULL))
170 1.38 jmcneill aprint_error_dev(self, "couldn't establish power handler\n");
171 1.1 haya }
172 1.1 haya
173 1.39 dyoung STATIC int
174 1.39 dyoung cardslotdetach(device_t self, int flags)
175 1.39 dyoung {
176 1.39 dyoung int rc;
177 1.39 dyoung struct cardslot_softc *sc = device_private(self);
178 1.39 dyoung
179 1.39 dyoung if ((rc = config_detach_children(self, flags)) != 0)
180 1.39 dyoung return rc;
181 1.39 dyoung
182 1.39 dyoung sc->sc_th_enable = 0;
183 1.39 dyoung wakeup(&sc->sc_events);
184 1.39 dyoung while (sc->sc_event_thread != NULL)
185 1.39 dyoung (void)tsleep(sc, PWAIT, "cardslotthd", 0);
186 1.39 dyoung
187 1.39 dyoung if (!SIMPLEQ_EMPTY(&sc->sc_events))
188 1.39 dyoung aprint_error_dev(self, "events outstanding");
189 1.1 haya
190 1.39 dyoung pmf_device_deregister(self);
191 1.39 dyoung return 0;
192 1.39 dyoung }
193 1.1 haya
194 1.1 haya STATIC int
195 1.34 dyoung cardslot_cb_print(void *aux, const char *pnp)
196 1.1 haya {
197 1.9 haya struct cbslot_attach_args *cba = aux;
198 1.4 haya
199 1.34 dyoung if (pnp != NULL) {
200 1.22 thorpej aprint_normal("cardbus at %s subordinate bus %d",
201 1.22 thorpej pnp, cba->cba_bus);
202 1.9 haya }
203 1.4 haya
204 1.9 haya return UNCONF;
205 1.1 haya }
206 1.1 haya
207 1.1 haya
208 1.1 haya static int
209 1.32 christos cardslot_16_submatch(struct device *parent, struct cfdata *cf,
210 1.33 christos const int *ldesc, void *aux)
211 1.1 haya {
212 1.1 haya
213 1.14 haya if (cf->cf_loc[PCMCIABUSCF_CONTROLLER] != PCMCIABUSCF_CONTROLLER_DEFAULT
214 1.14 haya && cf->cf_loc[PCMCIABUSCF_CONTROLLER] != 0) {
215 1.14 haya return 0;
216 1.14 haya }
217 1.14 haya
218 1.14 haya if ((cf->cf_loc[PCMCIABUSCF_CONTROLLER] == PCMCIABUSCF_CONTROLLER_DEFAULT)) {
219 1.18 thorpej return (config_match(parent, cf, aux));
220 1.14 haya }
221 1.14 haya
222 1.14 haya return 0;
223 1.1 haya }
224 1.1 haya
225 1.1 haya
226 1.1 haya
227 1.1 haya static int
228 1.33 christos cardslot_16_print(void *arg, const char *pnp)
229 1.1 haya {
230 1.4 haya
231 1.34 dyoung if (pnp != NULL) {
232 1.22 thorpej aprint_normal("pcmciabus at %s", pnp);
233 1.14 haya }
234 1.1 haya
235 1.14 haya return UNCONF;
236 1.1 haya }
237 1.1 haya
238 1.1 haya
239 1.1 haya /*
240 1.1 haya * void cardslot_event_throw(struct cardslot_softc *sc, int ev)
241 1.1 haya *
242 1.1 haya * This function throws an event to the event handler. If the state
243 1.1 haya * of a slot is changed, it should be noticed using this function.
244 1.1 haya */
245 1.1 haya void
246 1.34 dyoung cardslot_event_throw(struct cardslot_softc *sc, int ev)
247 1.1 haya {
248 1.14 haya struct cardslot_event *ce;
249 1.1 haya
250 1.14 haya DPRINTF(("cardslot_event_throw: an event %s comes\n",
251 1.14 haya ev == CARDSLOT_EVENT_INSERTION_CB ? "CardBus Card inserted" :
252 1.14 haya ev == CARDSLOT_EVENT_INSERTION_16 ? "16-bit Card inserted" :
253 1.14 haya ev == CARDSLOT_EVENT_REMOVAL_CB ? "CardBus Card removed" :
254 1.14 haya ev == CARDSLOT_EVENT_REMOVAL_16 ? "16-bit Card removed" : "???"));
255 1.1 haya
256 1.14 haya if (NULL == (ce = (struct cardslot_event *)malloc(sizeof (struct cardslot_event), M_TEMP, M_NOWAIT))) {
257 1.14 haya panic("cardslot_enevt");
258 1.14 haya }
259 1.1 haya
260 1.14 haya ce->ce_type = ev;
261 1.1 haya
262 1.14 haya {
263 1.14 haya int s = spltty();
264 1.14 haya SIMPLEQ_INSERT_TAIL(&sc->sc_events, ce, ce_q);
265 1.14 haya splx(s);
266 1.14 haya }
267 1.1 haya
268 1.14 haya wakeup(&sc->sc_events);
269 1.1 haya
270 1.14 haya return;
271 1.1 haya }
272 1.1 haya
273 1.1 haya
274 1.1 haya /*
275 1.1 haya * static void cardslot_event_thread(void *arg)
276 1.1 haya *
277 1.1 haya * This function is the main routine handing cardslot events such as
278 1.1 haya * insertions and removals.
279 1.1 haya *
280 1.1 haya */
281 1.1 haya static void
282 1.1 haya cardslot_event_thread(arg)
283 1.14 haya void *arg;
284 1.1 haya {
285 1.14 haya struct cardslot_softc *sc = arg;
286 1.14 haya struct cardslot_event *ce;
287 1.14 haya int s, first = 1;
288 1.14 haya static int antonym_ev[4] = {
289 1.14 haya CARDSLOT_EVENT_REMOVAL_16, CARDSLOT_EVENT_INSERTION_16,
290 1.14 haya CARDSLOT_EVENT_REMOVAL_CB, CARDSLOT_EVENT_INSERTION_CB
291 1.14 haya };
292 1.14 haya
293 1.14 haya while (sc->sc_th_enable) {
294 1.14 haya s = spltty();
295 1.14 haya if ((ce = SIMPLEQ_FIRST(&sc->sc_events)) == NULL) {
296 1.14 haya splx(s);
297 1.14 haya if (first) {
298 1.14 haya first = 0;
299 1.14 haya config_pending_decr();
300 1.14 haya }
301 1.14 haya (void) tsleep(&sc->sc_events, PWAIT, "cardslotev", 0);
302 1.14 haya continue;
303 1.14 haya }
304 1.17 lukem SIMPLEQ_REMOVE_HEAD(&sc->sc_events, ce_q);
305 1.14 haya splx(s);
306 1.14 haya
307 1.14 haya if (IS_CARDSLOT_INSERT_REMOVE_EV(ce->ce_type)) {
308 1.24 wiz /* Chattering suppression */
309 1.14 haya s = spltty();
310 1.14 haya while (1) {
311 1.14 haya struct cardslot_event *ce1, *ce2;
312 1.14 haya
313 1.14 haya if ((ce1 = SIMPLEQ_FIRST(&sc->sc_events)) == NULL) {
314 1.14 haya break;
315 1.14 haya }
316 1.14 haya if (ce1->ce_type != antonym_ev[ce->ce_type]) {
317 1.14 haya break;
318 1.14 haya }
319 1.14 haya if ((ce2 = SIMPLEQ_NEXT(ce1, ce_q)) == NULL) {
320 1.14 haya break;
321 1.14 haya }
322 1.14 haya if (ce2->ce_type == ce->ce_type) {
323 1.17 lukem SIMPLEQ_REMOVE_HEAD(&sc->sc_events,
324 1.17 lukem ce_q);
325 1.14 haya free(ce1, M_TEMP);
326 1.17 lukem SIMPLEQ_REMOVE_HEAD(&sc->sc_events,
327 1.17 lukem ce_q);
328 1.14 haya free(ce2, M_TEMP);
329 1.14 haya }
330 1.14 haya }
331 1.14 haya splx(s);
332 1.14 haya }
333 1.14 haya
334 1.14 haya switch (ce->ce_type) {
335 1.14 haya case CARDSLOT_EVENT_INSERTION_CB:
336 1.14 haya if ((CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB)
337 1.14 haya || (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_16)) {
338 1.14 haya if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
339 1.14 haya /*
340 1.14 haya * A card has already been
341 1.14 haya * inserted and works.
342 1.14 haya */
343 1.14 haya break;
344 1.14 haya }
345 1.14 haya }
346 1.14 haya
347 1.14 haya if (sc->sc_cb_softc) {
348 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status,
349 1.14 haya CARDSLOT_STATUS_CARD_CB);
350 1.14 haya if (cardbus_attach_card(sc->sc_cb_softc) > 0) {
351 1.14 haya /* at least one function works */
352 1.14 haya CARDSLOT_SET_WORK(sc->sc_status, CARDSLOT_STATUS_WORKING);
353 1.14 haya } else {
354 1.14 haya /*
355 1.14 haya * no functions work or this
356 1.14 haya * card is not known
357 1.14 haya */
358 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
359 1.14 haya CARDSLOT_STATUS_NOTWORK);
360 1.14 haya }
361 1.14 haya } else {
362 1.40 cegger panic("no cardbus on %s", device_xname(&sc->sc_dev));
363 1.14 haya }
364 1.14 haya
365 1.14 haya break;
366 1.14 haya
367 1.14 haya case CARDSLOT_EVENT_INSERTION_16:
368 1.14 haya if ((CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB)
369 1.14 haya || (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_16)) {
370 1.14 haya if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
371 1.14 haya /*
372 1.14 haya * A card has already been
373 1.14 haya * inserted and work.
374 1.14 haya */
375 1.14 haya break;
376 1.14 haya }
377 1.14 haya }
378 1.14 haya if (sc->sc_16_softc) {
379 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_16);
380 1.14 haya if (pcmcia_card_attach((struct device *)sc->sc_16_softc)) {
381 1.14 haya /* Do not attach */
382 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
383 1.14 haya CARDSLOT_STATUS_NOTWORK);
384 1.14 haya } else {
385 1.14 haya /* working */
386 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
387 1.14 haya CARDSLOT_STATUS_WORKING);
388 1.14 haya }
389 1.14 haya } else {
390 1.40 cegger panic("no 16-bit pcmcia on %s", device_xname(&sc->sc_dev));
391 1.14 haya }
392 1.14 haya
393 1.14 haya break;
394 1.14 haya
395 1.14 haya case CARDSLOT_EVENT_REMOVAL_CB:
396 1.14 haya if (CARDSLOT_CARDTYPE(sc->sc_status) == CARDSLOT_STATUS_CARD_CB) {
397 1.14 haya /* CardBus card has not been inserted. */
398 1.14 haya if (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING) {
399 1.14 haya cardbus_detach_card(sc->sc_cb_softc);
400 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
401 1.14 haya CARDSLOT_STATUS_NOTWORK);
402 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
403 1.14 haya CARDSLOT_STATUS_CARD_NONE);
404 1.14 haya }
405 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status,
406 1.14 haya CARDSLOT_STATUS_CARD_NONE);
407 1.14 haya } else if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_16) {
408 1.14 haya /* Unknown card... */
409 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status,
410 1.14 haya CARDSLOT_STATUS_CARD_NONE);
411 1.14 haya }
412 1.14 haya CARDSLOT_SET_WORK(sc->sc_status,
413 1.14 haya CARDSLOT_STATUS_NOTWORK);
414 1.14 haya break;
415 1.14 haya
416 1.14 haya case CARDSLOT_EVENT_REMOVAL_16:
417 1.40 cegger DPRINTF(("%s: removal event\n", device_xname(&sc->sc_dev)));
418 1.14 haya if (CARDSLOT_CARDTYPE(sc->sc_status) != CARDSLOT_STATUS_CARD_16) {
419 1.14 haya /* 16-bit card has not been inserted. */
420 1.14 haya break;
421 1.14 haya }
422 1.14 haya if ((sc->sc_16_softc != NULL)
423 1.14 haya && (CARDSLOT_WORK(sc->sc_status) == CARDSLOT_STATUS_WORKING)) {
424 1.14 haya struct pcmcia_softc *psc = sc->sc_16_softc;
425 1.14 haya
426 1.14 haya pcmcia_card_deactivate((struct device *)psc);
427 1.14 haya pcmcia_chip_socket_disable(psc->pct, psc->pch);
428 1.14 haya pcmcia_card_detach((struct device *)psc, DETACH_FORCE);
429 1.14 haya }
430 1.14 haya CARDSLOT_SET_CARDTYPE(sc->sc_status, CARDSLOT_STATUS_CARD_NONE);
431 1.14 haya CARDSLOT_SET_WORK(sc->sc_status, CARDSLOT_STATUS_NOTWORK);
432 1.14 haya break;
433 1.14 haya
434 1.14 haya default:
435 1.14 haya panic("cardslot_event_thread: unknown event %d", ce->ce_type);
436 1.14 haya }
437 1.14 haya free(ce, M_TEMP);
438 1.14 haya }
439 1.1 haya
440 1.14 haya sc->sc_event_thread = NULL;
441 1.1 haya
442 1.14 haya /* In case the parent device is waiting for us to exit. */
443 1.14 haya wakeup(sc);
444 1.1 haya
445 1.14 haya kthread_exit(0);
446 1.1 haya }
447