tcic2.c revision 1.28 1 1.28 ad /* $NetBSD: tcic2.c,v 1.28 2007/10/19 12:00:02 ad Exp $ */
2 1.1 bad
3 1.1 bad /*
4 1.1 bad * Copyright (c) 1998, 1999 Christoph Badura. All rights reserved.
5 1.1 bad * Copyright (c) 1997 Marc Horowitz. All rights reserved.
6 1.1 bad *
7 1.1 bad * Redistribution and use in source and binary forms, with or without
8 1.1 bad * modification, are permitted provided that the following conditions
9 1.1 bad * are met:
10 1.1 bad * 1. Redistributions of source code must retain the above copyright
11 1.1 bad * notice, this list of conditions and the following disclaimer.
12 1.1 bad * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 bad * notice, this list of conditions and the following disclaimer in the
14 1.1 bad * documentation and/or other materials provided with the distribution.
15 1.1 bad * 3. All advertising materials mentioning features or use of this software
16 1.1 bad * must display the following acknowledgement:
17 1.1 bad * This product includes software developed by Marc Horowitz.
18 1.1 bad * 4. The name of the author may not be used to endorse or promote products
19 1.1 bad * derived from this software without specific prior written permission.
20 1.1 bad *
21 1.1 bad * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22 1.1 bad * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23 1.1 bad * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24 1.1 bad * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25 1.1 bad * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26 1.1 bad * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 1.1 bad * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 1.1 bad * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 1.1 bad * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 1.1 bad * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 1.1 bad */
32 1.7 lukem
33 1.7 lukem #include <sys/cdefs.h>
34 1.28 ad __KERNEL_RCSID(0, "$NetBSD: tcic2.c,v 1.28 2007/10/19 12:00:02 ad Exp $");
35 1.7 lukem
36 1.7 lukem #undef TCICDEBUG
37 1.1 bad
38 1.1 bad #include <sys/param.h>
39 1.1 bad #include <sys/systm.h>
40 1.1 bad #include <sys/device.h>
41 1.1 bad #include <sys/extent.h>
42 1.1 bad #include <sys/malloc.h>
43 1.1 bad #include <sys/kthread.h>
44 1.1 bad
45 1.28 ad #include <sys/bus.h>
46 1.28 ad #include <sys/intr.h>
47 1.1 bad
48 1.1 bad #include <dev/pcmcia/pcmciareg.h>
49 1.1 bad #include <dev/pcmcia/pcmciavar.h>
50 1.1 bad
51 1.1 bad #include <dev/ic/tcic2reg.h>
52 1.1 bad #include <dev/ic/tcic2var.h>
53 1.1 bad
54 1.17 drochner #include "locators.h"
55 1.17 drochner
56 1.1 bad #ifdef TCICDEBUG
57 1.1 bad int tcic_debug = 1;
58 1.1 bad #define DPRINTF(arg) if (tcic_debug) printf arg;
59 1.1 bad #else
60 1.1 bad #define DPRINTF(arg)
61 1.1 bad #endif
62 1.1 bad
63 1.1 bad /*
64 1.1 bad * Individual drivers will allocate their own memory and io regions. Memory
65 1.1 bad * regions must be a multiple of 4k, aligned on a 4k boundary.
66 1.1 bad */
67 1.1 bad
68 1.1 bad #define TCIC_MEM_ALIGN TCIC_MEM_PAGESIZE
69 1.1 bad
70 1.18 perry void tcic_attach_socket(struct tcic_handle *);
71 1.18 perry void tcic_init_socket(struct tcic_handle *);
72 1.1 bad
73 1.18 perry int tcic_print(void *arg, const char *pnp);
74 1.18 perry int tcic_intr_socket(struct tcic_handle *);
75 1.1 bad
76 1.18 perry void tcic_attach_card(struct tcic_handle *);
77 1.18 perry void tcic_detach_card(struct tcic_handle *, int);
78 1.18 perry void tcic_deactivate_card(struct tcic_handle *);
79 1.1 bad
80 1.18 perry void tcic_chip_do_mem_map(struct tcic_handle *, int);
81 1.18 perry void tcic_chip_do_io_map(struct tcic_handle *, int);
82 1.1 bad
83 1.18 perry void tcic_create_event_thread(void *);
84 1.18 perry void tcic_event_thread(void *);
85 1.1 bad
86 1.18 perry void tcic_queue_event(struct tcic_handle *, int);
87 1.1 bad
88 1.1 bad /* Map between irq numbers and internal representation */
89 1.1 bad #if 1
90 1.1 bad int tcic_irqmap[] =
91 1.1 bad { 0, 0, 0, 3, 4, 5, 6, 7, 0, 0, 10, 1, 0, 0, 14, 0 };
92 1.1 bad int tcic_valid_irqs = 0x4cf8;
93 1.1 bad #else
94 1.1 bad int tcic_irqmap[] = /* irqs 9 and 6 switched, some ISA cards */
95 1.1 bad { 0, 0, 0, 3, 4, 5, 0, 7, 0, 6, 10, 1, 0, 0, 14, 0 };
96 1.1 bad int tcic_valid_irqs = 0x4eb8;
97 1.1 bad #endif
98 1.1 bad
99 1.1 bad int tcic_mem_speed = 250; /* memory access time in nanoseconds */
100 1.1 bad int tcic_io_speed = 165; /* io access time in nanoseconds */
101 1.1 bad
102 1.1 bad /*
103 1.1 bad * Check various reserved and otherwise in their value restricted bits.
104 1.1 bad */
105 1.1 bad int
106 1.1 bad tcic_check_reserved_bits(iot, ioh)
107 1.1 bad bus_space_tag_t iot;
108 1.1 bad bus_space_handle_t ioh;
109 1.1 bad {
110 1.1 bad int val, auxreg;
111 1.1 bad
112 1.1 bad DPRINTF(("tcic: chkrsvd 1\n"));
113 1.1 bad /* R_ADDR bit 30:28 have a restricted range. */
114 1.1 bad val = (bus_space_read_2(iot, ioh, TCIC_R_ADDR2) & TCIC_SS_MASK)
115 1.1 bad >> TCIC_SS_SHIFT;
116 1.1 bad if (val > 1)
117 1.1 bad return 0;
118 1.1 bad
119 1.1 bad DPRINTF(("tcic: chkrsvd 2\n"));
120 1.1 bad /* R_SCTRL bits 6,2,1 are reserved. */
121 1.1 bad val = bus_space_read_1(iot, ioh, TCIC_R_SCTRL);
122 1.1 bad if (val & TCIC_SCTRL_RSVD)
123 1.1 bad return 0;
124 1.1 bad
125 1.1 bad DPRINTF(("tcic: chkrsvd 3\n"));
126 1.1 bad /* R_ICSR bit 2 must be same as bit 3. */
127 1.1 bad val = bus_space_read_1(iot, ioh, TCIC_R_ICSR);
128 1.1 bad if (((val >> 1) & 1) != ((val >> 2) & 1))
129 1.1 bad return 0;
130 1.1 bad
131 1.1 bad DPRINTF(("tcic: chkrsvd 4\n"));
132 1.1 bad /* R_IENA bits 7,2 are reserverd. */
133 1.1 bad val = bus_space_read_1(iot, ioh, TCIC_R_IENA);
134 1.1 bad if (val & TCIC_IENA_RSVD)
135 1.1 bad return 0;
136 1.1 bad
137 1.1 bad DPRINTF(("tcic: chkrsvd 5\n"));
138 1.1 bad /* Some aux registers have reserved bits. */
139 1.1 bad /* Which are we looking at? */
140 1.1 bad auxreg = bus_space_read_1(iot, ioh, TCIC_R_MODE)
141 1.1 bad & TCIC_AR_MASK;
142 1.1 bad val = bus_space_read_2(iot, ioh, TCIC_R_AUX);
143 1.1 bad DPRINTF(("tcic: auxreg 0x%02x val 0x%04x\n", auxreg, val));
144 1.1 bad switch (auxreg) {
145 1.1 bad case TCIC_AR_SYSCFG:
146 1.1 bad if (INVALID_AR_SYSCFG(val))
147 1.1 bad return 0;
148 1.1 bad break;
149 1.1 bad case TCIC_AR_ILOCK:
150 1.1 bad if (INVALID_AR_ILOCK(val))
151 1.1 bad return 0;
152 1.1 bad break;
153 1.1 bad case TCIC_AR_TEST:
154 1.1 bad if (INVALID_AR_TEST(val))
155 1.1 bad return 0;
156 1.1 bad break;
157 1.1 bad }
158 1.1 bad
159 1.1 bad DPRINTF(("tcic: chkrsvd 6\n"));
160 1.1 bad /* XXX fails if pcmcia bios is enabled. */
161 1.1 bad /* Various bits set or not depending if in RESET mode. */
162 1.1 bad val = bus_space_read_1(iot, ioh, TCIC_R_SCTRL);
163 1.1 bad if (val & TCIC_SCTRL_RESET) {
164 1.1 bad DPRINTF(("tcic: chkrsvd 7\n"));
165 1.1 bad /* Address bits must be 0 */
166 1.1 bad val = bus_space_read_2(iot, ioh, TCIC_R_ADDR);
167 1.1 bad if (val != 0)
168 1.1 bad return 0;
169 1.1 bad val = bus_space_read_2(iot, ioh, TCIC_R_ADDR2);
170 1.1 bad if (val != 0)
171 1.1 bad return 0;
172 1.1 bad DPRINTF(("tcic: chkrsvd 8\n"));
173 1.1 bad /* EDC bits must be 0 */
174 1.1 bad val = bus_space_read_2(iot, ioh, TCIC_R_EDC);
175 1.1 bad if (val != 0)
176 1.1 bad return 0;
177 1.1 bad /* We're OK, so take it out of reset. XXX -chb */
178 1.1 bad bus_space_write_1(iot, ioh, TCIC_R_SCTRL, 0);
179 1.1 bad }
180 1.1 bad else { /* not in RESET mode */
181 1.1 bad int omode;
182 1.1 bad int val1, val2;
183 1.1 bad DPRINTF(("tcic: chkrsvd 9\n"));
184 1.1 bad /* Programming timers must have expired. */
185 1.1 bad val = bus_space_read_1(iot, ioh, TCIC_R_SSTAT);
186 1.1 bad if ((val & (TCIC_SSTAT_6US|TCIC_SSTAT_10US|TCIC_SSTAT_PROGTIME))
187 1.1 bad != (TCIC_SSTAT_6US|TCIC_SSTAT_10US|TCIC_SSTAT_PROGTIME))
188 1.1 bad return 0;
189 1.1 bad DPRINTF(("tcic: chkrsvd 10\n"));
190 1.1 bad /*
191 1.1 bad * EDC bits should change on read from data space
192 1.1 bad * as long as either EDC or the data are nonzero.
193 1.1 bad */
194 1.1 bad if ((bus_space_read_2(iot, ioh, TCIC_R_ADDR2)
195 1.1 bad & TCIC_ADDR2_INDREG) != 0) {
196 1.1 bad val1 = bus_space_read_2(iot, ioh, TCIC_R_EDC);
197 1.1 bad val2 = bus_space_read_2(iot, ioh, TCIC_R_DATA);
198 1.1 bad if (val1 | val2) {
199 1.1 bad val1 = bus_space_read_2(iot, ioh, TCIC_R_EDC);
200 1.1 bad if (val1 == val2)
201 1.1 bad return 0;
202 1.1 bad }
203 1.1 bad }
204 1.1 bad DPRINTF(("tcic: chkrsvd 11\n"));
205 1.1 bad /* XXX what does this check? -chb */
206 1.1 bad omode = bus_space_read_1(iot, ioh, TCIC_R_MODE);
207 1.1 bad val1 = omode ^ TCIC_AR_MASK;
208 1.1 bad bus_space_write_1(iot, ioh, TCIC_R_MODE, val1);
209 1.1 bad val2 = bus_space_read_1(iot, ioh, TCIC_R_MODE);
210 1.1 bad bus_space_write_1(iot, ioh, TCIC_R_MODE, omode);
211 1.1 bad if ( val1 != val2)
212 1.1 bad return 0;
213 1.1 bad }
214 1.1 bad /* All tests passed */
215 1.1 bad return 1;
216 1.1 bad }
217 1.1 bad
218 1.1 bad /*
219 1.1 bad * Read chip ID from AR_ILOCK in test mode.
220 1.1 bad */
221 1.1 bad int
222 1.1 bad tcic_chipid(iot, ioh)
223 1.1 bad bus_space_tag_t iot;
224 1.1 bad bus_space_handle_t ioh;
225 1.1 bad {
226 1.1 bad unsigned id, otest;
227 1.1 bad
228 1.1 bad otest = tcic_read_aux_2(iot, ioh, TCIC_AR_TEST);
229 1.1 bad tcic_write_aux_2(iot, ioh, TCIC_AR_TEST, TCIC_TEST_DIAG);
230 1.1 bad id = tcic_read_aux_2(iot, ioh, TCIC_AR_ILOCK);
231 1.1 bad tcic_write_aux_2(iot, ioh, TCIC_AR_TEST, otest);
232 1.1 bad id &= TCIC_ILOCKTEST_ID_MASK;
233 1.1 bad id >>= TCIC_ILOCKTEST_ID_SHFT;
234 1.1 bad
235 1.1 bad /* clear up IRQs inside tcic. XXX -chb */
236 1.1 bad while (bus_space_read_1(iot, ioh, TCIC_R_ICSR))
237 1.1 bad bus_space_write_1(iot, ioh, TCIC_R_ICSR, TCIC_ICSR_JAM);
238 1.1 bad
239 1.1 bad return id;
240 1.1 bad }
241 1.1 bad /*
242 1.1 bad * Indicate whether the driver can handle the chip.
243 1.1 bad */
244 1.1 bad int
245 1.1 bad tcic_chipid_known(id)
246 1.1 bad int id;
247 1.1 bad {
248 1.1 bad /* XXX only know how to handle DB86082 -chb */
249 1.1 bad switch (id) {
250 1.1 bad case TCIC_CHIPID_DB86082_1:
251 1.1 bad case TCIC_CHIPID_DB86082A:
252 1.1 bad case TCIC_CHIPID_DB86082B_ES:
253 1.1 bad case TCIC_CHIPID_DB86082B:
254 1.1 bad case TCIC_CHIPID_DB86084_1:
255 1.1 bad case TCIC_CHIPID_DB86084A:
256 1.1 bad case TCIC_CHIPID_DB86184_1:
257 1.1 bad case TCIC_CHIPID_DB86072_1_ES:
258 1.1 bad case TCIC_CHIPID_DB86072_1:
259 1.1 bad return 1;
260 1.1 bad }
261 1.1 bad
262 1.1 bad return 0;
263 1.1 bad }
264 1.1 bad
265 1.20 christos const char *
266 1.1 bad tcic_chipid_to_string(id)
267 1.1 bad int id;
268 1.1 bad {
269 1.1 bad switch (id) {
270 1.1 bad case TCIC_CHIPID_DB86082_1:
271 1.1 bad return ("Databook DB86082");
272 1.1 bad case TCIC_CHIPID_DB86082A:
273 1.1 bad return ("Databook DB86082A");
274 1.1 bad case TCIC_CHIPID_DB86082B_ES:
275 1.1 bad return ("Databook DB86082B-es");
276 1.1 bad case TCIC_CHIPID_DB86082B:
277 1.1 bad return ("Databook DB86082B");
278 1.1 bad case TCIC_CHIPID_DB86084_1:
279 1.1 bad return ("Databook DB86084");
280 1.1 bad case TCIC_CHIPID_DB86084A:
281 1.1 bad return ("Databook DB86084A");
282 1.1 bad case TCIC_CHIPID_DB86184_1:
283 1.1 bad return ("Databook DB86184");
284 1.1 bad case TCIC_CHIPID_DB86072_1_ES:
285 1.1 bad return ("Databook DB86072-es");
286 1.1 bad case TCIC_CHIPID_DB86072_1:
287 1.1 bad return ("Databook DB86072");
288 1.1 bad }
289 1.1 bad
290 1.1 bad return ("Unknown controller");
291 1.1 bad }
292 1.1 bad /*
293 1.1 bad * Return bitmask of IRQs that the chip can handle.
294 1.1 bad * XXX should be table driven.
295 1.1 bad */
296 1.1 bad int
297 1.1 bad tcic_validirqs(chipid)
298 1.1 bad int chipid;
299 1.1 bad {
300 1.1 bad switch (chipid) {
301 1.1 bad case TCIC_CHIPID_DB86082_1:
302 1.1 bad case TCIC_CHIPID_DB86082A:
303 1.1 bad case TCIC_CHIPID_DB86082B_ES:
304 1.1 bad case TCIC_CHIPID_DB86082B:
305 1.1 bad case TCIC_CHIPID_DB86084_1:
306 1.1 bad case TCIC_CHIPID_DB86084A:
307 1.1 bad case TCIC_CHIPID_DB86184_1:
308 1.1 bad case TCIC_CHIPID_DB86072_1_ES:
309 1.1 bad case TCIC_CHIPID_DB86072_1:
310 1.1 bad return tcic_valid_irqs;
311 1.1 bad }
312 1.1 bad return 0;
313 1.1 bad }
314 1.1 bad
315 1.1 bad void
316 1.1 bad tcic_attach(sc)
317 1.1 bad struct tcic_softc *sc;
318 1.1 bad {
319 1.1 bad int i, reg;
320 1.1 bad
321 1.13 wiz /* set more chipset dependent parameters in the softc. */
322 1.1 bad switch (sc->chipid) {
323 1.1 bad case TCIC_CHIPID_DB86084_1:
324 1.1 bad case TCIC_CHIPID_DB86084A:
325 1.1 bad case TCIC_CHIPID_DB86184_1:
326 1.1 bad sc->pwrena = TCIC_PWR_ENA;
327 1.1 bad break;
328 1.1 bad default:
329 1.1 bad sc->pwrena = 0;
330 1.1 bad break;
331 1.1 bad }
332 1.1 bad
333 1.1 bad /* set up global config registers */
334 1.1 bad reg = TCIC_WAIT_SYNC | TCIC_WAIT_CCLK | TCIC_WAIT_RISING;
335 1.1 bad reg |= (tcic_ns2wscnt(250) & TCIC_WAIT_COUNT_MASK);
336 1.1 bad tcic_write_aux_1(sc->iot, sc->ioh, TCIC_AR_WCTL, TCIC_R_WCTL_WAIT, reg);
337 1.1 bad reg = TCIC_SYSCFG_MPSEL_RI | TCIC_SYSCFG_MCSFULL;
338 1.1 bad tcic_write_aux_2(sc->iot, sc->ioh, TCIC_AR_SYSCFG, reg);
339 1.1 bad reg = tcic_read_aux_2(sc->iot, sc->ioh, TCIC_AR_ILOCK);
340 1.1 bad reg |= TCIC_ILOCK_HOLD_CCLK;
341 1.1 bad tcic_write_aux_2(sc->iot, sc->ioh, TCIC_AR_ILOCK, reg);
342 1.1 bad
343 1.1 bad /* the TCIC has two sockets */
344 1.1 bad /* XXX should i check for actual presence of sockets? -chb */
345 1.1 bad for (i = 0; i < TCIC_NSLOTS; i++) {
346 1.1 bad sc->handle[i].sc = sc;
347 1.1 bad sc->handle[i].sock = i;
348 1.1 bad sc->handle[i].flags = TCIC_FLAG_SOCKETP;
349 1.1 bad sc->handle[i].memwins
350 1.1 bad = sc->chipid == TCIC_CHIPID_DB86082_1 ? 4 : 5;
351 1.1 bad }
352 1.1 bad
353 1.1 bad /* establish the interrupt */
354 1.1 bad reg = tcic_read_1(&sc->handle[0], TCIC_R_IENA);
355 1.1 bad tcic_write_1(&sc->handle[0], TCIC_R_IENA,
356 1.1 bad (reg & ~TCIC_IENA_CFG_MASK) | TCIC_IENA_CFG_HIGH);
357 1.1 bad reg = tcic_read_aux_2(sc->iot, sc->ioh, TCIC_AR_SYSCFG);
358 1.1 bad tcic_write_aux_2(sc->iot, sc->ioh, TCIC_AR_SYSCFG,
359 1.1 bad (reg & ~TCIC_SYSCFG_IRQ_MASK) | tcic_irqmap[sc->irq]);
360 1.1 bad
361 1.1 bad /* XXX block interrupts? */
362 1.1 bad
363 1.1 bad for (i = 0; i < TCIC_NSLOTS; i++) {
364 1.1 bad /* XXX make more clear what happens here -chb */
365 1.1 bad tcic_sel_sock(&sc->handle[i]);
366 1.1 bad tcic_write_ind_2(&sc->handle[i], TCIC_IR_SCF1_N(i), 0);
367 1.19 perry tcic_write_ind_2(&sc->handle[i], TCIC_IR_SCF2_N(i),
368 1.1 bad (TCIC_SCF2_MCD|TCIC_SCF2_MWP|TCIC_SCF2_MRDY
369 1.1 bad #if 1 /* XXX explain byte routing issue */
370 1.1 bad |TCIC_SCF2_MLBAT2|TCIC_SCF2_MLBAT1|TCIC_SCF2_IDBR));
371 1.1 bad #else
372 1.1 bad |TCIC_SCF2_MLBAT2|TCIC_SCF2_MLBAT1));
373 1.1 bad #endif
374 1.1 bad tcic_write_1(&sc->handle[i], TCIC_R_MODE, 0);
375 1.1 bad reg = tcic_read_aux_2(sc->iot, sc->ioh, TCIC_AR_SYSCFG);
376 1.1 bad reg &= ~TCIC_SYSCFG_AUTOBUSY;
377 1.1 bad tcic_write_aux_2(sc->iot, sc->ioh, TCIC_AR_SYSCFG, reg);
378 1.1 bad SIMPLEQ_INIT(&sc->handle[i].events);
379 1.1 bad }
380 1.1 bad
381 1.1 bad if ((sc->handle[0].flags & TCIC_FLAG_SOCKETP) ||
382 1.1 bad (sc->handle[1].flags & TCIC_FLAG_SOCKETP)) {
383 1.1 bad printf("%s: %s has ", sc->dev.dv_xname,
384 1.1 bad tcic_chipid_to_string(sc->chipid));
385 1.1 bad
386 1.1 bad if ((sc->handle[0].flags & TCIC_FLAG_SOCKETP) &&
387 1.1 bad (sc->handle[1].flags & TCIC_FLAG_SOCKETP))
388 1.1 bad printf("sockets A and B\n");
389 1.1 bad else if (sc->handle[0].flags & TCIC_FLAG_SOCKETP)
390 1.1 bad printf("socket A only\n");
391 1.1 bad else
392 1.1 bad printf("socket B only\n");
393 1.1 bad
394 1.1 bad }
395 1.1 bad }
396 1.1 bad
397 1.1 bad void
398 1.1 bad tcic_attach_sockets(sc)
399 1.1 bad struct tcic_softc *sc;
400 1.1 bad {
401 1.1 bad int i;
402 1.1 bad
403 1.1 bad for (i = 0; i < TCIC_NSLOTS; i++)
404 1.1 bad if (sc->handle[i].flags & TCIC_FLAG_SOCKETP)
405 1.1 bad tcic_attach_socket(&sc->handle[i]);
406 1.1 bad }
407 1.1 bad
408 1.1 bad void
409 1.1 bad tcic_attach_socket(h)
410 1.1 bad struct tcic_handle *h;
411 1.1 bad {
412 1.1 bad struct pcmciabus_attach_args paa;
413 1.21 drochner int locs[PCMCIABUSCF_NLOCS];
414 1.1 bad
415 1.1 bad /* initialize the rest of the handle */
416 1.1 bad
417 1.1 bad h->shutdown = 0;
418 1.1 bad h->memalloc = 0;
419 1.1 bad h->ioalloc = 0;
420 1.1 bad h->ih_irq = 0;
421 1.1 bad
422 1.1 bad /* now, config one pcmcia device per socket */
423 1.1 bad
424 1.4 explorer paa.paa_busname = "pcmcia";
425 1.1 bad paa.pct = (pcmcia_chipset_tag_t) h->sc->pct;
426 1.1 bad paa.pch = (pcmcia_chipset_handle_t) h;
427 1.1 bad paa.iobase = h->sc->iobase;
428 1.1 bad paa.iosize = h->sc->iosize;
429 1.1 bad
430 1.21 drochner locs[PCMCIABUSCF_CONTROLLER] = 0;
431 1.21 drochner locs[PCMCIABUSCF_SOCKET] = h->sock;
432 1.17 drochner
433 1.21 drochner h->pcmcia = config_found_sm_loc(&h->sc->dev, "pcmciabus", locs, &paa,
434 1.22 drochner tcic_print, config_stdsubmatch);
435 1.1 bad
436 1.1 bad /* if there's actually a pcmcia device attached, initialize the slot */
437 1.1 bad
438 1.1 bad if (h->pcmcia)
439 1.1 bad tcic_init_socket(h);
440 1.1 bad }
441 1.1 bad
442 1.1 bad void
443 1.1 bad tcic_create_event_thread(arg)
444 1.1 bad void *arg;
445 1.1 bad {
446 1.1 bad struct tcic_handle *h = arg;
447 1.1 bad const char *cs;
448 1.1 bad
449 1.1 bad switch (h->sock) {
450 1.1 bad case 0:
451 1.1 bad cs = "0";
452 1.1 bad break;
453 1.1 bad case 1:
454 1.1 bad cs = "1";
455 1.1 bad break;
456 1.1 bad default:
457 1.1 bad panic("tcic_create_event_thread: unknown tcic socket");
458 1.1 bad }
459 1.1 bad
460 1.27 ad if (kthread_create(PRI_NONE, 0, NULL, tcic_event_thread, h,
461 1.27 ad &h->event_thread, "%s,%s", h->sc->dev.dv_xname, cs)) {
462 1.1 bad printf("%s: unable to create event thread for sock 0x%02x\n",
463 1.1 bad h->sc->dev.dv_xname, h->sock);
464 1.1 bad panic("tcic_create_event_thread");
465 1.1 bad }
466 1.1 bad }
467 1.1 bad
468 1.1 bad void
469 1.1 bad tcic_event_thread(arg)
470 1.1 bad void *arg;
471 1.1 bad {
472 1.1 bad struct tcic_handle *h = arg;
473 1.1 bad struct tcic_event *pe;
474 1.1 bad int s;
475 1.1 bad
476 1.1 bad while (h->shutdown == 0) {
477 1.1 bad s = splhigh();
478 1.1 bad if ((pe = SIMPLEQ_FIRST(&h->events)) == NULL) {
479 1.1 bad splx(s);
480 1.1 bad (void) tsleep(&h->events, PWAIT, "tcicev", 0);
481 1.1 bad continue;
482 1.1 bad }
483 1.10 lukem SIMPLEQ_REMOVE_HEAD(&h->events, pe_q);
484 1.1 bad splx(s);
485 1.1 bad
486 1.1 bad switch (pe->pe_type) {
487 1.1 bad case TCIC_EVENT_INSERTION:
488 1.1 bad DPRINTF(("%s: insertion event\n", h->sc->dev.dv_xname));
489 1.1 bad tcic_attach_card(h);
490 1.1 bad break;
491 1.1 bad
492 1.1 bad case TCIC_EVENT_REMOVAL:
493 1.1 bad DPRINTF(("%s: removal event\n", h->sc->dev.dv_xname));
494 1.1 bad tcic_detach_card(h, DETACH_FORCE);
495 1.1 bad break;
496 1.1 bad
497 1.1 bad default:
498 1.1 bad panic("tcic_event_thread: unknown event %d",
499 1.1 bad pe->pe_type);
500 1.1 bad }
501 1.1 bad free(pe, M_TEMP);
502 1.1 bad }
503 1.1 bad
504 1.1 bad h->event_thread = NULL;
505 1.1 bad
506 1.1 bad /* In case parent is waiting for us to exit. */
507 1.1 bad wakeup(h->sc);
508 1.1 bad
509 1.1 bad kthread_exit(0);
510 1.1 bad }
511 1.1 bad
512 1.1 bad
513 1.1 bad void
514 1.1 bad tcic_init_socket(h)
515 1.1 bad struct tcic_handle *h;
516 1.1 bad {
517 1.1 bad int reg;
518 1.1 bad
519 1.1 bad /* select this socket's config registers */
520 1.1 bad tcic_sel_sock(h);
521 1.1 bad
522 1.1 bad /* set up the socket to interrupt on card detect */
523 1.1 bad reg = tcic_read_ind_2(h, TCIC_IR_SCF2_N(h->sock));
524 1.1 bad tcic_write_ind_2(h, TCIC_IR_SCF2_N(h->sock), reg & ~TCIC_SCF2_MCD);
525 1.1 bad
526 1.1 bad /* enable CD irq in R_IENA */
527 1.1 bad reg = tcic_read_2(h, TCIC_R_IENA);
528 1.1 bad tcic_write_2(h, TCIC_R_IENA, reg |= TCIC_IENA_CDCHG);
529 1.1 bad
530 1.1 bad /* if there's a card there, then attach it. also save sstat */
531 1.1 bad h->sstat = reg = tcic_read_1(h, TCIC_R_SSTAT) & TCIC_SSTAT_STAT_MASK;
532 1.1 bad if (reg & TCIC_SSTAT_CD)
533 1.1 bad tcic_attach_card(h);
534 1.1 bad }
535 1.1 bad
536 1.1 bad int
537 1.1 bad tcic_print(arg, pnp)
538 1.1 bad void *arg;
539 1.1 bad const char *pnp;
540 1.1 bad {
541 1.1 bad struct pcmciabus_attach_args *paa = arg;
542 1.1 bad struct tcic_handle *h = (struct tcic_handle *) paa->pch;
543 1.1 bad
544 1.1 bad /* Only "pcmcia"s can attach to "tcic"s... easy. */
545 1.1 bad if (pnp)
546 1.12 thorpej aprint_normal("pcmcia at %s", pnp);
547 1.1 bad
548 1.17 drochner aprint_normal(" socket %d", h->sock);
549 1.17 drochner
550 1.1 bad return (UNCONF);
551 1.1 bad }
552 1.1 bad
553 1.1 bad int
554 1.1 bad tcic_intr(arg)
555 1.1 bad void *arg;
556 1.1 bad {
557 1.1 bad struct tcic_softc *sc = arg;
558 1.1 bad int i, ret = 0;
559 1.1 bad
560 1.1 bad DPRINTF(("%s: intr\n", sc->dev.dv_xname));
561 1.1 bad
562 1.1 bad for (i = 0; i < TCIC_NSLOTS; i++)
563 1.1 bad if (sc->handle[i].flags & TCIC_FLAG_SOCKETP)
564 1.1 bad ret += tcic_intr_socket(&sc->handle[i]);
565 1.1 bad
566 1.1 bad return (ret ? 1 : 0);
567 1.1 bad }
568 1.1 bad
569 1.1 bad int
570 1.1 bad tcic_intr_socket(h)
571 1.1 bad struct tcic_handle *h;
572 1.1 bad {
573 1.1 bad int icsr, rv;
574 1.1 bad
575 1.1 bad rv = 0;
576 1.1 bad tcic_sel_sock(h);
577 1.1 bad icsr = tcic_read_1(h, TCIC_R_ICSR);
578 1.1 bad
579 1.1 bad DPRINTF(("%s: %d icsr: 0x%02x \n", h->sc->dev.dv_xname, h->sock, icsr));
580 1.1 bad
581 1.1 bad /* XXX or should the next three be handled in tcic_intr? -chb */
582 1.1 bad if (icsr & TCIC_ICSR_PROGTIME) {
583 1.1 bad DPRINTF(("%s: %02x PROGTIME\n", h->sc->dev.dv_xname, h->sock));
584 1.1 bad rv = 1;
585 1.1 bad }
586 1.1 bad if (icsr & TCIC_ICSR_ILOCK) {
587 1.1 bad DPRINTF(("%s: %02x ILOCK\n", h->sc->dev.dv_xname, h->sock));
588 1.1 bad rv = 1;
589 1.1 bad }
590 1.1 bad if (icsr & TCIC_ICSR_ERR) {
591 1.1 bad DPRINTF(("%s: %02x ERR\n", h->sc->dev.dv_xname, h->sock));
592 1.1 bad rv = 1;
593 1.1 bad }
594 1.1 bad if (icsr & TCIC_ICSR_CDCHG) {
595 1.1 bad int sstat, delta;
596 1.1 bad
597 1.1 bad /* compute what changed since last interrupt */
598 1.1 bad sstat = tcic_read_aux_1(h->sc->iot, h->sc->ioh,
599 1.1 bad TCIC_AR_WCTL, TCIC_R_WCTL_XCSR) & TCIC_XCSR_STAT_MASK;
600 1.1 bad delta = h->sstat ^ sstat;
601 1.1 bad h->sstat = sstat;
602 1.1 bad
603 1.1 bad if (delta)
604 1.1 bad rv = 1;
605 1.1 bad
606 1.1 bad DPRINTF(("%s: %02x CDCHG %x\n", h->sc->dev.dv_xname, h->sock,
607 1.1 bad delta));
608 1.1 bad
609 1.1 bad /*
610 1.1 bad * XXX This should probably schedule something to happen
611 1.1 bad * after the interrupt handler completes
612 1.1 bad */
613 1.1 bad
614 1.1 bad if (delta & TCIC_SSTAT_CD) {
615 1.1 bad if (sstat & TCIC_SSTAT_CD) {
616 1.1 bad if (!(h->flags & TCIC_FLAG_CARDP)) {
617 1.1 bad DPRINTF(("%s: enqueing INSERTION event\n",
618 1.1 bad h->sc->dev.dv_xname));
619 1.1 bad tcic_queue_event(h, TCIC_EVENT_INSERTION);
620 1.1 bad }
621 1.1 bad } else {
622 1.1 bad if (h->flags & TCIC_FLAG_CARDP) {
623 1.1 bad /* Deactivate the card now. */
624 1.1 bad DPRINTF(("%s: deactivating card\n",
625 1.1 bad h->sc->dev.dv_xname));
626 1.1 bad tcic_deactivate_card(h);
627 1.1 bad
628 1.1 bad DPRINTF(("%s: enqueing REMOVAL event\n",
629 1.1 bad h->sc->dev.dv_xname));
630 1.1 bad tcic_queue_event(h, TCIC_EVENT_REMOVAL);
631 1.1 bad }
632 1.1 bad }
633 1.1 bad }
634 1.1 bad if (delta & TCIC_SSTAT_RDY) {
635 1.1 bad DPRINTF(("%s: %02x READY\n", h->sc->dev.dv_xname, h->sock));
636 1.1 bad /* shouldn't happen */
637 1.1 bad }
638 1.1 bad if (delta & TCIC_SSTAT_LBAT1) {
639 1.1 bad DPRINTF(("%s: %02x LBAT1\n", h->sc->dev.dv_xname, h->sock));
640 1.1 bad }
641 1.1 bad if (delta & TCIC_SSTAT_LBAT2) {
642 1.1 bad DPRINTF(("%s: %02x LBAT2\n", h->sc->dev.dv_xname, h->sock));
643 1.1 bad }
644 1.1 bad if (delta & TCIC_SSTAT_WP) {
645 1.1 bad DPRINTF(("%s: %02x WP\n", h->sc->dev.dv_xname, h->sock));
646 1.1 bad }
647 1.1 bad }
648 1.1 bad return rv;
649 1.1 bad }
650 1.1 bad
651 1.1 bad void
652 1.1 bad tcic_queue_event(h, event)
653 1.1 bad struct tcic_handle *h;
654 1.1 bad int event;
655 1.1 bad {
656 1.1 bad struct tcic_event *pe;
657 1.1 bad int s;
658 1.1 bad
659 1.1 bad pe = malloc(sizeof(*pe), M_TEMP, M_NOWAIT);
660 1.1 bad if (pe == NULL)
661 1.1 bad panic("tcic_queue_event: can't allocate event");
662 1.1 bad
663 1.1 bad pe->pe_type = event;
664 1.1 bad s = splhigh();
665 1.1 bad SIMPLEQ_INSERT_TAIL(&h->events, pe, pe_q);
666 1.1 bad splx(s);
667 1.1 bad wakeup(&h->events);
668 1.1 bad }
669 1.1 bad void
670 1.1 bad tcic_attach_card(h)
671 1.1 bad struct tcic_handle *h;
672 1.1 bad {
673 1.1 bad DPRINTF(("tcic_attach_card\n"));
674 1.1 bad
675 1.1 bad if (h->flags & TCIC_FLAG_CARDP)
676 1.1 bad panic("tcic_attach_card: already attached");
677 1.1 bad
678 1.1 bad /* call the MI attach function */
679 1.1 bad
680 1.1 bad pcmcia_card_attach(h->pcmcia);
681 1.1 bad
682 1.1 bad h->flags |= TCIC_FLAG_CARDP;
683 1.1 bad }
684 1.1 bad
685 1.1 bad void
686 1.1 bad tcic_detach_card(h, flags)
687 1.1 bad struct tcic_handle *h;
688 1.1 bad int flags; /* DETACH_* */
689 1.1 bad {
690 1.1 bad DPRINTF(("tcic_detach_card\n"));
691 1.1 bad
692 1.1 bad if (!(h->flags & TCIC_FLAG_CARDP))
693 1.1 bad panic("tcic_detach_card: already detached");
694 1.1 bad
695 1.1 bad h->flags &= ~TCIC_FLAG_CARDP;
696 1.1 bad
697 1.1 bad /* call the MI detach function */
698 1.1 bad
699 1.1 bad pcmcia_card_detach(h->pcmcia, flags);
700 1.1 bad
701 1.1 bad }
702 1.1 bad
703 1.1 bad void
704 1.1 bad tcic_deactivate_card(h)
705 1.1 bad struct tcic_handle *h;
706 1.1 bad {
707 1.1 bad int val, reg;
708 1.1 bad
709 1.1 bad if (!(h->flags & TCIC_FLAG_CARDP))
710 1.1 bad panic("tcic_deactivate_card: already detached");
711 1.1 bad
712 1.1 bad /* call the MI deactivate function */
713 1.1 bad pcmcia_card_deactivate(h->pcmcia);
714 1.1 bad
715 1.1 bad tcic_sel_sock(h);
716 1.1 bad
717 1.1 bad /* XXX disable card detect resume and configuration reset??? */
718 1.1 bad
719 1.1 bad /* power down the socket */
720 1.1 bad tcic_write_1(h, TCIC_R_PWR, 0);
721 1.1 bad
722 1.1 bad /* reset the card XXX ? -chb */
723 1.1 bad
724 1.1 bad /* turn off irq's for this socket */
725 1.1 bad reg = TCIC_IR_SCF1_N(h->sock);
726 1.1 bad val = tcic_read_ind_2(h, reg);
727 1.1 bad tcic_write_ind_2(h, reg, (val & ~TCIC_SCF1_IRQ_MASK)|TCIC_SCF1_IRQOFF);
728 1.1 bad reg = TCIC_IR_SCF2_N(h->sock);
729 1.1 bad val = tcic_read_ind_2(h, reg);
730 1.1 bad tcic_write_ind_2(h, reg,
731 1.1 bad (val | (TCIC_SCF2_MLBAT1|TCIC_SCF2_MLBAT2|TCIC_SCF2_MRDY
732 1.1 bad |TCIC_SCF2_MWP|TCIC_SCF2_MCD)));
733 1.1 bad }
734 1.1 bad
735 1.1 bad /* XXX the following routine may need to be rewritten. -chb */
736 1.19 perry int
737 1.1 bad tcic_chip_mem_alloc(pch, size, pcmhp)
738 1.1 bad pcmcia_chipset_handle_t pch;
739 1.1 bad bus_size_t size;
740 1.1 bad struct pcmcia_mem_handle *pcmhp;
741 1.1 bad {
742 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
743 1.1 bad bus_space_handle_t memh;
744 1.1 bad bus_addr_t addr;
745 1.1 bad bus_size_t sizepg;
746 1.24 christos int i, mask, mhandle, got = 0;
747 1.1 bad
748 1.1 bad /* out of sc->memh, allocate as many pages as necessary */
749 1.1 bad
750 1.1 bad /*
751 1.1 bad * The TCIC can map memory only in sizes that are
752 1.1 bad * powers of two, aligned at the natural boundary for the size.
753 1.1 bad */
754 1.1 bad i = tcic_log2((u_int)size);
755 1.1 bad if ((1<<i) < size)
756 1.1 bad i++;
757 1.1 bad sizepg = max(i, TCIC_MEM_SHIFT) - (TCIC_MEM_SHIFT-1);
758 1.1 bad
759 1.1 bad DPRINTF(("tcic_chip_mem_alloc: size %ld sizepg %ld\n", size, sizepg));
760 1.1 bad
761 1.1 bad /* can't allocate that much anyway */
762 1.1 bad if (sizepg > TCIC_MEM_PAGES) /* XXX -chb */
763 1.1 bad return 1;
764 1.1 bad
765 1.1 bad mask = (1 << sizepg) - 1;
766 1.1 bad
767 1.1 bad addr = 0; /* XXX gcc -Wuninitialized */
768 1.1 bad mhandle = 0; /* XXX gcc -Wuninitialized */
769 1.1 bad
770 1.1 bad /* XXX i should be initialised to always lay on boundary. -chb */
771 1.1 bad for (i = 0; i < (TCIC_MEM_PAGES + 1 - sizepg); i += sizepg) {
772 1.1 bad if ((h->sc->subregionmask & (mask << i)) == (mask << i)) {
773 1.1 bad if (bus_space_subregion(h->sc->memt, h->sc->memh,
774 1.1 bad i * TCIC_MEM_PAGESIZE,
775 1.1 bad sizepg * TCIC_MEM_PAGESIZE, &memh))
776 1.1 bad return (1);
777 1.1 bad mhandle = mask << i;
778 1.1 bad addr = h->sc->membase + (i * TCIC_MEM_PAGESIZE);
779 1.1 bad h->sc->subregionmask &= ~(mhandle);
780 1.24 christos got = 1;
781 1.1 bad break;
782 1.1 bad }
783 1.1 bad }
784 1.1 bad
785 1.24 christos if (got == 0)
786 1.1 bad return (1);
787 1.1 bad
788 1.1 bad DPRINTF(("tcic_chip_mem_alloc bus addr 0x%lx+0x%lx\n", (u_long) addr,
789 1.1 bad (u_long) size));
790 1.1 bad
791 1.1 bad pcmhp->memt = h->sc->memt;
792 1.1 bad pcmhp->memh = memh;
793 1.1 bad pcmhp->addr = addr;
794 1.1 bad pcmhp->size = size;
795 1.1 bad pcmhp->mhandle = mhandle;
796 1.1 bad pcmhp->realsize = sizepg * TCIC_MEM_PAGESIZE;
797 1.1 bad
798 1.1 bad return (0);
799 1.1 bad }
800 1.1 bad
801 1.1 bad /* XXX the following routine may need to be rewritten. -chb */
802 1.19 perry void
803 1.1 bad tcic_chip_mem_free(pch, pcmhp)
804 1.1 bad pcmcia_chipset_handle_t pch;
805 1.1 bad struct pcmcia_mem_handle *pcmhp;
806 1.1 bad {
807 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
808 1.1 bad
809 1.1 bad h->sc->subregionmask |= pcmhp->mhandle;
810 1.1 bad }
811 1.1 bad
812 1.19 perry void
813 1.1 bad tcic_chip_do_mem_map(h, win)
814 1.1 bad struct tcic_handle *h;
815 1.1 bad int win;
816 1.1 bad {
817 1.1 bad int reg, hwwin, wscnt;
818 1.1 bad
819 1.3 joda int kind = h->mem[win].kind & ~PCMCIA_WIDTH_MEM_MASK;
820 1.3 joda int mem8 = (h->mem[win].kind & PCMCIA_WIDTH_MEM_MASK) == PCMCIA_WIDTH_MEM8;
821 1.1 bad DPRINTF(("tcic_chip_do_mem_map window %d: 0x%lx+0x%lx 0x%lx\n",
822 1.1 bad win, (u_long)h->mem[win].addr, (u_long)h->mem[win].size,
823 1.1 bad (u_long)h->mem[win].offset));
824 1.1 bad /*
825 1.1 bad * the even windows are used for socket 0,
826 1.1 bad * the odd ones for socket 1.
827 1.1 bad */
828 1.1 bad hwwin = (win << 1) + h->sock;
829 1.1 bad
830 1.1 bad /* the WR_MEXT register is MBZ */
831 1.1 bad tcic_write_ind_2(h, TCIC_WR_MEXT_N(hwwin), 0);
832 1.1 bad
833 1.1 bad /* set the host base address and window size */
834 1.1 bad if (h->mem[win].size2 <= 1) {
835 1.1 bad reg = ((h->mem[win].addr >> TCIC_MEM_SHIFT) &
836 1.1 bad TCIC_MBASE_ADDR_MASK) | TCIC_MBASE_4K;
837 1.1 bad } else {
838 1.1 bad reg = ((h->mem[win].addr >> TCIC_MEM_SHIFT) &
839 1.1 bad TCIC_MBASE_ADDR_MASK) | (h->mem[win].size2 >> 1);
840 1.1 bad }
841 1.1 bad tcic_write_ind_2(h, TCIC_WR_MBASE_N(hwwin), reg);
842 1.1 bad
843 1.1 bad /* set the card address and address space */
844 1.1 bad reg = 0;
845 1.1 bad reg = ((h->mem[win].offset >> TCIC_MEM_SHIFT) & TCIC_MMAP_ADDR_MASK);
846 1.3 joda reg |= (kind == PCMCIA_MEM_ATTR) ? TCIC_MMAP_ATTR : 0;
847 1.1 bad DPRINTF(("tcic_chip_do_map_mem window %d(%d) mmap 0x%04x\n",
848 1.1 bad win, hwwin, reg));
849 1.1 bad tcic_write_ind_2(h, TCIC_WR_MMAP_N(hwwin), reg);
850 1.1 bad
851 1.1 bad /* set the MCTL register */
852 1.1 bad /* must save WSCNT field in case this is a DB86082 rev 0 */
853 1.1 bad /* XXX why can't I do the following two in one statement? */
854 1.1 bad reg = tcic_read_ind_2(h, TCIC_WR_MCTL_N(hwwin)) & TCIC_MCTL_WSCNT_MASK;
855 1.1 bad reg |= TCIC_MCTL_ENA|TCIC_MCTL_QUIET;
856 1.3 joda reg |= mem8 ? TCIC_MCTL_B8 : 0;
857 1.1 bad reg |= (h->sock << TCIC_MCTL_SS_SHIFT) & TCIC_MCTL_SS_MASK;
858 1.1 bad #ifdef notyet /* XXX must get speed from CIS somehow. -chb */
859 1.1 bad wscnt = tcic_ns2wscnt(h->mem[win].speed);
860 1.1 bad #else
861 1.1 bad wscnt = tcic_ns2wscnt(tcic_mem_speed); /* 300 is "save" default for CIS memory */
862 1.1 bad #endif
863 1.1 bad if (h->sc->chipid == TCIC_CHIPID_DB86082_1) {
864 1.1 bad /*
865 1.1 bad * this chip has the wait state count in window
866 1.1 bad * register 7 - hwwin.
867 1.1 bad */
868 1.1 bad int reg2;
869 1.1 bad reg2 = tcic_read_ind_2(h, TCIC_WR_MCTL_N(7-hwwin));
870 1.1 bad reg2 &= ~TCIC_MCTL_WSCNT_MASK;
871 1.1 bad reg2 |= wscnt & TCIC_MCTL_WSCNT_MASK;
872 1.1 bad tcic_write_ind_2(h, TCIC_WR_MCTL_N(7-hwwin), reg2);
873 1.1 bad } else {
874 1.1 bad reg |= wscnt & TCIC_MCTL_WSCNT_MASK;
875 1.1 bad }
876 1.1 bad tcic_write_ind_2(h, TCIC_WR_MCTL_N(hwwin), reg);
877 1.1 bad
878 1.1 bad #ifdef TCICDEBUG
879 1.1 bad {
880 1.1 bad int r1, r2, r3;
881 1.1 bad
882 1.1 bad r1 = tcic_read_ind_2(h, TCIC_WR_MBASE_N(hwwin));
883 1.1 bad r2 = tcic_read_ind_2(h, TCIC_WR_MMAP_N(hwwin));
884 1.1 bad r3 = tcic_read_ind_2(h, TCIC_WR_MCTL_N(hwwin));
885 1.1 bad
886 1.1 bad DPRINTF(("tcic_chip_do_mem_map window %d(%d): %04x %04x %04x\n",
887 1.1 bad win, hwwin, r1, r2, r3));
888 1.1 bad }
889 1.1 bad #endif
890 1.1 bad }
891 1.1 bad
892 1.1 bad /* XXX needs work */
893 1.19 perry int
894 1.1 bad tcic_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
895 1.1 bad pcmcia_chipset_handle_t pch;
896 1.1 bad int kind;
897 1.1 bad bus_addr_t card_addr;
898 1.1 bad bus_size_t size;
899 1.1 bad struct pcmcia_mem_handle *pcmhp;
900 1.9 soren bus_size_t *offsetp;
901 1.1 bad int *windowp;
902 1.1 bad {
903 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
904 1.1 bad bus_addr_t busaddr;
905 1.1 bad long card_offset;
906 1.1 bad int i, win;
907 1.1 bad
908 1.1 bad win = -1;
909 1.1 bad for (i = 0; i < h->memwins; i++) {
910 1.1 bad if ((h->memalloc & (1 << i)) == 0) {
911 1.1 bad win = i;
912 1.1 bad h->memalloc |= (1 << i);
913 1.1 bad break;
914 1.1 bad }
915 1.1 bad }
916 1.1 bad
917 1.1 bad if (win == -1)
918 1.1 bad return (1);
919 1.1 bad
920 1.1 bad *windowp = win;
921 1.1 bad
922 1.1 bad /* XXX this is pretty gross */
923 1.1 bad
924 1.1 bad if (h->sc->memt != pcmhp->memt)
925 1.1 bad panic("tcic_chip_mem_map memt is bogus");
926 1.1 bad
927 1.1 bad busaddr = pcmhp->addr;
928 1.1 bad
929 1.1 bad /*
930 1.1 bad * compute the address offset to the pcmcia address space for the
931 1.1 bad * tcic. this is intentionally signed. The masks and shifts below
932 1.1 bad * will cause TRT to happen in the tcic registers. Deal with making
933 1.1 bad * sure the address is aligned, and return the alignment offset.
934 1.1 bad */
935 1.1 bad
936 1.1 bad *offsetp = card_addr % TCIC_MEM_ALIGN;
937 1.1 bad card_addr -= *offsetp;
938 1.1 bad
939 1.1 bad DPRINTF(("tcic_chip_mem_map window %d bus %lx+%lx+%lx at card addr "
940 1.1 bad "%lx\n", win, (u_long) busaddr, (u_long) * offsetp, (u_long) size,
941 1.1 bad (u_long) card_addr));
942 1.1 bad
943 1.1 bad /* XXX we can't use size. -chb */
944 1.1 bad /*
945 1.1 bad * include the offset in the size, and decrement size by one, since
946 1.1 bad * the hw wants start/stop
947 1.1 bad */
948 1.1 bad size += *offsetp - 1;
949 1.1 bad
950 1.1 bad card_offset = (((long) card_addr) - ((long) busaddr));
951 1.1 bad
952 1.1 bad DPRINTF(("tcic_chip_mem_map window %d card_offset 0x%lx\n",
953 1.1 bad win, (u_long)card_offset));
954 1.1 bad
955 1.1 bad h->mem[win].addr = busaddr;
956 1.1 bad h->mem[win].size = size;
957 1.1 bad h->mem[win].size2 = tcic_log2((u_int)pcmhp->realsize) - TCIC_MEM_SHIFT;
958 1.1 bad h->mem[win].offset = card_offset;
959 1.1 bad h->mem[win].kind = kind;
960 1.1 bad
961 1.1 bad tcic_chip_do_mem_map(h, win);
962 1.1 bad
963 1.1 bad return (0);
964 1.1 bad }
965 1.1 bad
966 1.19 perry void
967 1.1 bad tcic_chip_mem_unmap(pch, window)
968 1.1 bad pcmcia_chipset_handle_t pch;
969 1.1 bad int window;
970 1.1 bad {
971 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
972 1.16 mycroft int hwwin;
973 1.1 bad
974 1.1 bad if (window >= h->memwins)
975 1.1 bad panic("tcic_chip_mem_unmap: window out of range");
976 1.1 bad
977 1.1 bad hwwin = (window << 1) + h->sock;
978 1.16 mycroft tcic_write_ind_2(h, TCIC_WR_MCTL_N(hwwin), 0);
979 1.1 bad
980 1.1 bad h->memalloc &= ~(1 << window);
981 1.1 bad }
982 1.1 bad
983 1.19 perry int
984 1.1 bad tcic_chip_io_alloc(pch, start, size, align, pcihp)
985 1.1 bad pcmcia_chipset_handle_t pch;
986 1.1 bad bus_addr_t start;
987 1.1 bad bus_size_t size;
988 1.1 bad bus_size_t align;
989 1.1 bad struct pcmcia_io_handle *pcihp;
990 1.1 bad {
991 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
992 1.1 bad bus_space_tag_t iot;
993 1.1 bad bus_space_handle_t ioh;
994 1.1 bad bus_addr_t ioaddr;
995 1.1 bad int size2, flags = 0;
996 1.1 bad
997 1.1 bad /*
998 1.1 bad * Allocate some arbitrary I/O space.
999 1.1 bad */
1000 1.1 bad
1001 1.1 bad DPRINTF(("tcic_chip_io_alloc req 0x%lx %ld %ld\n",
1002 1.1 bad (u_long) start, (u_long) size, (u_long) align));
1003 1.1 bad /*
1004 1.1 bad * The TCIC can map I/O space only in sizes that are
1005 1.1 bad * powers of two, aligned at the natural boundary for the size.
1006 1.1 bad */
1007 1.1 bad size2 = tcic_log2((u_int)size);
1008 1.1 bad if ((1 << size2) < size)
1009 1.1 bad size2++;
1010 1.1 bad /* can't allocate that much anyway */
1011 1.1 bad if (size2 > 16) /* XXX 64K -chb */
1012 1.1 bad return 1;
1013 1.1 bad if (align) {
1014 1.1 bad if ((1 << size2) != align)
1015 1.1 bad return 1; /* not suitably aligned */
1016 1.1 bad } else {
1017 1.1 bad align = 1 << size2; /* no alignment given, make it natural */
1018 1.1 bad }
1019 1.1 bad if (start & (align - 1))
1020 1.1 bad return 1; /* not suitably aligned */
1021 1.1 bad
1022 1.1 bad iot = h->sc->iot;
1023 1.1 bad
1024 1.1 bad if (start) {
1025 1.1 bad ioaddr = start;
1026 1.1 bad if (bus_space_map(iot, start, size, 0, &ioh))
1027 1.1 bad return (1);
1028 1.1 bad DPRINTF(("tcic_chip_io_alloc map port %lx+%lx\n",
1029 1.1 bad (u_long) ioaddr, (u_long) size));
1030 1.1 bad } else {
1031 1.1 bad flags |= PCMCIA_IO_ALLOCATED;
1032 1.1 bad if (bus_space_alloc(iot, h->sc->iobase,
1033 1.1 bad h->sc->iobase + h->sc->iosize, size, align, 0, 0,
1034 1.1 bad &ioaddr, &ioh))
1035 1.1 bad return (1);
1036 1.1 bad DPRINTF(("tcic_chip_io_alloc alloc port %lx+%lx\n",
1037 1.1 bad (u_long) ioaddr, (u_long) size));
1038 1.1 bad }
1039 1.1 bad
1040 1.1 bad pcihp->iot = iot;
1041 1.1 bad pcihp->ioh = ioh;
1042 1.1 bad pcihp->addr = ioaddr;
1043 1.1 bad pcihp->size = size;
1044 1.1 bad pcihp->flags = flags;
1045 1.1 bad
1046 1.1 bad return (0);
1047 1.1 bad }
1048 1.1 bad
1049 1.19 perry void
1050 1.26 christos tcic_chip_io_free(pcmcia_chipset_handle_t pch,
1051 1.25 christos struct pcmcia_io_handle *pcihp)
1052 1.1 bad {
1053 1.1 bad bus_space_tag_t iot = pcihp->iot;
1054 1.1 bad bus_space_handle_t ioh = pcihp->ioh;
1055 1.1 bad bus_size_t size = pcihp->size;
1056 1.1 bad
1057 1.1 bad if (pcihp->flags & PCMCIA_IO_ALLOCATED)
1058 1.1 bad bus_space_free(iot, ioh, size);
1059 1.1 bad else
1060 1.1 bad bus_space_unmap(iot, ioh, size);
1061 1.1 bad }
1062 1.1 bad
1063 1.1 bad static int tcic_iowidth_map[] =
1064 1.1 bad { TCIC_ICTL_AUTOSZ, TCIC_ICTL_B8, TCIC_ICTL_B16 };
1065 1.1 bad
1066 1.19 perry void
1067 1.1 bad tcic_chip_do_io_map(h, win)
1068 1.1 bad struct tcic_handle *h;
1069 1.1 bad int win;
1070 1.1 bad {
1071 1.1 bad int reg, size2, iotiny, wbase, hwwin, wscnt;
1072 1.1 bad
1073 1.1 bad DPRINTF(("tcic_chip_do_io_map win %d addr %lx size %lx width %d\n",
1074 1.1 bad win, (long) h->io[win].addr, (long) h->io[win].size,
1075 1.1 bad h->io[win].width * 8));
1076 1.1 bad
1077 1.1 bad /*
1078 1.1 bad * the even windows are used for socket 0,
1079 1.1 bad * the odd ones for socket 1.
1080 1.1 bad */
1081 1.1 bad hwwin = (win << 1) + h->sock;
1082 1.1 bad
1083 1.1 bad /* set the WR_BASE register */
1084 1.1 bad /* XXX what if size isn't power of 2? -chb */
1085 1.1 bad size2 = tcic_log2((u_int)h->io[win].size);
1086 1.1 bad DPRINTF(("tcic_chip_do_io_map win %d size2 %d\n", win, size2));
1087 1.1 bad if (size2 < 1) {
1088 1.1 bad iotiny = TCIC_ICTL_TINY;
1089 1.1 bad wbase = h->io[win].addr;
1090 1.1 bad } else {
1091 1.1 bad iotiny = 0;
1092 1.1 bad /* XXX we should do better -chb */
1093 1.1 bad wbase = h->io[win].addr | (1 << (size2 - 1));
1094 1.1 bad }
1095 1.1 bad tcic_write_ind_2(h, TCIC_WR_IBASE_N(hwwin), wbase);
1096 1.1 bad
1097 1.1 bad /* set the WR_ICTL register */
1098 1.1 bad reg = TCIC_ICTL_ENA | TCIC_ICTL_QUIET;
1099 1.1 bad reg |= (h->sock << TCIC_ICTL_SS_SHIFT) & TCIC_ICTL_SS_MASK;
1100 1.1 bad reg |= iotiny | tcic_iowidth_map[h->io[win].width];
1101 1.1 bad if (h->sc->chipid != TCIC_CHIPID_DB86082_1)
1102 1.1 bad reg |= TCIC_ICTL_PASS16;
1103 1.1 bad #ifdef notyet /* XXX must get speed from CIS somehow. -chb */
1104 1.1 bad wscnt = tcic_ns2wscnt(h->io[win].speed);
1105 1.1 bad #else
1106 1.1 bad wscnt = tcic_ns2wscnt(tcic_io_speed); /* linux uses 0 as default */
1107 1.1 bad #endif
1108 1.1 bad reg |= wscnt & TCIC_ICTL_WSCNT_MASK;
1109 1.1 bad tcic_write_ind_2(h, TCIC_WR_ICTL_N(hwwin), reg);
1110 1.1 bad
1111 1.1 bad #ifdef TCICDEBUG
1112 1.1 bad {
1113 1.1 bad int r1, r2;
1114 1.1 bad
1115 1.1 bad r1 = tcic_read_ind_2(h, TCIC_WR_IBASE_N(hwwin));
1116 1.1 bad r2 = tcic_read_ind_2(h, TCIC_WR_ICTL_N(hwwin));
1117 1.1 bad
1118 1.1 bad DPRINTF(("tcic_chip_do_io_map window %d(%d): %04x %04x\n",
1119 1.1 bad win, hwwin, r1, r2));
1120 1.1 bad }
1121 1.1 bad #endif
1122 1.1 bad }
1123 1.1 bad
1124 1.19 perry int
1125 1.1 bad tcic_chip_io_map(pch, width, offset, size, pcihp, windowp)
1126 1.1 bad pcmcia_chipset_handle_t pch;
1127 1.1 bad int width;
1128 1.1 bad bus_addr_t offset;
1129 1.1 bad bus_size_t size;
1130 1.1 bad struct pcmcia_io_handle *pcihp;
1131 1.1 bad int *windowp;
1132 1.1 bad {
1133 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
1134 1.1 bad bus_addr_t ioaddr = pcihp->addr + offset;
1135 1.1 bad int i, win;
1136 1.1 bad #ifdef TCICDEBUG
1137 1.1 bad static char *width_names[] = { "auto", "io8", "io16" };
1138 1.1 bad #endif
1139 1.1 bad
1140 1.1 bad /* XXX Sanity check offset/size. */
1141 1.1 bad
1142 1.1 bad win = -1;
1143 1.1 bad for (i = 0; i < TCIC_IO_WINS; i++) {
1144 1.1 bad if ((h->ioalloc & (1 << i)) == 0) {
1145 1.1 bad win = i;
1146 1.1 bad h->ioalloc |= (1 << i);
1147 1.1 bad break;
1148 1.1 bad }
1149 1.1 bad }
1150 1.1 bad
1151 1.1 bad if (win == -1)
1152 1.1 bad return (1);
1153 1.1 bad
1154 1.1 bad *windowp = win;
1155 1.1 bad
1156 1.1 bad /* XXX this is pretty gross */
1157 1.1 bad
1158 1.1 bad if (h->sc->iot != pcihp->iot)
1159 1.1 bad panic("tcic_chip_io_map iot is bogus");
1160 1.1 bad
1161 1.1 bad DPRINTF(("tcic_chip_io_map window %d %s port %lx+%lx\n",
1162 1.1 bad win, width_names[width], (u_long) ioaddr, (u_long) size));
1163 1.1 bad
1164 1.1 bad /* XXX wtf is this doing here? */
1165 1.1 bad
1166 1.14 christos printf("%s: port 0x%lx", h->sc->dev.dv_xname, (u_long) ioaddr);
1167 1.1 bad if (size > 1)
1168 1.1 bad printf("-0x%lx", (u_long) ioaddr + (u_long) size - 1);
1169 1.14 christos printf("\n");
1170 1.1 bad
1171 1.1 bad h->io[win].addr = ioaddr;
1172 1.1 bad h->io[win].size = size;
1173 1.1 bad h->io[win].width = width;
1174 1.1 bad
1175 1.1 bad tcic_chip_do_io_map(h, win);
1176 1.1 bad
1177 1.1 bad return (0);
1178 1.1 bad }
1179 1.1 bad
1180 1.19 perry void
1181 1.1 bad tcic_chip_io_unmap(pch, window)
1182 1.1 bad pcmcia_chipset_handle_t pch;
1183 1.1 bad int window;
1184 1.1 bad {
1185 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
1186 1.16 mycroft int hwwin;
1187 1.1 bad
1188 1.1 bad if (window >= TCIC_IO_WINS)
1189 1.1 bad panic("tcic_chip_io_unmap: window out of range");
1190 1.1 bad
1191 1.1 bad hwwin = (window << 1) + h->sock;
1192 1.16 mycroft tcic_write_ind_2(h, TCIC_WR_ICTL_N(hwwin), 0);
1193 1.1 bad
1194 1.1 bad h->ioalloc &= ~(1 << window);
1195 1.1 bad }
1196 1.1 bad
1197 1.1 bad void
1198 1.1 bad tcic_chip_socket_enable(pch)
1199 1.1 bad pcmcia_chipset_handle_t pch;
1200 1.1 bad {
1201 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
1202 1.16 mycroft int reg, win;
1203 1.1 bad
1204 1.1 bad tcic_sel_sock(h);
1205 1.1 bad
1206 1.1 bad /*
1207 1.1 bad * power down the socket to reset it.
1208 1.1 bad * put card reset into high-z, put chip outputs to card into high-z
1209 1.1 bad */
1210 1.1 bad
1211 1.1 bad tcic_write_1(h, TCIC_R_PWR, 0);
1212 1.1 bad reg = tcic_read_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK);
1213 1.1 bad reg |= TCIC_ILOCK_CWAIT;
1214 1.1 bad reg &= ~(TCIC_ILOCK_CRESET|TCIC_ILOCK_CRESENA);
1215 1.1 bad tcic_write_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK, reg);
1216 1.1 bad tcic_write_1(h, TCIC_R_SCTRL, 0); /* clear TCIC_SCTRL_ENA */
1217 1.1 bad
1218 1.16 mycroft /* zero out the address windows */
1219 1.16 mycroft
1220 1.16 mycroft tcic_write_ind_2(h, TCIC_IR_SCF1_N(h->sock), 0);
1221 1.16 mycroft /* writing to WR_MBASE_N disables the window */
1222 1.16 mycroft for (win = 0; win < h->memwins; win++) {
1223 1.16 mycroft tcic_write_ind_2(h, TCIC_WR_MBASE_N((win << 1) + h->sock), 0);
1224 1.16 mycroft }
1225 1.16 mycroft /* writing to WR_IBASE_N disables the window */
1226 1.16 mycroft for (win = 0; win < TCIC_IO_WINS; win++) {
1227 1.16 mycroft tcic_write_ind_2(h, TCIC_WR_IBASE_N((win << 1) + h->sock), 0);
1228 1.16 mycroft }
1229 1.16 mycroft
1230 1.1 bad /* power up the socket */
1231 1.1 bad
1232 1.1 bad /* turn on VCC, turn of VPP */
1233 1.1 bad reg = TCIC_PWR_VCC_N(h->sock) | TCIC_PWR_VPP_N(h->sock) | h->sc->pwrena;
1234 1.1 bad if (h->sc->pwrena) /* this is a '84 type chip */
1235 1.1 bad reg |= TCIC_PWR_VCC5V;
1236 1.1 bad tcic_write_1(h, TCIC_R_PWR, reg);
1237 1.1 bad delay(10000);
1238 1.1 bad
1239 1.1 bad /* enable reset and wiggle it to reset the card */
1240 1.1 bad reg = tcic_read_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK);
1241 1.1 bad reg |= TCIC_ILOCK_CRESENA;
1242 1.1 bad tcic_write_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK, reg);
1243 1.1 bad /* XXX need bus_space_barrier here */
1244 1.1 bad reg |= TCIC_ILOCK_CRESET;
1245 1.1 bad tcic_write_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK, reg);
1246 1.1 bad /* enable card signals */
1247 1.1 bad tcic_write_1(h, TCIC_R_SCTRL, TCIC_SCTRL_ENA);
1248 1.1 bad delay(10); /* wait 10 us */
1249 1.1 bad
1250 1.1 bad /* clear the reset flag */
1251 1.1 bad reg = tcic_read_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK);
1252 1.1 bad reg &= ~(TCIC_ILOCK_CRESET);
1253 1.1 bad tcic_write_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK, reg);
1254 1.1 bad
1255 1.1 bad /* wait 20ms as per pc card standard (r2.01) section 4.3.6 */
1256 1.1 bad delay(20000);
1257 1.1 bad
1258 1.1 bad /* wait for the chip to finish initializing */
1259 1.1 bad tcic_wait_ready(h);
1260 1.1 bad
1261 1.1 bad /* WWW */
1262 1.1 bad
1263 1.1 bad /* reinstall all the memory and io mappings */
1264 1.1 bad
1265 1.1 bad for (win = 0; win < h->memwins; win++)
1266 1.1 bad if (h->memalloc & (1 << win))
1267 1.1 bad tcic_chip_do_mem_map(h, win);
1268 1.1 bad
1269 1.1 bad for (win = 0; win < TCIC_IO_WINS; win++)
1270 1.1 bad if (h->ioalloc & (1 << win))
1271 1.1 bad tcic_chip_do_io_map(h, win);
1272 1.1 bad }
1273 1.1 bad
1274 1.1 bad void
1275 1.16 mycroft tcic_chip_socket_settype(pch, type)
1276 1.16 mycroft pcmcia_chipset_handle_t pch;
1277 1.16 mycroft int type;
1278 1.16 mycroft {
1279 1.16 mycroft struct tcic_handle *h = (struct tcic_handle *) pch;
1280 1.16 mycroft int reg;
1281 1.16 mycroft
1282 1.16 mycroft tcic_sel_sock(h);
1283 1.16 mycroft
1284 1.16 mycroft /* set the card type */
1285 1.16 mycroft
1286 1.16 mycroft reg = 0;
1287 1.16 mycroft if (type == PCMCIA_IFTYPE_IO) {
1288 1.16 mycroft reg |= TCIC_SCF1_IOSTS;
1289 1.16 mycroft reg |= tcic_irqmap[h->ih_irq]; /* enable interrupts */
1290 1.16 mycroft }
1291 1.16 mycroft tcic_write_ind_2(h, TCIC_IR_SCF1_N(h->sock), reg);
1292 1.16 mycroft
1293 1.16 mycroft DPRINTF(("%s: tcic_chip_socket_enable %d cardtype %s 0x%02x\n",
1294 1.16 mycroft h->sc->dev.dv_xname, h->sock,
1295 1.16 mycroft ((type == PCMCIA_IFTYPE_IO) ? "io" : "mem"), reg));
1296 1.16 mycroft }
1297 1.16 mycroft
1298 1.16 mycroft void
1299 1.1 bad tcic_chip_socket_disable(pch)
1300 1.1 bad pcmcia_chipset_handle_t pch;
1301 1.1 bad {
1302 1.1 bad struct tcic_handle *h = (struct tcic_handle *) pch;
1303 1.1 bad int val;
1304 1.1 bad
1305 1.1 bad DPRINTF(("tcic_chip_socket_disable\n"));
1306 1.1 bad
1307 1.1 bad tcic_sel_sock(h);
1308 1.1 bad
1309 1.1 bad /* disable interrupts */
1310 1.1 bad val = tcic_read_ind_2(h, TCIC_IR_SCF1_N(h->sock));
1311 1.1 bad val &= TCIC_SCF1_IRQ_MASK;
1312 1.1 bad tcic_write_ind_2(h, TCIC_IR_SCF1_N(h->sock), val);
1313 1.1 bad
1314 1.1 bad /* disable the output signals */
1315 1.1 bad tcic_write_1(h, TCIC_R_SCTRL, 0);
1316 1.1 bad val = tcic_read_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK);
1317 1.1 bad val &= ~TCIC_ILOCK_CRESENA;
1318 1.1 bad tcic_write_aux_2(h->sc->iot, h->sc->ioh, TCIC_AR_ILOCK, val);
1319 1.1 bad
1320 1.1 bad /* power down the socket */
1321 1.1 bad tcic_write_1(h, TCIC_R_PWR, 0);
1322 1.1 bad }
1323 1.1 bad
1324 1.1 bad /*
1325 1.1 bad * XXX The following is Linux driver but doesn't match the table
1326 1.1 bad * in the manual.
1327 1.1 bad */
1328 1.1 bad int
1329 1.1 bad tcic_ns2wscnt(ns)
1330 1.1 bad int ns;
1331 1.1 bad {
1332 1.1 bad if (ns < 14) {
1333 1.1 bad return 0;
1334 1.1 bad } else {
1335 1.1 bad return (2*(ns-14))/70; /* XXX assumes 14.31818 MHz clock. */
1336 1.1 bad }
1337 1.1 bad }
1338 1.1 bad
1339 1.1 bad int
1340 1.1 bad tcic_log2(val)
1341 1.1 bad u_int val;
1342 1.1 bad {
1343 1.1 bad int i, l2;
1344 1.1 bad
1345 1.1 bad l2 = i = 0;
1346 1.1 bad while (val) {
1347 1.1 bad if (val & 1)
1348 1.1 bad l2 = i;
1349 1.1 bad i++;
1350 1.1 bad val >>= 1;
1351 1.1 bad }
1352 1.1 bad return l2;
1353 1.1 bad }
1354