| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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(®s[ 0]), READ_DWORD(®s[ 1]), | 
|  | 174 | READ_DWORD(®s[ 2]), READ_DWORD(®s[ 3]))) | 
|  | 175 | DBG_FTL(("a0    0x%08x a1    0x%08x a2    0x%08x a3    0x%08x", | 
|  | 176 | READ_DWORD(®s[ 4]), READ_DWORD(®s[ 5]), | 
|  | 177 | READ_DWORD(®s[ 6]), READ_DWORD(®s[ 7]))) | 
|  | 178 | DBG_FTL(("t0    0x%08x t1    0x%08x t2    0x%08x t3    0x%08x", | 
|  | 179 | READ_DWORD(®s[ 8]), READ_DWORD(®s[ 9]), | 
|  | 180 | READ_DWORD(®s[10]), READ_DWORD(®s[11]))) | 
|  | 181 | DBG_FTL(("t4    0x%08x t5    0x%08x t6    0x%08x t7    0x%08x", | 
|  | 182 | READ_DWORD(®s[12]), READ_DWORD(®s[13]), | 
|  | 183 | READ_DWORD(®s[14]), READ_DWORD(®s[15]))) | 
|  | 184 | DBG_FTL(("s0    0x%08x s1    0x%08x s2    0x%08x s3    0x%08x", | 
|  | 185 | READ_DWORD(®s[16]), READ_DWORD(®s[17]), | 
|  | 186 | READ_DWORD(®s[18]), READ_DWORD(®s[19]))) | 
|  | 187 | DBG_FTL(("s4    0x%08x s5    0x%08x s6    0x%08x s7    0x%08x", | 
|  | 188 | READ_DWORD(®s[20]), READ_DWORD(®s[21]), | 
|  | 189 | READ_DWORD(®s[22]), READ_DWORD(®s[23]))) | 
|  | 190 | DBG_FTL(("t8    0x%08x t9    0x%08x k0    0x%08x k1    0x%08x", | 
|  | 191 | READ_DWORD(®s[24]), READ_DWORD(®s[25]), | 
|  | 192 | READ_DWORD(®s[26]), READ_DWORD(®s[27]))) | 
|  | 193 | DBG_FTL(("gp    0x%08x sp    0x%08x s8    0x%08x ra    0x%08x", | 
|  | 194 | READ_DWORD(®s[28]), READ_DWORD(®s[29]), | 
|  | 195 | READ_DWORD(®s[30]), READ_DWORD(®s[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)); | 
| Amol Lad | e2de257 | 2006-12-08 02:39:32 -0800 | [diff] [blame] | 265 | prms.structure_length = min_t(size_t, sizeof(prms), pI->structure_length); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | } |