192 строки
6.5 KiB
C
192 строки
6.5 KiB
C
|
|
||
|
|
/*
|
||
|
|
*
|
||
|
|
Copyright (c) Eicon Networks, 2002.
|
||
|
|
*
|
||
|
|
This source file is supplied for the use with
|
||
|
|
Eicon Networks range of DIVA Server Adapters.
|
||
|
|
*
|
||
|
|
Eicon File Revision : 2.1
|
||
|
|
*
|
||
|
|
This program is free software; you can redistribute it and/or modify
|
||
|
|
it under the terms of the GNU General Public License as published by
|
||
|
|
the Free Software Foundation; either version 2, or (at your option)
|
||
|
|
any later version.
|
||
|
|
*
|
||
|
|
This program is distributed in the hope that it will be useful,
|
||
|
|
but WITHOUT ANY WARRANTY OF ANY KIND WHATSOEVER INCLUDING ANY
|
||
|
|
implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
||
|
|
See the GNU General Public License for more details.
|
||
|
|
*
|
||
|
|
You should have received a copy of the GNU General Public License
|
||
|
|
along with this program; if not, write to the Free Software
|
||
|
|
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
#include "platform.h"
|
||
|
|
#include "di_defs.h"
|
||
|
|
#include "pc.h"
|
||
|
|
#include "pr_pc.h"
|
||
|
|
#include "di.h"
|
||
|
|
#include "mi_pc.h"
|
||
|
|
#include "pc_maint.h"
|
||
|
|
#include "divasync.h"
|
||
|
|
#include "io.h"
|
||
|
|
#include "helpers.h"
|
||
|
|
#include "dsrv_bri.h"
|
||
|
|
#include "dsp_defs.h"
|
||
|
|
/*****************************************************************************/
|
||
|
|
#define MAX_XLOG_SIZE (64 * 1024)
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Investigate card state, recovery trace buffer
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
static void bri_cpu_trapped (PISDN_ADAPTER IoAdapter) {
|
||
|
|
byte __iomem *addrHi, *addrLo, *ioaddr ;
|
||
|
|
word *Xlog ;
|
||
|
|
dword regs[4], i, size ;
|
||
|
|
Xdesc xlogDesc ;
|
||
|
|
byte __iomem *Port;
|
||
|
|
/*
|
||
|
|
* first read pointers and trap frame
|
||
|
|
*/
|
||
|
|
if ( !(Xlog = (word *)diva_os_malloc (0, MAX_XLOG_SIZE)) )
|
||
|
|
return ;
|
||
|
|
Port = DIVA_OS_MEM_ATTACH_PORT(IoAdapter);
|
||
|
|
addrHi = Port + ((IoAdapter->Properties.Bus == BUS_PCI) ? M_PCI_ADDRH : ADDRH) ;
|
||
|
|
addrLo = Port + ADDR ;
|
||
|
|
ioaddr = Port + DATA ;
|
||
|
|
outpp (addrHi, 0) ;
|
||
|
|
outppw (addrLo, 0) ;
|
||
|
|
for ( i = 0 ; i < 0x100 ; Xlog[i++] = inppw(ioaddr) ) ;
|
||
|
|
/*
|
||
|
|
* check for trapped MIPS 3xxx CPU, dump only exception frame
|
||
|
|
*/
|
||
|
|
if ( GET_DWORD(&Xlog[0x80 / sizeof(Xlog[0])]) == 0x99999999 )
|
||
|
|
{
|
||
|
|
dump_trap_frame (IoAdapter, &((byte *)Xlog)[0x90]) ;
|
||
|
|
IoAdapter->trapped = 1 ;
|
||
|
|
}
|
||
|
|
regs[0] = GET_DWORD(&((byte *)Xlog)[0x70]);
|
||
|
|
regs[1] = GET_DWORD(&((byte *)Xlog)[0x74]);
|
||
|
|
regs[2] = GET_DWORD(&((byte *)Xlog)[0x78]);
|
||
|
|
regs[3] = GET_DWORD(&((byte *)Xlog)[0x7c]);
|
||
|
|
outpp (addrHi, (regs[1] >> 16) & 0x7F) ;
|
||
|
|
outppw (addrLo, regs[1] & 0xFFFF) ;
|
||
|
|
xlogDesc.cnt = inppw(ioaddr) ;
|
||
|
|
outpp (addrHi, (regs[2] >> 16) & 0x7F) ;
|
||
|
|
outppw (addrLo, regs[2] & 0xFFFF) ;
|
||
|
|
xlogDesc.out = inppw(ioaddr) ;
|
||
|
|
xlogDesc.buf = Xlog ;
|
||
|
|
regs[0] &= IoAdapter->MemorySize - 1 ;
|
||
|
|
if ( (regs[0] < IoAdapter->MemorySize - 1) )
|
||
|
|
{
|
||
|
|
size = IoAdapter->MemorySize - regs[0] ;
|
||
|
|
if ( size > MAX_XLOG_SIZE )
|
||
|
|
size = MAX_XLOG_SIZE ;
|
||
|
|
for ( i = 0 ; i < (size / sizeof(*Xlog)) ; regs[0] += 2 )
|
||
|
|
{
|
||
|
|
outpp (addrHi, (regs[0] >> 16) & 0x7F) ;
|
||
|
|
outppw (addrLo, regs[0] & 0xFFFF) ;
|
||
|
|
Xlog[i++] = inppw(ioaddr) ;
|
||
|
|
}
|
||
|
|
dump_xlog_buffer (IoAdapter, &xlogDesc) ;
|
||
|
|
diva_os_free (0, Xlog) ;
|
||
|
|
IoAdapter->trapped = 2 ;
|
||
|
|
}
|
||
|
|
outpp (addrHi, (byte)((BRI_UNCACHED_ADDR (IoAdapter->MemoryBase + IoAdapter->MemorySize -
|
||
|
|
BRI_SHARED_RAM_SIZE)) >> 16)) ;
|
||
|
|
outppw (addrLo, 0x00) ;
|
||
|
|
DIVA_OS_MEM_DETACH_PORT(IoAdapter, Port);
|
||
|
|
}
|
||
|
|
/* ---------------------------------------------------------------------
|
||
|
|
Reset hardware
|
||
|
|
--------------------------------------------------------------------- */
|
||
|
|
static void reset_bri_hardware (PISDN_ADAPTER IoAdapter) {
|
||
|
|
byte __iomem *p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
outpp (p, 0x00) ;
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
}
|
||
|
|
/* ---------------------------------------------------------------------
|
||
|
|
Halt system
|
||
|
|
--------------------------------------------------------------------- */
|
||
|
|
static void stop_bri_hardware (PISDN_ADAPTER IoAdapter) {
|
||
|
|
byte __iomem *p = DIVA_OS_MEM_ATTACH_RESET(IoAdapter);
|
||
|
|
if (p) {
|
||
|
|
outpp (p, 0x00) ; /* disable interrupts ! */
|
||
|
|
}
|
||
|
|
DIVA_OS_MEM_DETACH_RESET(IoAdapter, p);
|
||
|
|
p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
outpp (p, 0x00) ; /* clear int, halt cpu */
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
}
|
||
|
|
static int load_bri_hardware (PISDN_ADAPTER IoAdapter) {
|
||
|
|
return (0);
|
||
|
|
}
|
||
|
|
/******************************************************************************/
|
||
|
|
static int bri_ISR (struct _ISDN_ADAPTER* IoAdapter) {
|
||
|
|
byte __iomem *p;
|
||
|
|
|
||
|
|
p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
if ( !(inpp (p) & 0x01) ) {
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
return (0) ;
|
||
|
|
}
|
||
|
|
/*
|
||
|
|
clear interrupt line
|
||
|
|
*/
|
||
|
|
outpp (p, 0x08) ;
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
IoAdapter->IrqCount++ ;
|
||
|
|
if ( IoAdapter->Initialized ) {
|
||
|
|
diva_os_schedule_soft_isr (&IoAdapter->isr_soft_isr);
|
||
|
|
}
|
||
|
|
return (1) ;
|
||
|
|
}
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Disable IRQ in the card hardware
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
static void disable_bri_interrupt (PISDN_ADAPTER IoAdapter) {
|
||
|
|
byte __iomem *p;
|
||
|
|
p = DIVA_OS_MEM_ATTACH_RESET(IoAdapter);
|
||
|
|
if ( p )
|
||
|
|
{
|
||
|
|
outpp (p, 0x00) ; /* disable interrupts ! */
|
||
|
|
}
|
||
|
|
DIVA_OS_MEM_DETACH_RESET(IoAdapter, p);
|
||
|
|
p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
outpp (p, 0x00) ; /* clear int, halt cpu */
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
}
|
||
|
|
/* -------------------------------------------------------------------------
|
||
|
|
Fill card entry points
|
||
|
|
------------------------------------------------------------------------- */
|
||
|
|
void prepare_maestra_functions (PISDN_ADAPTER IoAdapter) {
|
||
|
|
ADAPTER *a = &IoAdapter->a ;
|
||
|
|
a->ram_in = io_in ;
|
||
|
|
a->ram_inw = io_inw ;
|
||
|
|
a->ram_in_buffer = io_in_buffer ;
|
||
|
|
a->ram_look_ahead = io_look_ahead ;
|
||
|
|
a->ram_out = io_out ;
|
||
|
|
a->ram_outw = io_outw ;
|
||
|
|
a->ram_out_buffer = io_out_buffer ;
|
||
|
|
a->ram_inc = io_inc ;
|
||
|
|
IoAdapter->MemoryBase = BRI_MEMORY_BASE ;
|
||
|
|
IoAdapter->MemorySize = BRI_MEMORY_SIZE ;
|
||
|
|
IoAdapter->out = pr_out ;
|
||
|
|
IoAdapter->dpc = pr_dpc ;
|
||
|
|
IoAdapter->tst_irq = scom_test_int ;
|
||
|
|
IoAdapter->clr_irq = scom_clear_int ;
|
||
|
|
IoAdapter->pcm = (struct pc_maint *)MIPS_MAINT_OFFS ;
|
||
|
|
IoAdapter->load = load_bri_hardware ;
|
||
|
|
IoAdapter->disIrq = disable_bri_interrupt ;
|
||
|
|
IoAdapter->rstFnc = reset_bri_hardware ;
|
||
|
|
IoAdapter->stop = stop_bri_hardware ;
|
||
|
|
IoAdapter->trapFnc = bri_cpu_trapped ;
|
||
|
|
IoAdapter->diva_isr_handler = bri_ISR;
|
||
|
|
/*
|
||
|
|
Prepare OS dependent functions
|
||
|
|
*/
|
||
|
|
diva_os_prepare_maestra_functions (IoAdapter);
|
||
|
|
}
|
||
|
|
/* -------------------------------------------------------------------------- */
|