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