blob: 20f2653c58fad6fa0644215ecb769b5e7c6f3b31 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* $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"
Adrian Bunk6e21bd92006-01-08 01:05:15 -080019#include "dsrv_bri.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070020
21/*
22** IMPORTS
23*/
24extern void prepare_maestra_functions(PISDN_ADAPTER IoAdapter);
25extern void diva_xdi_display_adapter_features(int card);
Joe Perches475be4d2012-02-19 19:52:38 -080026extern int diva_card_read_xlog(diva_os_xdi_adapter_t *a);
Linus Torvalds1da177e2005-04-16 15:20:36 -070027
28/*
29** LOCALS
30*/
31static int bri_bar_length[3] = {
32 0x80,
33 0x80,
34 0x20
35};
Joe Perches475be4d2012-02-19 19:52:38 -080036static int diva_bri_cleanup_adapter(diva_os_xdi_adapter_t *a);
37static dword diva_bri_get_serial_number(diva_os_xdi_adapter_t *a);
Linus Torvalds1da177e2005-04-16 15:20:36 -070038static int diva_bri_cmd_card_proc(struct _diva_os_xdi_adapter *a,
Joe Perches475be4d2012-02-19 19:52:38 -080039 diva_xdi_um_cfg_cmd_t *cmd, int length);
40static int diva_bri_reregister_io(diva_os_xdi_adapter_t *a);
Linus Torvalds1da177e2005-04-16 15:20:36 -070041static int diva_bri_reset_adapter(PISDN_ADAPTER IoAdapter);
42static int diva_bri_write_sdram_block(PISDN_ADAPTER IoAdapter,
43 dword address,
Joe Perches475be4d2012-02-19 19:52:38 -080044 const byte *data, dword length);
Linus Torvalds1da177e2005-04-16 15:20:36 -070045static int diva_bri_start_adapter(PISDN_ADAPTER IoAdapter,
46 dword start_address, dword features);
Joe Perches475be4d2012-02-19 19:52:38 -080047static int diva_bri_stop_adapter(diva_os_xdi_adapter_t *a);
Linus Torvalds1da177e2005-04-16 15:20:36 -070048
Joe Perches475be4d2012-02-19 19:52:38 -080049static void diva_bri_set_addresses(diva_os_xdi_adapter_t *a)
Linus Torvalds1da177e2005-04-16 15:20:36 -070050{
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;
Joe Perches475be4d2012-02-19 19:52:38 -080057
Linus Torvalds1da177e2005-04-16 15:20:36 -070058 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*/
Joe Perches475be4d2012-02-19 19:52:38 -080075int diva_bri_init_card(diva_os_xdi_adapter_t *a)
Linus Torvalds1da177e2005-04-16 15:20:36 -070076{
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 /*
Joe Perches475be4d2012-02-19 19:52:38 -080085 Set properties
86 */
Linus Torvalds1da177e2005-04-16 15:20:36 -070087 a->xdi_adapter.Properties = CardProperties[a->CardOrdinal];
88 DBG_LOG(("Load %s", a->xdi_adapter.Properties.Name))
89
Joe Perches475be4d2012-02-19 19:52:38 -080090 /*
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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103
104 a->resources.pci.irq =
Joe Perches475be4d2012-02-19 19:52:38 -0800105 (byte) divasa_get_pci_irq(a->resources.pci.bus,
106 a->resources.pci.func,
107 a->resources.pci.hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108 if (!a->resources.pci.irq) {
109 DBG_ERR(("A: invalid irq"));
110 return (-1);
111 }
112
113 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800114 Get length of I/O bar 2 - it is different by older
115 EEPROM version
116 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117 Bus = a->resources.pci.bus;
118 Slot = a->resources.pci.func;
119 hdev = a->resources.pci.hdev;
120
121 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800122 Get plain original values of the BAR2 CDM registers
123 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124 PCIread(Bus, Slot, 0x18, &bar2, sizeof(bar2), hdev);
125 PCIread(Bus, Slot, 0x04, &cmd_org, sizeof(cmd_org), hdev);
126 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800127 Disable device and get BAR2 length
128 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800133 Restore BAR2 and CMD registers
134 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 PCIwrite(Bus, Slot, 0x18, &bar2, sizeof(bar2), hdev);
136 PCIwrite(Bus, Slot, 0x04, &cmd_org, sizeof(cmd_org), hdev);
137
138 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800139 Calculate BAR2 length
140 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141 bar2_length = (~(bar2_length & ~7)) + 1;
142 DBG_LOG(("BAR[2] length=%lx", bar2_length))
143
Joe Perches475be4d2012-02-19 19:52:38 -0800144 /*
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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154
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]"))
Joe Perches475be4d2012-02-19 19:52:38 -0800161 diva_bri_cleanup_adapter(a);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162 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]"))
Joe Perches475be4d2012-02-19 19:52:38 -0800170 diva_bri_cleanup_adapter(a);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800177 Set all memory areas
178 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179 diva_bri_set_addresses(a);
180
181 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800182 Get Serial Number
183 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184 a->xdi_adapter.serialNo = diva_bri_get_serial_number(a);
185
186 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800187 Register I/O ports with correct name now
188 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189 if (diva_bri_reregister_io(a)) {
190 diva_bri_cleanup_adapter(a);
191 return (-1);
192 }
193
194 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800195 Initialize OS dependent objects
196 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800216 Do not initialize second DPC - only one thread will be created
217 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700218 a->xdi_adapter.isr_soft_isr.object = a->xdi_adapter.req_soft_isr.object;
219
220 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800221 Create entity table
222 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800233 Set up interface
234 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800249 Set IRQ handler
250 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251 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
Joe Perches475be4d2012-02-19 19:52:38 -0800268static int diva_bri_cleanup_adapter(diva_os_xdi_adapter_t *a)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269{
270 int i;
271
272 if (a->xdi_adapter.Initialized) {
273 diva_bri_stop_adapter(a);
274 }
275
276 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800277 Remove ISR Handler
278 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800303 Free OS objects
304 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700305 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800315 Free memory
316 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700317 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*/
Joe Perches475be4d2012-02-19 19:52:38 -0800332static dword diva_bri_get_serial_number(diva_os_xdi_adapter_t *a)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700333{
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
Joe Perches475be4d2012-02-19 19:52:38 -0800348 confMem = (word __iomem *)DIVA_OS_MEM_ATTACH_RAM(&a->xdi_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349 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
Joe Perches475be4d2012-02-19 19:52:38 -0800357 return (serNo);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358}
359
360/*
361** Unregister I/O and register it with new name,
362** based on Serial Number
363*/
Joe Perches475be4d2012-02-19 19:52:38 -0800364static int diva_bri_reregister_io(diva_os_xdi_adapter_t *a)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365{
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))
Joe Perches475be4d2012-02-19 19:52:38 -0800383 return (-1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384 }
385 a->resources.pci.addr[i] =
Joe Perches475be4d2012-02-19 19:52:38 -0800386 (void *) (unsigned long) a->resources.pci.bar[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 }
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,
Joe Perches475be4d2012-02-19 19:52:38 -0800397 diva_xdi_um_cfg_cmd_t *cmd, int length)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398{
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))
Joe Perches475be4d2012-02-19 19:52:38 -0800404 return (-1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405 }
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 =
Joe Perches475be4d2012-02-19 19:52:38 -0800411 diva_os_malloc(0, a->xdi_mbox.data_length);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412 if (a->xdi_mbox.data) {
413 *(dword *) a->xdi_mbox.data =
Joe Perches475be4d2012-02-19 19:52:38 -0800414 (dword) a->CardOrdinal;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 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 =
Joe Perches475be4d2012-02-19 19:52:38 -0800423 diva_os_malloc(0, a->xdi_mbox.data_length);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424 if (a->xdi_mbox.data) {
425 *(dword *) a->xdi_mbox.data =
Joe Perches475be4d2012-02-19 19:52:38 -0800426 (dword) a->xdi_adapter.serialNo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427 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 =
Joe Perches475be4d2012-02-19 19:52:38 -0800435 diva_os_malloc(0, a->xdi_mbox.data_length);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436 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 =
Joe Perches475be4d2012-02-19 19:52:38 -0800452 diva_os_malloc(0, a->xdi_mbox.data_length);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700453 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,
Joe Perches475be4d2012-02-19 19:52:38 -0800477 (byte *)&cmd[1],
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478 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 =
Joe Perches475be4d2012-02-19 19:52:38 -0800492 cmd->command_data.features.features;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 a->xdi_adapter.a.protocol_capabilities =
Joe Perches475be4d2012-02-19 19:52:38 -0800494 a->xdi_adapter.features;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495 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 +
Joe Perches475be4d2012-02-19 19:52:38 -0800533 ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534 addrLo = Port + ADDR;
535 ioaddr = Port + DATA;
536 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800537 recover
538 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539 outpp(addrHi, (byte) 0);
540 outppw(addrLo, (word) 0);
541 outppw(ioaddr, (word) 0);
542 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800543 clear shared memory
544 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800554 clear signature
555 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800571 Forget all outstanding entities
572 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573 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,
Joe Perches475be4d2012-02-19 19:52:38 -0800605 dword address, const byte *data, dword length)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606{
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 +
Joe Perches475be4d2012-02-19 19:52:38 -0800616 ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617 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
Joe Perches475be4d2012-02-19 19:52:38 -0800654 Port = DIVA_OS_MEM_ATTACH_PORT(IoAdapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655 addrHi = Port +
Joe Perches475be4d2012-02-19 19:52:38 -0800656 ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657 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 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800669 start the protocol code
670 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700671 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 +
Joe Perches475be4d2012-02-19 19:52:38 -0800677 ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700678 addrLo = Port + ADDR;
679 ioaddr = Port + DATA;
680 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800681 wait for signature (max. 3 seconds)
682 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683 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)))
Joe Perches475be4d2012-02-19 19:52:38 -0800696 started = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697 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))
Joe Perches475be4d2012-02-19 19:52:38 -0800706 (*(IoAdapter->trapFnc)) (IoAdapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707 return (-1);
708 }
709
710 IoAdapter->Initialized = 1;
711
712 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800713 Check Interrupt
714 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715 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))
Joe Perches475be4d2012-02-19 19:52:38 -0800732 IoAdapter->Initialized = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700733 IoAdapter->stop(IoAdapter);
734 return (-1);
735 }
736
737 IoAdapter->Properties.Features = (word) features;
738 diva_xdi_display_adapter_features(IoAdapter->ANum);
Coly Li73ac36e2009-01-07 18:09:16 -0800739 DBG_LOG(("A(%d) BRI adapter successfully started", IoAdapter->ANum))
Joe Perches475be4d2012-02-19 19:52:38 -0800740 /*
741 Register with DIDD
742 */
743 diva_xdi_didd_register_adapter(IoAdapter->ANum);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744
745 return (0);
746}
747
Joe Perches475be4d2012-02-19 19:52:38 -0800748static void diva_bri_clear_interrupts(diva_os_xdi_adapter_t *a)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749{
750 PISDN_ADAPTER IoAdapter = &a->xdi_adapter;
751
752 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800753 clear any pending interrupt
754 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755 IoAdapter->disIrq(IoAdapter);
756
757 IoAdapter->tst_irq(&IoAdapter->a);
758 IoAdapter->clr_irq(&IoAdapter->a);
759 IoAdapter->tst_irq(&IoAdapter->a);
760
761 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800762 kill pending dpcs
763 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700764 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*/
Joe Perches475be4d2012-02-19 19:52:38 -0800771static int diva_bri_stop_adapter(diva_os_xdi_adapter_t *a)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772{
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))
Joe Perches475be4d2012-02-19 19:52:38 -0800782 return (-1); /* nothing to stop */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 }
784 IoAdapter->Initialized = 0;
785
786 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800787 Disconnect Adapter from DIDD
788 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789 diva_xdi_didd_remove_adapter(IoAdapter->ANum);
790
791 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800792 Stop interrupts
793 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700794 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))
Joe Perches475be4d2012-02-19 19:52:38 -0800805 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806 IoAdapter->a.ReadyInt = 0;
807
808 /*
Joe Perches475be4d2012-02-19 19:52:38 -0800809 Stop and reset adapter
810 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811 IoAdapter->stop(IoAdapter);
812
813 return (0);
814}