511 lines
15 KiB
C
511 lines
15 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 "pc_init.h"
|
||
|
|
#include "io.h"
|
||
|
|
#include "helpers.h"
|
||
|
|
#include "dsrv4bri.h"
|
||
|
|
#include "dsp_defs.h"
|
||
|
|
#include "sdp_hdr.h"
|
||
|
|
|
||
|
|
/*****************************************************************************/
|
||
|
|
#define MAX_XLOG_SIZE (64 * 1024)
|
||
|
|
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Recovery XLOG from QBRI Card
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
static void qBri_cpu_trapped (PISDN_ADAPTER IoAdapter) {
|
||
|
|
byte __iomem *base ;
|
||
|
|
word *Xlog ;
|
||
|
|
dword regs[4], TrapID, offset, size ;
|
||
|
|
Xdesc xlogDesc ;
|
||
|
|
int factor = (IoAdapter->tasks == 1) ? 1 : 2;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* check for trapped MIPS 46xx CPU, dump exception frame
|
||
|
|
*/
|
||
|
|
|
||
|
|
base = DIVA_OS_MEM_ATTACH_CONTROL(IoAdapter);
|
||
|
|
offset = IoAdapter->ControllerNumber * (IoAdapter->MemorySize >> factor) ;
|
||
|
|
|
||
|
|
TrapID = READ_DWORD(&base[0x80]) ;
|
||
|
|
|
||
|
|
if ( (TrapID == 0x99999999) || (TrapID == 0x99999901) )
|
||
|
|
{
|
||
|
|
dump_trap_frame (IoAdapter, &base[0x90]) ;
|
||
|
|
IoAdapter->trapped = 1 ;
|
||
|
|
}
|
||
|
|
|
||
|
|
regs[0] = READ_DWORD((base + offset) + 0x70);
|
||
|
|
regs[1] = READ_DWORD((base + offset) + 0x74);
|
||
|
|
regs[2] = READ_DWORD((base + offset) + 0x78);
|
||
|
|
regs[3] = READ_DWORD((base + offset) + 0x7c);
|
||
|
|
regs[0] &= IoAdapter->MemorySize - 1 ;
|
||
|
|
|
||
|
|
if ( (regs[0] >= offset)
|
||
|
|
&& (regs[0] < offset + (IoAdapter->MemorySize >> factor) - 1) )
|
||
|
|
{
|
||
|
|
if ( !(Xlog = (word *)diva_os_malloc (0, MAX_XLOG_SIZE)) ) {
|
||
|
|
DIVA_OS_MEM_DETACH_CONTROL(IoAdapter, base);
|
||
|
|
return ;
|
||
|
|
}
|
||
|
|
|
||
|
|
size = offset + (IoAdapter->MemorySize >> factor) - regs[0] ;
|
||
|
|
if ( size > MAX_XLOG_SIZE )
|
||
|
|
size = MAX_XLOG_SIZE ;
|
||
|
|
memcpy_fromio (Xlog, &base[regs[0]], size) ;
|
||
|
|
xlogDesc.buf = Xlog ;
|
||
|
|
xlogDesc.cnt = READ_WORD(&base[regs[1] & (IoAdapter->MemorySize - 1)]) ;
|
||
|
|
xlogDesc.out = READ_WORD(&base[regs[2] & (IoAdapter->MemorySize - 1)]) ;
|
||
|
|
dump_xlog_buffer (IoAdapter, &xlogDesc) ;
|
||
|
|
diva_os_free (0, Xlog) ;
|
||
|
|
IoAdapter->trapped = 2 ;
|
||
|
|
}
|
||
|
|
DIVA_OS_MEM_DETACH_CONTROL(IoAdapter, base);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Reset QBRI Hardware
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
static void reset_qBri_hardware (PISDN_ADAPTER IoAdapter) {
|
||
|
|
word volatile __iomem *qBriReset ;
|
||
|
|
byte volatile __iomem *qBriCntrl ;
|
||
|
|
byte volatile __iomem *p ;
|
||
|
|
|
||
|
|
qBriReset = (word volatile __iomem *)DIVA_OS_MEM_ATTACH_PROM(IoAdapter);
|
||
|
|
WRITE_WORD(qBriReset, READ_WORD(qBriReset) | PLX9054_SOFT_RESET) ;
|
||
|
|
diva_os_wait (1) ;
|
||
|
|
WRITE_WORD(qBriReset, READ_WORD(qBriReset) & ~PLX9054_SOFT_RESET) ;
|
||
|
|
diva_os_wait (1);
|
||
|
|
WRITE_WORD(qBriReset, READ_WORD(qBriReset) | PLX9054_RELOAD_EEPROM) ;
|
||
|
|
diva_os_wait (1) ;
|
||
|
|
WRITE_WORD(qBriReset, READ_WORD(qBriReset) & ~PLX9054_RELOAD_EEPROM) ;
|
||
|
|
diva_os_wait (1);
|
||
|
|
DIVA_OS_MEM_DETACH_PROM(IoAdapter, qBriReset);
|
||
|
|
|
||
|
|
qBriCntrl = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
p = &qBriCntrl[DIVA_4BRI_REVISION(IoAdapter) ? (MQ2_BREG_RISC) : (MQ_BREG_RISC)];
|
||
|
|
WRITE_DWORD(p, 0) ;
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, qBriCntrl);
|
||
|
|
|
||
|
|
DBG_TRC(("resetted board @ reset addr 0x%08lx", qBriReset))
|
||
|
|
DBG_TRC(("resetted board @ cntrl addr 0x%08lx", p))
|
||
|
|
}
|
||
|
|
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Start Card CPU
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
void start_qBri_hardware (PISDN_ADAPTER IoAdapter) {
|
||
|
|
byte volatile __iomem *qBriReset ;
|
||
|
|
byte volatile __iomem *p ;
|
||
|
|
|
||
|
|
p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
qBriReset = &p[(DIVA_4BRI_REVISION(IoAdapter)) ? (MQ2_BREG_RISC) : (MQ_BREG_RISC)];
|
||
|
|
WRITE_DWORD(qBriReset, MQ_RISC_COLD_RESET_MASK) ;
|
||
|
|
diva_os_wait (2) ;
|
||
|
|
WRITE_DWORD(qBriReset, MQ_RISC_WARM_RESET_MASK | MQ_RISC_COLD_RESET_MASK) ;
|
||
|
|
diva_os_wait (10) ;
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
|
||
|
|
DBG_TRC(("started processor @ addr 0x%08lx", qBriReset))
|
||
|
|
}
|
||
|
|
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Stop Card CPU
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
static void stop_qBri_hardware (PISDN_ADAPTER IoAdapter) {
|
||
|
|
byte volatile __iomem *p ;
|
||
|
|
dword volatile __iomem *qBriReset ;
|
||
|
|
dword volatile __iomem *qBriIrq ;
|
||
|
|
dword volatile __iomem *qBriIsacDspReset ;
|
||
|
|
int rev2 = DIVA_4BRI_REVISION(IoAdapter);
|
||
|
|
int reset_offset = rev2 ? (MQ2_BREG_RISC) : (MQ_BREG_RISC);
|
||
|
|
int irq_offset = rev2 ? (MQ2_BREG_IRQ_TEST) : (MQ_BREG_IRQ_TEST);
|
||
|
|
int hw_offset = rev2 ? (MQ2_ISAC_DSP_RESET) : (MQ_ISAC_DSP_RESET);
|
||
|
|
|
||
|
|
if ( IoAdapter->ControllerNumber > 0 )
|
||
|
|
return ;
|
||
|
|
p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
qBriReset = (dword volatile __iomem *)&p[reset_offset];
|
||
|
|
qBriIsacDspReset = (dword volatile __iomem *)&p[hw_offset];
|
||
|
|
/*
|
||
|
|
* clear interrupt line (reset Local Interrupt Test Register)
|
||
|
|
*/
|
||
|
|
WRITE_DWORD(qBriReset, 0) ;
|
||
|
|
WRITE_DWORD(qBriIsacDspReset, 0) ;
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
|
||
|
|
p = DIVA_OS_MEM_ATTACH_RESET(IoAdapter);
|
||
|
|
WRITE_BYTE(&p[PLX9054_INTCSR], 0x00); /* disable PCI interrupts */
|
||
|
|
DIVA_OS_MEM_DETACH_RESET(IoAdapter, p);
|
||
|
|
|
||
|
|
p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
qBriIrq = (dword volatile __iomem *)&p[irq_offset];
|
||
|
|
WRITE_DWORD(qBriIrq, MQ_IRQ_REQ_OFF) ;
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
|
||
|
|
DBG_TRC(("stopped processor @ addr 0x%08lx", qBriReset))
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
FPGA download
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
#define FPGA_NAME_OFFSET 0x10
|
||
|
|
|
||
|
|
static byte * qBri_check_FPGAsrc (PISDN_ADAPTER IoAdapter, char *FileName,
|
||
|
|
dword *Length, dword *code) {
|
||
|
|
byte *File ;
|
||
|
|
char *fpgaFile, *fpgaType, *fpgaDate, *fpgaTime ;
|
||
|
|
dword fpgaFlen, fpgaTlen, fpgaDlen, cnt, year, i ;
|
||
|
|
|
||
|
|
if (!(File = (byte *)xdiLoadFile (FileName, Length, 0))) {
|
||
|
|
return (NULL) ;
|
||
|
|
}
|
||
|
|
/*
|
||
|
|
* scan file until FF and put id string into buffer
|
||
|
|
*/
|
||
|
|
for ( i = 0 ; File[i] != 0xff ; )
|
||
|
|
{
|
||
|
|
if ( ++i >= *Length )
|
||
|
|
{
|
||
|
|
DBG_FTL(("FPGA download: start of data header not found"))
|
||
|
|
xdiFreeFile (File) ;
|
||
|
|
return (NULL) ;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
*code = i++ ;
|
||
|
|
|
||
|
|
if ( (File[i] & 0xF0) != 0x20 )
|
||
|
|
{
|
||
|
|
DBG_FTL(("FPGA download: data header corrupted"))
|
||
|
|
xdiFreeFile (File) ;
|
||
|
|
return (NULL) ;
|
||
|
|
}
|
||
|
|
fpgaFlen = (dword) File[FPGA_NAME_OFFSET - 1] ;
|
||
|
|
if ( fpgaFlen == 0 )
|
||
|
|
fpgaFlen = 12 ;
|
||
|
|
fpgaFile = (char *)&File[FPGA_NAME_OFFSET] ;
|
||
|
|
fpgaTlen = (dword) fpgaFile[fpgaFlen + 2] ;
|
||
|
|
if ( fpgaTlen == 0 )
|
||
|
|
fpgaTlen = 10 ;
|
||
|
|
fpgaType = (char *)&fpgaFile[fpgaFlen + 3] ;
|
||
|
|
fpgaDlen = (dword) fpgaType[fpgaTlen + 2] ;
|
||
|
|
if ( fpgaDlen == 0 )
|
||
|
|
fpgaDlen = 11 ;
|
||
|
|
fpgaDate = (char *)&fpgaType[fpgaTlen + 3] ;
|
||
|
|
fpgaTime = (char *)&fpgaDate[fpgaDlen + 3] ;
|
||
|
|
cnt = (dword)(((File[ i ] & 0x0F) << 20) + (File[i + 1] << 12)
|
||
|
|
+ (File[i + 2] << 4) + (File[i + 3] >> 4)) ;
|
||
|
|
|
||
|
|
if ( (dword)(i + (cnt / 8)) > *Length )
|
||
|
|
{
|
||
|
|
DBG_FTL(("FPGA download: '%s' file too small (%ld < %ld)",
|
||
|
|
FileName, *Length, code + ((cnt + 7) / 8) ))
|
||
|
|
xdiFreeFile (File) ;
|
||
|
|
return (NULL) ;
|
||
|
|
}
|
||
|
|
i = 0 ;
|
||
|
|
do
|
||
|
|
{
|
||
|
|
while ( (fpgaDate[i] != '\0')
|
||
|
|
&& ((fpgaDate[i] < '0') || (fpgaDate[i] > '9')) )
|
||
|
|
{
|
||
|
|
i++;
|
||
|
|
}
|
||
|
|
year = 0 ;
|
||
|
|
while ( (fpgaDate[i] >= '0') && (fpgaDate[i] <= '9') )
|
||
|
|
year = year * 10 + (fpgaDate[i++] - '0') ;
|
||
|
|
} while ( (year < 2000) && (fpgaDate[i] != '\0') );
|
||
|
|
|
||
|
|
switch (IoAdapter->cardType) {
|
||
|
|
case CARDTYPE_DIVASRV_B_2F_PCI:
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
if ( year >= 2001 ) {
|
||
|
|
IoAdapter->fpga_features |= PCINIT_FPGA_PLX_ACCESS_SUPPORTED ;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
DBG_LOG(("FPGA[%s] file %s (%s %s) len %d",
|
||
|
|
fpgaType, fpgaFile, fpgaDate, fpgaTime, cnt))
|
||
|
|
return (File) ;
|
||
|
|
}
|
||
|
|
|
||
|
|
/******************************************************************************/
|
||
|
|
|
||
|
|
#define FPGA_PROG 0x0001 /* PROG enable low */
|
||
|
|
#define FPGA_BUSY 0x0002 /* BUSY high, DONE low */
|
||
|
|
#define FPGA_CS 0x000C /* Enable I/O pins */
|
||
|
|
#define FPGA_CCLK 0x0100
|
||
|
|
#define FPGA_DOUT 0x0400
|
||
|
|
#define FPGA_DIN FPGA_DOUT /* bidirectional I/O */
|
||
|
|
|
||
|
|
int qBri_FPGA_download (PISDN_ADAPTER IoAdapter) {
|
||
|
|
int bit ;
|
||
|
|
byte *File ;
|
||
|
|
dword code, FileLength ;
|
||
|
|
word volatile __iomem *addr = (word volatile __iomem *)DIVA_OS_MEM_ATTACH_PROM(IoAdapter);
|
||
|
|
word val, baseval = FPGA_CS | FPGA_PROG ;
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
if (DIVA_4BRI_REVISION(IoAdapter))
|
||
|
|
{
|
||
|
|
char* name;
|
||
|
|
|
||
|
|
switch (IoAdapter->cardType) {
|
||
|
|
case CARDTYPE_DIVASRV_B_2F_PCI:
|
||
|
|
name = "dsbri2f.bit";
|
||
|
|
break;
|
||
|
|
|
||
|
|
case CARDTYPE_DIVASRV_B_2M_V2_PCI:
|
||
|
|
case CARDTYPE_DIVASRV_VOICE_B_2M_V2_PCI:
|
||
|
|
name = "dsbri2m.bit";
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
name = "ds4bri2.bit";
|
||
|
|
}
|
||
|
|
|
||
|
|
File = qBri_check_FPGAsrc (IoAdapter, name,
|
||
|
|
&FileLength, &code);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
File = qBri_check_FPGAsrc (IoAdapter, "ds4bri.bit",
|
||
|
|
&FileLength, &code) ;
|
||
|
|
}
|
||
|
|
if ( !File ) {
|
||
|
|
DIVA_OS_MEM_DETACH_PROM(IoAdapter, addr);
|
||
|
|
return (0) ;
|
||
|
|
}
|
||
|
|
/*
|
||
|
|
* prepare download, pulse PROGRAM pin down.
|
||
|
|
*/
|
||
|
|
WRITE_WORD(addr, baseval & ~FPGA_PROG) ; /* PROGRAM low pulse */
|
||
|
|
WRITE_WORD(addr, baseval) ; /* release */
|
||
|
|
diva_os_wait (50) ; /* wait until FPGA finished internal memory clear */
|
||
|
|
/*
|
||
|
|
* check done pin, must be low
|
||
|
|
*/
|
||
|
|
if ( READ_WORD(addr) & FPGA_BUSY )
|
||
|
|
{
|
||
|
|
DBG_FTL(("FPGA download: acknowledge for FPGA memory clear missing"))
|
||
|
|
xdiFreeFile (File) ;
|
||
|
|
DIVA_OS_MEM_DETACH_PROM(IoAdapter, addr);
|
||
|
|
return (0) ;
|
||
|
|
}
|
||
|
|
/*
|
||
|
|
* put data onto the FPGA
|
||
|
|
*/
|
||
|
|
while ( code < FileLength )
|
||
|
|
{
|
||
|
|
val = ((word)File[code++]) << 3 ;
|
||
|
|
|
||
|
|
for ( bit = 8 ; bit-- > 0 ; val <<= 1 ) /* put byte onto FPGA */
|
||
|
|
{
|
||
|
|
baseval &= ~FPGA_DOUT ; /* clr data bit */
|
||
|
|
baseval |= (val & FPGA_DOUT) ; /* copy data bit */
|
||
|
|
WRITE_WORD(addr, baseval) ;
|
||
|
|
WRITE_WORD(addr, baseval | FPGA_CCLK) ; /* set CCLK hi */
|
||
|
|
WRITE_WORD(addr, baseval | FPGA_CCLK) ; /* set CCLK hi */
|
||
|
|
WRITE_WORD(addr, baseval) ; /* set CCLK lo */
|
||
|
|
}
|
||
|
|
}
|
||
|
|
xdiFreeFile (File) ;
|
||
|
|
diva_os_wait (100) ;
|
||
|
|
val = READ_WORD(addr) ;
|
||
|
|
|
||
|
|
DIVA_OS_MEM_DETACH_PROM(IoAdapter, addr);
|
||
|
|
|
||
|
|
if ( !(val & FPGA_BUSY) )
|
||
|
|
{
|
||
|
|
DBG_FTL(("FPGA download: chip remains in busy state (0x%04x)", val))
|
||
|
|
return (0) ;
|
||
|
|
}
|
||
|
|
|
||
|
|
return (1) ;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int load_qBri_hardware (PISDN_ADAPTER IoAdapter) {
|
||
|
|
return (0);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Card ISR
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
static int qBri_ISR (struct _ISDN_ADAPTER* IoAdapter) {
|
||
|
|
dword volatile __iomem *qBriIrq ;
|
||
|
|
|
||
|
|
PADAPTER_LIST_ENTRY QuadroList = IoAdapter->QuadroList ;
|
||
|
|
|
||
|
|
word i ;
|
||
|
|
int serviced = 0 ;
|
||
|
|
byte __iomem *p;
|
||
|
|
|
||
|
|
p = DIVA_OS_MEM_ATTACH_RESET(IoAdapter);
|
||
|
|
|
||
|
|
if ( !(READ_BYTE(&p[PLX9054_INTCSR]) & 0x80) ) {
|
||
|
|
DIVA_OS_MEM_DETACH_RESET(IoAdapter, p);
|
||
|
|
return (0) ;
|
||
|
|
}
|
||
|
|
DIVA_OS_MEM_DETACH_RESET(IoAdapter, p);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* clear interrupt line (reset Local Interrupt Test Register)
|
||
|
|
*/
|
||
|
|
p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
qBriIrq = (dword volatile __iomem *)(&p[DIVA_4BRI_REVISION(IoAdapter) ? (MQ2_BREG_IRQ_TEST) : (MQ_BREG_IRQ_TEST)]);
|
||
|
|
WRITE_DWORD(qBriIrq, MQ_IRQ_REQ_OFF) ;
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
|
||
|
|
for ( i = 0 ; i < IoAdapter->tasks; ++i )
|
||
|
|
{
|
||
|
|
IoAdapter = QuadroList->QuadroAdapter[i] ;
|
||
|
|
|
||
|
|
if ( IoAdapter && IoAdapter->Initialized
|
||
|
|
&& IoAdapter->tst_irq (&IoAdapter->a) )
|
||
|
|
{
|
||
|
|
IoAdapter->IrqCount++ ;
|
||
|
|
serviced = 1 ;
|
||
|
|
diva_os_schedule_soft_isr (&IoAdapter->isr_soft_isr);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return (serviced) ;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Does disable the interrupt on the card
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
static void disable_qBri_interrupt (PISDN_ADAPTER IoAdapter) {
|
||
|
|
dword volatile __iomem *qBriIrq ;
|
||
|
|
byte __iomem *p;
|
||
|
|
|
||
|
|
if ( IoAdapter->ControllerNumber > 0 )
|
||
|
|
return ;
|
||
|
|
/*
|
||
|
|
* clear interrupt line (reset Local Interrupt Test Register)
|
||
|
|
*/
|
||
|
|
p = DIVA_OS_MEM_ATTACH_RESET(IoAdapter);
|
||
|
|
WRITE_BYTE(&p[PLX9054_INTCSR], 0x00); /* disable PCI interrupts */
|
||
|
|
DIVA_OS_MEM_DETACH_RESET(IoAdapter, p);
|
||
|
|
|
||
|
|
p = DIVA_OS_MEM_ATTACH_CTLREG(IoAdapter);
|
||
|
|
qBriIrq = (dword volatile __iomem *)(&p[DIVA_4BRI_REVISION(IoAdapter) ? (MQ2_BREG_IRQ_TEST) : (MQ_BREG_IRQ_TEST)]);
|
||
|
|
WRITE_DWORD(qBriIrq, MQ_IRQ_REQ_OFF) ;
|
||
|
|
DIVA_OS_MEM_DETACH_CTLREG(IoAdapter, p);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* --------------------------------------------------------------------------
|
||
|
|
Install Adapter Entry Points
|
||
|
|
-------------------------------------------------------------------------- */
|
||
|
|
static void set_common_qBri_functions (PISDN_ADAPTER IoAdapter) {
|
||
|
|
ADAPTER *a;
|
||
|
|
|
||
|
|
a = &IoAdapter->a ;
|
||
|
|
|
||
|
|
a->ram_in = mem_in ;
|
||
|
|
a->ram_inw = mem_inw ;
|
||
|
|
a->ram_in_buffer = mem_in_buffer ;
|
||
|
|
a->ram_look_ahead = mem_look_ahead ;
|
||
|
|
a->ram_out = mem_out ;
|
||
|
|
a->ram_outw = mem_outw ;
|
||
|
|
a->ram_out_buffer = mem_out_buffer ;
|
||
|
|
a->ram_inc = mem_inc ;
|
||
|
|
|
||
|
|
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_qBri_hardware ;
|
||
|
|
|
||
|
|
IoAdapter->disIrq = disable_qBri_interrupt ;
|
||
|
|
IoAdapter->rstFnc = reset_qBri_hardware ;
|
||
|
|
IoAdapter->stop = stop_qBri_hardware ;
|
||
|
|
IoAdapter->trapFnc = qBri_cpu_trapped ;
|
||
|
|
|
||
|
|
IoAdapter->diva_isr_handler = qBri_ISR;
|
||
|
|
|
||
|
|
IoAdapter->a.io = (void*)IoAdapter ;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void set_qBri_functions (PISDN_ADAPTER IoAdapter) {
|
||
|
|
if (!IoAdapter->tasks) {
|
||
|
|
IoAdapter->tasks = MQ_INSTANCE_COUNT;
|
||
|
|
}
|
||
|
|
IoAdapter->MemorySize = MQ_MEMORY_SIZE ;
|
||
|
|
set_common_qBri_functions (IoAdapter) ;
|
||
|
|
diva_os_set_qBri_functions (IoAdapter) ;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void set_qBri2_functions (PISDN_ADAPTER IoAdapter) {
|
||
|
|
if (!IoAdapter->tasks) {
|
||
|
|
IoAdapter->tasks = MQ_INSTANCE_COUNT;
|
||
|
|
}
|
||
|
|
IoAdapter->MemorySize = (IoAdapter->tasks == 1) ? BRI2_MEMORY_SIZE : MQ2_MEMORY_SIZE;
|
||
|
|
set_common_qBri_functions (IoAdapter) ;
|
||
|
|
diva_os_set_qBri2_functions (IoAdapter) ;
|
||
|
|
}
|
||
|
|
|
||
|
|
/******************************************************************************/
|
||
|
|
|
||
|
|
void prepare_qBri_functions (PISDN_ADAPTER IoAdapter) {
|
||
|
|
|
||
|
|
set_qBri_functions (IoAdapter->QuadroList->QuadroAdapter[0]) ;
|
||
|
|
set_qBri_functions (IoAdapter->QuadroList->QuadroAdapter[1]) ;
|
||
|
|
set_qBri_functions (IoAdapter->QuadroList->QuadroAdapter[2]) ;
|
||
|
|
set_qBri_functions (IoAdapter->QuadroList->QuadroAdapter[3]) ;
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
void prepare_qBri2_functions (PISDN_ADAPTER IoAdapter) {
|
||
|
|
if (!IoAdapter->tasks) {
|
||
|
|
IoAdapter->tasks = MQ_INSTANCE_COUNT;
|
||
|
|
}
|
||
|
|
|
||
|
|
set_qBri2_functions (IoAdapter->QuadroList->QuadroAdapter[0]) ;
|
||
|
|
if (IoAdapter->tasks > 1) {
|
||
|
|
set_qBri2_functions (IoAdapter->QuadroList->QuadroAdapter[1]) ;
|
||
|
|
set_qBri2_functions (IoAdapter->QuadroList->QuadroAdapter[2]) ;
|
||
|
|
set_qBri2_functions (IoAdapter->QuadroList->QuadroAdapter[3]) ;
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
/* -------------------------------------------------------------------------- */
|