Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / isdn / hardware / eicon / io.c
1
2 /*
3  *
4  Copyright (c) Eicon Networks, 2002.
5  *
6  This source file is supplied for the use with
7  Eicon Networks range of DIVA Server Adapters.
8  *
9  Eicon File Revision :    2.1
10  *
11  This program is free software; you can redistribute it and/or modify
12  it under the terms of the GNU General Public License as published by
13  the Free Software Foundation; either version 2, or (at your option)
14  any later version.
15  *
16  This program is distributed in the hope that it will be useful,
17  but WITHOUT ANY WARRANTY OF ANY KIND WHATSOEVER INCLUDING ANY
18  implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
19  See the GNU General Public License for more details.
20  *
21  You should have received a copy of the GNU General Public License
22  along with this program; if not, write to the Free Software
23  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24  *
25  */
26 #include "platform.h"
27 #include "di_defs.h"
28 #include "pc.h"
29 #include "pr_pc.h"
30 #include "divasync.h"
31 #define MIPS_SCOM
32 #include "pkmaint.h" /* pc_main.h, packed in os-dependent fashion */
33 #include "di.h"
34 #include "mi_pc.h"
35 #include "io.h"
36 extern ADAPTER *adapter[MAX_ADAPTER];
37 extern PISDN_ADAPTER IoAdapters[MAX_ADAPTER];
38 void request(PISDN_ADAPTER, ENTITY *);
39 static void pcm_req(PISDN_ADAPTER, ENTITY *);
40 /* --------------------------------------------------------------------------
41    local functions
42    -------------------------------------------------------------------------- */
43 #define ReqFunc(N)                                                      \
44         static void Request##N(ENTITY *e)                               \
45         { if (IoAdapters[N]) (*IoAdapters[N]->DIRequest)(IoAdapters[N], e); }
46 ReqFunc(0)
47 ReqFunc(1)
48 ReqFunc(2)
49 ReqFunc(3)
50 ReqFunc(4)
51 ReqFunc(5)
52 ReqFunc(6)
53 ReqFunc(7)
54 ReqFunc(8)
55 ReqFunc(9)
56 ReqFunc(10)
57 ReqFunc(11)
58 ReqFunc(12)
59 ReqFunc(13)
60 ReqFunc(14)
61 ReqFunc(15)
62 IDI_CALL Requests[MAX_ADAPTER] =
63 { &Request0, &Request1, &Request2, &Request3,
64   &Request4, &Request5, &Request6, &Request7,
65   &Request8, &Request9, &Request10, &Request11,
66   &Request12, &Request13, &Request14, &Request15
67 };
68 /*****************************************************************************/
69 /*
70   This array should indicate all new services, that this version of XDI
71   is able to provide to his clients
72 */
73 static byte extended_xdi_features[DIVA_XDI_EXTENDED_FEATURES_MAX_SZ + 1] = {
74         (DIVA_XDI_EXTENDED_FEATURES_VALID       |
75          DIVA_XDI_EXTENDED_FEATURE_SDRAM_BAR    |
76          DIVA_XDI_EXTENDED_FEATURE_CAPI_PRMS    |
77 #if defined(DIVA_IDI_RX_DMA)
78          DIVA_XDI_EXTENDED_FEATURE_CMA          |
79          DIVA_XDI_EXTENDED_FEATURE_RX_DMA       |
80          DIVA_XDI_EXTENDED_FEATURE_MANAGEMENT_DMA |
81 #endif
82          DIVA_XDI_EXTENDED_FEATURE_NO_CANCEL_RC),
83         0
84 };
85 /*****************************************************************************/
86 void
87 dump_xlog_buffer(PISDN_ADAPTER IoAdapter, Xdesc *xlogDesc)
88 {
89         dword   logLen;
90         word *Xlog   = xlogDesc->buf;
91         word  logCnt = xlogDesc->cnt;
92         word  logOut = xlogDesc->out / sizeof(*Xlog);
93         DBG_FTL(("%s: ************* XLOG recovery (%d) *************",
94                  &IoAdapter->Name[0], (int)logCnt))
95                 DBG_FTL(("Microcode: %s", &IoAdapter->ProtocolIdString[0]))
96                 for (; logCnt > 0; --logCnt)
97                 {
98                         if (!GET_WORD(&Xlog[logOut]))
99                         {
100                                 if (--logCnt == 0)
101                                         break;
102                                 logOut = 0;
103                         }
104                         if (GET_WORD(&Xlog[logOut]) <= (logOut * sizeof(*Xlog)))
105                         {
106                                 if (logCnt > 2)
107                                 {
108                                         DBG_FTL(("Possibly corrupted XLOG: %d entries left",
109                                                  (int)logCnt))
110                                                 }
111                                 break;
112                         }
113                         logLen = (dword)(GET_WORD(&Xlog[logOut]) - (logOut * sizeof(*Xlog)));
114                         DBG_FTL_MXLOG(((char *)&Xlog[logOut + 1], (dword)(logLen - 2)))
115                                 logOut = (GET_WORD(&Xlog[logOut]) + 1) / sizeof(*Xlog);
116                 }
117         DBG_FTL(("%s: ***************** end of XLOG *****************",
118                  &IoAdapter->Name[0]))
119                 }
120 /*****************************************************************************/
121 #if defined(XDI_USE_XLOG)
122 static char *(ExceptionCauseTable[]) =
123 {
124         "Interrupt",
125         "TLB mod /IBOUND",
126         "TLB load /DBOUND",
127         "TLB store",
128         "Address error load",
129         "Address error store",
130         "Instruction load bus error",
131         "Data load/store bus error",
132         "Syscall",
133         "Breakpoint",
134         "Reverd instruction",
135         "Coprocessor unusable",
136         "Overflow",
137         "TRAP",
138         "VCEI",
139         "Floating Point Exception",
140         "CP2",
141         "Reserved 17",
142         "Reserved 18",
143         "Reserved 19",
144         "Reserved 20",
145         "Reserved 21",
146         "Reserved 22",
147         "WATCH",
148         "Reserved 24",
149         "Reserved 25",
150         "Reserved 26",
151         "Reserved 27",
152         "Reserved 28",
153         "Reserved 29",
154         "Reserved 30",
155         "VCED"
156 };
157 #endif
158 void
159 dump_trap_frame(PISDN_ADAPTER IoAdapter, byte __iomem *exceptionFrame)
160 {
161         MP_XCPTC __iomem *xcept = (MP_XCPTC __iomem *)exceptionFrame;
162         dword    __iomem *regs;
163         regs  = &xcept->regs[0];
164         DBG_FTL(("%s: ***************** CPU TRAPPED *****************",
165                  &IoAdapter->Name[0]))
166                 DBG_FTL(("Microcode: %s", &IoAdapter->ProtocolIdString[0]))
167                 DBG_FTL(("Cause: %s",
168                          ExceptionCauseTable[(READ_DWORD(&xcept->cr) & 0x0000007c) >> 2]))
169                 DBG_FTL(("sr    0x%08x cr    0x%08x epc   0x%08x vaddr 0x%08x",
170                          READ_DWORD(&xcept->sr), READ_DWORD(&xcept->cr),
171                          READ_DWORD(&xcept->epc), READ_DWORD(&xcept->vaddr)))
172                 DBG_FTL(("zero  0x%08x at    0x%08x v0    0x%08x v1    0x%08x",
173                          READ_DWORD(&regs[0]), READ_DWORD(&regs[1]),
174                          READ_DWORD(&regs[2]), READ_DWORD(&regs[3])))
175                 DBG_FTL(("a0    0x%08x a1    0x%08x a2    0x%08x a3    0x%08x",
176                          READ_DWORD(&regs[4]), READ_DWORD(&regs[5]),
177                          READ_DWORD(&regs[6]), READ_DWORD(&regs[7])))
178                 DBG_FTL(("t0    0x%08x t1    0x%08x t2    0x%08x t3    0x%08x",
179                          READ_DWORD(&regs[8]), READ_DWORD(&regs[9]),
180                          READ_DWORD(&regs[10]), READ_DWORD(&regs[11])))
181                 DBG_FTL(("t4    0x%08x t5    0x%08x t6    0x%08x t7    0x%08x",
182                          READ_DWORD(&regs[12]), READ_DWORD(&regs[13]),
183                          READ_DWORD(&regs[14]), READ_DWORD(&regs[15])))
184                 DBG_FTL(("s0    0x%08x s1    0x%08x s2    0x%08x s3    0x%08x",
185                          READ_DWORD(&regs[16]), READ_DWORD(&regs[17]),
186                          READ_DWORD(&regs[18]), READ_DWORD(&regs[19])))
187                 DBG_FTL(("s4    0x%08x s5    0x%08x s6    0x%08x s7    0x%08x",
188                          READ_DWORD(&regs[20]), READ_DWORD(&regs[21]),
189                          READ_DWORD(&regs[22]), READ_DWORD(&regs[23])))
190                 DBG_FTL(("t8    0x%08x t9    0x%08x k0    0x%08x k1    0x%08x",
191                          READ_DWORD(&regs[24]), READ_DWORD(&regs[25]),
192                          READ_DWORD(&regs[26]), READ_DWORD(&regs[27])))
193                 DBG_FTL(("gp    0x%08x sp    0x%08x s8    0x%08x ra    0x%08x",
194                          READ_DWORD(&regs[28]), READ_DWORD(&regs[29]),
195                          READ_DWORD(&regs[30]), READ_DWORD(&regs[31])))
196                 DBG_FTL(("md    0x%08x|%08x         resvd 0x%08x class 0x%08x",
197                          READ_DWORD(&xcept->mdhi), READ_DWORD(&xcept->mdlo),
198                          READ_DWORD(&xcept->reseverd), READ_DWORD(&xcept->xclass)))
199                 }
200 /* --------------------------------------------------------------------------
201    Real XDI Request function
202    -------------------------------------------------------------------------- */
203 void request(PISDN_ADAPTER IoAdapter, ENTITY *e)
204 {
205         byte i;
206         diva_os_spin_lock_magic_t irql;
207 /*
208  * if the Req field in the entity structure is 0,
209  * we treat this request as a special function call
210  */
211         if (!e->Req)
212         {
213                 IDI_SYNC_REQ *syncReq = (IDI_SYNC_REQ *)e;
214                 switch (e->Rc)
215                 {
216 #if defined(DIVA_IDI_RX_DMA)
217                 case IDI_SYNC_REQ_DMA_DESCRIPTOR_OPERATION: {
218                         diva_xdi_dma_descriptor_operation_t *pI = \
219                                 &syncReq->xdi_dma_descriptor_operation.info;
220                         if (!IoAdapter->dma_map) {
221                                 pI->operation         = -1;
222                                 pI->descriptor_number = -1;
223                                 return;
224                         }
225                         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock, &irql, "dma_op");
226                         if (pI->operation == IDI_SYNC_REQ_DMA_DESCRIPTOR_ALLOC) {
227                                 pI->descriptor_number = diva_alloc_dma_map_entry(\
228                                         (struct _diva_dma_map_entry *)IoAdapter->dma_map);
229                                 if (pI->descriptor_number >= 0) {
230                                         dword dma_magic;
231                                         void *local_addr;
232                                         diva_get_dma_map_entry(\
233                                                 (struct _diva_dma_map_entry *)IoAdapter->dma_map,
234                                                 pI->descriptor_number,
235                                                 &local_addr, &dma_magic);
236                                         pI->descriptor_address  = local_addr;
237                                         pI->descriptor_magic    = dma_magic;
238                                         pI->operation           = 0;
239                                 } else {
240                                         pI->operation           = -1;
241                                 }
242                         } else if ((pI->operation == IDI_SYNC_REQ_DMA_DESCRIPTOR_FREE) &&
243                                    (pI->descriptor_number >= 0)) {
244                                 diva_free_dma_map_entry((struct _diva_dma_map_entry *)IoAdapter->dma_map,
245                                                         pI->descriptor_number);
246                                 pI->descriptor_number = -1;
247                                 pI->operation         = 0;
248                         } else {
249                                 pI->descriptor_number = -1;
250                                 pI->operation         = -1;
251                         }
252                         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock, &irql, "dma_op");
253                 } return;
254 #endif
255                 case IDI_SYNC_REQ_XDI_GET_LOGICAL_ADAPTER_NUMBER: {
256                         diva_xdi_get_logical_adapter_number_s_t *pI = \
257                                 &syncReq->xdi_logical_adapter_number.info;
258                         pI->logical_adapter_number = IoAdapter->ANum;
259                         pI->controller = IoAdapter->ControllerNumber;
260                         pI->total_controllers = IoAdapter->Properties.Adapters;
261                 } return;
262                 case IDI_SYNC_REQ_XDI_GET_CAPI_PARAMS: {
263                         diva_xdi_get_capi_parameters_t prms, *pI = &syncReq->xdi_capi_prms.info;
264                         memset(&prms, 0x00, sizeof(prms));
265                         prms.structure_length = min_t(size_t, sizeof(prms), pI->structure_length);
266                         memset(pI, 0x00, pI->structure_length);
267                         prms.flag_dynamic_l1_down    = (IoAdapter->capi_cfg.cfg_1 & \
268                                                         DIVA_XDI_CAPI_CFG_1_DYNAMIC_L1_ON) ? 1 : 0;
269                         prms.group_optimization_enabled = (IoAdapter->capi_cfg.cfg_1 & \
270                                                            DIVA_XDI_CAPI_CFG_1_GROUP_POPTIMIZATION_ON) ? 1 : 0;
271                         memcpy(pI, &prms, prms.structure_length);
272                 } return;
273                 case IDI_SYNC_REQ_XDI_GET_ADAPTER_SDRAM_BAR:
274                         syncReq->xdi_sdram_bar.info.bar = IoAdapter->sdram_bar;
275                         return;
276                 case IDI_SYNC_REQ_XDI_GET_EXTENDED_FEATURES: {
277                         dword i;
278                         diva_xdi_get_extended_xdi_features_t *pI =\
279                                 &syncReq->xdi_extended_features.info;
280                         pI->buffer_length_in_bytes &= ~0x80000000;
281                         if (pI->buffer_length_in_bytes && pI->features) {
282                                 memset(pI->features, 0x00, pI->buffer_length_in_bytes);
283                         }
284                         for (i = 0; ((pI->features) && (i < pI->buffer_length_in_bytes) &&
285                                      (i < DIVA_XDI_EXTENDED_FEATURES_MAX_SZ)); i++) {
286                                 pI->features[i] = extended_xdi_features[i];
287                         }
288                         if ((pI->buffer_length_in_bytes < DIVA_XDI_EXTENDED_FEATURES_MAX_SZ) ||
289                             (!pI->features)) {
290                                 pI->buffer_length_in_bytes =\
291                                         (0x80000000 | DIVA_XDI_EXTENDED_FEATURES_MAX_SZ);
292                         }
293                 } return;
294                 case IDI_SYNC_REQ_XDI_GET_STREAM:
295                         if (IoAdapter) {
296                                 diva_xdi_provide_istream_info(&IoAdapter->a,
297                                                               &syncReq->xdi_stream_info.info);
298                         } else {
299                                 syncReq->xdi_stream_info.info.provided_service = 0;
300                         }
301                         return;
302                 case IDI_SYNC_REQ_GET_NAME:
303                         if (IoAdapter)
304                         {
305                                 strcpy(&syncReq->GetName.name[0], IoAdapter->Name);
306                                 DBG_TRC(("xdi: Adapter %d / Name '%s'",
307                                          IoAdapter->ANum, IoAdapter->Name))
308                                         return;
309                         }
310                         syncReq->GetName.name[0] = '\0';
311                         break;
312                 case IDI_SYNC_REQ_GET_SERIAL:
313                         if (IoAdapter)
314                         {
315                                 syncReq->GetSerial.serial = IoAdapter->serialNo;
316                                 DBG_TRC(("xdi: Adapter %d / SerialNo %ld",
317                                          IoAdapter->ANum, IoAdapter->serialNo))
318                                         return;
319                         }
320                         syncReq->GetSerial.serial = 0;
321                         break;
322                 case IDI_SYNC_REQ_GET_CARDTYPE:
323                         if (IoAdapter)
324                         {
325                                 syncReq->GetCardType.cardtype = IoAdapter->cardType;
326                                 DBG_TRC(("xdi: Adapter %d / CardType %ld",
327                                          IoAdapter->ANum, IoAdapter->cardType))
328                                         return;
329                         }
330                         syncReq->GetCardType.cardtype = 0;
331                         break;
332                 case IDI_SYNC_REQ_GET_XLOG:
333                         if (IoAdapter)
334                         {
335                                 pcm_req(IoAdapter, e);
336                                 return;
337                         }
338                         e->Ind = 0;
339                         break;
340                 case IDI_SYNC_REQ_GET_DBG_XLOG:
341                         if (IoAdapter)
342                         {
343                                 pcm_req(IoAdapter, e);
344                                 return;
345                         }
346                         e->Ind = 0;
347                         break;
348                 case IDI_SYNC_REQ_GET_FEATURES:
349                         if (IoAdapter)
350                         {
351                                 syncReq->GetFeatures.features =
352                                         (unsigned short)IoAdapter->features;
353                                 return;
354                         }
355                         syncReq->GetFeatures.features = 0;
356                         break;
357                 case IDI_SYNC_REQ_PORTDRV_HOOK:
358                         if (IoAdapter)
359                         {
360                                 DBG_TRC(("Xdi:IDI_SYNC_REQ_PORTDRV_HOOK - ignored"))
361                                         return;
362                         }
363                         break;
364                 }
365                 if (IoAdapter)
366                 {
367                         return;
368                 }
369         }
370         DBG_TRC(("xdi: Id 0x%x / Req 0x%x / Rc 0x%x", e->Id, e->Req, e->Rc))
371                 if (!IoAdapter)
372                 {
373                         DBG_FTL(("xdi: uninitialized Adapter used - ignore request"))
374                                 return;
375                 }
376         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_req");
377 /*
378  * assign an entity
379  */
380         if (!(e->Id & 0x1f))
381         {
382                 if (IoAdapter->e_count >= IoAdapter->e_max)
383                 {
384                         DBG_FTL(("xdi: all Ids in use (max=%d) --> Req ignored",
385                                  IoAdapter->e_max))
386                                 diva_os_leave_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_req");
387                         return;
388                 }
389 /*
390  * find a new free id
391  */
392                 for (i = 1; IoAdapter->e_tbl[i].e; ++i);
393                 IoAdapter->e_tbl[i].e = e;
394                 IoAdapter->e_count++;
395                 e->No = (byte)i;
396                 e->More = 0;
397                 e->RCurrent = 0xff;
398         }
399         else
400         {
401                 i = e->No;
402         }
403 /*
404  * if the entity is still busy, ignore the request call
405  */
406         if (e->More & XBUSY)
407         {
408                 DBG_FTL(("xdi: Id 0x%x busy --> Req 0x%x ignored", e->Id, e->Req))
409                         if (!IoAdapter->trapped && IoAdapter->trapFnc)
410                         {
411                                 IoAdapter->trapFnc(IoAdapter);
412                                 /*
413                                   Firs trap, also notify user if supported
414                                 */
415                                 if (IoAdapter->trapped && IoAdapter->os_trap_nfy_Fnc) {
416                                         (*(IoAdapter->os_trap_nfy_Fnc))(IoAdapter, IoAdapter->ANum);
417                                 }
418                         }
419                 diva_os_leave_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_req");
420                 return;
421         }
422 /*
423  * initialize transmit status variables
424  */
425         e->More |= XBUSY;
426         e->More &= ~XMOREF;
427         e->XCurrent = 0;
428         e->XOffset = 0;
429 /*
430  * queue this entity in the adapter request queue
431  */
432         IoAdapter->e_tbl[i].next = 0;
433         if (IoAdapter->head)
434         {
435                 IoAdapter->e_tbl[IoAdapter->tail].next = i;
436                 IoAdapter->tail = i;
437         }
438         else
439         {
440                 IoAdapter->head = i;
441                 IoAdapter->tail = i;
442         }
443 /*
444  * queue the DPC to process the request
445  */
446         diva_os_schedule_soft_isr(&IoAdapter->req_soft_isr);
447         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_req");
448 }
449 /* ---------------------------------------------------------------------
450    Main DPC routine
451    --------------------------------------------------------------------- */
452 void DIDpcRoutine(struct _diva_os_soft_isr *psoft_isr, void *Context) {
453         PISDN_ADAPTER IoAdapter = (PISDN_ADAPTER)Context;
454         ADAPTER *a = &IoAdapter->a;
455         diva_os_atomic_t *pin_dpc = &IoAdapter->in_dpc;
456         if (diva_os_atomic_increment(pin_dpc) == 1) {
457                 do {
458                         if (IoAdapter->tst_irq(a))
459                         {
460                                 if (!IoAdapter->Unavailable)
461                                         IoAdapter->dpc(a);
462                                 IoAdapter->clr_irq(a);
463                         }
464                         IoAdapter->out(a);
465                 } while (diva_os_atomic_decrement(pin_dpc) > 0);
466                 /* ----------------------------------------------------------------
467                    Look for XLOG request (cards with indirect addressing)
468                    ---------------------------------------------------------------- */
469                 if (IoAdapter->pcm_pending) {
470                         struct pc_maint *pcm;
471                         diva_os_spin_lock_magic_t OldIrql;
472                         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock,
473                                                 &OldIrql,
474                                                 "data_dpc");
475                         pcm = (struct pc_maint *)IoAdapter->pcm_data;
476                         switch (IoAdapter->pcm_pending) {
477                         case 1: /* ask card for XLOG */
478                                 a->ram_out(a, &IoAdapter->pcm->rc, 0);
479                                 a->ram_out(a, &IoAdapter->pcm->req, pcm->req);
480                                 IoAdapter->pcm_pending = 2;
481                                 break;
482                         case 2: /* Try to get XLOG from the card */
483                                 if ((int)(a->ram_in(a, &IoAdapter->pcm->rc))) {
484                                         a->ram_in_buffer(a, IoAdapter->pcm, pcm, sizeof(*pcm));
485                                         IoAdapter->pcm_pending = 3;
486                                 }
487                                 break;
488                         case 3: /* let XDI recovery XLOG */
489                                 break;
490                         }
491                         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock,
492                                                 &OldIrql,
493                                                 "data_dpc");
494                 }
495                 /* ---------------------------------------------------------------- */
496         }
497 }
498 /* --------------------------------------------------------------------------
499    XLOG interface
500    -------------------------------------------------------------------------- */
501 static void
502 pcm_req(PISDN_ADAPTER IoAdapter, ENTITY *e)
503 {
504         diva_os_spin_lock_magic_t OldIrql;
505         int              i, rc;
506         ADAPTER         *a = &IoAdapter->a;
507         struct pc_maint *pcm = (struct pc_maint *)&e->Ind;
508 /*
509  * special handling of I/O based card interface
510  * the memory access isn't an atomic operation !
511  */
512         if (IoAdapter->Properties.Card == CARD_MAE)
513         {
514                 diva_os_enter_spin_lock(&IoAdapter->data_spin_lock,
515                                         &OldIrql,
516                                         "data_pcm_1");
517                 IoAdapter->pcm_data = (void *)pcm;
518                 IoAdapter->pcm_pending = 1;
519                 diva_os_schedule_soft_isr(&IoAdapter->req_soft_isr);
520                 diva_os_leave_spin_lock(&IoAdapter->data_spin_lock,
521                                         &OldIrql,
522                                         "data_pcm_1");
523                 for (rc = 0, i = (IoAdapter->trapped ? 3000 : 250); !rc && (i > 0); --i)
524                 {
525                         diva_os_sleep(1);
526                         if (IoAdapter->pcm_pending == 3) {
527                                 diva_os_enter_spin_lock(&IoAdapter->data_spin_lock,
528                                                         &OldIrql,
529                                                         "data_pcm_3");
530                                 IoAdapter->pcm_pending = 0;
531                                 IoAdapter->pcm_data    = NULL;
532                                 diva_os_leave_spin_lock(&IoAdapter->data_spin_lock,
533                                                         &OldIrql,
534                                                         "data_pcm_3");
535                                 return;
536                         }
537                         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock,
538                                                 &OldIrql,
539                                                 "data_pcm_2");
540                         diva_os_schedule_soft_isr(&IoAdapter->req_soft_isr);
541                         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock,
542                                                 &OldIrql,
543                                                 "data_pcm_2");
544                 }
545                 diva_os_enter_spin_lock(&IoAdapter->data_spin_lock,
546                                         &OldIrql,
547                                         "data_pcm_4");
548                 IoAdapter->pcm_pending = 0;
549                 IoAdapter->pcm_data    = NULL;
550                 diva_os_leave_spin_lock(&IoAdapter->data_spin_lock,
551                                         &OldIrql,
552                                         "data_pcm_4");
553                 goto Trapped;
554         }
555 /*
556  * memory based shared ram is accessible from different
557  * processors without disturbing concurrent processes.
558  */
559         a->ram_out(a, &IoAdapter->pcm->rc, 0);
560         a->ram_out(a, &IoAdapter->pcm->req, pcm->req);
561         for (i = (IoAdapter->trapped ? 3000 : 250); --i > 0;)
562         {
563                 diva_os_sleep(1);
564                 rc = (int)(a->ram_in(a, &IoAdapter->pcm->rc));
565                 if (rc)
566                 {
567                         a->ram_in_buffer(a, IoAdapter->pcm, pcm, sizeof(*pcm));
568                         return;
569                 }
570         }
571 Trapped:
572         if (IoAdapter->trapFnc)
573         {
574                 int trapped = IoAdapter->trapped;
575                 IoAdapter->trapFnc(IoAdapter);
576                 /*
577                   Firs trap, also notify user if supported
578                 */
579                 if (!trapped && IoAdapter->trapped && IoAdapter->os_trap_nfy_Fnc) {
580                         (*(IoAdapter->os_trap_nfy_Fnc))(IoAdapter, IoAdapter->ANum);
581                 }
582         }
583 }
584 /*------------------------------------------------------------------*/
585 /* ram access functions for memory mapped cards                     */
586 /*------------------------------------------------------------------*/
587 byte mem_in(ADAPTER *a, void *addr)
588 {
589         byte val;
590         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
591         val = READ_BYTE(Base + (unsigned long)addr);
592         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
593         return (val);
594 }
595 word mem_inw(ADAPTER *a, void *addr)
596 {
597         word val;
598         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
599         val = READ_WORD((Base + (unsigned long)addr));
600         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
601         return (val);
602 }
603 void mem_in_dw(ADAPTER *a, void *addr, dword *data, int dwords)
604 {
605         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
606         while (dwords--) {
607                 *data++ = READ_DWORD((Base + (unsigned long)addr));
608                 addr += 4;
609         }
610         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
611 }
612 void mem_in_buffer(ADAPTER *a, void *addr, void *buffer, word length)
613 {
614         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
615         memcpy_fromio(buffer, (Base + (unsigned long)addr), length);
616         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
617 }
618 void mem_look_ahead(ADAPTER *a, PBUFFER *RBuffer, ENTITY *e)
619 {
620         PISDN_ADAPTER IoAdapter = (PISDN_ADAPTER)a->io;
621         IoAdapter->RBuffer.length = mem_inw(a, &RBuffer->length);
622         mem_in_buffer(a, RBuffer->P, IoAdapter->RBuffer.P,
623                       IoAdapter->RBuffer.length);
624         e->RBuffer = (DBUFFER *)&IoAdapter->RBuffer;
625 }
626 void mem_out(ADAPTER *a, void *addr, byte data)
627 {
628         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
629         WRITE_BYTE(Base + (unsigned long)addr, data);
630         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
631 }
632 void mem_outw(ADAPTER *a, void *addr, word data)
633 {
634         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
635         WRITE_WORD((Base + (unsigned long)addr), data);
636         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
637 }
638 void mem_out_dw(ADAPTER *a, void *addr, const dword *data, int dwords)
639 {
640         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
641         while (dwords--) {
642                 WRITE_DWORD((Base + (unsigned long)addr), *data);
643                 addr += 4;
644                 data++;
645         }
646         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
647 }
648 void mem_out_buffer(ADAPTER *a, void *addr, void *buffer, word length)
649 {
650         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
651         memcpy_toio((Base + (unsigned long)addr), buffer, length);
652         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
653 }
654 void mem_inc(ADAPTER *a, void *addr)
655 {
656         volatile byte __iomem *Base = DIVA_OS_MEM_ATTACH_RAM((PISDN_ADAPTER)a->io);
657         byte  x = READ_BYTE(Base + (unsigned long)addr);
658         WRITE_BYTE(Base + (unsigned long)addr, x + 1);
659         DIVA_OS_MEM_DETACH_RAM((PISDN_ADAPTER)a->io, Base);
660 }
661 /*------------------------------------------------------------------*/
662 /* ram access functions for io-mapped cards                         */
663 /*------------------------------------------------------------------*/
664 byte io_in(ADAPTER *a, void *adr)
665 {
666         byte val;
667         byte __iomem *Port = DIVA_OS_MEM_ATTACH_PORT((PISDN_ADAPTER)a->io);
668         outppw(Port + 4, (word)(unsigned long)adr);
669         val = inpp(Port);
670         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
671         return (val);
672 }
673 word io_inw(ADAPTER *a, void *adr)
674 {
675         word val;
676         byte __iomem *Port = DIVA_OS_MEM_ATTACH_PORT((PISDN_ADAPTER)a->io);
677         outppw(Port + 4, (word)(unsigned long)adr);
678         val = inppw(Port);
679         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
680         return (val);
681 }
682 void io_in_buffer(ADAPTER *a, void *adr, void *buffer, word len)
683 {
684         byte __iomem *Port = DIVA_OS_MEM_ATTACH_PORT((PISDN_ADAPTER)a->io);
685         byte *P = (byte *)buffer;
686         if ((long)adr & 1) {
687                 outppw(Port + 4, (word)(unsigned long)adr);
688                 *P = inpp(Port);
689                 P++;
690                 adr = ((byte *) adr) + 1;
691                 len--;
692                 if (!len) {
693                         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
694                         return;
695                 }
696         }
697         outppw(Port + 4, (word)(unsigned long)adr);
698         inppw_buffer(Port, P, len + 1);
699         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
700 }
701 void io_look_ahead(ADAPTER *a, PBUFFER *RBuffer, ENTITY *e)
702 {
703         byte __iomem *Port = DIVA_OS_MEM_ATTACH_PORT((PISDN_ADAPTER)a->io);
704         outppw(Port + 4, (word)(unsigned long)RBuffer);
705         ((PISDN_ADAPTER)a->io)->RBuffer.length = inppw(Port);
706         inppw_buffer(Port, ((PISDN_ADAPTER)a->io)->RBuffer.P, ((PISDN_ADAPTER)a->io)->RBuffer.length + 1);
707         e->RBuffer = (DBUFFER *) &(((PISDN_ADAPTER)a->io)->RBuffer);
708         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
709 }
710 void io_out(ADAPTER *a, void *adr, byte data)
711 {
712         byte __iomem *Port = DIVA_OS_MEM_ATTACH_PORT((PISDN_ADAPTER)a->io);
713         outppw(Port + 4, (word)(unsigned long)adr);
714         outpp(Port, data);
715         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
716 }
717 void io_outw(ADAPTER *a, void *adr, word data)
718 {
719         byte __iomem *Port = DIVA_OS_MEM_ATTACH_PORT((PISDN_ADAPTER)a->io);
720         outppw(Port + 4, (word)(unsigned long)adr);
721         outppw(Port, data);
722         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
723 }
724 void io_out_buffer(ADAPTER *a, void *adr, void *buffer, word len)
725 {
726         byte __iomem *Port = DIVA_OS_MEM_ATTACH_PORT((PISDN_ADAPTER)a->io);
727         byte *P = (byte *)buffer;
728         if ((long)adr & 1) {
729                 outppw(Port + 4, (word)(unsigned long)adr);
730                 outpp(Port, *P);
731                 P++;
732                 adr = ((byte *) adr) + 1;
733                 len--;
734                 if (!len) {
735                         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
736                         return;
737                 }
738         }
739         outppw(Port + 4, (word)(unsigned long)adr);
740         outppw_buffer(Port, P, len + 1);
741         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
742 }
743 void io_inc(ADAPTER *a, void *adr)
744 {
745         byte x;
746         byte __iomem *Port = DIVA_OS_MEM_ATTACH_PORT((PISDN_ADAPTER)a->io);
747         outppw(Port + 4, (word)(unsigned long)adr);
748         x = inpp(Port);
749         outppw(Port + 4, (word)(unsigned long)adr);
750         outpp(Port, x + 1);
751         DIVA_OS_MEM_DETACH_PORT((PISDN_ADAPTER)a->io, Port);
752 }
753 /*------------------------------------------------------------------*/
754 /* OS specific functions related to queuing of entities             */
755 /*------------------------------------------------------------------*/
756 void free_entity(ADAPTER *a, byte e_no)
757 {
758         PISDN_ADAPTER IoAdapter;
759         diva_os_spin_lock_magic_t irql;
760         IoAdapter = (PISDN_ADAPTER) a->io;
761         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_free");
762         IoAdapter->e_tbl[e_no].e = NULL;
763         IoAdapter->e_count--;
764         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_free");
765 }
766 void assign_queue(ADAPTER *a, byte e_no, word ref)
767 {
768         PISDN_ADAPTER IoAdapter;
769         diva_os_spin_lock_magic_t irql;
770         IoAdapter = (PISDN_ADAPTER) a->io;
771         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_assign");
772         IoAdapter->e_tbl[e_no].assign_ref = ref;
773         IoAdapter->e_tbl[e_no].next = (byte)IoAdapter->assign;
774         IoAdapter->assign = e_no;
775         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_assign");
776 }
777 byte get_assign(ADAPTER *a, word ref)
778 {
779         PISDN_ADAPTER IoAdapter;
780         diva_os_spin_lock_magic_t irql;
781         byte e_no;
782         IoAdapter = (PISDN_ADAPTER) a->io;
783         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock,
784                                 &irql,
785                                 "data_assign_get");
786         for (e_no = (byte)IoAdapter->assign;
787             e_no && IoAdapter->e_tbl[e_no].assign_ref != ref;
788             e_no = IoAdapter->e_tbl[e_no].next);
789         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock,
790                                 &irql,
791                                 "data_assign_get");
792         return e_no;
793 }
794 void req_queue(ADAPTER *a, byte e_no)
795 {
796         PISDN_ADAPTER IoAdapter;
797         diva_os_spin_lock_magic_t irql;
798         IoAdapter = (PISDN_ADAPTER) a->io;
799         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_req_q");
800         IoAdapter->e_tbl[e_no].next = 0;
801         if (IoAdapter->head) {
802                 IoAdapter->e_tbl[IoAdapter->tail].next = e_no;
803                 IoAdapter->tail = e_no;
804         }
805         else {
806                 IoAdapter->head = e_no;
807                 IoAdapter->tail = e_no;
808         }
809         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_req_q");
810 }
811 byte look_req(ADAPTER *a)
812 {
813         PISDN_ADAPTER IoAdapter;
814         IoAdapter = (PISDN_ADAPTER) a->io;
815         return ((byte)IoAdapter->head);
816 }
817 void next_req(ADAPTER *a)
818 {
819         PISDN_ADAPTER IoAdapter;
820         diva_os_spin_lock_magic_t irql;
821         IoAdapter = (PISDN_ADAPTER) a->io;
822         diva_os_enter_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_req_next");
823         IoAdapter->head = IoAdapter->e_tbl[IoAdapter->head].next;
824         if (!IoAdapter->head) IoAdapter->tail = 0;
825         diva_os_leave_spin_lock(&IoAdapter->data_spin_lock, &irql, "data_req_next");
826 }
827 /*------------------------------------------------------------------*/
828 /* memory map functions                                             */
829 /*------------------------------------------------------------------*/
830 ENTITY *entity_ptr(ADAPTER *a, byte e_no)
831 {
832         PISDN_ADAPTER IoAdapter;
833         IoAdapter = (PISDN_ADAPTER)a->io;
834         return (IoAdapter->e_tbl[e_no].e);
835 }
836 void *PTR_X(ADAPTER *a, ENTITY *e)
837 {
838         return ((void *) e->X);
839 }
840 void *PTR_R(ADAPTER *a, ENTITY *e)
841 {
842         return ((void *) e->R);
843 }
844 void *PTR_P(ADAPTER *a, ENTITY *e, void *P)
845 {
846         return P;
847 }
848 void CALLBACK(ADAPTER *a, ENTITY *e)
849 {
850         if (e && e->callback)
851                 e->callback(e);
852 }