| 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 |
|
|---|