1 /* $Id: os_bri.c,v 1.21 2004/03/21 17:26:01 armin 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 */
24 extern void prepare_maestra_functions(PISDN_ADAPTER IoAdapter);
25 extern void diva_xdi_display_adapter_features(int card);
26 extern int diva_card_read_xlog(diva_os_xdi_adapter_t *a);
27
28 /*
29 ** LOCALS
30 */
31 static int bri_bar_length[3] = {
32 0x80,
33 0x80,
34 0x20
35 };
36 static int diva_bri_cleanup_adapter(diva_os_xdi_adapter_t *a);
37 static dword diva_bri_get_serial_number(diva_os_xdi_adapter_t *a);
38 static int diva_bri_cmd_card_proc(struct _diva_os_xdi_adapter *a,
39 diva_xdi_um_cfg_cmd_t *cmd, int length);
40 static int diva_bri_reregister_io(diva_os_xdi_adapter_t *a);
41 static int diva_bri_reset_adapter(PISDN_ADAPTER IoAdapter);
42 static int diva_bri_write_sdram_block(PISDN_ADAPTER IoAdapter,
43 dword address,
44 const byte *data, dword length);
45 static int diva_bri_start_adapter(PISDN_ADAPTER IoAdapter,
46 dword start_address, dword features);
47 static int diva_bri_stop_adapter(diva_os_xdi_adapter_t *a);
48
diva_bri_set_addresses(diva_os_xdi_adapter_t * a)49 static 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 */
diva_bri_init_card(diva_os_xdi_adapter_t * a)75 int 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
diva_bri_cleanup_adapter(diva_os_xdi_adapter_t * a)268 static 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
diva_os_prepare_maestra_functions(PISDN_ADAPTER IoAdapter)325 void diva_os_prepare_maestra_functions(PISDN_ADAPTER IoAdapter)
326 {
327 }
328
329 /*
330 ** Get serial number
331 */
diva_bri_get_serial_number(diva_os_xdi_adapter_t * a)332 static 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 */
diva_bri_reregister_io(diva_os_xdi_adapter_t * a)364 static 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 */
395 static int
diva_bri_cmd_card_proc(struct _diva_os_xdi_adapter * a,diva_xdi_um_cfg_cmd_t * cmd,int length)396 diva_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
diva_bri_reset_adapter(PISDN_ADAPTER IoAdapter)516 static 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
603 static int
diva_bri_write_sdram_block(PISDN_ADAPTER IoAdapter,dword address,const byte * data,dword length)604 diva_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
631 static int
diva_bri_start_adapter(PISDN_ADAPTER IoAdapter,dword start_address,dword features)632 diva_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 successfully started", IoAdapter->ANum))
740 /*
741 Register with DIDD
742 */
743 diva_xdi_didd_register_adapter(IoAdapter->ANum);
744
745 return (0);
746 }
747
diva_bri_clear_interrupts(diva_os_xdi_adapter_t * a)748 static 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 */
diva_bri_stop_adapter(diva_os_xdi_adapter_t * a)771 static 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