1 | /*
|
---|
2 | ti1225.c
|
---|
3 |
|
---|
4 | Created: Dec 2005 by Philip Homburg
|
---|
5 | */
|
---|
6 |
|
---|
7 | #include "../drivers.h"
|
---|
8 | #include <ibm/pci.h>
|
---|
9 | #include <sys/vm.h>
|
---|
10 |
|
---|
11 | #include "ti1225.h"
|
---|
12 | #include "i82365.h"
|
---|
13 |
|
---|
14 | /* The use of interrupts is not yet ready for prime time */
|
---|
15 | #define USE_INTS 0
|
---|
16 |
|
---|
17 | #define MICROS_TO_TICKS(m) (((m)*HZ/1000000)+1)
|
---|
18 |
|
---|
19 | #define NR_PORTS 2
|
---|
20 |
|
---|
21 | PRIVATE struct port
|
---|
22 | {
|
---|
23 | unsigned p_flags;
|
---|
24 | int p_devind;
|
---|
25 | u8_t p_cb_busnr;
|
---|
26 | u16_t p_exca_port;
|
---|
27 | #if USE_INTS
|
---|
28 | int p_irq;
|
---|
29 | int p_hook;
|
---|
30 | #endif
|
---|
31 | char *base_ptr;
|
---|
32 | volatile struct csr *csr_ptr;
|
---|
33 |
|
---|
34 | char buffer[2*PAGE_SIZE];
|
---|
35 | } ports[NR_PORTS];
|
---|
36 |
|
---|
37 | #define PF_PRESENT 1
|
---|
38 |
|
---|
39 | struct pcitab
|
---|
40 | {
|
---|
41 | u16_t vid;
|
---|
42 | u16_t did;
|
---|
43 | int checkclass;
|
---|
44 | };
|
---|
45 |
|
---|
46 | PRIVATE struct pcitab pcitab_ti[]=
|
---|
47 | {
|
---|
48 | { 0x104C, 0xAC1C, 0 }, /* TI PCI1225 */
|
---|
49 |
|
---|
50 | { 0x0000, 0x0000, 0 }
|
---|
51 | };
|
---|
52 | PRIVATE char *progname;
|
---|
53 | PRIVATE int debug;
|
---|
54 |
|
---|
55 | FORWARD _PROTOTYPE( void init, (void) );
|
---|
56 | FORWARD _PROTOTYPE( void hw_init, (struct port *pp) );
|
---|
57 | FORWARD _PROTOTYPE( void map_regs, (struct port *pp, u32_t base) );
|
---|
58 | FORWARD _PROTOTYPE( void do_int, (struct port *pp) );
|
---|
59 | FORWARD _PROTOTYPE( u8_t read_exca, (struct port *pp, int socket, int reg) );
|
---|
60 | FORWARD _PROTOTYPE( void do_outb, (port_t port, u8_t value) );
|
---|
61 | FORWARD _PROTOTYPE( u8_t do_inb, (port_t port) );
|
---|
62 | FORWARD _PROTOTYPE( void micro_delay, (unsigned long usecs) );
|
---|
63 |
|
---|
64 | int main(int argc, char *argv[])
|
---|
65 | {
|
---|
66 | int c, r;
|
---|
67 | message m;
|
---|
68 |
|
---|
69 | (progname=strrchr(argv[0],'/')) ? progname++ : (progname=argv[0]);
|
---|
70 |
|
---|
71 | debug= 0;
|
---|
72 | while (c= getopt(argc, argv, "d?"), c != -1)
|
---|
73 | {
|
---|
74 | switch(c)
|
---|
75 | {
|
---|
76 | case '?': panic("ti1225", "Usage: ti1225 [-d]", NO_NUM);
|
---|
77 | case 'd': debug++; break;
|
---|
78 | default: panic("ti1225", "getopt failed", NO_NUM);
|
---|
79 | }
|
---|
80 | }
|
---|
81 |
|
---|
82 | init();
|
---|
83 |
|
---|
84 | for (;;)
|
---|
85 | {
|
---|
86 | r= receive(ANY, &m);
|
---|
87 | if (r != OK)
|
---|
88 | panic("ti1225", "receive failed", r);
|
---|
89 | printf("ti1225: got message %u from %d\n",
|
---|
90 | m.m_type, m.m_source);
|
---|
91 | }
|
---|
92 | return 0;
|
---|
93 | }
|
---|
94 |
|
---|
95 | PRIVATE void init()
|
---|
96 | {
|
---|
97 | int i, r, first, devind, port;
|
---|
98 | u16_t vid, did;
|
---|
99 |
|
---|
100 | pci_init1(progname);
|
---|
101 |
|
---|
102 | first= 1;
|
---|
103 | port= 0;
|
---|
104 | for (;;)
|
---|
105 | {
|
---|
106 | if (first)
|
---|
107 | {
|
---|
108 | first= 0;
|
---|
109 | r= pci_first_dev(&devind, &vid, &did);
|
---|
110 | }
|
---|
111 | else
|
---|
112 | r= pci_next_dev(&devind, &vid, &did);
|
---|
113 | if (r != 1)
|
---|
114 | break;
|
---|
115 |
|
---|
116 | for (i= 0; pcitab_ti[i].vid != 0; i++)
|
---|
117 | {
|
---|
118 | if (pcitab_ti[i].vid != vid)
|
---|
119 | continue;
|
---|
120 | if (pcitab_ti[i].did != did)
|
---|
121 | continue;
|
---|
122 | if (pcitab_ti[i].checkclass)
|
---|
123 | {
|
---|
124 | panic("ti1225",
|
---|
125 | "fxp_probe: class check not implemented",
|
---|
126 | NO_NUM);
|
---|
127 | }
|
---|
128 | break;
|
---|
129 | }
|
---|
130 | if (pcitab_ti[i].vid == 0)
|
---|
131 | continue;
|
---|
132 |
|
---|
133 | pci_reserve(devind);
|
---|
134 |
|
---|
135 | if (debug)
|
---|
136 | printf("ti1225: found device %04x/%04x\n", vid, did);
|
---|
137 | ports[port].p_devind= devind;
|
---|
138 | ports[port].p_flags |= PF_PRESENT;
|
---|
139 | port++;
|
---|
140 | if (port >= NR_PORTS)
|
---|
141 | break;
|
---|
142 | }
|
---|
143 |
|
---|
144 | for (i= 0; i<NR_PORTS; i++)
|
---|
145 | {
|
---|
146 | if (!(ports[i].p_flags & PF_PRESENT))
|
---|
147 | continue;
|
---|
148 | hw_init(&ports[i]);
|
---|
149 | }
|
---|
150 | }
|
---|
151 |
|
---|
152 | PRIVATE void hw_init(pp)
|
---|
153 | struct port *pp;
|
---|
154 | {
|
---|
155 | int i, r, devind, irq, socket;
|
---|
156 | u8_t v8;
|
---|
157 | u16_t v16;
|
---|
158 | u32_t v32;
|
---|
159 |
|
---|
160 | devind= pp->p_devind;
|
---|
161 | if (debug)
|
---|
162 | printf("hw_init: devind = %d\n", devind);
|
---|
163 |
|
---|
164 | if (debug)
|
---|
165 | {
|
---|
166 | v16= pci_attr_r16(devind, PCI_CR);
|
---|
167 | printf("ti1225: command register 0x%x\n", v16);
|
---|
168 | }
|
---|
169 |
|
---|
170 | v32= pci_attr_r32(devind, TI_CB_BASEADDR);
|
---|
171 | if (debug)
|
---|
172 | printf("ti1225: Cardbus/ExCA base address 0x%x\n", v32);
|
---|
173 | map_regs(pp, v32);
|
---|
174 | pp->csr_ptr= (struct csr *)pp->base_ptr;
|
---|
175 |
|
---|
176 | if (debug)
|
---|
177 | {
|
---|
178 | v8= pci_attr_r8(devind, TI_PCI_BUS_NR);
|
---|
179 | printf("ti1225: PCI bus number %d\n", v8);
|
---|
180 | }
|
---|
181 | v8= pci_attr_r8(devind, TI_CB_BUS_NR);
|
---|
182 | pp->p_cb_busnr= v8;
|
---|
183 | if (debug)
|
---|
184 | {
|
---|
185 | printf("ti1225: CardBus bus number %d\n", v8);
|
---|
186 | v8= pci_attr_r8(devind, TI_SO_BUS_NR);
|
---|
187 | printf("ti1225: Subordinate bus number %d\n", v8);
|
---|
188 | }
|
---|
189 |
|
---|
190 | #if USE_INTS
|
---|
191 | irq= pci_attr_r8(devind, PCI_ILR);
|
---|
192 | pp->p_irq= irq;
|
---|
193 | printf("ti1225 using IRQ %d\n", irq);
|
---|
194 | #endif
|
---|
195 |
|
---|
196 | v32= pci_attr_r32(devind, TI_LEGACY_BA);
|
---|
197 | v32 &= ~1;
|
---|
198 | if (debug)
|
---|
199 | {
|
---|
200 | printf("ti1225: PC Card 16-bit legacy-mode base address 0x%x\n",
|
---|
201 | v32);
|
---|
202 | }
|
---|
203 |
|
---|
204 | if (v32 == 0)
|
---|
205 | panic("ti1225", "bad lagacy-mode base address 0x%x\n", v32);
|
---|
206 | pp->p_exca_port= v32;
|
---|
207 |
|
---|
208 | if (debug)
|
---|
209 | {
|
---|
210 | v32= pci_attr_r32(devind, TI_MF_ROUTE);
|
---|
211 | printf("ti1225: Multifunction routing 0x%08x\n", v32);
|
---|
212 | }
|
---|
213 |
|
---|
214 | #if USE_INTS
|
---|
215 | pp->p_hook = pp->p_irq;
|
---|
216 | r= sys_irqsetpolicy(pp->p_irq, 0, &pp->p_hook);
|
---|
217 | if (r != OK)
|
---|
218 | panic("ti1225","sys_irqsetpolicy failed", r);
|
---|
219 | #endif
|
---|
220 |
|
---|
221 | /* Clear CBB_BC_INTEXCA */
|
---|
222 | v16= pci_attr_r16(devind, CBB_BRIDGECTRL);
|
---|
223 | if (debug)
|
---|
224 | printf("ti1225: Bridge control 0x%04x\n", v16);
|
---|
225 | v16 &= ~CBB_BC_INTEXCA;
|
---|
226 | pci_attr_w16(devind, CBB_BRIDGECTRL, v16);
|
---|
227 |
|
---|
228 | if (debug)
|
---|
229 | {
|
---|
230 | v32= pci_attr_r32(devind, TI_SYSCTRL);
|
---|
231 | printf("ti1225: System Control Register 0x%08x\n", v32);
|
---|
232 |
|
---|
233 | v8= pci_attr_r8(devind, TI_CARD_CTRL);
|
---|
234 | printf("ti1225: Card Control 0x%02x\n", v8);
|
---|
235 |
|
---|
236 | v8= pci_attr_r8(devind, TI_DEV_CTRL);
|
---|
237 | printf("ti1225: Device Control 0x%02x\n", v8);
|
---|
238 | }
|
---|
239 |
|
---|
240 | /* Enable socket interrupts */
|
---|
241 | pp->csr_ptr->csr_mask |= CM_PWRMASK | CM_CDMASK | CM_CSTSMASK;
|
---|
242 |
|
---|
243 | do_int(pp);
|
---|
244 |
|
---|
245 | #if USE_INTS
|
---|
246 | r= sys_irqenable(&pp->p_hook);
|
---|
247 | if (r != OK)
|
---|
248 | panic("ti1225","unable enable interrupts", r);
|
---|
249 | #endif
|
---|
250 | }
|
---|
251 |
|
---|
252 | PRIVATE void map_regs(pp, base)
|
---|
253 | struct port *pp;
|
---|
254 | u32_t base;
|
---|
255 | {
|
---|
256 | int r;
|
---|
257 | vir_bytes buf_base;
|
---|
258 |
|
---|
259 | buf_base= (vir_bytes)pp->buffer;
|
---|
260 | if (buf_base % PAGE_SIZE)
|
---|
261 | buf_base += PAGE_SIZE-(buf_base % PAGE_SIZE);
|
---|
262 | pp->base_ptr= (char *)buf_base;
|
---|
263 | if (debug)
|
---|
264 | {
|
---|
265 | printf("ti1225: map_regs: using %p for %p\n",
|
---|
266 | pp->base_ptr, pp->buffer);
|
---|
267 | }
|
---|
268 |
|
---|
269 | /* Clear low order bits in base */
|
---|
270 | base &= ~(u32_t)0xF;
|
---|
271 |
|
---|
272 | r= sys_vm_map(SELF, 1 /* map */, (vir_bytes)pp->base_ptr,
|
---|
273 | PAGE_SIZE, (phys_bytes)base);
|
---|
274 | if (r != OK)
|
---|
275 | panic("ti1225", "map_regs: sys_vm_map failed", r);
|
---|
276 | }
|
---|
277 |
|
---|
278 | PRIVATE void do_int(pp)
|
---|
279 | struct port *pp;
|
---|
280 | {
|
---|
281 | int i, r, devind, vcc_5v, vcc_3v, vcc_Xv, vcc_Yv,
|
---|
282 | socket_5v, socket_3v, socket_Xv, socket_Yv;
|
---|
283 | clock_t t0, t1;
|
---|
284 | u32_t csr_event, csr_present, csr_control;
|
---|
285 | u8_t v8;
|
---|
286 | u16_t v16;
|
---|
287 |
|
---|
288 | devind= pp->p_devind;
|
---|
289 | v8= pci_attr_r8(devind, TI_CARD_CTRL);
|
---|
290 | if (v8 & TI_CCR_IFG)
|
---|
291 | {
|
---|
292 | printf("ti1225: got functional interrupt\n", v8);
|
---|
293 | pci_attr_w8(devind, TI_CARD_CTRL, v8);
|
---|
294 | }
|
---|
295 |
|
---|
296 | if (debug)
|
---|
297 | {
|
---|
298 | printf("Socket event: 0x%x\n", pp->csr_ptr->csr_event);
|
---|
299 | printf("Socket mask: 0x%x\n", pp->csr_ptr->csr_mask);
|
---|
300 | }
|
---|
301 |
|
---|
302 | csr_present= pp->csr_ptr->csr_present;
|
---|
303 | csr_control= pp->csr_ptr->csr_control;
|
---|
304 |
|
---|
305 | if ((csr_present & (CP_CDETECT1|CP_CDETECT2)) != 0)
|
---|
306 | {
|
---|
307 | if (debug)
|
---|
308 | printf("do_int: no card present\n");
|
---|
309 | return;
|
---|
310 | }
|
---|
311 | if (csr_present & CP_BADVCCREQ)
|
---|
312 | {
|
---|
313 | printf("do_int: Bad Vcc request\n");
|
---|
314 | /* return; */
|
---|
315 | }
|
---|
316 | if (csr_present & CP_DATALOST)
|
---|
317 | {
|
---|
318 | /* Do we care? */
|
---|
319 | if (debug)
|
---|
320 | printf("do_int: Data lost\n");
|
---|
321 | /* return; */
|
---|
322 | }
|
---|
323 | if (csr_present & CP_NOTACARD)
|
---|
324 | {
|
---|
325 | printf("do_int: Not a card\n");
|
---|
326 | return;
|
---|
327 | }
|
---|
328 | if (debug)
|
---|
329 | {
|
---|
330 | if (csr_present & CP_CBCARD)
|
---|
331 | printf("do_int: Cardbus card detected\n");
|
---|
332 | if (csr_present & CP_16BITCARD)
|
---|
333 | printf("do_int: 16-bit card detected\n");
|
---|
334 | }
|
---|
335 | if (csr_present & CP_PWRCYCLE)
|
---|
336 | {
|
---|
337 | if (debug)
|
---|
338 | printf("do_int: powered up\n");
|
---|
339 | return;
|
---|
340 | }
|
---|
341 | vcc_5v= !!(csr_present & CP_5VCARD);
|
---|
342 | vcc_3v= !!(csr_present & CP_3VCARD);
|
---|
343 | vcc_Xv= !!(csr_present & CP_XVCARD);
|
---|
344 | vcc_Yv= !!(csr_present & CP_YVCARD);
|
---|
345 | if (debug)
|
---|
346 | {
|
---|
347 | printf("do_int: card supports:%s%s%s%s\n",
|
---|
348 | vcc_5v ? " 5V" : "", vcc_3v ? " 3V" : "",
|
---|
349 | vcc_Xv ? " X.X V" : "", vcc_Yv ? " Y.Y V" : "");
|
---|
350 | }
|
---|
351 | socket_5v= !!(csr_present & CP_5VSOCKET);
|
---|
352 | socket_3v= !!(csr_present & CP_3VSOCKET);
|
---|
353 | socket_Xv= !!(csr_present & CP_XVSOCKET);
|
---|
354 | socket_Yv= !!(csr_present & CP_YVSOCKET);
|
---|
355 | if (debug)
|
---|
356 | {
|
---|
357 | printf("do_int: socket supports:%s%s%s%s\n",
|
---|
358 | socket_5v ? " 5V" : "", socket_3v ? " 3V" : "",
|
---|
359 | socket_Xv ? " X.X V" : "", socket_Yv ? " Y.Y V" : "");
|
---|
360 | }
|
---|
361 | if (vcc_5v && socket_5v)
|
---|
362 | {
|
---|
363 | csr_control= (csr_control & ~CC_VCCCTRL) | CC_VCC_5V;
|
---|
364 | pp->csr_ptr->csr_control= csr_control;
|
---|
365 | if (debug)
|
---|
366 | printf("do_int: applying 5V\n");
|
---|
367 | }
|
---|
368 | else if (vcc_3v && socket_3v)
|
---|
369 | {
|
---|
370 | csr_control= (csr_control & ~CC_VCCCTRL) | CC_VCC_3V;
|
---|
371 | pp->csr_ptr->csr_control= csr_control;
|
---|
372 | if (debug)
|
---|
373 | printf("do_int: applying 3V\n");
|
---|
374 | }
|
---|
375 | else if (vcc_Xv && socket_Xv)
|
---|
376 | {
|
---|
377 | csr_control= (csr_control & ~CC_VCCCTRL) | CC_VCC_XV;
|
---|
378 | pp->csr_ptr->csr_control= csr_control;
|
---|
379 | printf("do_int: applying X.X V\n");
|
---|
380 | }
|
---|
381 | else if (vcc_Yv && socket_Yv)
|
---|
382 | {
|
---|
383 | csr_control= (csr_control & ~CC_VCCCTRL) | CC_VCC_YV;
|
---|
384 | pp->csr_ptr->csr_control= csr_control;
|
---|
385 | printf("do_int: applying Y.Y V\n");
|
---|
386 | }
|
---|
387 | else
|
---|
388 | {
|
---|
389 | printf("do_int: socket and card are not compatible\n");
|
---|
390 | return;
|
---|
391 | }
|
---|
392 |
|
---|
393 | csr_event= pp->csr_ptr->csr_event;
|
---|
394 | if (csr_event)
|
---|
395 | {
|
---|
396 | if (debug)
|
---|
397 | printf("clearing socket event\n");
|
---|
398 | pp->csr_ptr->csr_event= csr_event;
|
---|
399 | if (debug)
|
---|
400 | {
|
---|
401 | printf("Socket event (cleared): 0x%x\n",
|
---|
402 | pp->csr_ptr->csr_event);
|
---|
403 | }
|
---|
404 | }
|
---|
405 |
|
---|
406 | devind= pp->p_devind;
|
---|
407 | v8= pci_attr_r8(devind, TI_CARD_CTRL);
|
---|
408 | if (v8 & TI_CCR_IFG)
|
---|
409 | {
|
---|
410 | printf("ti1225: got functional interrupt\n", v8);
|
---|
411 | pci_attr_w8(devind, TI_CARD_CTRL, v8);
|
---|
412 | }
|
---|
413 |
|
---|
414 | if (debug)
|
---|
415 | {
|
---|
416 | v8= pci_attr_r8(devind, TI_CARD_CTRL);
|
---|
417 | printf("TI_CARD_CTRL: 0x%02x\n", v8);
|
---|
418 | }
|
---|
419 |
|
---|
420 | getuptime(&t0);
|
---|
421 | do {
|
---|
422 | csr_present= pp->csr_ptr->csr_present;
|
---|
423 | if (csr_present & CP_PWRCYCLE)
|
---|
424 | break;
|
---|
425 | } while (getuptime(&t1)==OK && (t1-t0) < MICROS_TO_TICKS(100000));
|
---|
426 |
|
---|
427 | if (!(csr_present & CP_PWRCYCLE))
|
---|
428 | {
|
---|
429 | printf("do_int: not powered up?\n");
|
---|
430 | return;
|
---|
431 | }
|
---|
432 |
|
---|
433 | /* Reset device */
|
---|
434 | v16= pci_attr_r16(devind, CBB_BRIDGECTRL);
|
---|
435 | v16 |= CBB_BC_CRST;
|
---|
436 | pci_attr_w16(devind, CBB_BRIDGECTRL, v16);
|
---|
437 |
|
---|
438 | /* Wait one microsecond. Is this correct? What are the specs? */
|
---|
439 | micro_delay(1);
|
---|
440 |
|
---|
441 | /* Clear CBB_BC_CRST */
|
---|
442 | v16= pci_attr_r16(devind, CBB_BRIDGECTRL);
|
---|
443 | v16 &= ~CBB_BC_CRST;
|
---|
444 | pci_attr_w16(devind, CBB_BRIDGECTRL, v16);
|
---|
445 |
|
---|
446 | /* Wait one microsecond after clearing the reset line. Is this
|
---|
447 | * correct? What are the specs?
|
---|
448 | */
|
---|
449 | micro_delay(1);
|
---|
450 |
|
---|
451 | pci_rescan_bus(pp->p_cb_busnr);
|
---|
452 |
|
---|
453 | #if USE_INTS
|
---|
454 | r= sys_irqenable(&pp->p_hook);
|
---|
455 | if (r != OK)
|
---|
456 | panic("ti1225","unable enable interrupts", r);
|
---|
457 | #endif
|
---|
458 |
|
---|
459 | }
|
---|
460 |
|
---|
461 | PRIVATE u8_t read_exca(pp, socket, reg)
|
---|
462 | struct port *pp;
|
---|
463 | int socket;
|
---|
464 | int reg;
|
---|
465 | {
|
---|
466 | u16_t port;
|
---|
467 |
|
---|
468 | port= pp->p_exca_port;
|
---|
469 | if (port == 0)
|
---|
470 | panic("ti1225", "read_exca: bad port", NO_NUM);
|
---|
471 | do_outb(port, socket * 0x40 + reg);
|
---|
472 | return do_inb(port+1);
|
---|
473 | }
|
---|
474 |
|
---|
475 | PRIVATE u8_t do_inb(port_t port)
|
---|
476 | {
|
---|
477 | int r;
|
---|
478 | u32_t value;
|
---|
479 |
|
---|
480 | r= sys_inb(port, &value);
|
---|
481 | if (r != OK)
|
---|
482 | panic("ti1225","sys_inb failed", r);
|
---|
483 | return value;
|
---|
484 | }
|
---|
485 |
|
---|
486 | PRIVATE void do_outb(port_t port, u8_t value)
|
---|
487 | {
|
---|
488 | int r;
|
---|
489 |
|
---|
490 | r= sys_outb(port, value);
|
---|
491 | if (r != OK)
|
---|
492 | panic("ti1225","sys_outb failed", r);
|
---|
493 | }
|
---|
494 |
|
---|
495 | PRIVATE void micro_delay(unsigned long usecs)
|
---|
496 | {
|
---|
497 | tickdelay(MICROS_TO_TICKS(usecs));
|
---|
498 | }
|
---|
499 |
|
---|