1/* $Id: os_bri.c,v 1.1.1.1 2007/08/03 18:52:35 Exp $ */ 2 3#include "platform.h" 4#include "debuglib.h" 5#include "cardtype.h" 6#include "pc.h" 7#include "pr_pc.h" 8#include "di_defs.h" 9#include "dsp_defs.h" 10#include "di.h" 11#include "io.h" 12 13#include "xdi_msg.h" 14#include "xdi_adapter.h" 15#include "os_bri.h" 16#include "diva_pci.h" 17#include "mi_pc.h" 18#include "pc_maint.h" 19#include "dsrv_bri.h" 20 21/* 22** IMPORTS 23*/ 24extern void prepare_maestra_functions(PISDN_ADAPTER IoAdapter); 25extern void diva_xdi_display_adapter_features(int card); 26extern int diva_card_read_xlog(diva_os_xdi_adapter_t * a); 27 28/* 29** LOCALS 30*/ 31static int bri_bar_length[3] = { 32 0x80, 33 0x80, 34 0x20 35}; 36static int diva_bri_cleanup_adapter(diva_os_xdi_adapter_t * a); 37static dword diva_bri_get_serial_number(diva_os_xdi_adapter_t * a); 38static int diva_bri_cmd_card_proc(struct _diva_os_xdi_adapter *a, 39 diva_xdi_um_cfg_cmd_t * cmd, int length); 40static int diva_bri_reregister_io(diva_os_xdi_adapter_t * a); 41static int diva_bri_reset_adapter(PISDN_ADAPTER IoAdapter); 42static int diva_bri_write_sdram_block(PISDN_ADAPTER IoAdapter, 43 dword address, 44 const byte * data, dword length); 45static int diva_bri_start_adapter(PISDN_ADAPTER IoAdapter, 46 dword start_address, dword features); 47static int diva_bri_stop_adapter(diva_os_xdi_adapter_t * a); 48 49static void diva_bri_set_addresses(diva_os_xdi_adapter_t * a) 50{ 51 a->resources.pci.mem_type_id[MEM_TYPE_RAM] = 0; 52 a->resources.pci.mem_type_id[MEM_TYPE_CFG] = 1; 53 a->resources.pci.mem_type_id[MEM_TYPE_ADDRESS] = 2; 54 a->resources.pci.mem_type_id[MEM_TYPE_RESET] = 1; 55 a->resources.pci.mem_type_id[MEM_TYPE_PORT] = 2; 56 a->resources.pci.mem_type_id[MEM_TYPE_CTLREG] = 2; 57 58 a->xdi_adapter.ram = a->resources.pci.addr[0]; 59 a->xdi_adapter.cfg = a->resources.pci.addr[1]; 60 a->xdi_adapter.Address = a->resources.pci.addr[2]; 61 62 a->xdi_adapter.reset = a->xdi_adapter.cfg; 63 a->xdi_adapter.port = a->xdi_adapter.Address; 64 65 a->xdi_adapter.ctlReg = a->xdi_adapter.port + M_PCI_RESET; 66 67 a->xdi_adapter.reset += 0x4C; /* PLX 9050 !! */ 68} 69 70/* 71** BAR0 - MEM Addr - 0x80 - NOT USED 72** BAR1 - I/O Addr - 0x80 73** BAR2 - I/O Addr - 0x20 74*/ 75int diva_bri_init_card(diva_os_xdi_adapter_t * a) 76{ 77 int bar; 78 dword bar2 = 0, bar2_length = 0xffffffff; 79 word cmd = 0, cmd_org; 80 byte Bus, Slot; 81 void *hdev; 82 byte __iomem *p; 83 84 /* 85 Set properties 86 */ 87 a->xdi_adapter.Properties = CardProperties[a->CardOrdinal]; 88 DBG_LOG(("Load %s", a->xdi_adapter.Properties.Name)) 89 90 /* 91 Get resources 92 */ 93 for (bar = 0; bar < 3; bar++) { 94 a->resources.pci.bar[bar] = 95 divasa_get_pci_bar(a->resources.pci.bus, 96 a->resources.pci.func, bar, 97 a->resources.pci.hdev); 98 if (!a->resources.pci.bar[bar]) { 99 DBG_ERR(("A: can't get BAR[%d]", bar)) 100 return (-1); 101 } 102 } 103 104 a->resources.pci.irq = 105 (byte) divasa_get_pci_irq(a->resources.pci.bus, 106 a->resources.pci.func, 107 a->resources.pci.hdev); 108 if (!a->resources.pci.irq) { 109 DBG_ERR(("A: invalid irq")); 110 return (-1); 111 } 112 113 /* 114 Get length of I/O bar 2 - it is different by older 115 EEPROM version 116 */ 117 Bus = a->resources.pci.bus; 118 Slot = a->resources.pci.func; 119 hdev = a->resources.pci.hdev; 120 121 /* 122 Get plain original values of the BAR2 CDM registers 123 */ 124 PCIread(Bus, Slot, 0x18, &bar2, sizeof(bar2), hdev); 125 PCIread(Bus, Slot, 0x04, &cmd_org, sizeof(cmd_org), hdev); 126 /* 127 Disable device and get BAR2 length 128 */ 129 PCIwrite(Bus, Slot, 0x04, &cmd, sizeof(cmd), hdev); 130 PCIwrite(Bus, Slot, 0x18, &bar2_length, sizeof(bar2_length), hdev); 131 PCIread(Bus, Slot, 0x18, &bar2_length, sizeof(bar2_length), hdev); 132 /* 133 Restore BAR2 and CMD registers 134 */ 135 PCIwrite(Bus, Slot, 0x18, &bar2, sizeof(bar2), hdev); 136 PCIwrite(Bus, Slot, 0x04, &cmd_org, sizeof(cmd_org), hdev); 137 138 /* 139 Calculate BAR2 length 140 */ 141 bar2_length = (~(bar2_length & ~7)) + 1; 142 DBG_LOG(("BAR[2] length=%lx", bar2_length)) 143 144 /* 145 Map and register resources 146 */ 147 if (!(a->resources.pci.addr[0] = 148 divasa_remap_pci_bar(a, 0, a->resources.pci.bar[0], 149 bri_bar_length[0]))) { 150 DBG_ERR(("A: BRI, can't map BAR[0]")) 151 diva_bri_cleanup_adapter(a); 152 return (-1); 153 } 154 155 sprintf(&a->port_name[0], "BRI %02x:%02x", 156 a->resources.pci.bus, a->resources.pci.func); 157 158 if (diva_os_register_io_port(a, 1, a->resources.pci.bar[1], 159 bri_bar_length[1], &a->port_name[0], 1)) { 160 DBG_ERR(("A: BRI, can't register BAR[1]")) 161 diva_bri_cleanup_adapter(a); 162 return (-1); 163 } 164 a->resources.pci.addr[1] = (void *) (unsigned long) a->resources.pci.bar[1]; 165 a->resources.pci.length[1] = bri_bar_length[1]; 166 167 if (diva_os_register_io_port(a, 1, a->resources.pci.bar[2], 168 bar2_length, &a->port_name[0], 2)) { 169 DBG_ERR(("A: BRI, can't register BAR[2]")) 170 diva_bri_cleanup_adapter(a); 171 return (-1); 172 } 173 a->resources.pci.addr[2] = (void *) (unsigned long) a->resources.pci.bar[2]; 174 a->resources.pci.length[2] = bar2_length; 175 176 /* 177 Set all memory areas 178 */ 179 diva_bri_set_addresses(a); 180 181 /* 182 Get Serial Number 183 */ 184 a->xdi_adapter.serialNo = diva_bri_get_serial_number(a); 185 186 /* 187 Register I/O ports with correct name now 188 */ 189 if (diva_bri_reregister_io(a)) { 190 diva_bri_cleanup_adapter(a); 191 return (-1); 192 } 193 194 /* 195 Initialize OS dependent objects 196 */ 197 if (diva_os_initialize_spin_lock 198 (&a->xdi_adapter.isr_spin_lock, "isr")) { 199 diva_bri_cleanup_adapter(a); 200 return (-1); 201 } 202 if (diva_os_initialize_spin_lock 203 (&a->xdi_adapter.data_spin_lock, "data")) { 204 diva_bri_cleanup_adapter(a); 205 return (-1); 206 } 207 208 strcpy(a->xdi_adapter.req_soft_isr.dpc_thread_name, "kdivasbrid"); 209 210 if (diva_os_initialize_soft_isr(&a->xdi_adapter.req_soft_isr, 211 DIDpcRoutine, &a->xdi_adapter)) { 212 diva_bri_cleanup_adapter(a); 213 return (-1); 214 } 215 /* 216 Do not initialize second DPC - only one thread will be created 217 */ 218 a->xdi_adapter.isr_soft_isr.object = a->xdi_adapter.req_soft_isr.object; 219 220 /* 221 Create entity table 222 */ 223 a->xdi_adapter.Channels = CardProperties[a->CardOrdinal].Channels; 224 a->xdi_adapter.e_max = CardProperties[a->CardOrdinal].E_info; 225 a->xdi_adapter.e_tbl = diva_os_malloc(0, a->xdi_adapter.e_max * sizeof(E_INFO)); 226 if (!a->xdi_adapter.e_tbl) { 227 diva_bri_cleanup_adapter(a); 228 return (-1); 229 } 230 memset(a->xdi_adapter.e_tbl, 0x00, a->xdi_adapter.e_max * sizeof(E_INFO)); 231 232 /* 233 Set up interface 234 */ 235 a->xdi_adapter.a.io = &a->xdi_adapter; 236 a->xdi_adapter.DIRequest = request; 237 a->interface.cleanup_adapter_proc = diva_bri_cleanup_adapter; 238 a->interface.cmd_proc = diva_bri_cmd_card_proc; 239 240 p = DIVA_OS_MEM_ATTACH_RESET(&a->xdi_adapter); 241 outpp(p, 0x41); 242 DIVA_OS_MEM_DETACH_RESET(&a->xdi_adapter, p); 243 244 prepare_maestra_functions(&a->xdi_adapter); 245 246 a->dsp_mask = 0x00000003; 247 248 /* 249 Set IRQ handler 250 */ 251 a->xdi_adapter.irq_info.irq_nr = a->resources.pci.irq; 252 sprintf(a->xdi_adapter.irq_info.irq_name, "DIVA BRI %ld", 253 (long) a->xdi_adapter.serialNo); 254 if (diva_os_register_irq(a, a->xdi_adapter.irq_info.irq_nr, 255 a->xdi_adapter.irq_info.irq_name)) { 256 diva_bri_cleanup_adapter(a); 257 return (-1); 258 } 259 a->xdi_adapter.irq_info.registered = 1; 260 261 diva_log_info("%s IRQ:%d SerNo:%d", a->xdi_adapter.Properties.Name, 262 a->resources.pci.irq, a->xdi_adapter.serialNo); 263 264 return (0); 265} 266 267 268static int diva_bri_cleanup_adapter(diva_os_xdi_adapter_t * a) 269{ 270 int i; 271 272 if (a->xdi_adapter.Initialized) { 273 diva_bri_stop_adapter(a); 274 } 275 276 /* 277 Remove ISR Handler 278 */ 279 if (a->xdi_adapter.irq_info.registered) { 280 diva_os_remove_irq(a, a->xdi_adapter.irq_info.irq_nr); 281 } 282 a->xdi_adapter.irq_info.registered = 0; 283 284 if (a->resources.pci.addr[0] && a->resources.pci.bar[0]) { 285 divasa_unmap_pci_bar(a->resources.pci.addr[0]); 286 a->resources.pci.addr[0] = NULL; 287 a->resources.pci.bar[0] = 0; 288 } 289 290 for (i = 1; i < 3; i++) { 291 if (a->resources.pci.addr[i] && a->resources.pci.bar[i]) { 292 diva_os_register_io_port(a, 0, 293 a->resources.pci.bar[i], 294 a->resources.pci. 295 length[i], 296 &a->port_name[0], i); 297 a->resources.pci.addr[i] = NULL; 298 a->resources.pci.bar[i] = 0; 299 } 300 } 301 302 /* 303 Free OS objects 304 */ 305 diva_os_cancel_soft_isr(&a->xdi_adapter.req_soft_isr); 306 diva_os_cancel_soft_isr(&a->xdi_adapter.isr_soft_isr); 307 308 diva_os_remove_soft_isr(&a->xdi_adapter.req_soft_isr); 309 a->xdi_adapter.isr_soft_isr.object = NULL; 310 311 diva_os_destroy_spin_lock(&a->xdi_adapter.isr_spin_lock, "rm"); 312 diva_os_destroy_spin_lock(&a->xdi_adapter.data_spin_lock, "rm"); 313 314 /* 315 Free memory 316 */ 317 if (a->xdi_adapter.e_tbl) { 318 diva_os_free(0, a->xdi_adapter.e_tbl); 319 a->xdi_adapter.e_tbl = NULL; 320 } 321 322 return (0); 323} 324 325void diva_os_prepare_maestra_functions(PISDN_ADAPTER IoAdapter) 326{ 327} 328 329/* 330** Get serial number 331*/ 332static dword diva_bri_get_serial_number(diva_os_xdi_adapter_t * a) 333{ 334 dword serNo = 0; 335 byte __iomem *confIO; 336 word serHi, serLo; 337 word __iomem *confMem; 338 339 confIO = DIVA_OS_MEM_ATTACH_CFG(&a->xdi_adapter); 340 serHi = (word) (inppw(&confIO[0x22]) & 0x0FFF); 341 serLo = (word) (inppw(&confIO[0x26]) & 0x0FFF); 342 serNo = ((dword) serHi << 16) | (dword) serLo; 343 DIVA_OS_MEM_DETACH_CFG(&a->xdi_adapter, confIO); 344 345 if ((serNo == 0) || (serNo == 0xFFFFFFFF)) { 346 DBG_FTL(("W: BRI use BAR[0] to get card serial number")) 347 348 confMem = (word __iomem *)DIVA_OS_MEM_ATTACH_RAM(&a->xdi_adapter); 349 serHi = (word) (READ_WORD(&confMem[0x11]) & 0x0FFF); 350 serLo = (word) (READ_WORD(&confMem[0x13]) & 0x0FFF); 351 serNo = (((dword) serHi) << 16) | ((dword) serLo); 352 DIVA_OS_MEM_DETACH_RAM(&a->xdi_adapter, confMem); 353 } 354 355 DBG_LOG(("Serial Number=%ld", serNo)) 356 357 return (serNo); 358} 359 360/* 361** Unregister I/O and register it with new name, 362** based on Serial Number 363*/ 364static int diva_bri_reregister_io(diva_os_xdi_adapter_t * a) 365{ 366 int i; 367 368 for (i = 1; i < 3; i++) { 369 diva_os_register_io_port(a, 0, a->resources.pci.bar[i], 370 a->resources.pci.length[i], 371 &a->port_name[0], i); 372 a->resources.pci.addr[i] = NULL; 373 } 374 375 sprintf(a->port_name, "DIVA BRI %ld", 376 (long) a->xdi_adapter.serialNo); 377 378 for (i = 1; i < 3; i++) { 379 if (diva_os_register_io_port(a, 1, a->resources.pci.bar[i], 380 a->resources.pci.length[i], 381 &a->port_name[0], i)) { 382 DBG_ERR(("A: failed to reregister BAR[%d]", i)) 383 return (-1); 384 } 385 a->resources.pci.addr[i] = 386 (void *) (unsigned long) a->resources.pci.bar[i]; 387 } 388 389 return (0); 390} 391 392/* 393** Process command from user mode 394*/ 395static int 396diva_bri_cmd_card_proc(struct _diva_os_xdi_adapter *a, 397 diva_xdi_um_cfg_cmd_t * cmd, int length) 398{ 399 int ret = -1; 400 401 if (cmd->adapter != a->controller) { 402 DBG_ERR(("A: pri_cmd, invalid controller=%d != %d", 403 cmd->adapter, a->controller)) 404 return (-1); 405 } 406 407 switch (cmd->command) { 408 case DIVA_XDI_UM_CMD_GET_CARD_ORDINAL: 409 a->xdi_mbox.data_length = sizeof(dword); 410 a->xdi_mbox.data = 411 diva_os_malloc(0, a->xdi_mbox.data_length); 412 if (a->xdi_mbox.data) { 413 *(dword *) a->xdi_mbox.data = 414 (dword) a->CardOrdinal; 415 a->xdi_mbox.status = DIVA_XDI_MBOX_BUSY; 416 ret = 0; 417 } 418 break; 419 420 case DIVA_XDI_UM_CMD_GET_SERIAL_NR: 421 a->xdi_mbox.data_length = sizeof(dword); 422 a->xdi_mbox.data = 423 diva_os_malloc(0, a->xdi_mbox.data_length); 424 if (a->xdi_mbox.data) { 425 *(dword *) a->xdi_mbox.data = 426 (dword) a->xdi_adapter.serialNo; 427 a->xdi_mbox.status = DIVA_XDI_MBOX_BUSY; 428 ret = 0; 429 } 430 break; 431 432 case DIVA_XDI_UM_CMD_GET_PCI_HW_CONFIG: 433 a->xdi_mbox.data_length = sizeof(dword) * 9; 434 a->xdi_mbox.data = 435 diva_os_malloc(0, a->xdi_mbox.data_length); 436 if (a->xdi_mbox.data) { 437 int i; 438 dword *data = (dword *) a->xdi_mbox.data; 439 440 for (i = 0; i < 8; i++) { 441 *data++ = a->resources.pci.bar[i]; 442 } 443 *data++ = (dword) a->resources.pci.irq; 444 a->xdi_mbox.status = DIVA_XDI_MBOX_BUSY; 445 ret = 0; 446 } 447 break; 448 449 case DIVA_XDI_UM_CMD_GET_CARD_STATE: 450 a->xdi_mbox.data_length = sizeof(dword); 451 a->xdi_mbox.data = 452 diva_os_malloc(0, a->xdi_mbox.data_length); 453 if (a->xdi_mbox.data) { 454 dword *data = (dword *) a->xdi_mbox.data; 455 if (!a->xdi_adapter.port) { 456 *data = 3; 457 } else if (a->xdi_adapter.trapped) { 458 *data = 2; 459 } else if (a->xdi_adapter.Initialized) { 460 *data = 1; 461 } else { 462 *data = 0; 463 } 464 a->xdi_mbox.status = DIVA_XDI_MBOX_BUSY; 465 ret = 0; 466 } 467 break; 468 469 case DIVA_XDI_UM_CMD_RESET_ADAPTER: 470 ret = diva_bri_reset_adapter(&a->xdi_adapter); 471 break; 472 473 case DIVA_XDI_UM_CMD_WRITE_SDRAM_BLOCK: 474 ret = diva_bri_write_sdram_block(&a->xdi_adapter, 475 cmd->command_data. 476 write_sdram.offset, 477 (byte *) & cmd[1], 478 cmd->command_data. 479 write_sdram.length); 480 break; 481 482 case DIVA_XDI_UM_CMD_START_ADAPTER: 483 ret = diva_bri_start_adapter(&a->xdi_adapter, 484 cmd->command_data.start. 485 offset, 486 cmd->command_data.start. 487 features); 488 break; 489 490 case DIVA_XDI_UM_CMD_SET_PROTOCOL_FEATURES: 491 a->xdi_adapter.features = 492 cmd->command_data.features.features; 493 a->xdi_adapter.a.protocol_capabilities = 494 a->xdi_adapter.features; 495 DBG_TRC( 496 ("Set raw protocol features (%08x)", 497 a->xdi_adapter.features)) ret = 0; 498 break; 499 500 case DIVA_XDI_UM_CMD_STOP_ADAPTER: 501 ret = diva_bri_stop_adapter(a); 502 break; 503 504 case DIVA_XDI_UM_CMD_READ_XLOG_ENTRY: 505 ret = diva_card_read_xlog(a); 506 break; 507 508 default: 509 DBG_ERR( 510 ("A: A(%d) invalid cmd=%d", a->controller, 511 cmd->command))} 512 513 return (ret); 514} 515 516static int diva_bri_reset_adapter(PISDN_ADAPTER IoAdapter) 517{ 518 byte __iomem *addrHi, *addrLo, *ioaddr; 519 dword i; 520 byte __iomem *Port; 521 522 if (!IoAdapter->port) { 523 return (-1); 524 } 525 if (IoAdapter->Initialized) { 526 DBG_ERR(("A: A(%d) can't reset BRI adapter - please stop first", 527 IoAdapter->ANum)) return (-1); 528 } 529 (*(IoAdapter->rstFnc)) (IoAdapter); 530 diva_os_wait(100); 531 Port = DIVA_OS_MEM_ATTACH_PORT(IoAdapter); 532 addrHi = Port + 533 ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH); 534 addrLo = Port + ADDR; 535 ioaddr = Port + DATA; 536 /* 537 recover 538 */ 539 outpp(addrHi, (byte) 0); 540 outppw(addrLo, (word) 0); 541 outppw(ioaddr, (word) 0); 542 /* 543 clear shared memory 544 */ 545 outpp(addrHi, 546 (byte) ( 547 (IoAdapter->MemoryBase + IoAdapter->MemorySize - 548 BRI_SHARED_RAM_SIZE) >> 16)); 549 outppw(addrLo, 0); 550 for (i = 0; i < 0x8000; outppw(ioaddr, 0), ++i); 551 diva_os_wait(100); 552 553 /* 554 clear signature 555 */ 556 outpp(addrHi, 557 (byte) ( 558 (IoAdapter->MemoryBase + IoAdapter->MemorySize - 559 BRI_SHARED_RAM_SIZE) >> 16)); 560 outppw(addrLo, 0x1e); 561 outpp(ioaddr, 0); 562 outpp(ioaddr, 0); 563 564 outpp(addrHi, (byte) 0); 565 outppw(addrLo, (word) 0); 566 outppw(ioaddr, (word) 0); 567 568 DIVA_OS_MEM_DETACH_PORT(IoAdapter, Port); 569 570 /* 571 Forget all outstanding entities 572 */ 573 IoAdapter->e_count = 0; 574 if (IoAdapter->e_tbl) { 575 memset(IoAdapter->e_tbl, 0x00, 576 IoAdapter->e_max * sizeof(E_INFO)); 577 } 578 IoAdapter->head = 0; 579 IoAdapter->tail = 0; 580 IoAdapter->assign = 0; 581 IoAdapter->trapped = 0; 582 583 memset(&IoAdapter->a.IdTable[0], 0x00, 584 sizeof(IoAdapter->a.IdTable)); 585 memset(&IoAdapter->a.IdTypeTable[0], 0x00, 586 sizeof(IoAdapter->a.IdTypeTable)); 587 memset(&IoAdapter->a.FlowControlIdTable[0], 0x00, 588 sizeof(IoAdapter->a.FlowControlIdTable)); 589 memset(&IoAdapter->a.FlowControlSkipTable[0], 0x00, 590 sizeof(IoAdapter->a.FlowControlSkipTable)); 591 memset(&IoAdapter->a.misc_flags_table[0], 0x00, 592 sizeof(IoAdapter->a.misc_flags_table)); 593 memset(&IoAdapter->a.rx_stream[0], 0x00, 594 sizeof(IoAdapter->a.rx_stream)); 595 memset(&IoAdapter->a.tx_stream[0], 0x00, 596 sizeof(IoAdapter->a.tx_stream)); 597 memset(&IoAdapter->a.tx_pos[0], 0x00, sizeof(IoAdapter->a.tx_pos)); 598 memset(&IoAdapter->a.rx_pos[0], 0x00, sizeof(IoAdapter->a.rx_pos)); 599 600 return (0); 601} 602 603static int 604diva_bri_write_sdram_block(PISDN_ADAPTER IoAdapter, 605 dword address, const byte * data, dword length) 606{ 607 byte __iomem *addrHi, *addrLo, *ioaddr; 608 byte __iomem *Port; 609 610 if (!IoAdapter->port) { 611 return (-1); 612 } 613 614 Port = DIVA_OS_MEM_ATTACH_PORT(IoAdapter); 615 addrHi = Port + 616 ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH); 617 addrLo = Port + ADDR; 618 ioaddr = Port + DATA; 619 620 while (length--) { 621 outpp(addrHi, (word) (address >> 16)); 622 outppw(addrLo, (word) (address & 0x0000ffff)); 623 outpp(ioaddr, *data++); 624 address++; 625 } 626 627 DIVA_OS_MEM_DETACH_PORT(IoAdapter, Port); 628 return (0); 629} 630 631static int 632diva_bri_start_adapter(PISDN_ADAPTER IoAdapter, 633 dword start_address, dword features) 634{ 635 byte __iomem *Port; 636 dword i, test; 637 byte __iomem *addrHi, *addrLo, *ioaddr; 638 int started = 0; 639 ADAPTER *a = &IoAdapter->a; 640 641 if (IoAdapter->Initialized) { 642 DBG_ERR( 643 ("A: A(%d) bri_start_adapter, adapter already running", 644 IoAdapter->ANum)) return (-1); 645 } 646 if (!IoAdapter->port) { 647 DBG_ERR(("A: A(%d) bri_start_adapter, adapter not mapped", 648 IoAdapter->ANum)) return (-1); 649 } 650 651 sprintf(IoAdapter->Name, "A(%d)", (int) IoAdapter->ANum); 652 DBG_LOG(("A(%d) start BRI", IoAdapter->ANum)) 653 654 Port = DIVA_OS_MEM_ATTACH_PORT(IoAdapter); 655 addrHi = Port + 656 ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH); 657 addrLo = Port + ADDR; 658 ioaddr = Port + DATA; 659 660 outpp(addrHi, 661 (byte) ( 662 (IoAdapter->MemoryBase + IoAdapter->MemorySize - 663 BRI_SHARED_RAM_SIZE) >> 16)); 664 outppw(addrLo, 0x1e); 665 outppw(ioaddr, 0x00); 666 DIVA_OS_MEM_DETACH_PORT(IoAdapter, Port); 667 668 /* 669 start the protocol code 670 */ 671 Port = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter); 672 outpp(Port, 0x08); 673 DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, Port); 674 675 Port = DIVA_OS_MEM_ATTACH_PORT(IoAdapter); 676 addrHi = Port + 677 ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH); 678 addrLo = Port + ADDR; 679 ioaddr = Port + DATA; 680 /* 681 wait for signature (max. 3 seconds) 682 */ 683 for (i = 0; i < 300; ++i) { 684 diva_os_wait(10); 685 outpp(addrHi, 686 (byte) ( 687 (IoAdapter->MemoryBase + 688 IoAdapter->MemorySize - 689 BRI_SHARED_RAM_SIZE) >> 16)); 690 outppw(addrLo, 0x1e); 691 test = (dword) inppw(ioaddr); 692 if (test == 0x4447) { 693 DBG_LOG( 694 ("Protocol startup time %d.%02d seconds", 695 (i / 100), (i % 100))) 696 started = 1; 697 break; 698 } 699 } 700 DIVA_OS_MEM_DETACH_PORT(IoAdapter, Port); 701 702 if (!started) { 703 DBG_FTL(("A: A(%d) %s: Adapter selftest failed 0x%04X", 704 IoAdapter->ANum, IoAdapter->Properties.Name, 705 test)) 706 (*(IoAdapter->trapFnc)) (IoAdapter); 707 return (-1); 708 } 709 710 IoAdapter->Initialized = 1; 711 712 /* 713 Check Interrupt 714 */ 715 IoAdapter->IrqCount = 0; 716 a->ReadyInt = 1; 717 718 if (IoAdapter->reset) { 719 Port = DIVA_OS_MEM_ATTACH_RESET(IoAdapter); 720 outpp(Port, 0x41); 721 DIVA_OS_MEM_DETACH_RESET(IoAdapter, Port); 722 } 723 724 a->ram_out(a, &PR_RAM->ReadyInt, 1); 725 for (i = 0; ((!IoAdapter->IrqCount) && (i < 100)); i++) { 726 diva_os_wait(10); 727 } 728 if (!IoAdapter->IrqCount) { 729 DBG_ERR( 730 ("A: A(%d) interrupt test failed", 731 IoAdapter->ANum)) 732 IoAdapter->Initialized = 0; 733 IoAdapter->stop(IoAdapter); 734 return (-1); 735 } 736 737 IoAdapter->Properties.Features = (word) features; 738 diva_xdi_display_adapter_features(IoAdapter->ANum); 739 DBG_LOG(("A(%d) BRI adapter successfull started", IoAdapter->ANum)) 740 /* 741 Register with DIDD 742 */ 743 diva_xdi_didd_register_adapter(IoAdapter->ANum); 744 745 return (0); 746} 747 748static void diva_bri_clear_interrupts(diva_os_xdi_adapter_t * a) 749{ 750 PISDN_ADAPTER IoAdapter = &a->xdi_adapter; 751 752 /* 753 clear any pending interrupt 754 */ 755 IoAdapter->disIrq(IoAdapter); 756 757 IoAdapter->tst_irq(&IoAdapter->a); 758 IoAdapter->clr_irq(&IoAdapter->a); 759 IoAdapter->tst_irq(&IoAdapter->a); 760 761 /* 762 kill pending dpcs 763 */ 764 diva_os_cancel_soft_isr(&IoAdapter->req_soft_isr); 765 diva_os_cancel_soft_isr(&IoAdapter->isr_soft_isr); 766} 767 768/* 769** Stop card 770*/ 771static int diva_bri_stop_adapter(diva_os_xdi_adapter_t * a) 772{ 773 PISDN_ADAPTER IoAdapter = &a->xdi_adapter; 774 int i = 100; 775 776 if (!IoAdapter->port) { 777 return (-1); 778 } 779 if (!IoAdapter->Initialized) { 780 DBG_ERR(("A: A(%d) can't stop BRI adapter - not running", 781 IoAdapter->ANum)) 782 return (-1); /* nothing to stop */ 783 } 784 IoAdapter->Initialized = 0; 785 786 /* 787 Disconnect Adapter from DIDD 788 */ 789 diva_xdi_didd_remove_adapter(IoAdapter->ANum); 790 791 /* 792 Stop interrupts 793 */ 794 a->clear_interrupts_proc = diva_bri_clear_interrupts; 795 IoAdapter->a.ReadyInt = 1; 796 IoAdapter->a.ram_inc(&IoAdapter->a, &PR_RAM->ReadyInt); 797 do { 798 diva_os_sleep(10); 799 } while (i-- && a->clear_interrupts_proc); 800 if (a->clear_interrupts_proc) { 801 diva_bri_clear_interrupts(a); 802 a->clear_interrupts_proc = NULL; 803 DBG_ERR(("A: A(%d) no final interrupt from BRI adapter", 804 IoAdapter->ANum)) 805 } 806 IoAdapter->a.ReadyInt = 0; 807 808 /* 809 Stop and reset adapter 810 */ 811 IoAdapter->stop(IoAdapter); 812 813 return (0); 814} 815