stp4020.c revision 1.15 1 1.15 martin /* $NetBSD: stp4020.c,v 1.15 2002/03/01 10:02:38 martin Exp $ */
2 1.1 pk
3 1.1 pk /*-
4 1.1 pk * Copyright (c) 1998 The NetBSD Foundation, Inc.
5 1.1 pk * All rights reserved.
6 1.1 pk *
7 1.1 pk * This code is derived from software contributed to The NetBSD Foundation
8 1.1 pk * by Paul Kranenburg.
9 1.1 pk *
10 1.1 pk * Redistribution and use in source and binary forms, with or without
11 1.1 pk * modification, are permitted provided that the following conditions
12 1.1 pk * are met:
13 1.1 pk * 1. Redistributions of source code must retain the above copyright
14 1.1 pk * notice, this list of conditions and the following disclaimer.
15 1.1 pk * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 pk * notice, this list of conditions and the following disclaimer in the
17 1.1 pk * documentation and/or other materials provided with the distribution.
18 1.1 pk * 3. All advertising materials mentioning features or use of this software
19 1.1 pk * must display the following acknowledgement:
20 1.1 pk * This product includes software developed by the NetBSD
21 1.1 pk * Foundation, Inc. and its contributors.
22 1.1 pk * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 pk * contributors may be used to endorse or promote products derived
24 1.1 pk * from this software without specific prior written permission.
25 1.1 pk *
26 1.1 pk * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 pk * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 pk * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 pk * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 pk * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 pk * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 pk * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 pk * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 pk * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 pk * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 pk * POSSIBILITY OF SUCH DAMAGE.
37 1.1 pk */
38 1.1 pk
39 1.1 pk /*
40 1.1 pk * STP4020: SBus/PCMCIA bridge supporting two Type-3 PCMCIA cards.
41 1.1 pk */
42 1.12 lukem
43 1.12 lukem #include <sys/cdefs.h>
44 1.15 martin __KERNEL_RCSID(0, "$NetBSD: stp4020.c,v 1.15 2002/03/01 10:02:38 martin Exp $");
45 1.1 pk
46 1.1 pk #include <sys/param.h>
47 1.1 pk #include <sys/systm.h>
48 1.1 pk #include <sys/errno.h>
49 1.1 pk #include <sys/malloc.h>
50 1.15 martin #include <sys/extent.h>
51 1.1 pk #include <sys/proc.h>
52 1.1 pk #include <sys/kernel.h>
53 1.1 pk #include <sys/kthread.h>
54 1.1 pk #include <sys/device.h>
55 1.1 pk
56 1.1 pk #include <dev/pcmcia/pcmciareg.h>
57 1.1 pk #include <dev/pcmcia/pcmciavar.h>
58 1.1 pk #include <dev/pcmcia/pcmciachip.h>
59 1.1 pk
60 1.1 pk #include <machine/bus.h>
61 1.11 pk #include <machine/intr.h>
62 1.1 pk
63 1.1 pk #include <dev/sbus/sbusvar.h>
64 1.1 pk #include <dev/sbus/stp4020reg.h>
65 1.1 pk
66 1.1 pk #define STP4020_DEBUG 1 /* XXX-temp */
67 1.1 pk
68 1.15 martin /*
69 1.15 martin * We use the three available windows per socket in a simple, fixed
70 1.15 martin * arrangement. Each window maps (at full 1 MB size) one of the pcmcia
71 1.15 martin * spaces into sbus space.
72 1.15 martin */
73 1.15 martin #define STP_WIN_ATTR 0 /* index of the attribute memory space window */
74 1.15 martin #define STP_WIN_MEM 1 /* index of the common memory space window */
75 1.15 martin #define STP_WIN_IO 2 /* index of the io space window */
76 1.15 martin
77 1.15 martin
78 1.1 pk #if defined(STP4020_DEBUG)
79 1.1 pk int stp4020_debug = 0;
80 1.1 pk #define DPRINTF(x) do { if (stp4020_debug) printf x; } while(0)
81 1.1 pk #else
82 1.1 pk #define DPRINTF(x)
83 1.1 pk #endif
84 1.1 pk
85 1.1 pk /*
86 1.1 pk * Event queue; events detected in an interrupt context go here
87 1.1 pk * awaiting attention from our event handling thread.
88 1.1 pk */
89 1.1 pk struct stp4020_event {
90 1.1 pk SIMPLEQ_ENTRY(stp4020_event) se_q;
91 1.1 pk int se_type;
92 1.1 pk int se_sock;
93 1.1 pk };
94 1.1 pk /* Defined event types */
95 1.1 pk #define STP4020_EVENT_INSERTION 0
96 1.1 pk #define STP4020_EVENT_REMOVAL 1
97 1.1 pk
98 1.1 pk /*
99 1.1 pk * Per socket data.
100 1.1 pk */
101 1.1 pk struct stp4020_socket {
102 1.1 pk struct stp4020_softc *sc; /* Back link */
103 1.1 pk int flags;
104 1.1 pk #define STP4020_SOCKET_BUSY 0x0001
105 1.1 pk #define STP4020_SOCKET_SHUTDOWN 0x0002
106 1.1 pk int sock; /* Socket number (0 or 1) */
107 1.1 pk bus_space_tag_t tag; /* socket control space */
108 1.1 pk bus_space_handle_t regs; /* */
109 1.1 pk struct device *pcmcia; /* Associated PCMCIA device */
110 1.1 pk int (*intrhandler) /* Card driver interrupt handler */
111 1.1 pk __P((void *));
112 1.1 pk void *intrarg; /* Card interrupt handler argument */
113 1.1 pk int ipl; /* Interrupt level suggested by card */
114 1.1 pk struct {
115 1.1 pk bus_space_handle_t winaddr;/* this window's address */
116 1.1 pk } windows[STP4020_NWIN];
117 1.1 pk
118 1.1 pk };
119 1.1 pk
120 1.1 pk struct stp4020_softc {
121 1.1 pk struct device sc_dev; /* Base device */
122 1.1 pk struct sbusdev sc_sd; /* SBus device */
123 1.1 pk bus_space_tag_t sc_bustag;
124 1.1 pk bus_dma_tag_t sc_dmatag;
125 1.1 pk pcmcia_chipset_tag_t sc_pct; /* Chipset methods */
126 1.1 pk
127 1.1 pk struct proc *event_thread; /* event handling thread */
128 1.1 pk SIMPLEQ_HEAD(, stp4020_event) events; /* Pending events for thread */
129 1.1 pk
130 1.1 pk struct stp4020_socket sc_socks[STP4020_NSOCK];
131 1.1 pk };
132 1.1 pk
133 1.1 pk
134 1.1 pk static int stp4020print __P((void *, const char *));
135 1.1 pk static int stp4020match __P((struct device *, struct cfdata *, void *));
136 1.1 pk static void stp4020attach __P((struct device *, struct device *, void *));
137 1.1 pk static int stp4020_iointr __P((void *));
138 1.1 pk static int stp4020_statintr __P((void *));
139 1.15 martin static void stp4020_map_window(struct stp4020_socket *h, int win);
140 1.15 martin static int dummy_splraise(int ipl);
141 1.1 pk
142 1.1 pk struct cfattach nell_ca = {
143 1.1 pk sizeof(struct stp4020_softc), stp4020match, stp4020attach
144 1.1 pk };
145 1.1 pk
146 1.6 pk #ifdef STP4020_DEBUG
147 1.6 pk static void stp4020_dump_regs __P((struct stp4020_socket *));
148 1.6 pk #endif
149 1.1 pk
150 1.1 pk static int stp4020_rd_sockctl __P((struct stp4020_socket *, int));
151 1.1 pk static void stp4020_wr_sockctl __P((struct stp4020_socket *, int, int));
152 1.1 pk static int stp4020_rd_winctl __P((struct stp4020_socket *, int, int));
153 1.1 pk static void stp4020_wr_winctl __P((struct stp4020_socket *, int, int, int));
154 1.1 pk
155 1.1 pk void stp4020_delay __P((unsigned int));
156 1.1 pk void stp4020_attach_socket __P((struct stp4020_socket *));
157 1.1 pk void stp4020_create_event_thread __P((void *));
158 1.1 pk void stp4020_event_thread __P((void *));
159 1.1 pk void stp4020_queue_event __P((struct stp4020_softc *, int, int));
160 1.1 pk
161 1.1 pk int stp4020_chip_mem_alloc __P((pcmcia_chipset_handle_t, bus_size_t,
162 1.1 pk struct pcmcia_mem_handle *));
163 1.1 pk void stp4020_chip_mem_free __P((pcmcia_chipset_handle_t,
164 1.1 pk struct pcmcia_mem_handle *));
165 1.1 pk int stp4020_chip_mem_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
166 1.1 pk bus_size_t, struct pcmcia_mem_handle *,
167 1.14 soren bus_size_t *, int *));
168 1.1 pk void stp4020_chip_mem_unmap __P((pcmcia_chipset_handle_t, int));
169 1.1 pk
170 1.1 pk int stp4020_chip_io_alloc __P((pcmcia_chipset_handle_t,
171 1.1 pk bus_addr_t, bus_size_t, bus_size_t,
172 1.1 pk struct pcmcia_io_handle *));
173 1.1 pk void stp4020_chip_io_free __P((pcmcia_chipset_handle_t,
174 1.1 pk struct pcmcia_io_handle *));
175 1.1 pk int stp4020_chip_io_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
176 1.1 pk bus_size_t, struct pcmcia_io_handle *, int *));
177 1.1 pk void stp4020_chip_io_unmap __P((pcmcia_chipset_handle_t, int));
178 1.1 pk
179 1.1 pk void stp4020_chip_socket_enable __P((pcmcia_chipset_handle_t));
180 1.1 pk void stp4020_chip_socket_disable __P((pcmcia_chipset_handle_t));
181 1.1 pk void *stp4020_chip_intr_establish __P((pcmcia_chipset_handle_t,
182 1.1 pk struct pcmcia_function *, int,
183 1.1 pk int (*) __P((void *)), void *));
184 1.1 pk void stp4020_chip_intr_disestablish __P((pcmcia_chipset_handle_t, void *));
185 1.1 pk
186 1.1 pk /* Our PCMCIA chipset methods */
187 1.1 pk static struct pcmcia_chip_functions stp4020_functions = {
188 1.1 pk stp4020_chip_mem_alloc,
189 1.1 pk stp4020_chip_mem_free,
190 1.1 pk stp4020_chip_mem_map,
191 1.1 pk stp4020_chip_mem_unmap,
192 1.1 pk
193 1.1 pk stp4020_chip_io_alloc,
194 1.1 pk stp4020_chip_io_free,
195 1.1 pk stp4020_chip_io_map,
196 1.1 pk stp4020_chip_io_unmap,
197 1.1 pk
198 1.1 pk stp4020_chip_intr_establish,
199 1.1 pk stp4020_chip_intr_disestablish,
200 1.1 pk
201 1.1 pk stp4020_chip_socket_enable,
202 1.1 pk stp4020_chip_socket_disable
203 1.1 pk };
204 1.1 pk
205 1.1 pk
206 1.1 pk static __inline__ int
207 1.1 pk stp4020_rd_sockctl(h, idx)
208 1.1 pk struct stp4020_socket *h;
209 1.1 pk int idx;
210 1.1 pk {
211 1.1 pk int o = ((STP4020_SOCKREGS_SIZE * (h->sock)) + idx);
212 1.1 pk return (bus_space_read_2(h->tag, h->regs, o));
213 1.1 pk }
214 1.1 pk
215 1.1 pk static __inline__ void
216 1.1 pk stp4020_wr_sockctl(h, idx, v)
217 1.1 pk struct stp4020_socket *h;
218 1.1 pk int idx;
219 1.1 pk int v;
220 1.1 pk {
221 1.1 pk int o = (STP4020_SOCKREGS_SIZE * (h->sock)) + idx;
222 1.1 pk bus_space_write_2(h->tag, h->regs, o, v);
223 1.1 pk }
224 1.1 pk
225 1.1 pk static __inline__ int
226 1.1 pk stp4020_rd_winctl(h, win, idx)
227 1.1 pk struct stp4020_socket *h;
228 1.1 pk int win;
229 1.1 pk int idx;
230 1.1 pk {
231 1.1 pk int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
232 1.1 pk (STP4020_WINREGS_SIZE * win) + idx;
233 1.1 pk return (bus_space_read_2(h->tag, h->regs, o));
234 1.1 pk }
235 1.1 pk
236 1.1 pk static __inline__ void
237 1.1 pk stp4020_wr_winctl(h, win, idx, v)
238 1.1 pk struct stp4020_socket *h;
239 1.1 pk int win;
240 1.1 pk int idx;
241 1.1 pk int v;
242 1.1 pk {
243 1.1 pk int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
244 1.1 pk (STP4020_WINREGS_SIZE * win) + idx;
245 1.1 pk
246 1.1 pk bus_space_write_2(h->tag, h->regs, o, v);
247 1.1 pk }
248 1.1 pk
249 1.1 pk
250 1.1 pk int
251 1.1 pk stp4020print(aux, busname)
252 1.1 pk void *aux;
253 1.1 pk const char *busname;
254 1.1 pk {
255 1.4 pk struct pcmciabus_attach_args *paa = aux;
256 1.3 pk struct stp4020_socket *h = paa->pch;
257 1.3 pk
258 1.3 pk printf(" socket %d", h->sock);
259 1.1 pk return (UNCONF);
260 1.1 pk }
261 1.1 pk
262 1.1 pk int
263 1.1 pk stp4020match(parent, cf, aux)
264 1.1 pk struct device *parent;
265 1.1 pk struct cfdata *cf;
266 1.1 pk void *aux;
267 1.1 pk {
268 1.1 pk struct sbus_attach_args *sa = aux;
269 1.1 pk
270 1.2 pk return (strcmp("SUNW,pcmcia", sa->sa_name) == 0);
271 1.1 pk }
272 1.1 pk
273 1.1 pk /*
274 1.1 pk * Attach all the sub-devices we can find
275 1.1 pk */
276 1.1 pk void
277 1.1 pk stp4020attach(parent, self, aux)
278 1.1 pk struct device *parent, *self;
279 1.1 pk void *aux;
280 1.1 pk {
281 1.1 pk struct sbus_attach_args *sa = aux;
282 1.1 pk struct stp4020_softc *sc = (void *)self;
283 1.1 pk int node, rev;
284 1.1 pk int i;
285 1.1 pk bus_space_handle_t bh;
286 1.1 pk
287 1.1 pk node = sa->sa_node;
288 1.1 pk
289 1.1 pk /* Transfer bus tags */
290 1.1 pk sc->sc_bustag = sa->sa_bustag;
291 1.1 pk sc->sc_dmatag = sa->sa_dmatag;
292 1.1 pk
293 1.1 pk /* Set up per-socket static initialization */
294 1.1 pk sc->sc_socks[0].sc = sc->sc_socks[1].sc = sc;
295 1.1 pk sc->sc_socks[0].tag = sc->sc_socks[1].tag = sa->sa_bustag;
296 1.1 pk
297 1.9 pk if (sa->sa_nreg < 8) {
298 1.1 pk printf("%s: only %d register sets\n",
299 1.1 pk self->dv_xname, sa->sa_nreg);
300 1.1 pk return;
301 1.1 pk }
302 1.1 pk
303 1.1 pk if (sa->sa_nintr != 2) {
304 1.1 pk printf("%s: expect 2 interrupt Sbus levels; got %d\n",
305 1.1 pk self->dv_xname, sa->sa_nintr);
306 1.1 pk return;
307 1.1 pk }
308 1.1 pk
309 1.9 pk #define STP4020_BANK_PROM 0
310 1.1 pk #define STP4020_BANK_CTRL 4
311 1.1 pk for (i = 0; i < 8; i++) {
312 1.10 pk
313 1.1 pk /*
314 1.1 pk * STP4020 Register address map:
315 1.1 pk * bank 0: Forth PROM
316 1.1 pk * banks 1-3: socket 0, windows 0-2
317 1.1 pk * bank 4: control registers
318 1.1 pk * banks 5-7: socket 1, windows 0-2
319 1.1 pk */
320 1.10 pk
321 1.9 pk if (i == STP4020_BANK_PROM)
322 1.9 pk /* Skip the PROM */
323 1.9 pk continue;
324 1.9 pk
325 1.1 pk if (sbus_bus_map(sa->sa_bustag,
326 1.1 pk sa->sa_reg[i].sbr_slot,
327 1.1 pk sa->sa_reg[i].sbr_offset,
328 1.1 pk sa->sa_reg[i].sbr_size,
329 1.1 pk BUS_SPACE_MAP_LINEAR, 0,
330 1.10 pk &bh) != 0) {
331 1.1 pk printf("%s: attach: cannot map registers\n",
332 1.1 pk self->dv_xname);
333 1.1 pk return;
334 1.1 pk }
335 1.10 pk
336 1.10 pk if (i == STP4020_BANK_CTRL) {
337 1.10 pk /*
338 1.10 pk * Copy tag and handle to both socket structures
339 1.10 pk * for easy access in control/status IO functions.
340 1.10 pk */
341 1.10 pk sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
342 1.15 martin printf("%s: control registers = %p\n", sc->sc_dev.dv_xname, (void*)bh);
343 1.10 pk } else if (i < STP4020_BANK_CTRL) {
344 1.10 pk /* banks 1-3 */
345 1.10 pk sc->sc_socks[0].windows[i-1].winaddr = bh;
346 1.15 martin printf("%s [0]: window[%d].winaddr = %p\n", sc->sc_dev.dv_xname, i-1, (void*)bh);
347 1.10 pk } else {
348 1.10 pk /* banks 5-7 */
349 1.10 pk sc->sc_socks[1].windows[i-5].winaddr = bh;
350 1.15 martin printf("%s [1]: window[%d].winaddr = %p\n", sc->sc_dev.dv_xname, i-5, (void*)bh);
351 1.10 pk }
352 1.1 pk }
353 1.1 pk
354 1.1 pk sbus_establish(&sc->sc_sd, &sc->sc_dev);
355 1.1 pk
356 1.1 pk /*
357 1.1 pk * We get to use two SBus interrupt levels.
358 1.1 pk * The higher level we use for status change interrupts;
359 1.1 pk * the lower level for PC card I/O.
360 1.1 pk */
361 1.7 pk if (sa->sa_nintr != 0) {
362 1.7 pk bus_intr_establish(sa->sa_bustag, sa->sa_intr[1].sbi_pri,
363 1.11 pk IPL_NONE, 0, stp4020_statintr, sc);
364 1.1 pk
365 1.7 pk bus_intr_establish(sa->sa_bustag, sa->sa_intr[0].sbi_pri,
366 1.11 pk IPL_NONE, 0, stp4020_iointr, sc);
367 1.7 pk }
368 1.1 pk
369 1.1 pk rev = stp4020_rd_sockctl(&sc->sc_socks[0], STP4020_ISR1_IDX) &
370 1.1 pk STP4020_ISR1_REV_M;
371 1.1 pk printf(": rev %x\n", rev);
372 1.1 pk
373 1.1 pk sc->sc_pct = (pcmcia_chipset_tag_t)&stp4020_functions;
374 1.1 pk
375 1.1 pk /*
376 1.1 pk * Arrange that a kernel thread be created to handle
377 1.1 pk * insert/removal events.
378 1.1 pk */
379 1.1 pk SIMPLEQ_INIT(&sc->events);
380 1.5 thorpej kthread_create(stp4020_create_event_thread, sc);
381 1.1 pk
382 1.1 pk for (i = 0; i < STP4020_NSOCK; i++) {
383 1.1 pk struct stp4020_socket *h = &sc->sc_socks[i];
384 1.1 pk h->sock = i;
385 1.1 pk h->sc = sc;
386 1.6 pk #ifdef STP4020_DEBUG
387 1.6 pk stp4020_dump_regs(h);
388 1.6 pk #endif
389 1.1 pk stp4020_attach_socket(h);
390 1.1 pk }
391 1.1 pk }
392 1.1 pk
393 1.1 pk void
394 1.1 pk stp4020_attach_socket(h)
395 1.1 pk struct stp4020_socket *h;
396 1.1 pk {
397 1.1 pk struct pcmciabus_attach_args paa;
398 1.1 pk int v;
399 1.1 pk
400 1.15 martin /* Map all three windows */
401 1.15 martin stp4020_map_window(h, STP_WIN_ATTR);
402 1.15 martin stp4020_map_window(h, STP_WIN_MEM);
403 1.15 martin stp4020_map_window(h, STP_WIN_IO);
404 1.1 pk
405 1.1 pk /* Configure one pcmcia device per socket */
406 1.9 pk paa.paa_busname = "pcmcia";
407 1.1 pk paa.pct = (pcmcia_chipset_tag_t)h->sc->sc_pct;
408 1.1 pk paa.pch = (pcmcia_chipset_handle_t)h;
409 1.1 pk paa.iobase = 0;
410 1.15 martin paa.iosize = STP4020_WINDOW_SIZE;
411 1.1 pk
412 1.1 pk h->pcmcia = config_found(&h->sc->sc_dev, &paa, stp4020print);
413 1.1 pk
414 1.1 pk if (h->pcmcia == NULL)
415 1.1 pk return;
416 1.1 pk
417 1.1 pk /*
418 1.1 pk * There's actually a pcmcia bus attached; initialize the slot.
419 1.1 pk */
420 1.1 pk
421 1.1 pk /*
422 1.1 pk * Enable socket status change interrupts.
423 1.1 pk * We use SB_INT[1] for status change interrupts.
424 1.1 pk */
425 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
426 1.1 pk v |= STP4020_ICR0_ALL_STATUS_IE | STP4020_ICR0_SCILVL_SB1;
427 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
428 1.1 pk
429 1.1 pk /* Get live status bits from ISR0 */
430 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
431 1.1 pk if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0)
432 1.1 pk return;
433 1.1 pk
434 1.1 pk pcmcia_card_attach(h->pcmcia);
435 1.1 pk h->flags |= STP4020_SOCKET_BUSY;
436 1.1 pk }
437 1.1 pk
438 1.1 pk
439 1.1 pk /*
440 1.1 pk * Deferred thread creation callback.
441 1.1 pk */
442 1.1 pk void
443 1.1 pk stp4020_create_event_thread(arg)
444 1.1 pk void *arg;
445 1.1 pk {
446 1.1 pk struct stp4020_softc *sc = arg;
447 1.1 pk const char *name = sc->sc_dev.dv_xname;
448 1.1 pk
449 1.5 thorpej if (kthread_create1(stp4020_event_thread, sc, &sc->event_thread,
450 1.1 pk "%s", name)) {
451 1.1 pk panic("%s: unable to create event thread", name);
452 1.1 pk }
453 1.1 pk }
454 1.1 pk
455 1.1 pk /*
456 1.1 pk * The actual event handling thread.
457 1.1 pk */
458 1.1 pk void
459 1.1 pk stp4020_event_thread(arg)
460 1.1 pk void *arg;
461 1.1 pk {
462 1.1 pk struct stp4020_softc *sc = arg;
463 1.1 pk struct stp4020_event *e;
464 1.1 pk int s;
465 1.1 pk
466 1.1 pk while (1) {
467 1.1 pk struct stp4020_socket *h;
468 1.1 pk int n;
469 1.1 pk
470 1.1 pk s = splhigh();
471 1.1 pk if ((e = SIMPLEQ_FIRST(&sc->events)) == NULL) {
472 1.1 pk splx(s);
473 1.1 pk (void)tsleep(&sc->events, PWAIT, "pcicev", 0);
474 1.1 pk continue;
475 1.1 pk }
476 1.1 pk SIMPLEQ_REMOVE_HEAD(&sc->events, e, se_q);
477 1.1 pk splx(s);
478 1.1 pk
479 1.1 pk n = e->se_sock;
480 1.1 pk if (n < 0 || n >= STP4020_NSOCK)
481 1.1 pk panic("stp4020_event_thread: wayward socket number %d",
482 1.1 pk n);
483 1.1 pk
484 1.1 pk h = &sc->sc_socks[n];
485 1.1 pk switch (e->se_type) {
486 1.1 pk case STP4020_EVENT_INSERTION:
487 1.15 martin printf("pcmcia_card_attach for slot #%d\n", n);
488 1.1 pk pcmcia_card_attach(h->pcmcia);
489 1.1 pk break;
490 1.1 pk case STP4020_EVENT_REMOVAL:
491 1.15 martin printf("pcmcia_card_detach for slot #%d\n", n);
492 1.1 pk pcmcia_card_detach(h->pcmcia, DETACH_FORCE);
493 1.1 pk break;
494 1.1 pk default:
495 1.1 pk panic("stp4020_event_thread: unknown event type %d",
496 1.1 pk e->se_type);
497 1.1 pk }
498 1.1 pk free(e, M_TEMP);
499 1.1 pk }
500 1.1 pk }
501 1.1 pk
502 1.1 pk void
503 1.1 pk stp4020_queue_event(sc, sock, event)
504 1.1 pk struct stp4020_softc *sc;
505 1.1 pk int sock, event;
506 1.1 pk {
507 1.1 pk struct stp4020_event *e;
508 1.1 pk int s;
509 1.1 pk
510 1.1 pk e = malloc(sizeof(*e), M_TEMP, M_NOWAIT);
511 1.1 pk if (e == NULL)
512 1.1 pk panic("stp4020_queue_event: can't allocate event");
513 1.1 pk
514 1.1 pk e->se_type = event;
515 1.1 pk e->se_sock = sock;
516 1.1 pk s = splhigh();
517 1.1 pk SIMPLEQ_INSERT_TAIL(&sc->events, e, se_q);
518 1.1 pk splx(s);
519 1.1 pk wakeup(&sc->events);
520 1.1 pk }
521 1.1 pk
522 1.1 pk int
523 1.1 pk stp4020_statintr(arg)
524 1.1 pk void *arg;
525 1.1 pk {
526 1.1 pk struct stp4020_softc *sc = arg;
527 1.1 pk int i, r = 0;
528 1.1 pk
529 1.1 pk /*
530 1.1 pk * Check each socket for pending requests.
531 1.1 pk */
532 1.1 pk for (i = 0 ; i < STP4020_NSOCK; i++) {
533 1.1 pk struct stp4020_socket *h;
534 1.1 pk int v;
535 1.1 pk
536 1.1 pk h = &sc->sc_socks[i];
537 1.1 pk
538 1.1 pk /* Read socket's ISR0 for the interrupt status bits */
539 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
540 1.1 pk
541 1.1 pk #ifdef STP4020_DEBUG
542 1.1 pk if (stp4020_debug != 0) {
543 1.1 pk char bits[64];
544 1.1 pk bitmask_snprintf(v, STP4020_ISR0_IOBITS,
545 1.1 pk bits, sizeof(bits));
546 1.1 pk printf("stp4020_statintr: ISR0=%s\n", bits);
547 1.1 pk }
548 1.1 pk #endif
549 1.1 pk
550 1.1 pk /* Ack all interrupts at once */
551 1.1 pk stp4020_wr_sockctl(h, STP4020_ISR0_IDX,
552 1.1 pk STP4020_ISR0_ALL_STATUS_IRQ);
553 1.1 pk
554 1.1 pk if ((v & STP4020_ISR0_CDCHG) != 0) {
555 1.1 pk /*
556 1.1 pk * Card status change detect
557 1.1 pk */
558 1.1 pk if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) != 0){
559 1.1 pk if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
560 1.1 pk stp4020_queue_event(sc, i,
561 1.1 pk STP4020_EVENT_INSERTION);
562 1.1 pk h->flags |= STP4020_SOCKET_BUSY;
563 1.1 pk }
564 1.1 pk }
565 1.1 pk if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0){
566 1.1 pk if ((h->flags & STP4020_SOCKET_BUSY) != 0) {
567 1.1 pk stp4020_queue_event(sc, i,
568 1.1 pk STP4020_EVENT_REMOVAL);
569 1.1 pk h->flags &= ~STP4020_SOCKET_BUSY;
570 1.1 pk }
571 1.1 pk }
572 1.1 pk }
573 1.1 pk
574 1.1 pk /* XXX - a bunch of unhandled conditions */
575 1.1 pk if ((v & STP4020_ISR0_BVD1CHG) != 0) {
576 1.1 pk printf("stp4020[%d]: Battery change 1\n", h->sock);
577 1.15 martin r = 1;
578 1.1 pk }
579 1.1 pk
580 1.1 pk if ((v & STP4020_ISR0_BVD2CHG) != 0) {
581 1.1 pk printf("stp4020[%d]: Battery change 2\n", h->sock);
582 1.15 martin r = 1;
583 1.1 pk }
584 1.1 pk
585 1.1 pk if ((v & STP4020_ISR0_RDYCHG) != 0) {
586 1.1 pk printf("stp4020[%d]: Ready/Busy change\n", h->sock);
587 1.15 martin r = 1;
588 1.1 pk }
589 1.1 pk
590 1.1 pk if ((v & STP4020_ISR0_WPCHG) != 0) {
591 1.1 pk printf("stp4020[%d]: Write protect change\n", h->sock);
592 1.15 martin r = 1;
593 1.1 pk }
594 1.1 pk
595 1.1 pk if ((v & STP4020_ISR0_PCTO) != 0) {
596 1.1 pk printf("stp4020[%d]: Card access timeout\n", h->sock);
597 1.15 martin r = 1;
598 1.1 pk }
599 1.1 pk }
600 1.1 pk
601 1.1 pk return (r);
602 1.1 pk }
603 1.1 pk
604 1.15 martin static int
605 1.15 martin dummy_splraise(int ipl)
606 1.15 martin {
607 1.15 martin switch(ipl) {
608 1.15 martin case IPL_SOFTCLOCK:
609 1.15 martin return splsoftclock();
610 1.15 martin case IPL_BIO:
611 1.15 martin return splbio();
612 1.15 martin case IPL_NET:
613 1.15 martin return splnet();
614 1.15 martin case IPL_SOFTSERIAL:
615 1.15 martin return splserial(); /* XXX ? */
616 1.15 martin case IPL_TTY:
617 1.15 martin return spltty();
618 1.15 martin case IPL_IMP:
619 1.15 martin return splhigh(); /* XXX ? */
620 1.15 martin case IPL_AUDIO:
621 1.15 martin return splaudio();
622 1.15 martin case IPL_CLOCK:
623 1.15 martin return splclock();
624 1.15 martin case IPL_SERIAL:
625 1.15 martin return splserial();
626 1.15 martin case IPL_HIGH:
627 1.15 martin return splhigh();
628 1.15 martin }
629 1.15 martin panic("illegal pcmcia interrupt level");
630 1.15 martin }
631 1.15 martin
632 1.1 pk int
633 1.1 pk stp4020_iointr(arg)
634 1.1 pk void *arg;
635 1.1 pk {
636 1.1 pk struct stp4020_softc *sc = arg;
637 1.15 martin int i, r = 0, s;
638 1.1 pk
639 1.1 pk /*
640 1.1 pk * Check each socket for pending requests.
641 1.1 pk */
642 1.1 pk for (i = 0 ; i < STP4020_NSOCK; i++) {
643 1.1 pk struct stp4020_socket *h;
644 1.1 pk int v;
645 1.1 pk
646 1.1 pk h = &sc->sc_socks[i];
647 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
648 1.1 pk
649 1.1 pk if ((v & STP4020_ISR0_IOINT) != 0) {
650 1.1 pk /* It's a card interrupt */
651 1.1 pk if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
652 1.1 pk printf("stp4020[%d]: spurious interrupt?\n",
653 1.1 pk h->sock);
654 1.1 pk continue;
655 1.1 pk }
656 1.1 pk /* Call card handler, if any */
657 1.15 martin if (h->intrhandler != NULL) {
658 1.15 martin s = dummy_splraise(h->ipl);
659 1.1 pk r |= (*h->intrhandler)(h->intrarg);
660 1.15 martin splx(s);
661 1.15 martin }
662 1.1 pk }
663 1.1 pk
664 1.1 pk }
665 1.15 martin if (r)
666 1.15 martin printf("stp4020_iointr() -> %d\n", r);
667 1.1 pk
668 1.1 pk return (r);
669 1.1 pk }
670 1.1 pk
671 1.15 martin static void
672 1.15 martin stp4020_map_window(struct stp4020_socket *h, int win)
673 1.1 pk {
674 1.15 martin int v;
675 1.15 martin
676 1.15 martin /*
677 1.15 martin * XXX - Need to calculate these, but don't know how.
678 1.15 martin * For now use maximal values.
679 1.15 martin */
680 1.15 martin int length = STP4020_WCR0_CMDLNG_M >> STP4020_WCR0_CMDLNG_S;
681 1.15 martin int delay = STP4020_WCR0_CMDDLY_M >> STP4020_WCR0_CMDDLY_S;
682 1.15 martin
683 1.15 martin /*
684 1.15 martin * XXX - May need to configure the WAIT delayes in CR1 too,
685 1.15 martin * but right now it looks like we never cause waits - so
686 1.15 martin * why bother.
687 1.15 martin */
688 1.1 pk
689 1.1 pk /*
690 1.15 martin * Fill in the Address Space Select and Base Address
691 1.15 martin * fields of this windows control register 0.
692 1.1 pk */
693 1.15 martin v = (delay << STP4020_WCR0_CMDDLY_S) | (length << STP4020_WCR0_CMDLNG_S);
694 1.15 martin switch (win) {
695 1.15 martin case STP_WIN_ATTR:
696 1.15 martin v |= STP4020_WCR0_ASPSEL_AM;
697 1.15 martin break;
698 1.15 martin case STP_WIN_MEM:
699 1.15 martin v |= STP4020_WCR0_ASPSEL_CM;
700 1.15 martin break;
701 1.15 martin case STP_WIN_IO:
702 1.15 martin v |= STP4020_WCR0_ASPSEL_IO;
703 1.15 martin break;
704 1.15 martin }
705 1.15 martin v |= (STP4020_ADDR2PAGE(0) & STP4020_WCR0_BASE_M);
706 1.15 martin printf("%s [%d]: win %d, WCR0 <- 0x%x\n",
707 1.15 martin h->sc->sc_dev.dv_xname, h->sock, win, v);
708 1.15 martin stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
709 1.1 pk
710 1.15 martin if (win == STP_WIN_ATTR) {
711 1.15 martin int i;
712 1.15 martin u_int8_t v;
713 1.15 martin for (i = 0; i < 64; i++) {
714 1.15 martin v = bus_space_read_1(h->tag, h->windows[win].winaddr, i);
715 1.15 martin printf("0x%02x ", v);
716 1.15 martin if (i % 16 == 15) printf("\n");
717 1.1 pk }
718 1.1 pk }
719 1.15 martin }
720 1.1 pk
721 1.15 martin int
722 1.15 martin stp4020_chip_mem_alloc(pch, size, pcmhp)
723 1.15 martin pcmcia_chipset_handle_t pch;
724 1.15 martin bus_size_t size;
725 1.15 martin struct pcmcia_mem_handle *pcmhp;
726 1.15 martin {
727 1.15 martin struct stp4020_socket *h = (struct stp4020_socket *)pch;
728 1.1 pk
729 1.15 martin /* we can not do much here, defere work to _mem_map */
730 1.15 martin pcmhp->memt = h->tag;
731 1.1 pk pcmhp->size = size;
732 1.1 pk
733 1.1 pk return (0);
734 1.1 pk }
735 1.1 pk
736 1.1 pk void
737 1.1 pk stp4020_chip_mem_free(pch, pcmhp)
738 1.1 pk pcmcia_chipset_handle_t pch;
739 1.1 pk struct pcmcia_mem_handle *pcmhp;
740 1.1 pk {
741 1.1 pk }
742 1.1 pk
743 1.1 pk int
744 1.1 pk stp4020_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
745 1.1 pk pcmcia_chipset_handle_t pch;
746 1.1 pk int kind;
747 1.1 pk bus_addr_t card_addr;
748 1.1 pk bus_size_t size;
749 1.1 pk struct pcmcia_mem_handle *pcmhp;
750 1.14 soren bus_size_t *offsetp;
751 1.1 pk int *windowp;
752 1.1 pk {
753 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
754 1.15 martin int win = (kind&PCMCIA_MEM_ATTR)? STP_WIN_ATTR : STP_WIN_MEM;
755 1.8 joda
756 1.15 martin pcmhp->memt = h->tag;
757 1.15 martin bus_space_subregion(h->tag, h->windows[win].winaddr, card_addr, size, &pcmhp->memh);
758 1.15 martin printf("%s [%d]: win=%d, stp4020_chip_mem_map -> %p\n", h->sc->sc_dev.dv_xname, h->sock, win, (void*)pcmhp->memh);
759 1.15 martin *offsetp = 0;
760 1.15 martin *windowp = 0;
761 1.1 pk
762 1.1 pk return (0);
763 1.1 pk }
764 1.1 pk
765 1.1 pk void
766 1.1 pk stp4020_chip_mem_unmap(pch, win)
767 1.1 pk pcmcia_chipset_handle_t pch;
768 1.1 pk int win;
769 1.1 pk {
770 1.1 pk }
771 1.1 pk
772 1.1 pk int
773 1.1 pk stp4020_chip_io_alloc(pch, start, size, align, pcihp)
774 1.1 pk pcmcia_chipset_handle_t pch;
775 1.1 pk bus_addr_t start;
776 1.1 pk bus_size_t size;
777 1.1 pk bus_size_t align;
778 1.1 pk struct pcmcia_io_handle *pcihp;
779 1.1 pk {
780 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
781 1.1 pk
782 1.1 pk pcihp->iot = h->tag;
783 1.15 martin pcihp->ioh = h->windows[STP_WIN_IO].winaddr;
784 1.15 martin return 0;
785 1.1 pk }
786 1.1 pk
787 1.1 pk void
788 1.1 pk stp4020_chip_io_free(pch, pcihp)
789 1.1 pk pcmcia_chipset_handle_t pch;
790 1.1 pk struct pcmcia_io_handle *pcihp;
791 1.1 pk {
792 1.1 pk }
793 1.1 pk
794 1.1 pk int
795 1.1 pk stp4020_chip_io_map(pch, width, offset, size, pcihp, windowp)
796 1.1 pk pcmcia_chipset_handle_t pch;
797 1.1 pk int width;
798 1.1 pk bus_addr_t offset;
799 1.1 pk bus_size_t size;
800 1.1 pk struct pcmcia_io_handle *pcihp;
801 1.1 pk int *windowp;
802 1.1 pk {
803 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
804 1.1 pk
805 1.15 martin pcihp->iot = h->tag;
806 1.15 martin bus_space_subregion(h->tag, h->windows[STP_WIN_IO].winaddr, offset, size, &pcihp->ioh);
807 1.15 martin *windowp = 0;
808 1.15 martin return 0;
809 1.1 pk }
810 1.1 pk
811 1.1 pk void
812 1.1 pk stp4020_chip_io_unmap(pch, win)
813 1.1 pk pcmcia_chipset_handle_t pch;
814 1.1 pk int win;
815 1.1 pk {
816 1.1 pk }
817 1.1 pk
818 1.1 pk void
819 1.1 pk stp4020_chip_socket_enable(pch)
820 1.1 pk pcmcia_chipset_handle_t pch;
821 1.1 pk {
822 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
823 1.1 pk int i, v, cardtype;
824 1.1 pk
825 1.15 martin printf("%s: powering down the socket\n", h->sc->sc_dev.dv_xname);
826 1.15 martin
827 1.1 pk /* this bit is mostly stolen from pcic_attach_card */
828 1.1 pk
829 1.1 pk /* Power down the socket to reset it, clear the card reset pin */
830 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
831 1.1 pk v &= ~STP4020_ICR1_MSTPWR;
832 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
833 1.1 pk
834 1.1 pk /*
835 1.1 pk * wait 300ms until power fails (Tpf). Then, wait 100ms since
836 1.1 pk * we are changing Vcc (Toff).
837 1.1 pk */
838 1.1 pk stp4020_delay((300 + 100) * 1000);
839 1.1 pk
840 1.1 pk /* Power up the socket */
841 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
842 1.1 pk v |= STP4020_ICR1_MSTPWR;
843 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
844 1.1 pk
845 1.1 pk /*
846 1.1 pk * wait 100ms until power raise (Tpr) and 20ms to become
847 1.1 pk * stable (Tsu(Vcc)).
848 1.1 pk */
849 1.1 pk stp4020_delay((100 + 20) * 1000);
850 1.1 pk
851 1.1 pk v |= STP4020_ICR1_PCIFOE;
852 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
853 1.1 pk
854 1.1 pk /*
855 1.1 pk * hold RESET at least 10us.
856 1.1 pk */
857 1.1 pk delay(10);
858 1.1 pk
859 1.1 pk /* Clear reset flag */
860 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
861 1.1 pk v &= ~STP4020_ICR0_RESET;
862 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
863 1.1 pk
864 1.1 pk /* wait 20ms as per pc card standard (r2.01) section 4.3.6 */
865 1.1 pk stp4020_delay(20000);
866 1.1 pk
867 1.1 pk /* Wait for the chip to finish initializing (5 seconds max) */
868 1.1 pk for (i = 10000; i > 0; i--) {
869 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
870 1.1 pk if ((v & STP4020_ISR0_RDYST) != 0)
871 1.1 pk break;
872 1.1 pk delay(500);
873 1.1 pk }
874 1.1 pk if (i <= 0) {
875 1.1 pk char bits[64];
876 1.1 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
877 1.1 pk STP4020_ISR0_IOBITS, bits, sizeof(bits));
878 1.1 pk printf("stp4020_chip_socket_enable: not ready: status %s\n",
879 1.1 pk bits);
880 1.1 pk return;
881 1.1 pk }
882 1.15 martin printf("%s: power up complete, card got ready\n", h->sc->sc_dev.dv_xname);
883 1.1 pk
884 1.1 pk /* Set the card type */
885 1.1 pk cardtype = pcmcia_card_gettype(h->pcmcia);
886 1.1 pk
887 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
888 1.1 pk v &= ~STP4020_ICR0_IFTYPE;
889 1.1 pk v |= (cardtype == PCMCIA_IFTYPE_IO)
890 1.1 pk ? STP4020_ICR0_IFTYPE_IO
891 1.1 pk : STP4020_ICR0_IFTYPE_MEM;
892 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
893 1.1 pk
894 1.1 pk DPRINTF(("%s: stp4020_chip_socket_enable %02x cardtype %s\n",
895 1.1 pk h->sc->sc_dev.dv_xname, h->sock,
896 1.1 pk ((cardtype == PCMCIA_IFTYPE_IO) ? "io" : "mem")));
897 1.1 pk
898 1.1 pk /*
899 1.1 pk * Enable socket I/O interrupts.
900 1.1 pk * We use level SB_INT[0] for I/O interrupts.
901 1.1 pk */
902 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
903 1.1 pk v &= ~STP4020_ICR0_IOILVL;
904 1.1 pk v |= STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL_SB0;
905 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
906 1.1 pk
907 1.1 pk /* Reinstall all the memory and io mappings */
908 1.15 martin /* XXX - do we need that? */
909 1.1 pk
910 1.15 martin {
911 1.15 martin int i;
912 1.15 martin u_int8_t v;
913 1.15 martin for (i = 0; i < 64; i++) {
914 1.15 martin v = bus_space_read_1(h->tag, h->windows[STP_WIN_ATTR].winaddr, i);
915 1.15 martin printf("0x%02x ", v);
916 1.15 martin if (i % 16 == 15) printf("\n");
917 1.15 martin }
918 1.15 martin }
919 1.1 pk }
920 1.1 pk
921 1.1 pk void
922 1.1 pk stp4020_chip_socket_disable(pch)
923 1.1 pk pcmcia_chipset_handle_t pch;
924 1.1 pk {
925 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
926 1.1 pk int v;
927 1.1 pk
928 1.1 pk DPRINTF(("stp4020_chip_socket_disable\n"));
929 1.1 pk
930 1.1 pk /*
931 1.1 pk * Disable socket I/O interrupts.
932 1.1 pk */
933 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
934 1.1 pk v &= ~(STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL);
935 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
936 1.1 pk
937 1.1 pk /* Power down the socket */
938 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
939 1.1 pk v &= ~STP4020_ICR1_MSTPWR;
940 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
941 1.1 pk
942 1.1 pk /*
943 1.1 pk * wait 300ms until power fails (Tpf).
944 1.1 pk */
945 1.1 pk stp4020_delay(300 * 1000);
946 1.1 pk }
947 1.1 pk
948 1.1 pk void *
949 1.1 pk stp4020_chip_intr_establish(pch, pf, ipl, handler, arg)
950 1.1 pk pcmcia_chipset_handle_t pch;
951 1.1 pk struct pcmcia_function *pf;
952 1.1 pk int ipl;
953 1.1 pk int (*handler) __P((void *));
954 1.1 pk void *arg;
955 1.1 pk {
956 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
957 1.1 pk
958 1.1 pk h->intrhandler = handler;
959 1.1 pk h->intrarg = arg;
960 1.1 pk h->ipl = ipl;
961 1.1 pk return (NULL);
962 1.1 pk }
963 1.1 pk
964 1.1 pk void
965 1.1 pk stp4020_chip_intr_disestablish(pch, ih)
966 1.1 pk pcmcia_chipset_handle_t pch;
967 1.1 pk void *ih;
968 1.1 pk {
969 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
970 1.1 pk
971 1.1 pk h->intrhandler = NULL;
972 1.1 pk h->intrarg = NULL;
973 1.1 pk }
974 1.1 pk
975 1.1 pk /*
976 1.1 pk * Delay and possibly yield CPU.
977 1.1 pk * XXX - assumes a context
978 1.1 pk */
979 1.1 pk void
980 1.1 pk stp4020_delay(ms)
981 1.1 pk unsigned int ms;
982 1.1 pk {
983 1.1 pk unsigned int ticks;
984 1.1 pk extern int cold;
985 1.1 pk
986 1.1 pk /* Convert to ticks */
987 1.1 pk ticks = (ms * hz ) / 1000000;
988 1.1 pk
989 1.1 pk if (cold || ticks == 0) {
990 1.1 pk delay(ms);
991 1.1 pk return;
992 1.1 pk }
993 1.1 pk
994 1.1 pk #ifdef DIAGNOSTIC
995 1.1 pk if (ticks > 60*hz)
996 1.1 pk panic("stp4020: preposterous delay: %u", ticks);
997 1.1 pk #endif
998 1.1 pk tsleep(&ticks, 0, "stp4020_delay", ticks);
999 1.1 pk }
1000 1.6 pk
1001 1.6 pk #ifdef STP4020_DEBUG
1002 1.6 pk void
1003 1.6 pk stp4020_dump_regs(h)
1004 1.6 pk struct stp4020_socket *h;
1005 1.6 pk {
1006 1.6 pk char bits[64];
1007 1.6 pk /*
1008 1.6 pk * Dump control and status registers.
1009 1.6 pk */
1010 1.6 pk printf("socket[%d] registers:\n", h->sock);
1011 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
1012 1.6 pk STP4020_ICR0_BITS, bits, sizeof(bits));
1013 1.6 pk printf("\tICR0=%s\n", bits);
1014 1.6 pk
1015 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
1016 1.6 pk STP4020_ICR1_BITS, bits, sizeof(bits));
1017 1.6 pk printf("\tICR1=%s\n", bits);
1018 1.6 pk
1019 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
1020 1.6 pk STP4020_ISR0_IOBITS, bits, sizeof(bits));
1021 1.6 pk printf("\tISR0=%s\n", bits);
1022 1.6 pk
1023 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
1024 1.6 pk STP4020_ISR1_BITS, bits, sizeof(bits));
1025 1.6 pk printf("\tISR1=%s\n", bits);
1026 1.6 pk }
1027 1.6 pk #endif /* STP4020_DEBUG */
1028