stp4020.c revision 1.29 1 1.29 pk /* $NetBSD: stp4020.c,v 1.29 2002/12/10 13:44:48 pk 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.29 pk __KERNEL_RCSID(0, "$NetBSD: stp4020.c,v 1.29 2002/12/10 13:44:48 pk 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.28 martin int sbus_intno; /* Do we use first (0) or second (1)
108 1.28 martin interrupt? */
109 1.1 pk bus_space_tag_t tag; /* socket control space */
110 1.1 pk bus_space_handle_t regs; /* */
111 1.1 pk struct device *pcmcia; /* Associated PCMCIA device */
112 1.1 pk int (*intrhandler) /* Card driver interrupt handler */
113 1.1 pk __P((void *));
114 1.1 pk void *intrarg; /* Card interrupt handler argument */
115 1.1 pk int ipl; /* Interrupt level suggested by card */
116 1.1 pk struct {
117 1.1 pk bus_space_handle_t winaddr;/* this window's address */
118 1.1 pk } windows[STP4020_NWIN];
119 1.1 pk
120 1.1 pk };
121 1.1 pk
122 1.1 pk struct stp4020_softc {
123 1.1 pk struct device sc_dev; /* Base device */
124 1.1 pk struct sbusdev sc_sd; /* SBus device */
125 1.1 pk bus_space_tag_t sc_bustag;
126 1.1 pk bus_dma_tag_t sc_dmatag;
127 1.1 pk pcmcia_chipset_tag_t sc_pct; /* Chipset methods */
128 1.1 pk
129 1.1 pk struct proc *event_thread; /* event handling thread */
130 1.1 pk SIMPLEQ_HEAD(, stp4020_event) events; /* Pending events for thread */
131 1.1 pk
132 1.1 pk struct stp4020_socket sc_socks[STP4020_NSOCK];
133 1.1 pk };
134 1.1 pk
135 1.1 pk
136 1.1 pk static int stp4020print __P((void *, const char *));
137 1.1 pk static int stp4020match __P((struct device *, struct cfdata *, void *));
138 1.1 pk static void stp4020attach __P((struct device *, struct device *, void *));
139 1.28 martin static int stp4020_intr __P((void *));
140 1.16 martin static void stp4020_map_window(struct stp4020_socket *h, int win, int speed);
141 1.16 martin static void stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay);
142 1.1 pk
143 1.26 thorpej CFATTACH_DECL(nell, sizeof(struct stp4020_softc),
144 1.27 thorpej stp4020match, stp4020attach, NULL, NULL);
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.16 martin void stp4020_attach_socket __P((struct stp4020_socket *, int));
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.28 martin int i, sbus_intno;
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.28 martin /* lsb of our config flags decides which interrupt we use */
290 1.28 martin sbus_intno = sc->sc_dev.dv_cfdata->cf_flags & 1;
291 1.28 martin
292 1.1 pk /* Transfer bus tags */
293 1.1 pk sc->sc_bustag = sa->sa_bustag;
294 1.1 pk sc->sc_dmatag = sa->sa_dmatag;
295 1.1 pk
296 1.1 pk /* Set up per-socket static initialization */
297 1.1 pk sc->sc_socks[0].sc = sc->sc_socks[1].sc = sc;
298 1.1 pk sc->sc_socks[0].tag = sc->sc_socks[1].tag = sa->sa_bustag;
299 1.28 martin sc->sc_socks[0].sbus_intno =
300 1.28 martin sc->sc_socks[1].sbus_intno = sbus_intno;
301 1.1 pk
302 1.9 pk if (sa->sa_nreg < 8) {
303 1.1 pk printf("%s: only %d register sets\n",
304 1.1 pk self->dv_xname, sa->sa_nreg);
305 1.1 pk return;
306 1.1 pk }
307 1.1 pk
308 1.1 pk if (sa->sa_nintr != 2) {
309 1.1 pk printf("%s: expect 2 interrupt Sbus levels; got %d\n",
310 1.1 pk self->dv_xname, sa->sa_nintr);
311 1.1 pk return;
312 1.1 pk }
313 1.1 pk
314 1.9 pk #define STP4020_BANK_PROM 0
315 1.1 pk #define STP4020_BANK_CTRL 4
316 1.1 pk for (i = 0; i < 8; i++) {
317 1.10 pk
318 1.1 pk /*
319 1.1 pk * STP4020 Register address map:
320 1.1 pk * bank 0: Forth PROM
321 1.1 pk * banks 1-3: socket 0, windows 0-2
322 1.1 pk * bank 4: control registers
323 1.1 pk * banks 5-7: socket 1, windows 0-2
324 1.1 pk */
325 1.10 pk
326 1.9 pk if (i == STP4020_BANK_PROM)
327 1.9 pk /* Skip the PROM */
328 1.9 pk continue;
329 1.9 pk
330 1.1 pk if (sbus_bus_map(sa->sa_bustag,
331 1.24 martin sa->sa_reg[i].oa_space,
332 1.24 martin sa->sa_reg[i].oa_base,
333 1.24 martin sa->sa_reg[i].oa_size,
334 1.21 eeh 0, &bh) != 0) {
335 1.1 pk printf("%s: attach: cannot map registers\n",
336 1.1 pk self->dv_xname);
337 1.1 pk return;
338 1.1 pk }
339 1.10 pk
340 1.10 pk if (i == STP4020_BANK_CTRL) {
341 1.10 pk /*
342 1.10 pk * Copy tag and handle to both socket structures
343 1.10 pk * for easy access in control/status IO functions.
344 1.10 pk */
345 1.10 pk sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
346 1.10 pk } else if (i < STP4020_BANK_CTRL) {
347 1.10 pk /* banks 1-3 */
348 1.10 pk sc->sc_socks[0].windows[i-1].winaddr = bh;
349 1.10 pk } else {
350 1.10 pk /* banks 5-7 */
351 1.10 pk sc->sc_socks[1].windows[i-5].winaddr = bh;
352 1.10 pk }
353 1.1 pk }
354 1.1 pk
355 1.1 pk sbus_establish(&sc->sc_sd, &sc->sc_dev);
356 1.1 pk
357 1.28 martin /* We only use one interrupt level. */
358 1.28 martin if (sa->sa_nintr > sbus_intno) {
359 1.28 martin bus_intr_establish(sa->sa_bustag,
360 1.28 martin sa->sa_intr[sbus_intno].oi_pri,
361 1.29 pk IPL_NONE, stp4020_intr, sc);
362 1.7 pk }
363 1.1 pk
364 1.1 pk rev = stp4020_rd_sockctl(&sc->sc_socks[0], STP4020_ISR1_IDX) &
365 1.1 pk STP4020_ISR1_REV_M;
366 1.1 pk printf(": rev %x\n", rev);
367 1.1 pk
368 1.1 pk sc->sc_pct = (pcmcia_chipset_tag_t)&stp4020_functions;
369 1.1 pk
370 1.1 pk /*
371 1.1 pk * Arrange that a kernel thread be created to handle
372 1.1 pk * insert/removal events.
373 1.1 pk */
374 1.1 pk SIMPLEQ_INIT(&sc->events);
375 1.5 thorpej kthread_create(stp4020_create_event_thread, sc);
376 1.1 pk
377 1.1 pk for (i = 0; i < STP4020_NSOCK; i++) {
378 1.1 pk struct stp4020_socket *h = &sc->sc_socks[i];
379 1.1 pk h->sock = i;
380 1.1 pk h->sc = sc;
381 1.6 pk #ifdef STP4020_DEBUG
382 1.18 martin if (stp4020_debug)
383 1.18 martin stp4020_dump_regs(h);
384 1.6 pk #endif
385 1.16 martin stp4020_attach_socket(h, sa->sa_frequency);
386 1.1 pk }
387 1.1 pk }
388 1.1 pk
389 1.1 pk void
390 1.16 martin stp4020_attach_socket(h, speed)
391 1.1 pk struct stp4020_socket *h;
392 1.16 martin int speed;
393 1.1 pk {
394 1.1 pk struct pcmciabus_attach_args paa;
395 1.1 pk int v;
396 1.1 pk
397 1.15 martin /* Map all three windows */
398 1.16 martin stp4020_map_window(h, STP_WIN_ATTR, speed);
399 1.16 martin stp4020_map_window(h, STP_WIN_MEM, speed);
400 1.16 martin stp4020_map_window(h, STP_WIN_IO, speed);
401 1.1 pk
402 1.1 pk /* Configure one pcmcia device per socket */
403 1.9 pk paa.paa_busname = "pcmcia";
404 1.1 pk paa.pct = (pcmcia_chipset_tag_t)h->sc->sc_pct;
405 1.1 pk paa.pch = (pcmcia_chipset_handle_t)h;
406 1.1 pk paa.iobase = 0;
407 1.15 martin paa.iosize = STP4020_WINDOW_SIZE;
408 1.1 pk
409 1.1 pk h->pcmcia = config_found(&h->sc->sc_dev, &paa, stp4020print);
410 1.1 pk
411 1.1 pk if (h->pcmcia == NULL)
412 1.1 pk return;
413 1.1 pk
414 1.1 pk /*
415 1.1 pk * There's actually a pcmcia bus attached; initialize the slot.
416 1.1 pk */
417 1.1 pk
418 1.1 pk /*
419 1.16 martin * Clear things up before we enable status change interrupts.
420 1.16 martin * This seems to not be fully initialized by the PROM.
421 1.16 martin */
422 1.16 martin stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
423 1.16 martin stp4020_wr_sockctl(h, STP4020_ICR0_IDX, 0);
424 1.16 martin stp4020_wr_sockctl(h, STP4020_ISR1_IDX, 0x3fff);
425 1.16 martin stp4020_wr_sockctl(h, STP4020_ISR0_IDX, 0x3fff);
426 1.16 martin
427 1.16 martin /*
428 1.1 pk * Enable socket status change interrupts.
429 1.28 martin * We only use one common interrupt for status change
430 1.28 martin * and IO, to avoid locking issues.
431 1.1 pk */
432 1.28 martin v = STP4020_ICR0_ALL_STATUS_IE
433 1.28 martin | (h->sbus_intno ? STP4020_ICR0_SCILVL_SB1
434 1.28 martin : STP4020_ICR0_SCILVL_SB0);
435 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
436 1.1 pk
437 1.1 pk /* Get live status bits from ISR0 */
438 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
439 1.1 pk if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0)
440 1.1 pk return;
441 1.1 pk
442 1.1 pk pcmcia_card_attach(h->pcmcia);
443 1.1 pk h->flags |= STP4020_SOCKET_BUSY;
444 1.1 pk }
445 1.1 pk
446 1.1 pk
447 1.1 pk /*
448 1.1 pk * Deferred thread creation callback.
449 1.1 pk */
450 1.1 pk void
451 1.1 pk stp4020_create_event_thread(arg)
452 1.1 pk void *arg;
453 1.1 pk {
454 1.1 pk struct stp4020_softc *sc = arg;
455 1.1 pk const char *name = sc->sc_dev.dv_xname;
456 1.1 pk
457 1.5 thorpej if (kthread_create1(stp4020_event_thread, sc, &sc->event_thread,
458 1.1 pk "%s", name)) {
459 1.1 pk panic("%s: unable to create event thread", name);
460 1.1 pk }
461 1.1 pk }
462 1.1 pk
463 1.1 pk /*
464 1.1 pk * The actual event handling thread.
465 1.1 pk */
466 1.1 pk void
467 1.1 pk stp4020_event_thread(arg)
468 1.1 pk void *arg;
469 1.1 pk {
470 1.1 pk struct stp4020_softc *sc = arg;
471 1.1 pk struct stp4020_event *e;
472 1.1 pk int s;
473 1.1 pk
474 1.1 pk while (1) {
475 1.1 pk struct stp4020_socket *h;
476 1.1 pk int n;
477 1.1 pk
478 1.1 pk s = splhigh();
479 1.1 pk if ((e = SIMPLEQ_FIRST(&sc->events)) == NULL) {
480 1.1 pk splx(s);
481 1.1 pk (void)tsleep(&sc->events, PWAIT, "pcicev", 0);
482 1.1 pk continue;
483 1.1 pk }
484 1.23 lukem SIMPLEQ_REMOVE_HEAD(&sc->events, se_q);
485 1.1 pk splx(s);
486 1.1 pk
487 1.1 pk n = e->se_sock;
488 1.1 pk if (n < 0 || n >= STP4020_NSOCK)
489 1.1 pk panic("stp4020_event_thread: wayward socket number %d",
490 1.1 pk n);
491 1.1 pk
492 1.1 pk h = &sc->sc_socks[n];
493 1.1 pk switch (e->se_type) {
494 1.1 pk case STP4020_EVENT_INSERTION:
495 1.1 pk pcmcia_card_attach(h->pcmcia);
496 1.1 pk break;
497 1.1 pk case STP4020_EVENT_REMOVAL:
498 1.1 pk pcmcia_card_detach(h->pcmcia, DETACH_FORCE);
499 1.1 pk break;
500 1.1 pk default:
501 1.1 pk panic("stp4020_event_thread: unknown event type %d",
502 1.1 pk e->se_type);
503 1.1 pk }
504 1.1 pk free(e, M_TEMP);
505 1.1 pk }
506 1.1 pk }
507 1.1 pk
508 1.1 pk void
509 1.1 pk stp4020_queue_event(sc, sock, event)
510 1.1 pk struct stp4020_softc *sc;
511 1.1 pk int sock, event;
512 1.1 pk {
513 1.1 pk struct stp4020_event *e;
514 1.1 pk int s;
515 1.1 pk
516 1.1 pk e = malloc(sizeof(*e), M_TEMP, M_NOWAIT);
517 1.1 pk if (e == NULL)
518 1.1 pk panic("stp4020_queue_event: can't allocate event");
519 1.1 pk
520 1.1 pk e->se_type = event;
521 1.1 pk e->se_sock = sock;
522 1.1 pk s = splhigh();
523 1.1 pk SIMPLEQ_INSERT_TAIL(&sc->events, e, se_q);
524 1.1 pk splx(s);
525 1.1 pk wakeup(&sc->events);
526 1.1 pk }
527 1.1 pk
528 1.1 pk int
529 1.28 martin stp4020_intr(arg)
530 1.1 pk void *arg;
531 1.1 pk {
532 1.1 pk struct stp4020_softc *sc = arg;
533 1.28 martin int i, r = 0, cd_change = 0;
534 1.1 pk
535 1.1 pk /*
536 1.1 pk * Check each socket for pending requests.
537 1.1 pk */
538 1.1 pk for (i = 0 ; i < STP4020_NSOCK; i++) {
539 1.1 pk struct stp4020_socket *h;
540 1.28 martin int v;
541 1.1 pk
542 1.1 pk h = &sc->sc_socks[i];
543 1.28 martin v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
544 1.1 pk
545 1.28 martin /* Ack all interrupts at once */
546 1.28 martin stp4020_wr_sockctl(h, STP4020_ISR0_IDX, STP4020_ISR0_ALL_STATUS_IRQ);
547 1.1 pk
548 1.1 pk #ifdef STP4020_DEBUG
549 1.1 pk if (stp4020_debug != 0) {
550 1.1 pk char bits[64];
551 1.1 pk bitmask_snprintf(v, STP4020_ISR0_IOBITS,
552 1.1 pk bits, sizeof(bits));
553 1.1 pk printf("stp4020_statintr: ISR0=%s\n", bits);
554 1.1 pk }
555 1.1 pk #endif
556 1.1 pk
557 1.1 pk if ((v & STP4020_ISR0_CDCHG) != 0) {
558 1.1 pk /*
559 1.1 pk * Card status change detect
560 1.1 pk */
561 1.18 martin cd_change = 1;
562 1.18 martin r = 1;
563 1.18 martin if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)){
564 1.1 pk if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
565 1.1 pk stp4020_queue_event(sc, i,
566 1.1 pk STP4020_EVENT_INSERTION);
567 1.1 pk h->flags |= STP4020_SOCKET_BUSY;
568 1.1 pk }
569 1.1 pk }
570 1.1 pk if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0){
571 1.1 pk if ((h->flags & STP4020_SOCKET_BUSY) != 0) {
572 1.1 pk stp4020_queue_event(sc, i,
573 1.1 pk STP4020_EVENT_REMOVAL);
574 1.1 pk h->flags &= ~STP4020_SOCKET_BUSY;
575 1.1 pk }
576 1.1 pk }
577 1.1 pk }
578 1.28 martin
579 1.28 martin if ((v & STP4020_ISR0_IOINT) != 0) {
580 1.28 martin /* we can not deny this is ours, no matter what the
581 1.28 martin card driver says. */
582 1.28 martin r = 1;
583 1.28 martin
584 1.28 martin /* ack interrupt */
585 1.28 martin stp4020_wr_sockctl(h, STP4020_ISR0_IDX, v);
586 1.28 martin
587 1.28 martin /* It's a card interrupt */
588 1.28 martin if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
589 1.28 martin printf("stp4020[%d]: spurious interrupt?\n",
590 1.28 martin h->sock);
591 1.28 martin continue;
592 1.28 martin }
593 1.28 martin /* Call card handler, if any */
594 1.28 martin if (h->intrhandler != NULL) {
595 1.28 martin /*
596 1.28 martin * Called without handling of it's requested
597 1.28 martin * protection level (h->ipl), since we have
598 1.28 martin * no general queuing mechanism available
599 1.28 martin * right now and we know for sure we are
600 1.28 martin * running at a higher protection level
601 1.28 martin * right now.
602 1.28 martin */
603 1.28 martin (*h->intrhandler)(h->intrarg);
604 1.28 martin }
605 1.28 martin }
606 1.1 pk
607 1.18 martin /* informational messages */
608 1.1 pk if ((v & STP4020_ISR0_BVD1CHG) != 0) {
609 1.18 martin /* ignore if this is caused by insert or removal */
610 1.18 martin if (!cd_change)
611 1.18 martin printf("stp4020[%d]: Battery change 1\n", h->sock);
612 1.15 martin r = 1;
613 1.1 pk }
614 1.1 pk
615 1.1 pk if ((v & STP4020_ISR0_BVD2CHG) != 0) {
616 1.18 martin /* ignore if this is caused by insert or removal */
617 1.18 martin if (!cd_change)
618 1.18 martin printf("stp4020[%d]: Battery change 2\n", h->sock);
619 1.15 martin r = 1;
620 1.1 pk }
621 1.1 pk
622 1.1 pk if ((v & STP4020_ISR0_RDYCHG) != 0) {
623 1.18 martin DPRINTF(("stp4020[%d]: Ready/Busy change\n", h->sock));
624 1.15 martin r = 1;
625 1.1 pk }
626 1.1 pk
627 1.1 pk if ((v & STP4020_ISR0_WPCHG) != 0) {
628 1.18 martin DPRINTF(("stp4020[%d]: Write protect change\n", h->sock));
629 1.15 martin r = 1;
630 1.1 pk }
631 1.1 pk
632 1.1 pk if ((v & STP4020_ISR0_PCTO) != 0) {
633 1.18 martin DPRINTF(("stp4020[%d]: Card access timeout\n", h->sock));
634 1.15 martin r = 1;
635 1.1 pk }
636 1.18 martin
637 1.1 pk }
638 1.1 pk
639 1.1 pk return (r);
640 1.1 pk }
641 1.1 pk
642 1.16 martin /*
643 1.16 martin * The function gets the sbus speed and a access time and calculates
644 1.16 martin * values for the CMDLNG and CMDDLAY registers.
645 1.16 martin */
646 1.15 martin static void
647 1.16 martin stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay)
648 1.1 pk {
649 1.16 martin int result;
650 1.16 martin
651 1.16 martin if (ns < STP4020_MEM_SPEED_MIN)
652 1.16 martin ns = STP4020_MEM_SPEED_MIN;
653 1.16 martin else if (ns > STP4020_MEM_SPEED_MAX)
654 1.16 martin ns = STP4020_MEM_SPEED_MAX;
655 1.16 martin result = ns*(bus_speed/1000);
656 1.16 martin if (result % 1000000)
657 1.16 martin result = result/1000000 + 1;
658 1.16 martin else
659 1.16 martin result /= 1000000;
660 1.16 martin *length = result;
661 1.16 martin
662 1.16 martin /* the sbus frequency range is limited, so we can keep this simple */
663 1.16 martin *delay = ns <= STP4020_MEM_SPEED_MIN? 1 : 2;
664 1.16 martin }
665 1.15 martin
666 1.16 martin static void
667 1.16 martin stp4020_map_window(struct stp4020_socket *h, int win, int speed)
668 1.16 martin {
669 1.16 martin int v, length, delay;
670 1.15 martin
671 1.15 martin /*
672 1.16 martin * According to the PC Card standard 300ns access timing should be
673 1.16 martin * used for attribute memory access. Our pcmcia framework does not
674 1.16 martin * seem to propagate timing information, so we use that
675 1.16 martin * everywhere.
676 1.15 martin */
677 1.24 martin stp4020_calc_speed(speed, (win==STP_WIN_ATTR)? 300 : 100, &length, &delay);
678 1.1 pk
679 1.1 pk /*
680 1.15 martin * Fill in the Address Space Select and Base Address
681 1.15 martin * fields of this windows control register 0.
682 1.1 pk */
683 1.16 martin v = ((delay << STP4020_WCR0_CMDDLY_S)&STP4020_WCR0_CMDDLY_M)
684 1.16 martin | ((length << STP4020_WCR0_CMDLNG_S)&STP4020_WCR0_CMDLNG_M);
685 1.15 martin switch (win) {
686 1.15 martin case STP_WIN_ATTR:
687 1.15 martin v |= STP4020_WCR0_ASPSEL_AM;
688 1.15 martin break;
689 1.15 martin case STP_WIN_MEM:
690 1.15 martin v |= STP4020_WCR0_ASPSEL_CM;
691 1.15 martin break;
692 1.15 martin case STP_WIN_IO:
693 1.15 martin v |= STP4020_WCR0_ASPSEL_IO;
694 1.15 martin break;
695 1.15 martin }
696 1.15 martin v |= (STP4020_ADDR2PAGE(0) & STP4020_WCR0_BASE_M);
697 1.15 martin stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
698 1.16 martin stp4020_wr_winctl(h, win, STP4020_WCR1_IDX, 1<<STP4020_WCR1_WAITREQ_S);
699 1.15 martin }
700 1.1 pk
701 1.15 martin int
702 1.15 martin stp4020_chip_mem_alloc(pch, size, pcmhp)
703 1.15 martin pcmcia_chipset_handle_t pch;
704 1.15 martin bus_size_t size;
705 1.15 martin struct pcmcia_mem_handle *pcmhp;
706 1.15 martin {
707 1.15 martin struct stp4020_socket *h = (struct stp4020_socket *)pch;
708 1.1 pk
709 1.15 martin /* we can not do much here, defere work to _mem_map */
710 1.15 martin pcmhp->memt = h->tag;
711 1.1 pk pcmhp->size = size;
712 1.19 martin pcmhp->addr = 0;
713 1.19 martin pcmhp->mhandle = 0;
714 1.19 martin pcmhp->realsize = size;
715 1.1 pk
716 1.1 pk return (0);
717 1.1 pk }
718 1.1 pk
719 1.1 pk void
720 1.1 pk stp4020_chip_mem_free(pch, pcmhp)
721 1.1 pk pcmcia_chipset_handle_t pch;
722 1.1 pk struct pcmcia_mem_handle *pcmhp;
723 1.1 pk {
724 1.1 pk }
725 1.1 pk
726 1.1 pk int
727 1.1 pk stp4020_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
728 1.1 pk pcmcia_chipset_handle_t pch;
729 1.1 pk int kind;
730 1.1 pk bus_addr_t card_addr;
731 1.1 pk bus_size_t size;
732 1.1 pk struct pcmcia_mem_handle *pcmhp;
733 1.14 soren bus_size_t *offsetp;
734 1.1 pk int *windowp;
735 1.1 pk {
736 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
737 1.15 martin int win = (kind&PCMCIA_MEM_ATTR)? STP_WIN_ATTR : STP_WIN_MEM;
738 1.8 joda
739 1.15 martin pcmhp->memt = h->tag;
740 1.15 martin bus_space_subregion(h->tag, h->windows[win].winaddr, card_addr, size, &pcmhp->memh);
741 1.19 martin pcmhp->size = size;
742 1.19 martin pcmhp->realsize = STP4020_WINDOW_SIZE - card_addr;
743 1.15 martin *offsetp = 0;
744 1.15 martin *windowp = 0;
745 1.1 pk
746 1.1 pk return (0);
747 1.1 pk }
748 1.1 pk
749 1.1 pk void
750 1.1 pk stp4020_chip_mem_unmap(pch, win)
751 1.1 pk pcmcia_chipset_handle_t pch;
752 1.1 pk int win;
753 1.1 pk {
754 1.1 pk }
755 1.1 pk
756 1.1 pk int
757 1.1 pk stp4020_chip_io_alloc(pch, start, size, align, pcihp)
758 1.1 pk pcmcia_chipset_handle_t pch;
759 1.1 pk bus_addr_t start;
760 1.1 pk bus_size_t size;
761 1.1 pk bus_size_t align;
762 1.1 pk struct pcmcia_io_handle *pcihp;
763 1.1 pk {
764 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
765 1.1 pk
766 1.1 pk pcihp->iot = h->tag;
767 1.15 martin pcihp->ioh = h->windows[STP_WIN_IO].winaddr;
768 1.15 martin return 0;
769 1.1 pk }
770 1.1 pk
771 1.1 pk void
772 1.1 pk stp4020_chip_io_free(pch, pcihp)
773 1.1 pk pcmcia_chipset_handle_t pch;
774 1.1 pk struct pcmcia_io_handle *pcihp;
775 1.1 pk {
776 1.1 pk }
777 1.1 pk
778 1.1 pk int
779 1.1 pk stp4020_chip_io_map(pch, width, offset, size, pcihp, windowp)
780 1.1 pk pcmcia_chipset_handle_t pch;
781 1.1 pk int width;
782 1.1 pk bus_addr_t offset;
783 1.1 pk bus_size_t size;
784 1.1 pk struct pcmcia_io_handle *pcihp;
785 1.1 pk int *windowp;
786 1.1 pk {
787 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
788 1.1 pk
789 1.15 martin pcihp->iot = h->tag;
790 1.15 martin bus_space_subregion(h->tag, h->windows[STP_WIN_IO].winaddr, offset, size, &pcihp->ioh);
791 1.15 martin *windowp = 0;
792 1.15 martin return 0;
793 1.1 pk }
794 1.1 pk
795 1.1 pk void
796 1.1 pk stp4020_chip_io_unmap(pch, win)
797 1.1 pk pcmcia_chipset_handle_t pch;
798 1.1 pk int win;
799 1.1 pk {
800 1.1 pk }
801 1.1 pk
802 1.1 pk void
803 1.1 pk stp4020_chip_socket_enable(pch)
804 1.1 pk pcmcia_chipset_handle_t pch;
805 1.1 pk {
806 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
807 1.18 martin int i, v;
808 1.1 pk
809 1.1 pk /* this bit is mostly stolen from pcic_attach_card */
810 1.1 pk
811 1.1 pk /* Power down the socket to reset it, clear the card reset pin */
812 1.18 martin stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
813 1.1 pk
814 1.1 pk /*
815 1.1 pk * wait 300ms until power fails (Tpf). Then, wait 100ms since
816 1.1 pk * we are changing Vcc (Toff).
817 1.1 pk */
818 1.1 pk stp4020_delay((300 + 100) * 1000);
819 1.1 pk
820 1.1 pk /* Power up the socket */
821 1.18 martin v = STP4020_ICR1_MSTPWR;
822 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
823 1.1 pk
824 1.1 pk /*
825 1.1 pk * wait 100ms until power raise (Tpr) and 20ms to become
826 1.1 pk * stable (Tsu(Vcc)).
827 1.1 pk */
828 1.1 pk stp4020_delay((100 + 20) * 1000);
829 1.1 pk
830 1.18 martin v |= STP4020_ICR1_PCIFOE|STP4020_ICR1_VPP1_VCC;
831 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
832 1.1 pk
833 1.1 pk /*
834 1.1 pk * hold RESET at least 10us.
835 1.1 pk */
836 1.1 pk delay(10);
837 1.1 pk
838 1.1 pk /* Clear reset flag */
839 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
840 1.1 pk v &= ~STP4020_ICR0_RESET;
841 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
842 1.1 pk
843 1.1 pk /* wait 20ms as per pc card standard (r2.01) section 4.3.6 */
844 1.1 pk stp4020_delay(20000);
845 1.1 pk
846 1.1 pk /* Wait for the chip to finish initializing (5 seconds max) */
847 1.1 pk for (i = 10000; i > 0; i--) {
848 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
849 1.1 pk if ((v & STP4020_ISR0_RDYST) != 0)
850 1.1 pk break;
851 1.1 pk delay(500);
852 1.1 pk }
853 1.1 pk if (i <= 0) {
854 1.1 pk char bits[64];
855 1.1 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
856 1.1 pk STP4020_ISR0_IOBITS, bits, sizeof(bits));
857 1.1 pk printf("stp4020_chip_socket_enable: not ready: status %s\n",
858 1.1 pk bits);
859 1.1 pk return;
860 1.1 pk }
861 1.1 pk
862 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
863 1.1 pk
864 1.1 pk /*
865 1.18 martin * Check the card type.
866 1.18 martin * Enable socket I/O interrupts for IO cards.
867 1.1 pk * We use level SB_INT[0] for I/O interrupts.
868 1.1 pk */
869 1.18 martin if (pcmcia_card_gettype(h->pcmcia) == PCMCIA_IFTYPE_IO) {
870 1.18 martin v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE);
871 1.18 martin v |= STP4020_ICR0_IFTYPE_IO|STP4020_ICR0_IOIE
872 1.28 martin |STP4020_ICR0_SPKREN;
873 1.28 martin v |= h->sbus_intno ? STP4020_ICR0_IOILVL_SB1
874 1.28 martin : STP4020_ICR0_IOILVL_SB0;
875 1.18 martin DPRINTF(("%s: configuring card for IO useage\n", h->sc->sc_dev.dv_xname));
876 1.18 martin } else {
877 1.18 martin v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE
878 1.28 martin |STP4020_ICR0_SPKREN);
879 1.18 martin v |= STP4020_ICR0_IFTYPE_MEM;
880 1.18 martin DPRINTF(("%s: configuring card for MEM ONLY useage\n", h->sc->sc_dev.dv_xname));
881 1.18 martin }
882 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
883 1.1 pk }
884 1.1 pk
885 1.1 pk void
886 1.1 pk stp4020_chip_socket_disable(pch)
887 1.1 pk pcmcia_chipset_handle_t pch;
888 1.1 pk {
889 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
890 1.1 pk int v;
891 1.1 pk
892 1.1 pk /*
893 1.1 pk * Disable socket I/O interrupts.
894 1.1 pk */
895 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
896 1.1 pk v &= ~(STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL);
897 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
898 1.1 pk
899 1.1 pk /* Power down the socket */
900 1.18 martin stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
901 1.1 pk
902 1.1 pk /*
903 1.1 pk * wait 300ms until power fails (Tpf).
904 1.1 pk */
905 1.1 pk stp4020_delay(300 * 1000);
906 1.1 pk }
907 1.1 pk
908 1.1 pk void *
909 1.1 pk stp4020_chip_intr_establish(pch, pf, ipl, handler, arg)
910 1.1 pk pcmcia_chipset_handle_t pch;
911 1.1 pk struct pcmcia_function *pf;
912 1.1 pk int ipl;
913 1.1 pk int (*handler) __P((void *));
914 1.1 pk void *arg;
915 1.1 pk {
916 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
917 1.1 pk
918 1.1 pk h->intrhandler = handler;
919 1.1 pk h->intrarg = arg;
920 1.1 pk h->ipl = ipl;
921 1.16 martin return h;
922 1.1 pk }
923 1.1 pk
924 1.1 pk void
925 1.1 pk stp4020_chip_intr_disestablish(pch, ih)
926 1.1 pk pcmcia_chipset_handle_t pch;
927 1.1 pk void *ih;
928 1.1 pk {
929 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
930 1.1 pk
931 1.1 pk h->intrhandler = NULL;
932 1.1 pk h->intrarg = NULL;
933 1.1 pk }
934 1.1 pk
935 1.1 pk /*
936 1.1 pk * Delay and possibly yield CPU.
937 1.1 pk * XXX - assumes a context
938 1.1 pk */
939 1.1 pk void
940 1.1 pk stp4020_delay(ms)
941 1.1 pk unsigned int ms;
942 1.1 pk {
943 1.1 pk unsigned int ticks;
944 1.1 pk
945 1.1 pk /* Convert to ticks */
946 1.1 pk ticks = (ms * hz ) / 1000000;
947 1.1 pk
948 1.1 pk if (cold || ticks == 0) {
949 1.1 pk delay(ms);
950 1.1 pk return;
951 1.1 pk }
952 1.1 pk
953 1.1 pk #ifdef DIAGNOSTIC
954 1.1 pk if (ticks > 60*hz)
955 1.1 pk panic("stp4020: preposterous delay: %u", ticks);
956 1.1 pk #endif
957 1.1 pk tsleep(&ticks, 0, "stp4020_delay", ticks);
958 1.1 pk }
959 1.6 pk
960 1.6 pk #ifdef STP4020_DEBUG
961 1.6 pk void
962 1.6 pk stp4020_dump_regs(h)
963 1.6 pk struct stp4020_socket *h;
964 1.6 pk {
965 1.6 pk char bits[64];
966 1.6 pk /*
967 1.6 pk * Dump control and status registers.
968 1.6 pk */
969 1.6 pk printf("socket[%d] registers:\n", h->sock);
970 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
971 1.6 pk STP4020_ICR0_BITS, bits, sizeof(bits));
972 1.6 pk printf("\tICR0=%s\n", bits);
973 1.6 pk
974 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
975 1.6 pk STP4020_ICR1_BITS, bits, sizeof(bits));
976 1.6 pk printf("\tICR1=%s\n", bits);
977 1.6 pk
978 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
979 1.6 pk STP4020_ISR0_IOBITS, bits, sizeof(bits));
980 1.6 pk printf("\tISR0=%s\n", bits);
981 1.6 pk
982 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
983 1.6 pk STP4020_ISR1_BITS, bits, sizeof(bits));
984 1.6 pk printf("\tISR1=%s\n", bits);
985 1.6 pk }
986 1.6 pk #endif /* STP4020_DEBUG */
987