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