drivers/isdn/hardware/eicon/s_pri.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 "di.h"
  31 #include "mi_pc.h"
  32 #include "pc_maint.h"
  33 #include "divasync.h"
  34 #include "io.h"
  35 #include "helpers.h"
  36 #include "dsrv_pri.h"
  37 #include "dsp_defs.h"
  38 /*****************************************************************************/
  39 #define MAX_XLOG_SIZE  (64 * 1024)
  40 /* -------------------------------------------------------------------------
  41    Does return offset between ADAPTER->ram and real begin of memory
  42    ------------------------------------------------------------------------- */
  43 static dword pri_ram_offset(ADAPTER *a) {
  44         return ((dword)MP_SHARED_RAM_OFFSET);
  45 }
  46 /* -------------------------------------------------------------------------
  47    Recovery XLOG buffer from the card
  48    ------------------------------------------------------------------------- */
  49 static void pri_cpu_trapped(PISDN_ADAPTER IoAdapter) {
  50         byte  __iomem *base;
  51         word *Xlog;
  52         dword   regs[4], TrapID, size;
  53         Xdesc   xlogDesc;
  54 /*
  55  * check for trapped MIPS 46xx CPU, dump exception frame
  56  */
  57         base   = DIVA_OS_MEM_ATTACH_ADDRESS(IoAdapter);
  58         TrapID = READ_DWORD(&base[0x80]);
  59         if ((TrapID == 0x99999999) || (TrapID == 0x99999901))
  60         {
  61                 dump_trap_frame(IoAdapter, &base[0x90]);
  62                 IoAdapter->trapped = 1;
  63         }
  64         regs[0] = READ_DWORD(&base[MP_PROTOCOL_OFFSET + 0x70]);
  65         regs[1] = READ_DWORD(&base[MP_PROTOCOL_OFFSET + 0x74]);
  66         regs[2] = READ_DWORD(&base[MP_PROTOCOL_OFFSET + 0x78]);
  67         regs[3] = READ_DWORD(&base[MP_PROTOCOL_OFFSET + 0x7c]);
  68         regs[0] &= IoAdapter->MemorySize - 1;
  69         if ((regs[0] < IoAdapter->MemorySize - 1))
  70         {
  71                 if (!(Xlog = (word *)diva_os_malloc(0, MAX_XLOG_SIZE))) {
  72                         DIVA_OS_MEM_DETACH_ADDRESS(IoAdapter, base);
  73                         return;
  74                 }
  75                 size = IoAdapter->MemorySize - regs[0];
  76                 if (size > MAX_XLOG_SIZE)
  77                         size = MAX_XLOG_SIZE;
  78                 memcpy_fromio(Xlog, &base[regs[0]], size);
  79                 xlogDesc.buf = Xlog;
  80                 xlogDesc.cnt = READ_WORD(&base[regs[1] & (IoAdapter->MemorySize - 1)]);
  81                 xlogDesc.out = READ_WORD(&base[regs[2] & (IoAdapter->MemorySize - 1)]);
  82                 dump_xlog_buffer(IoAdapter, &xlogDesc);
  83                 diva_os_free(0, Xlog);
  84                 IoAdapter->trapped = 2;
  85         }
  86         DIVA_OS_MEM_DETACH_ADDRESS(IoAdapter, base);
  87 }
  88 /* -------------------------------------------------------------------------
  89    Hardware reset of PRI card
  90    ------------------------------------------------------------------------- */
  91 static void reset_pri_hardware(PISDN_ADAPTER IoAdapter) {
  92         byte __iomem *p = DIVA_OS_MEM_ATTACH_RESET(IoAdapter);
  93         WRITE_BYTE(p, _MP_RISC_RESET | _MP_LED1 | _MP_LED2);
  94         diva_os_wait(50);
  95         WRITE_BYTE(p, 0x00);
  96         diva_os_wait(50);
  97         DIVA_OS_MEM_DETACH_RESET(IoAdapter, p);
  98 }
  99 /* -------------------------------------------------------------------------
 100    Stop Card Hardware
 101    ------------------------------------------------------------------------- */
 102 static void stop_pri_hardware(PISDN_ADAPTER IoAdapter) {
 103         dword i;
 104         byte __iomem *p;
 105         dword volatile __iomem *cfgReg = (void __iomem *)DIVA_OS_MEM_ATTACH_CFG(IoAdapter);
 106         WRITE_DWORD(&cfgReg[3], 0);
 107         WRITE_DWORD(&cfgReg[1], 0);
 108         DIVA_OS_MEM_DETACH_CFG(IoAdapter, cfgReg);
 109         IoAdapter->a.ram_out(&IoAdapter->a, &RAM->SWReg, SWREG_HALT_CPU);
 110         i = 0;
 111         while ((i < 100) && (IoAdapter->a.ram_in(&IoAdapter->a, &RAM->SWReg) != 0))
 112         {
 113                 diva_os_wait(1);
 114                 i++;
 115         }
 116         DBG_TRC(("%s: PRI stopped (%d)", IoAdapter->Name, i))
 117                 cfgReg = (void __iomem *)DIVA_OS_MEM_ATTACH_CFG(IoAdapter);
 118         WRITE_DWORD(&cfgReg[0], ((dword)(~0x03E00000)));
 119         DIVA_OS_MEM_DETACH_CFG(IoAdapter, cfgReg);
 120         diva_os_wait(1);
 121         p = DIVA_OS_MEM_ATTACH_RESET(IoAdapter);
 122         WRITE_BYTE(p, _MP_RISC_RESET | _MP_LED1 | _MP_LED2);
 123         DIVA_OS_MEM_DETACH_RESET(IoAdapter, p);
 124 }
 125 static int load_pri_hardware(PISDN_ADAPTER IoAdapter) {
 126         return (0);
 127 }
 128 /* --------------------------------------------------------------------------
 129    PRI Adapter interrupt Service Routine
 130    -------------------------------------------------------------------------- */
 131 static int pri_ISR(struct _ISDN_ADAPTER *IoAdapter) {
 132         byte __iomem *cfg = DIVA_OS_MEM_ATTACH_CFG(IoAdapter);
 133         if (!(READ_DWORD(cfg) & 0x80000000)) {
 134                 DIVA_OS_MEM_DETACH_CFG(IoAdapter, cfg);
 135                 return (0);
 136         }
 137         /*
 138           clear interrupt line
 139         */
 140         WRITE_DWORD(cfg, (dword)~0x03E00000);
 141         DIVA_OS_MEM_DETACH_CFG(IoAdapter, cfg);
 142         IoAdapter->IrqCount++;
 143         if (IoAdapter->Initialized)
 144         {
 145                 diva_os_schedule_soft_isr(&IoAdapter->isr_soft_isr);
 146         }
 147         return (1);
 148 }
 149 /* -------------------------------------------------------------------------
 150    Disable interrupt in the card hardware
 151    ------------------------------------------------------------------------- */
 152 static void disable_pri_interrupt(PISDN_ADAPTER IoAdapter) {
 153         dword volatile __iomem *cfgReg = (dword volatile __iomem *)DIVA_OS_MEM_ATTACH_CFG(IoAdapter);
 154         WRITE_DWORD(&cfgReg[3], 0);
 155         WRITE_DWORD(&cfgReg[1], 0);
 156         WRITE_DWORD(&cfgReg[0], (dword)(~0x03E00000));
 157         DIVA_OS_MEM_DETACH_CFG(IoAdapter, cfgReg);
 158 }
 159 /* -------------------------------------------------------------------------
 160    Install entry points for PRI Adapter
 161    ------------------------------------------------------------------------- */
 162 static void prepare_common_pri_functions(PISDN_ADAPTER IoAdapter) {
 163         ADAPTER *a = &IoAdapter->a;
 164         a->ram_in           = mem_in;
 165         a->ram_inw          = mem_inw;
 166         a->ram_in_buffer    = mem_in_buffer;
 167         a->ram_look_ahead   = mem_look_ahead;
 168         a->ram_out          = mem_out;
 169         a->ram_outw         = mem_outw;
 170         a->ram_out_buffer   = mem_out_buffer;
 171         a->ram_inc          = mem_inc;
 172         a->ram_offset       = pri_ram_offset;
 173         a->ram_out_dw    = mem_out_dw;
 174         a->ram_in_dw    = mem_in_dw;
 175         a->istream_wakeup   = pr_stream;
 176         IoAdapter->out      = pr_out;
 177         IoAdapter->dpc      = pr_dpc;
 178         IoAdapter->tst_irq  = scom_test_int;
 179         IoAdapter->clr_irq  = scom_clear_int;
 180         IoAdapter->pcm      = (struct pc_maint *)(MIPS_MAINT_OFFS
 181                                                   - MP_SHARED_RAM_OFFSET);
 182         IoAdapter->load     = load_pri_hardware;
 183         IoAdapter->disIrq   = disable_pri_interrupt;
 184         IoAdapter->rstFnc   = reset_pri_hardware;
 185         IoAdapter->stop     = stop_pri_hardware;
 186         IoAdapter->trapFnc  = pri_cpu_trapped;
 187         IoAdapter->diva_isr_handler = pri_ISR;
 188 }
 189 /* -------------------------------------------------------------------------
 190    Install entry points for PRI Adapter
 191    ------------------------------------------------------------------------- */
 192 void prepare_pri_functions(PISDN_ADAPTER IoAdapter) {
 193         IoAdapter->MemorySize = MP_MEMORY_SIZE;
 194         prepare_common_pri_functions(IoAdapter);
 195         diva_os_prepare_pri_functions(IoAdapter);
 196 }
 197 /* -------------------------------------------------------------------------
 198    Install entry points for PRI Rev.2 Adapter
 199    ------------------------------------------------------------------------- */
 200 void prepare_pri2_functions(PISDN_ADAPTER IoAdapter) {
 201         IoAdapter->MemorySize = MP2_MEMORY_SIZE;
 202         prepare_common_pri_functions(IoAdapter);
 203         diva_os_prepare_pri2_functions(IoAdapter);
 204 }
 205 /* ------------------------------------------------------------------------- */