stp4020.c revision 1.26 1 1.26 thorpej /* $NetBSD: stp4020.c,v 1.26 2002/09/30 23:07:08 thorpej 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.26 thorpej __KERNEL_RCSID(0, "$NetBSD: stp4020.c,v 1.26 2002/09/30 23:07:08 thorpej 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.16 martin static void stp4020_map_window(struct stp4020_socket *h, int win, int speed);
140 1.16 martin static void stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay);
141 1.1 pk
142 1.26 thorpej CFATTACH_DECL(nell, sizeof(struct stp4020_softc),
143 1.26 thorpej stp4020match, stp4020attach, NULL, NULL)
144 1.1 pk
145 1.6 pk #ifdef STP4020_DEBUG
146 1.6 pk static void stp4020_dump_regs __P((struct stp4020_socket *));
147 1.6 pk #endif
148 1.1 pk
149 1.1 pk static int stp4020_rd_sockctl __P((struct stp4020_socket *, int));
150 1.1 pk static void stp4020_wr_sockctl __P((struct stp4020_socket *, int, int));
151 1.1 pk static int stp4020_rd_winctl __P((struct stp4020_socket *, int, int));
152 1.1 pk static void stp4020_wr_winctl __P((struct stp4020_socket *, int, int, int));
153 1.1 pk
154 1.1 pk void stp4020_delay __P((unsigned int));
155 1.16 martin void stp4020_attach_socket __P((struct stp4020_socket *, int));
156 1.1 pk void stp4020_create_event_thread __P((void *));
157 1.1 pk void stp4020_event_thread __P((void *));
158 1.1 pk void stp4020_queue_event __P((struct stp4020_softc *, int, int));
159 1.1 pk
160 1.1 pk int stp4020_chip_mem_alloc __P((pcmcia_chipset_handle_t, bus_size_t,
161 1.1 pk struct pcmcia_mem_handle *));
162 1.1 pk void stp4020_chip_mem_free __P((pcmcia_chipset_handle_t,
163 1.1 pk struct pcmcia_mem_handle *));
164 1.1 pk int stp4020_chip_mem_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
165 1.1 pk bus_size_t, struct pcmcia_mem_handle *,
166 1.14 soren bus_size_t *, int *));
167 1.1 pk void stp4020_chip_mem_unmap __P((pcmcia_chipset_handle_t, int));
168 1.1 pk
169 1.1 pk int stp4020_chip_io_alloc __P((pcmcia_chipset_handle_t,
170 1.1 pk bus_addr_t, bus_size_t, bus_size_t,
171 1.1 pk struct pcmcia_io_handle *));
172 1.1 pk void stp4020_chip_io_free __P((pcmcia_chipset_handle_t,
173 1.1 pk struct pcmcia_io_handle *));
174 1.1 pk int stp4020_chip_io_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
175 1.1 pk bus_size_t, struct pcmcia_io_handle *, int *));
176 1.1 pk void stp4020_chip_io_unmap __P((pcmcia_chipset_handle_t, int));
177 1.1 pk
178 1.1 pk void stp4020_chip_socket_enable __P((pcmcia_chipset_handle_t));
179 1.1 pk void stp4020_chip_socket_disable __P((pcmcia_chipset_handle_t));
180 1.1 pk void *stp4020_chip_intr_establish __P((pcmcia_chipset_handle_t,
181 1.1 pk struct pcmcia_function *, int,
182 1.1 pk int (*) __P((void *)), void *));
183 1.1 pk void stp4020_chip_intr_disestablish __P((pcmcia_chipset_handle_t, void *));
184 1.1 pk
185 1.1 pk /* Our PCMCIA chipset methods */
186 1.1 pk static struct pcmcia_chip_functions stp4020_functions = {
187 1.1 pk stp4020_chip_mem_alloc,
188 1.1 pk stp4020_chip_mem_free,
189 1.1 pk stp4020_chip_mem_map,
190 1.1 pk stp4020_chip_mem_unmap,
191 1.1 pk
192 1.1 pk stp4020_chip_io_alloc,
193 1.1 pk stp4020_chip_io_free,
194 1.1 pk stp4020_chip_io_map,
195 1.1 pk stp4020_chip_io_unmap,
196 1.1 pk
197 1.1 pk stp4020_chip_intr_establish,
198 1.1 pk stp4020_chip_intr_disestablish,
199 1.1 pk
200 1.1 pk stp4020_chip_socket_enable,
201 1.1 pk stp4020_chip_socket_disable
202 1.1 pk };
203 1.1 pk
204 1.1 pk
205 1.1 pk static __inline__ int
206 1.1 pk stp4020_rd_sockctl(h, idx)
207 1.1 pk struct stp4020_socket *h;
208 1.1 pk int idx;
209 1.1 pk {
210 1.1 pk int o = ((STP4020_SOCKREGS_SIZE * (h->sock)) + idx);
211 1.1 pk return (bus_space_read_2(h->tag, h->regs, o));
212 1.1 pk }
213 1.1 pk
214 1.1 pk static __inline__ void
215 1.1 pk stp4020_wr_sockctl(h, idx, v)
216 1.1 pk struct stp4020_socket *h;
217 1.1 pk int idx;
218 1.1 pk int v;
219 1.1 pk {
220 1.1 pk int o = (STP4020_SOCKREGS_SIZE * (h->sock)) + idx;
221 1.1 pk bus_space_write_2(h->tag, h->regs, o, v);
222 1.1 pk }
223 1.1 pk
224 1.1 pk static __inline__ int
225 1.1 pk stp4020_rd_winctl(h, win, idx)
226 1.1 pk struct stp4020_socket *h;
227 1.1 pk int win;
228 1.1 pk int idx;
229 1.1 pk {
230 1.1 pk int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
231 1.1 pk (STP4020_WINREGS_SIZE * win) + idx;
232 1.1 pk return (bus_space_read_2(h->tag, h->regs, o));
233 1.1 pk }
234 1.1 pk
235 1.1 pk static __inline__ void
236 1.1 pk stp4020_wr_winctl(h, win, idx, v)
237 1.1 pk struct stp4020_socket *h;
238 1.1 pk int win;
239 1.1 pk int idx;
240 1.1 pk int v;
241 1.1 pk {
242 1.1 pk int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
243 1.1 pk (STP4020_WINREGS_SIZE * win) + idx;
244 1.1 pk
245 1.1 pk bus_space_write_2(h->tag, h->regs, o, v);
246 1.1 pk }
247 1.1 pk
248 1.1 pk
249 1.1 pk int
250 1.1 pk stp4020print(aux, busname)
251 1.1 pk void *aux;
252 1.1 pk const char *busname;
253 1.1 pk {
254 1.4 pk struct pcmciabus_attach_args *paa = aux;
255 1.3 pk struct stp4020_socket *h = paa->pch;
256 1.3 pk
257 1.3 pk printf(" socket %d", h->sock);
258 1.1 pk return (UNCONF);
259 1.1 pk }
260 1.1 pk
261 1.1 pk int
262 1.1 pk stp4020match(parent, cf, aux)
263 1.1 pk struct device *parent;
264 1.1 pk struct cfdata *cf;
265 1.1 pk void *aux;
266 1.1 pk {
267 1.1 pk struct sbus_attach_args *sa = aux;
268 1.1 pk
269 1.2 pk return (strcmp("SUNW,pcmcia", sa->sa_name) == 0);
270 1.1 pk }
271 1.1 pk
272 1.1 pk /*
273 1.1 pk * Attach all the sub-devices we can find
274 1.1 pk */
275 1.1 pk void
276 1.1 pk stp4020attach(parent, self, aux)
277 1.1 pk struct device *parent, *self;
278 1.1 pk void *aux;
279 1.1 pk {
280 1.1 pk struct sbus_attach_args *sa = aux;
281 1.1 pk struct stp4020_softc *sc = (void *)self;
282 1.1 pk int node, rev;
283 1.1 pk int i;
284 1.1 pk bus_space_handle_t bh;
285 1.1 pk
286 1.1 pk node = sa->sa_node;
287 1.1 pk
288 1.1 pk /* Transfer bus tags */
289 1.1 pk sc->sc_bustag = sa->sa_bustag;
290 1.1 pk sc->sc_dmatag = sa->sa_dmatag;
291 1.1 pk
292 1.1 pk /* Set up per-socket static initialization */
293 1.1 pk sc->sc_socks[0].sc = sc->sc_socks[1].sc = sc;
294 1.1 pk sc->sc_socks[0].tag = sc->sc_socks[1].tag = sa->sa_bustag;
295 1.1 pk
296 1.9 pk if (sa->sa_nreg < 8) {
297 1.1 pk printf("%s: only %d register sets\n",
298 1.1 pk self->dv_xname, sa->sa_nreg);
299 1.1 pk return;
300 1.1 pk }
301 1.1 pk
302 1.1 pk if (sa->sa_nintr != 2) {
303 1.1 pk printf("%s: expect 2 interrupt Sbus levels; got %d\n",
304 1.1 pk self->dv_xname, sa->sa_nintr);
305 1.1 pk return;
306 1.1 pk }
307 1.1 pk
308 1.9 pk #define STP4020_BANK_PROM 0
309 1.1 pk #define STP4020_BANK_CTRL 4
310 1.1 pk for (i = 0; i < 8; i++) {
311 1.10 pk
312 1.1 pk /*
313 1.1 pk * STP4020 Register address map:
314 1.1 pk * bank 0: Forth PROM
315 1.1 pk * banks 1-3: socket 0, windows 0-2
316 1.1 pk * bank 4: control registers
317 1.1 pk * banks 5-7: socket 1, windows 0-2
318 1.1 pk */
319 1.10 pk
320 1.9 pk if (i == STP4020_BANK_PROM)
321 1.9 pk /* Skip the PROM */
322 1.9 pk continue;
323 1.9 pk
324 1.1 pk if (sbus_bus_map(sa->sa_bustag,
325 1.24 martin sa->sa_reg[i].oa_space,
326 1.24 martin sa->sa_reg[i].oa_base,
327 1.24 martin sa->sa_reg[i].oa_size,
328 1.21 eeh 0, &bh) != 0) {
329 1.1 pk printf("%s: attach: cannot map registers\n",
330 1.1 pk self->dv_xname);
331 1.1 pk return;
332 1.1 pk }
333 1.10 pk
334 1.10 pk if (i == STP4020_BANK_CTRL) {
335 1.10 pk /*
336 1.10 pk * Copy tag and handle to both socket structures
337 1.10 pk * for easy access in control/status IO functions.
338 1.10 pk */
339 1.10 pk sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
340 1.10 pk } else if (i < STP4020_BANK_CTRL) {
341 1.10 pk /* banks 1-3 */
342 1.10 pk sc->sc_socks[0].windows[i-1].winaddr = bh;
343 1.10 pk } else {
344 1.10 pk /* banks 5-7 */
345 1.10 pk sc->sc_socks[1].windows[i-5].winaddr = bh;
346 1.10 pk }
347 1.1 pk }
348 1.1 pk
349 1.1 pk sbus_establish(&sc->sc_sd, &sc->sc_dev);
350 1.1 pk
351 1.1 pk /*
352 1.1 pk * We get to use two SBus interrupt levels.
353 1.1 pk * The higher level we use for status change interrupts;
354 1.1 pk * the lower level for PC card I/O.
355 1.1 pk */
356 1.7 pk if (sa->sa_nintr != 0) {
357 1.24 martin bus_intr_establish(sa->sa_bustag, sa->sa_intr[1].oi_pri,
358 1.11 pk IPL_NONE, 0, stp4020_statintr, sc);
359 1.1 pk
360 1.24 martin bus_intr_establish(sa->sa_bustag, sa->sa_intr[0].oi_pri,
361 1.11 pk IPL_NONE, 0, stp4020_iointr, 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.1 pk * We use SB_INT[1] for status change interrupts.
430 1.1 pk */
431 1.18 martin v = STP4020_ICR0_ALL_STATUS_IE | STP4020_ICR0_SCILVL_SB1;
432 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
433 1.1 pk
434 1.1 pk /* Get live status bits from ISR0 */
435 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
436 1.1 pk if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0)
437 1.1 pk return;
438 1.1 pk
439 1.1 pk pcmcia_card_attach(h->pcmcia);
440 1.1 pk h->flags |= STP4020_SOCKET_BUSY;
441 1.1 pk }
442 1.1 pk
443 1.1 pk
444 1.1 pk /*
445 1.1 pk * Deferred thread creation callback.
446 1.1 pk */
447 1.1 pk void
448 1.1 pk stp4020_create_event_thread(arg)
449 1.1 pk void *arg;
450 1.1 pk {
451 1.1 pk struct stp4020_softc *sc = arg;
452 1.1 pk const char *name = sc->sc_dev.dv_xname;
453 1.1 pk
454 1.5 thorpej if (kthread_create1(stp4020_event_thread, sc, &sc->event_thread,
455 1.1 pk "%s", name)) {
456 1.1 pk panic("%s: unable to create event thread", name);
457 1.1 pk }
458 1.1 pk }
459 1.1 pk
460 1.1 pk /*
461 1.1 pk * The actual event handling thread.
462 1.1 pk */
463 1.1 pk void
464 1.1 pk stp4020_event_thread(arg)
465 1.1 pk void *arg;
466 1.1 pk {
467 1.1 pk struct stp4020_softc *sc = arg;
468 1.1 pk struct stp4020_event *e;
469 1.1 pk int s;
470 1.1 pk
471 1.1 pk while (1) {
472 1.1 pk struct stp4020_socket *h;
473 1.1 pk int n;
474 1.1 pk
475 1.1 pk s = splhigh();
476 1.1 pk if ((e = SIMPLEQ_FIRST(&sc->events)) == NULL) {
477 1.1 pk splx(s);
478 1.1 pk (void)tsleep(&sc->events, PWAIT, "pcicev", 0);
479 1.1 pk continue;
480 1.1 pk }
481 1.23 lukem SIMPLEQ_REMOVE_HEAD(&sc->events, se_q);
482 1.1 pk splx(s);
483 1.1 pk
484 1.1 pk n = e->se_sock;
485 1.1 pk if (n < 0 || n >= STP4020_NSOCK)
486 1.1 pk panic("stp4020_event_thread: wayward socket number %d",
487 1.1 pk n);
488 1.1 pk
489 1.1 pk h = &sc->sc_socks[n];
490 1.1 pk switch (e->se_type) {
491 1.1 pk case STP4020_EVENT_INSERTION:
492 1.1 pk pcmcia_card_attach(h->pcmcia);
493 1.1 pk break;
494 1.1 pk case STP4020_EVENT_REMOVAL:
495 1.1 pk pcmcia_card_detach(h->pcmcia, DETACH_FORCE);
496 1.1 pk break;
497 1.1 pk default:
498 1.1 pk panic("stp4020_event_thread: unknown event type %d",
499 1.1 pk e->se_type);
500 1.1 pk }
501 1.1 pk free(e, M_TEMP);
502 1.1 pk }
503 1.1 pk }
504 1.1 pk
505 1.1 pk void
506 1.1 pk stp4020_queue_event(sc, sock, event)
507 1.1 pk struct stp4020_softc *sc;
508 1.1 pk int sock, event;
509 1.1 pk {
510 1.1 pk struct stp4020_event *e;
511 1.1 pk int s;
512 1.1 pk
513 1.1 pk e = malloc(sizeof(*e), M_TEMP, M_NOWAIT);
514 1.1 pk if (e == NULL)
515 1.1 pk panic("stp4020_queue_event: can't allocate event");
516 1.1 pk
517 1.1 pk e->se_type = event;
518 1.1 pk e->se_sock = sock;
519 1.1 pk s = splhigh();
520 1.1 pk SIMPLEQ_INSERT_TAIL(&sc->events, e, se_q);
521 1.1 pk splx(s);
522 1.1 pk wakeup(&sc->events);
523 1.1 pk }
524 1.1 pk
525 1.1 pk int
526 1.1 pk stp4020_statintr(arg)
527 1.1 pk void *arg;
528 1.1 pk {
529 1.1 pk struct stp4020_softc *sc = arg;
530 1.1 pk int i, r = 0;
531 1.1 pk
532 1.1 pk /*
533 1.1 pk * Check each socket for pending requests.
534 1.1 pk */
535 1.1 pk for (i = 0 ; i < STP4020_NSOCK; i++) {
536 1.1 pk struct stp4020_socket *h;
537 1.18 martin int v, cd_change = 0;
538 1.1 pk
539 1.1 pk h = &sc->sc_socks[i];
540 1.1 pk
541 1.1 pk /* Read socket's ISR0 for the interrupt status bits */
542 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
543 1.1 pk
544 1.1 pk #ifdef STP4020_DEBUG
545 1.1 pk if (stp4020_debug != 0) {
546 1.1 pk char bits[64];
547 1.1 pk bitmask_snprintf(v, STP4020_ISR0_IOBITS,
548 1.1 pk bits, sizeof(bits));
549 1.1 pk printf("stp4020_statintr: ISR0=%s\n", bits);
550 1.1 pk }
551 1.1 pk #endif
552 1.1 pk
553 1.1 pk /* Ack all interrupts at once */
554 1.18 martin stp4020_wr_sockctl(h, STP4020_ISR0_IDX, STP4020_ISR0_ALL_STATUS_IRQ);
555 1.1 pk
556 1.1 pk if ((v & STP4020_ISR0_CDCHG) != 0) {
557 1.1 pk /*
558 1.1 pk * Card status change detect
559 1.1 pk */
560 1.18 martin cd_change = 1;
561 1.18 martin r = 1;
562 1.18 martin if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)){
563 1.1 pk if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
564 1.1 pk stp4020_queue_event(sc, i,
565 1.1 pk STP4020_EVENT_INSERTION);
566 1.1 pk h->flags |= STP4020_SOCKET_BUSY;
567 1.1 pk }
568 1.1 pk }
569 1.1 pk if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0){
570 1.1 pk if ((h->flags & STP4020_SOCKET_BUSY) != 0) {
571 1.1 pk stp4020_queue_event(sc, i,
572 1.1 pk STP4020_EVENT_REMOVAL);
573 1.1 pk h->flags &= ~STP4020_SOCKET_BUSY;
574 1.1 pk }
575 1.1 pk }
576 1.1 pk }
577 1.1 pk
578 1.18 martin /* informational messages */
579 1.1 pk if ((v & STP4020_ISR0_BVD1CHG) != 0) {
580 1.18 martin /* ignore if this is caused by insert or removal */
581 1.18 martin if (!cd_change)
582 1.18 martin printf("stp4020[%d]: Battery change 1\n", h->sock);
583 1.15 martin r = 1;
584 1.1 pk }
585 1.1 pk
586 1.1 pk if ((v & STP4020_ISR0_BVD2CHG) != 0) {
587 1.18 martin /* ignore if this is caused by insert or removal */
588 1.18 martin if (!cd_change)
589 1.18 martin printf("stp4020[%d]: Battery change 2\n", h->sock);
590 1.15 martin r = 1;
591 1.1 pk }
592 1.1 pk
593 1.1 pk if ((v & STP4020_ISR0_RDYCHG) != 0) {
594 1.18 martin DPRINTF(("stp4020[%d]: Ready/Busy change\n", h->sock));
595 1.15 martin r = 1;
596 1.1 pk }
597 1.1 pk
598 1.1 pk if ((v & STP4020_ISR0_WPCHG) != 0) {
599 1.18 martin DPRINTF(("stp4020[%d]: Write protect change\n", h->sock));
600 1.15 martin r = 1;
601 1.1 pk }
602 1.1 pk
603 1.1 pk if ((v & STP4020_ISR0_PCTO) != 0) {
604 1.18 martin DPRINTF(("stp4020[%d]: Card access timeout\n", h->sock));
605 1.15 martin r = 1;
606 1.1 pk }
607 1.18 martin
608 1.1 pk }
609 1.1 pk
610 1.1 pk return (r);
611 1.1 pk }
612 1.1 pk
613 1.1 pk int
614 1.1 pk stp4020_iointr(arg)
615 1.1 pk void *arg;
616 1.1 pk {
617 1.1 pk struct stp4020_softc *sc = arg;
618 1.22 martin int i, r = 0;
619 1.1 pk
620 1.1 pk /*
621 1.1 pk * Check each socket for pending requests.
622 1.1 pk */
623 1.1 pk for (i = 0 ; i < STP4020_NSOCK; i++) {
624 1.1 pk struct stp4020_socket *h;
625 1.1 pk int v;
626 1.1 pk
627 1.1 pk h = &sc->sc_socks[i];
628 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
629 1.1 pk
630 1.1 pk if ((v & STP4020_ISR0_IOINT) != 0) {
631 1.18 martin /* we can not deny this is ours, no matter what the
632 1.18 martin card driver says. */
633 1.18 martin r = 1;
634 1.22 martin
635 1.18 martin /* ack interrupt */
636 1.18 martin stp4020_wr_sockctl(h, STP4020_ISR0_IDX, v);
637 1.18 martin
638 1.1 pk /* It's a card interrupt */
639 1.1 pk if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
640 1.1 pk printf("stp4020[%d]: spurious interrupt?\n",
641 1.1 pk h->sock);
642 1.1 pk continue;
643 1.1 pk }
644 1.1 pk /* Call card handler, if any */
645 1.15 martin if (h->intrhandler != NULL) {
646 1.22 martin /*
647 1.22 martin * Called without handling of it's requested
648 1.22 martin * protection level (h->ipl), since we have
649 1.22 martin * no general queuing mechanism available
650 1.22 martin * right now and we know for sure we are
651 1.22 martin * running at a higher protection level
652 1.22 martin * right now.
653 1.22 martin */
654 1.19 martin (*h->intrhandler)(h->intrarg);
655 1.15 martin }
656 1.1 pk }
657 1.1 pk
658 1.1 pk }
659 1.1 pk
660 1.1 pk return (r);
661 1.1 pk }
662 1.1 pk
663 1.16 martin /*
664 1.16 martin * The function gets the sbus speed and a access time and calculates
665 1.16 martin * values for the CMDLNG and CMDDLAY registers.
666 1.16 martin */
667 1.15 martin static void
668 1.16 martin stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay)
669 1.1 pk {
670 1.16 martin int result;
671 1.16 martin
672 1.16 martin if (ns < STP4020_MEM_SPEED_MIN)
673 1.16 martin ns = STP4020_MEM_SPEED_MIN;
674 1.16 martin else if (ns > STP4020_MEM_SPEED_MAX)
675 1.16 martin ns = STP4020_MEM_SPEED_MAX;
676 1.16 martin result = ns*(bus_speed/1000);
677 1.16 martin if (result % 1000000)
678 1.16 martin result = result/1000000 + 1;
679 1.16 martin else
680 1.16 martin result /= 1000000;
681 1.16 martin *length = result;
682 1.16 martin
683 1.16 martin /* the sbus frequency range is limited, so we can keep this simple */
684 1.16 martin *delay = ns <= STP4020_MEM_SPEED_MIN? 1 : 2;
685 1.16 martin }
686 1.15 martin
687 1.16 martin static void
688 1.16 martin stp4020_map_window(struct stp4020_socket *h, int win, int speed)
689 1.16 martin {
690 1.16 martin int v, length, delay;
691 1.15 martin
692 1.15 martin /*
693 1.16 martin * According to the PC Card standard 300ns access timing should be
694 1.16 martin * used for attribute memory access. Our pcmcia framework does not
695 1.16 martin * seem to propagate timing information, so we use that
696 1.16 martin * everywhere.
697 1.15 martin */
698 1.24 martin stp4020_calc_speed(speed, (win==STP_WIN_ATTR)? 300 : 100, &length, &delay);
699 1.1 pk
700 1.1 pk /*
701 1.15 martin * Fill in the Address Space Select and Base Address
702 1.15 martin * fields of this windows control register 0.
703 1.1 pk */
704 1.16 martin v = ((delay << STP4020_WCR0_CMDDLY_S)&STP4020_WCR0_CMDDLY_M)
705 1.16 martin | ((length << STP4020_WCR0_CMDLNG_S)&STP4020_WCR0_CMDLNG_M);
706 1.15 martin switch (win) {
707 1.15 martin case STP_WIN_ATTR:
708 1.15 martin v |= STP4020_WCR0_ASPSEL_AM;
709 1.15 martin break;
710 1.15 martin case STP_WIN_MEM:
711 1.15 martin v |= STP4020_WCR0_ASPSEL_CM;
712 1.15 martin break;
713 1.15 martin case STP_WIN_IO:
714 1.15 martin v |= STP4020_WCR0_ASPSEL_IO;
715 1.15 martin break;
716 1.15 martin }
717 1.15 martin v |= (STP4020_ADDR2PAGE(0) & STP4020_WCR0_BASE_M);
718 1.15 martin stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
719 1.16 martin stp4020_wr_winctl(h, win, STP4020_WCR1_IDX, 1<<STP4020_WCR1_WAITREQ_S);
720 1.15 martin }
721 1.1 pk
722 1.15 martin int
723 1.15 martin stp4020_chip_mem_alloc(pch, size, pcmhp)
724 1.15 martin pcmcia_chipset_handle_t pch;
725 1.15 martin bus_size_t size;
726 1.15 martin struct pcmcia_mem_handle *pcmhp;
727 1.15 martin {
728 1.15 martin struct stp4020_socket *h = (struct stp4020_socket *)pch;
729 1.1 pk
730 1.15 martin /* we can not do much here, defere work to _mem_map */
731 1.15 martin pcmhp->memt = h->tag;
732 1.1 pk pcmhp->size = size;
733 1.19 martin pcmhp->addr = 0;
734 1.19 martin pcmhp->mhandle = 0;
735 1.19 martin pcmhp->realsize = size;
736 1.1 pk
737 1.1 pk return (0);
738 1.1 pk }
739 1.1 pk
740 1.1 pk void
741 1.1 pk stp4020_chip_mem_free(pch, pcmhp)
742 1.1 pk pcmcia_chipset_handle_t pch;
743 1.1 pk struct pcmcia_mem_handle *pcmhp;
744 1.1 pk {
745 1.1 pk }
746 1.1 pk
747 1.1 pk int
748 1.1 pk stp4020_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
749 1.1 pk pcmcia_chipset_handle_t pch;
750 1.1 pk int kind;
751 1.1 pk bus_addr_t card_addr;
752 1.1 pk bus_size_t size;
753 1.1 pk struct pcmcia_mem_handle *pcmhp;
754 1.14 soren bus_size_t *offsetp;
755 1.1 pk int *windowp;
756 1.1 pk {
757 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
758 1.15 martin int win = (kind&PCMCIA_MEM_ATTR)? STP_WIN_ATTR : STP_WIN_MEM;
759 1.8 joda
760 1.15 martin pcmhp->memt = h->tag;
761 1.15 martin bus_space_subregion(h->tag, h->windows[win].winaddr, card_addr, size, &pcmhp->memh);
762 1.19 martin pcmhp->size = size;
763 1.19 martin pcmhp->realsize = STP4020_WINDOW_SIZE - card_addr;
764 1.15 martin *offsetp = 0;
765 1.15 martin *windowp = 0;
766 1.1 pk
767 1.1 pk return (0);
768 1.1 pk }
769 1.1 pk
770 1.1 pk void
771 1.1 pk stp4020_chip_mem_unmap(pch, win)
772 1.1 pk pcmcia_chipset_handle_t pch;
773 1.1 pk int win;
774 1.1 pk {
775 1.1 pk }
776 1.1 pk
777 1.1 pk int
778 1.1 pk stp4020_chip_io_alloc(pch, start, size, align, pcihp)
779 1.1 pk pcmcia_chipset_handle_t pch;
780 1.1 pk bus_addr_t start;
781 1.1 pk bus_size_t size;
782 1.1 pk bus_size_t align;
783 1.1 pk struct pcmcia_io_handle *pcihp;
784 1.1 pk {
785 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
786 1.1 pk
787 1.1 pk pcihp->iot = h->tag;
788 1.15 martin pcihp->ioh = h->windows[STP_WIN_IO].winaddr;
789 1.15 martin return 0;
790 1.1 pk }
791 1.1 pk
792 1.1 pk void
793 1.1 pk stp4020_chip_io_free(pch, pcihp)
794 1.1 pk pcmcia_chipset_handle_t pch;
795 1.1 pk struct pcmcia_io_handle *pcihp;
796 1.1 pk {
797 1.1 pk }
798 1.1 pk
799 1.1 pk int
800 1.1 pk stp4020_chip_io_map(pch, width, offset, size, pcihp, windowp)
801 1.1 pk pcmcia_chipset_handle_t pch;
802 1.1 pk int width;
803 1.1 pk bus_addr_t offset;
804 1.1 pk bus_size_t size;
805 1.1 pk struct pcmcia_io_handle *pcihp;
806 1.1 pk int *windowp;
807 1.1 pk {
808 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
809 1.1 pk
810 1.15 martin pcihp->iot = h->tag;
811 1.15 martin bus_space_subregion(h->tag, h->windows[STP_WIN_IO].winaddr, offset, size, &pcihp->ioh);
812 1.15 martin *windowp = 0;
813 1.15 martin return 0;
814 1.1 pk }
815 1.1 pk
816 1.1 pk void
817 1.1 pk stp4020_chip_io_unmap(pch, win)
818 1.1 pk pcmcia_chipset_handle_t pch;
819 1.1 pk int win;
820 1.1 pk {
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.18 martin int i, v;
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.18 martin stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
834 1.1 pk
835 1.1 pk /*
836 1.1 pk * wait 300ms until power fails (Tpf). Then, wait 100ms since
837 1.1 pk * we are changing Vcc (Toff).
838 1.1 pk */
839 1.1 pk stp4020_delay((300 + 100) * 1000);
840 1.1 pk
841 1.1 pk /* Power up the socket */
842 1.18 martin 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.18 martin v |= STP4020_ICR1_PCIFOE|STP4020_ICR1_VPP1_VCC;
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.1 pk
883 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
884 1.1 pk
885 1.1 pk /*
886 1.18 martin * Check the card type.
887 1.18 martin * Enable socket I/O interrupts for IO cards.
888 1.1 pk * We use level SB_INT[0] for I/O interrupts.
889 1.1 pk */
890 1.18 martin if (pcmcia_card_gettype(h->pcmcia) == PCMCIA_IFTYPE_IO) {
891 1.18 martin v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE);
892 1.18 martin v |= STP4020_ICR0_IFTYPE_IO|STP4020_ICR0_IOIE
893 1.18 martin |STP4020_ICR0_IOILVL_SB0|STP4020_ICR0_SPKREN;
894 1.18 martin DPRINTF(("%s: configuring card for IO useage\n", h->sc->sc_dev.dv_xname));
895 1.18 martin } else {
896 1.18 martin v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE
897 1.18 martin |STP4020_ICR0_SPKREN|STP4020_ICR0_IOILVL_SB0
898 1.18 martin |STP4020_ICR0_IOILVL_SB1|STP4020_ICR0_SPKREN);
899 1.18 martin v |= STP4020_ICR0_IFTYPE_MEM;
900 1.18 martin DPRINTF(("%s: configuring card for MEM ONLY useage\n", h->sc->sc_dev.dv_xname));
901 1.18 martin }
902 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
903 1.1 pk }
904 1.1 pk
905 1.1 pk void
906 1.1 pk stp4020_chip_socket_disable(pch)
907 1.1 pk pcmcia_chipset_handle_t pch;
908 1.1 pk {
909 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
910 1.1 pk int v;
911 1.1 pk
912 1.1 pk /*
913 1.1 pk * Disable socket I/O interrupts.
914 1.1 pk */
915 1.1 pk v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
916 1.1 pk v &= ~(STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL);
917 1.1 pk stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
918 1.1 pk
919 1.1 pk /* Power down the socket */
920 1.18 martin stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
921 1.1 pk
922 1.1 pk /*
923 1.1 pk * wait 300ms until power fails (Tpf).
924 1.1 pk */
925 1.1 pk stp4020_delay(300 * 1000);
926 1.1 pk }
927 1.1 pk
928 1.1 pk void *
929 1.1 pk stp4020_chip_intr_establish(pch, pf, ipl, handler, arg)
930 1.1 pk pcmcia_chipset_handle_t pch;
931 1.1 pk struct pcmcia_function *pf;
932 1.1 pk int ipl;
933 1.1 pk int (*handler) __P((void *));
934 1.1 pk void *arg;
935 1.1 pk {
936 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
937 1.1 pk
938 1.1 pk h->intrhandler = handler;
939 1.1 pk h->intrarg = arg;
940 1.1 pk h->ipl = ipl;
941 1.16 martin return h;
942 1.1 pk }
943 1.1 pk
944 1.1 pk void
945 1.1 pk stp4020_chip_intr_disestablish(pch, ih)
946 1.1 pk pcmcia_chipset_handle_t pch;
947 1.1 pk void *ih;
948 1.1 pk {
949 1.1 pk struct stp4020_socket *h = (struct stp4020_socket *)pch;
950 1.1 pk
951 1.1 pk h->intrhandler = NULL;
952 1.1 pk h->intrarg = NULL;
953 1.1 pk }
954 1.1 pk
955 1.1 pk /*
956 1.1 pk * Delay and possibly yield CPU.
957 1.1 pk * XXX - assumes a context
958 1.1 pk */
959 1.1 pk void
960 1.1 pk stp4020_delay(ms)
961 1.1 pk unsigned int ms;
962 1.1 pk {
963 1.1 pk unsigned int ticks;
964 1.1 pk
965 1.1 pk /* Convert to ticks */
966 1.1 pk ticks = (ms * hz ) / 1000000;
967 1.1 pk
968 1.1 pk if (cold || ticks == 0) {
969 1.1 pk delay(ms);
970 1.1 pk return;
971 1.1 pk }
972 1.1 pk
973 1.1 pk #ifdef DIAGNOSTIC
974 1.1 pk if (ticks > 60*hz)
975 1.1 pk panic("stp4020: preposterous delay: %u", ticks);
976 1.1 pk #endif
977 1.1 pk tsleep(&ticks, 0, "stp4020_delay", ticks);
978 1.1 pk }
979 1.6 pk
980 1.6 pk #ifdef STP4020_DEBUG
981 1.6 pk void
982 1.6 pk stp4020_dump_regs(h)
983 1.6 pk struct stp4020_socket *h;
984 1.6 pk {
985 1.6 pk char bits[64];
986 1.6 pk /*
987 1.6 pk * Dump control and status registers.
988 1.6 pk */
989 1.6 pk printf("socket[%d] registers:\n", h->sock);
990 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
991 1.6 pk STP4020_ICR0_BITS, bits, sizeof(bits));
992 1.6 pk printf("\tICR0=%s\n", bits);
993 1.6 pk
994 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
995 1.6 pk STP4020_ICR1_BITS, bits, sizeof(bits));
996 1.6 pk printf("\tICR1=%s\n", bits);
997 1.6 pk
998 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
999 1.6 pk STP4020_ISR0_IOBITS, bits, sizeof(bits));
1000 1.6 pk printf("\tISR0=%s\n", bits);
1001 1.6 pk
1002 1.6 pk bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
1003 1.6 pk STP4020_ISR1_BITS, bits, sizeof(bits));
1004 1.6 pk printf("\tISR1=%s\n", bits);
1005 1.6 pk }
1006 1.6 pk #endif /* STP4020_DEBUG */
1007