![Adrian Bunk](/assets/img/avatar_default.png)
This patch contains the following possible cleanups: - make needlessly global code static - remove the compiled but unused st5481_hdlc.{c,h} - kill enternow.h - enternow_pci.c: kill InByte/OutByte/BYTE - isdnl2.c: kill FreeSkb - remove or #if 0 the following unused functions: - config.c: IsdnCardState - ipacx.c: ipacx_new_ph - ipacx.c: dch_bh - ipacx.c: setup_ipacx - isdnl2.c: IsRR Signed-off-by: Adrian Bunk <bunk@stusta.de> Acked-by: Kai Germaschewski <kai@germaschewski.name> Signed-off-by: Andrew Morton <akpm@osdl.org> Signed-off-by: Linus Torvalds <torvalds@osdl.org>
797 lines
23 KiB
C
797 lines
23 KiB
C
/* gerdes_amd7930.c,v 0.99 2001/10/02
|
||
*
|
||
* gerdes_amd7930.c Amd 79C30A and 79C32A specific routines
|
||
* (based on HiSax driver by Karsten Keil)
|
||
*
|
||
* Author Christoph Ersfeld <info@formula-n.de>
|
||
* Formula-n Europe AG (www.formula-n.com)
|
||
* previously Gerdes AG
|
||
*
|
||
*
|
||
* This file is (c) under GNU PUBLIC LICENSE
|
||
*
|
||
*
|
||
* Notes:
|
||
* Version 0.99 is the first release of this driver and there are
|
||
* certainly a few bugs.
|
||
*
|
||
* Please don't report any malfunction to me without sending
|
||
* (compressed) debug-logs.
|
||
* It would be nearly impossible to retrace it.
|
||
*
|
||
* Log D-channel-processing as follows:
|
||
*
|
||
* 1. Load hisax with card-specific parameters, this example ist for
|
||
* Formula-n enter:now ISDN PCI and compatible
|
||
* (f.e. Gerdes Power ISDN PCI)
|
||
*
|
||
* modprobe hisax type=41 protocol=2 id=gerdes
|
||
*
|
||
* if you chose an other value for id, you need to modify the
|
||
* code below, too.
|
||
*
|
||
* 2. set debug-level
|
||
*
|
||
* hisaxctrl gerdes 1 0x3ff
|
||
* hisaxctrl gerdes 11 0x4f
|
||
* cat /dev/isdnctrl >> ~/log &
|
||
*
|
||
* Please take also a look into /var/log/messages if there is
|
||
* anything importand concerning HISAX.
|
||
*
|
||
*
|
||
* Credits:
|
||
* Programming the driver for Formula-n enter:now ISDN PCI and
|
||
* necessary this driver for the used Amd 7930 D-channel-controller
|
||
* was spnsored by Formula-n Europe AG.
|
||
* Thanks to Karsten Keil and Petr Novak, who gave me support in
|
||
* Hisax-specific questions.
|
||
* I want so say special thanks to Carl-Friedrich Braun, who had to
|
||
* answer a lot of questions about generally ISDN and about handling
|
||
* of the Amd-Chip.
|
||
*
|
||
*/
|
||
|
||
|
||
#include "hisax.h"
|
||
#include "isdnl1.h"
|
||
#include "isac.h"
|
||
#include "amd7930_fn.h"
|
||
#include <linux/interrupt.h>
|
||
#include <linux/init.h>
|
||
|
||
static void Amd7930_new_ph(struct IsdnCardState *cs);
|
||
|
||
static WORD initAMD[] = {
|
||
0x0100,
|
||
|
||
0x00A5, 3, 0x01, 0x40, 0x58, // LPR, LMR1, LMR2
|
||
0x0086, 1, 0x0B, // DMR1 (D-Buffer TH-Interrupts on)
|
||
0x0087, 1, 0xFF, // DMR2
|
||
0x0092, 1, 0x03, // EFCR (extended mode d-channel-fifo on)
|
||
0x0090, 4, 0xFE, 0xFF, 0x02, 0x0F, // FRAR4, SRAR4, DMR3, DMR4 (address recognition )
|
||
0x0084, 2, 0x80, 0x00, // DRLR
|
||
0x00C0, 1, 0x47, // PPCR1
|
||
0x00C8, 1, 0x01, // PPCR2
|
||
|
||
0x0102,
|
||
0x0107,
|
||
0x01A1, 1,
|
||
0x0121, 1,
|
||
0x0189, 2,
|
||
|
||
0x0045, 4, 0x61, 0x72, 0x00, 0x00, // MCR1, MCR2, MCR3, MCR4
|
||
0x0063, 2, 0x08, 0x08, // GX
|
||
0x0064, 2, 0x08, 0x08, // GR
|
||
0x0065, 2, 0x99, 0x00, // GER
|
||
0x0066, 2, 0x7C, 0x8B, // STG
|
||
0x0067, 2, 0x00, 0x00, // FTGR1, FTGR2
|
||
0x0068, 2, 0x20, 0x20, // ATGR1, ATGR2
|
||
0x0069, 1, 0x4F, // MMR1
|
||
0x006A, 1, 0x00, // MMR2
|
||
0x006C, 1, 0x40, // MMR3
|
||
0x0021, 1, 0x02, // INIT
|
||
0x00A3, 1, 0x40, // LMR1
|
||
|
||
0xFFFF
|
||
};
|
||
|
||
|
||
static void /* macro wWordAMD */
|
||
WriteWordAmd7930(struct IsdnCardState *cs, BYTE reg, WORD val)
|
||
{
|
||
wByteAMD(cs, 0x00, reg);
|
||
wByteAMD(cs, 0x01, LOBYTE(val));
|
||
wByteAMD(cs, 0x01, HIBYTE(val));
|
||
}
|
||
|
||
static WORD /* macro rWordAMD */
|
||
ReadWordAmd7930(struct IsdnCardState *cs, BYTE reg)
|
||
{
|
||
WORD res;
|
||
/* direct access register */
|
||
if(reg < 8) {
|
||
res = rByteAMD(cs, reg);
|
||
res += 256*rByteAMD(cs, reg);
|
||
}
|
||
/* indirect access register */
|
||
else {
|
||
wByteAMD(cs, 0x00, reg);
|
||
res = rByteAMD(cs, 0x01);
|
||
res += 256*rByteAMD(cs, 0x01);
|
||
}
|
||
return (res);
|
||
}
|
||
|
||
|
||
static void
|
||
Amd7930_ph_command(struct IsdnCardState *cs, u_char command, char *s)
|
||
{
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "AMD7930: %s: ph_command 0x%02X", s, command);
|
||
|
||
cs->dc.amd7930.lmr1 = command;
|
||
wByteAMD(cs, 0xA3, command);
|
||
}
|
||
|
||
|
||
|
||
static BYTE i430States[] = {
|
||
// to reset F3 F4 F5 F6 F7 F8 AR from
|
||
0x01, 0x02, 0x00, 0x00, 0x00, 0x07, 0x05, 0x00, // init
|
||
0x01, 0x02, 0x00, 0x00, 0x00, 0x07, 0x05, 0x00, // reset
|
||
0x01, 0x02, 0x00, 0x00, 0x00, 0x09, 0x05, 0x04, // F3
|
||
0x01, 0x02, 0x00, 0x00, 0x1B, 0x00, 0x00, 0x00, // F4
|
||
0x01, 0x02, 0x00, 0x00, 0x1B, 0x00, 0x00, 0x00, // F5
|
||
0x01, 0x03, 0x00, 0x00, 0x00, 0x06, 0x05, 0x00, // F6
|
||
0x11, 0x13, 0x00, 0x00, 0x1B, 0x00, 0x15, 0x00, // F7
|
||
0x01, 0x03, 0x00, 0x00, 0x00, 0x06, 0x00, 0x00, // F8
|
||
0x01, 0x03, 0x00, 0x00, 0x00, 0x09, 0x00, 0x0A}; // AR
|
||
|
||
|
||
/* Row init - reset F3 F4 F5 F6 F7 F8 AR */
|
||
static BYTE stateHelper[] = { 0x00, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08 };
|
||
|
||
|
||
|
||
|
||
static void
|
||
Amd7930_get_state(struct IsdnCardState *cs) {
|
||
BYTE lsr = rByteAMD(cs, 0xA1);
|
||
cs->dc.amd7930.ph_state = (lsr & 0x7) + 2;
|
||
Amd7930_new_ph(cs);
|
||
}
|
||
|
||
|
||
|
||
static void
|
||
Amd7930_new_ph(struct IsdnCardState *cs)
|
||
{
|
||
u_char index = stateHelper[cs->dc.amd7930.old_state]*8 + stateHelper[cs->dc.amd7930.ph_state]-1;
|
||
u_char message = i430States[index];
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "AMD7930: new_ph %d, old_ph %d, message %d, index %d",
|
||
cs->dc.amd7930.ph_state, cs->dc.amd7930.old_state, message & 0x0f, index);
|
||
|
||
cs->dc.amd7930.old_state = cs->dc.amd7930.ph_state;
|
||
|
||
/* abort transmit if nessesary */
|
||
if ((message & 0xf0) && (cs->tx_skb)) {
|
||
wByteAMD(cs, 0x21, 0xC2);
|
||
wByteAMD(cs, 0x21, 0x02);
|
||
}
|
||
|
||
switch (message & 0x0f) {
|
||
|
||
case (1):
|
||
l1_msg(cs, HW_RESET | INDICATION, NULL);
|
||
Amd7930_get_state(cs);
|
||
break;
|
||
case (2): /* init, Card starts in F3 */
|
||
l1_msg(cs, HW_DEACTIVATE | CONFIRM, NULL);
|
||
break;
|
||
case (3):
|
||
l1_msg(cs, HW_DEACTIVATE | INDICATION, NULL);
|
||
break;
|
||
case (4):
|
||
l1_msg(cs, HW_POWERUP | CONFIRM, NULL);
|
||
Amd7930_ph_command(cs, 0x50, "HW_ENABLE REQUEST");
|
||
break;
|
||
case (5):
|
||
l1_msg(cs, HW_RSYNC | INDICATION, NULL);
|
||
break;
|
||
case (6):
|
||
l1_msg(cs, HW_INFO4_P8 | INDICATION, NULL);
|
||
break;
|
||
case (7): /* init, Card starts in F7 */
|
||
l1_msg(cs, HW_RSYNC | INDICATION, NULL);
|
||
l1_msg(cs, HW_INFO4_P8 | INDICATION, NULL);
|
||
break;
|
||
case (8):
|
||
l1_msg(cs, HW_POWERUP | CONFIRM, NULL);
|
||
/* fall through */
|
||
case (9):
|
||
Amd7930_ph_command(cs, 0x40, "HW_ENABLE REQ cleared if set");
|
||
l1_msg(cs, HW_RSYNC | INDICATION, NULL);
|
||
l1_msg(cs, HW_INFO2 | INDICATION, NULL);
|
||
l1_msg(cs, HW_INFO4_P8 | INDICATION, NULL);
|
||
break;
|
||
case (10):
|
||
Amd7930_ph_command(cs, 0x40, "T3 expired, HW_ENABLE REQ cleared");
|
||
cs->dc.amd7930.old_state = 3;
|
||
break;
|
||
case (11):
|
||
l1_msg(cs, HW_INFO2 | INDICATION, NULL);
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
}
|
||
|
||
|
||
|
||
static void
|
||
Amd7930_bh(struct IsdnCardState *cs)
|
||
{
|
||
|
||
struct PStack *stptr;
|
||
|
||
if (!cs)
|
||
return;
|
||
if (test_and_clear_bit(D_CLEARBUSY, &cs->event)) {
|
||
if (cs->debug)
|
||
debugl1(cs, "Amd7930: bh, D-Channel Busy cleared");
|
||
stptr = cs->stlist;
|
||
while (stptr != NULL) {
|
||
stptr->l1.l1l2(stptr, PH_PAUSE | CONFIRM, NULL);
|
||
stptr = stptr->next;
|
||
}
|
||
}
|
||
if (test_and_clear_bit(D_L1STATECHANGE, &cs->event)) {
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "AMD7930: bh, D_L1STATECHANGE");
|
||
Amd7930_new_ph(cs);
|
||
}
|
||
|
||
if (test_and_clear_bit(D_RCVBUFREADY, &cs->event)) {
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "AMD7930: bh, D_RCVBUFREADY");
|
||
DChannel_proc_rcv(cs);
|
||
}
|
||
|
||
if (test_and_clear_bit(D_XMTBUFREADY, &cs->event)) {
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "AMD7930: bh, D_XMTBUFREADY");
|
||
DChannel_proc_xmt(cs);
|
||
}
|
||
}
|
||
|
||
static void
|
||
Amd7930_empty_Dfifo(struct IsdnCardState *cs, int flag)
|
||
{
|
||
|
||
BYTE stat, der;
|
||
BYTE *ptr;
|
||
struct sk_buff *skb;
|
||
|
||
|
||
if ((cs->debug & L1_DEB_ISAC) && !(cs->debug & L1_DEB_ISAC_FIFO))
|
||
debugl1(cs, "Amd7930: empty_Dfifo");
|
||
|
||
|
||
ptr = cs->rcvbuf + cs->rcvidx;
|
||
|
||
/* AMD interrupts off */
|
||
AmdIrqOff(cs);
|
||
|
||
/* read D-Channel-Fifo*/
|
||
stat = rByteAMD(cs, 0x07); // DSR2
|
||
|
||
/* while Data in Fifo ... */
|
||
while ( (stat & 2) && ((ptr-cs->rcvbuf) < MAX_DFRAME_LEN_L1) ) {
|
||
*ptr = rByteAMD(cs, 0x04); // DCRB
|
||
ptr++;
|
||
stat = rByteAMD(cs, 0x07); // DSR2
|
||
cs->rcvidx = ptr - cs->rcvbuf;
|
||
|
||
/* Paket ready? */
|
||
if (stat & 1) {
|
||
|
||
der = rWordAMD(cs, 0x03);
|
||
|
||
/* no errors, packet ok */
|
||
if(!der && !flag) {
|
||
rWordAMD(cs, 0x89); // clear DRCR
|
||
|
||
if ((cs->rcvidx) > 0) {
|
||
if (!(skb = alloc_skb(cs->rcvidx, GFP_ATOMIC)))
|
||
printk(KERN_WARNING "HiSax: Amd7930: empty_Dfifo, D receive out of memory!\n");
|
||
else {
|
||
/* Debugging */
|
||
if (cs->debug & L1_DEB_ISAC_FIFO) {
|
||
char *t = cs->dlog;
|
||
|
||
t += sprintf(t, "Amd7930: empty_Dfifo cnt: %d |", cs->rcvidx);
|
||
QuickHex(t, cs->rcvbuf, cs->rcvidx);
|
||
debugl1(cs, cs->dlog);
|
||
}
|
||
/* moves received data in sk-buffer */
|
||
memcpy(skb_put(skb, cs->rcvidx), cs->rcvbuf, cs->rcvidx);
|
||
skb_queue_tail(&cs->rq, skb);
|
||
}
|
||
}
|
||
|
||
}
|
||
/* throw damaged packets away, reset receive-buffer, indicate RX */
|
||
ptr = cs->rcvbuf;
|
||
cs->rcvidx = 0;
|
||
schedule_event(cs, D_RCVBUFREADY);
|
||
}
|
||
}
|
||
/* Packet to long, overflow */
|
||
if(cs->rcvidx >= MAX_DFRAME_LEN_L1) {
|
||
if (cs->debug & L1_DEB_WARN)
|
||
debugl1(cs, "AMD7930: empty_Dfifo L2-Framelength overrun");
|
||
cs->rcvidx = 0;
|
||
return;
|
||
}
|
||
/* AMD interrupts on */
|
||
AmdIrqOn(cs);
|
||
}
|
||
|
||
|
||
static void
|
||
Amd7930_fill_Dfifo(struct IsdnCardState *cs)
|
||
{
|
||
|
||
WORD dtcrr, dtcrw, len, count;
|
||
BYTE txstat, dmr3;
|
||
BYTE *ptr, *deb_ptr;
|
||
|
||
if ((cs->debug & L1_DEB_ISAC) && !(cs->debug & L1_DEB_ISAC_FIFO))
|
||
debugl1(cs, "Amd7930: fill_Dfifo");
|
||
|
||
if ((!cs->tx_skb) || (cs->tx_skb->len <= 0))
|
||
return;
|
||
|
||
dtcrw = 0;
|
||
if(!cs->dc.amd7930.tx_xmtlen)
|
||
/* new Frame */
|
||
len = dtcrw = cs->tx_skb->len;
|
||
/* continue frame */
|
||
else len = cs->dc.amd7930.tx_xmtlen;
|
||
|
||
|
||
/* AMD interrupts off */
|
||
AmdIrqOff(cs);
|
||
|
||
deb_ptr = ptr = cs->tx_skb->data;
|
||
|
||
/* while free place in tx-fifo available and data in sk-buffer */
|
||
txstat = 0x10;
|
||
while((txstat & 0x10) && (cs->tx_cnt < len)) {
|
||
wByteAMD(cs, 0x04, *ptr);
|
||
ptr++;
|
||
cs->tx_cnt++;
|
||
txstat= rByteAMD(cs, 0x07);
|
||
}
|
||
count = ptr - cs->tx_skb->data;
|
||
skb_pull(cs->tx_skb, count);
|
||
|
||
|
||
dtcrr = rWordAMD(cs, 0x85); // DTCR
|
||
dmr3 = rByteAMD(cs, 0x8E);
|
||
|
||
if (cs->debug & L1_DEB_ISAC) {
|
||
debugl1(cs, "Amd7930: fill_Dfifo, DMR3: 0x%02X, DTCR read: 0x%04X write: 0x%02X 0x%02X", dmr3, dtcrr, LOBYTE(dtcrw), HIBYTE(dtcrw));
|
||
}
|
||
|
||
/* writeing of dtcrw starts transmit */
|
||
if(!cs->dc.amd7930.tx_xmtlen) {
|
||
wWordAMD(cs, 0x85, dtcrw);
|
||
cs->dc.amd7930.tx_xmtlen = dtcrw;
|
||
}
|
||
|
||
if (test_and_set_bit(FLG_DBUSY_TIMER, &cs->HW_Flags)) {
|
||
debugl1(cs, "Amd7930: fill_Dfifo dbusytimer running");
|
||
del_timer(&cs->dbusytimer);
|
||
}
|
||
init_timer(&cs->dbusytimer);
|
||
cs->dbusytimer.expires = jiffies + ((DBUSY_TIMER_VALUE * HZ) / 1000);
|
||
add_timer(&cs->dbusytimer);
|
||
|
||
if (cs->debug & L1_DEB_ISAC_FIFO) {
|
||
char *t = cs->dlog;
|
||
|
||
t += sprintf(t, "Amd7930: fill_Dfifo cnt: %d |", count);
|
||
QuickHex(t, deb_ptr, count);
|
||
debugl1(cs, cs->dlog);
|
||
}
|
||
/* AMD interrupts on */
|
||
AmdIrqOn(cs);
|
||
}
|
||
|
||
|
||
void Amd7930_interrupt(struct IsdnCardState *cs, BYTE irflags)
|
||
{
|
||
BYTE dsr1, dsr2, lsr;
|
||
WORD der;
|
||
|
||
while (irflags)
|
||
{
|
||
|
||
dsr1 = rByteAMD(cs, 0x02);
|
||
der = rWordAMD(cs, 0x03);
|
||
dsr2 = rByteAMD(cs, 0x07);
|
||
lsr = rByteAMD(cs, 0xA1);
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: interrupt: flags: 0x%02X, DSR1: 0x%02X, DSR2: 0x%02X, LSR: 0x%02X, DER=0x%04X", irflags, dsr1, dsr2, lsr, der);
|
||
|
||
/* D error -> read DER and DSR2 bit 2 */
|
||
if (der || (dsr2 & 4)) {
|
||
|
||
if (cs->debug & L1_DEB_WARN)
|
||
debugl1(cs, "Amd7930: interrupt: D error DER=0x%04X", der);
|
||
|
||
/* RX, TX abort if collision detected */
|
||
if (der & 2) {
|
||
wByteAMD(cs, 0x21, 0xC2);
|
||
wByteAMD(cs, 0x21, 0x02);
|
||
if (test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags))
|
||
del_timer(&cs->dbusytimer);
|
||
if (test_and_clear_bit(FLG_L1_DBUSY, &cs->HW_Flags))
|
||
schedule_event(cs, D_CLEARBUSY);
|
||
/* restart frame */
|
||
if (cs->tx_skb) {
|
||
skb_push(cs->tx_skb, cs->tx_cnt);
|
||
cs->tx_cnt = 0;
|
||
cs->dc.amd7930.tx_xmtlen = 0;
|
||
Amd7930_fill_Dfifo(cs);
|
||
} else {
|
||
printk(KERN_WARNING "HiSax: Amd7930 D-Collision, no skb\n");
|
||
debugl1(cs, "Amd7930: interrupt: D-Collision, no skb");
|
||
}
|
||
}
|
||
/* remove damaged data from fifo */
|
||
Amd7930_empty_Dfifo(cs, 1);
|
||
|
||
if (test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags))
|
||
del_timer(&cs->dbusytimer);
|
||
if (test_and_clear_bit(FLG_L1_DBUSY, &cs->HW_Flags))
|
||
schedule_event(cs, D_CLEARBUSY);
|
||
/* restart TX-Frame */
|
||
if (cs->tx_skb) {
|
||
skb_push(cs->tx_skb, cs->tx_cnt);
|
||
cs->tx_cnt = 0;
|
||
cs->dc.amd7930.tx_xmtlen = 0;
|
||
Amd7930_fill_Dfifo(cs);
|
||
}
|
||
}
|
||
|
||
/* D TX FIFO empty -> fill */
|
||
if (irflags & 1) {
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: interrupt: clear Timer and fill D-TX-FIFO if data");
|
||
|
||
/* AMD interrupts off */
|
||
AmdIrqOff(cs);
|
||
|
||
if (test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags))
|
||
del_timer(&cs->dbusytimer);
|
||
if (test_and_clear_bit(FLG_L1_DBUSY, &cs->HW_Flags))
|
||
schedule_event(cs, D_CLEARBUSY);
|
||
if (cs->tx_skb) {
|
||
if (cs->tx_skb->len)
|
||
Amd7930_fill_Dfifo(cs);
|
||
}
|
||
/* AMD interrupts on */
|
||
AmdIrqOn(cs);
|
||
}
|
||
|
||
|
||
/* D RX FIFO full or tiny packet in Fifo -> empty */
|
||
if ((irflags & 2) || (dsr1 & 2)) {
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: interrupt: empty D-FIFO");
|
||
Amd7930_empty_Dfifo(cs, 0);
|
||
}
|
||
|
||
|
||
/* D-Frame transmit complete */
|
||
if (dsr1 & 64) {
|
||
if (cs->debug & L1_DEB_ISAC) {
|
||
debugl1(cs, "Amd7930: interrupt: transmit packet ready");
|
||
}
|
||
/* AMD interrupts off */
|
||
AmdIrqOff(cs);
|
||
|
||
if (test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags))
|
||
del_timer(&cs->dbusytimer);
|
||
if (test_and_clear_bit(FLG_L1_DBUSY, &cs->HW_Flags))
|
||
schedule_event(cs, D_CLEARBUSY);
|
||
|
||
if (cs->tx_skb) {
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: interrupt: TX-Packet ready, freeing skb");
|
||
dev_kfree_skb_irq(cs->tx_skb);
|
||
cs->tx_cnt = 0;
|
||
cs->dc.amd7930.tx_xmtlen=0;
|
||
cs->tx_skb = NULL;
|
||
}
|
||
if ((cs->tx_skb = skb_dequeue(&cs->sq))) {
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: interrupt: TX-Packet ready, next packet dequeued");
|
||
cs->tx_cnt = 0;
|
||
cs->dc.amd7930.tx_xmtlen=0;
|
||
Amd7930_fill_Dfifo(cs);
|
||
}
|
||
else
|
||
schedule_event(cs, D_XMTBUFREADY);
|
||
/* AMD interrupts on */
|
||
AmdIrqOn(cs);
|
||
}
|
||
|
||
/* LIU status interrupt -> read LSR, check statechanges */
|
||
if (lsr & 0x38) {
|
||
/* AMD interrupts off */
|
||
AmdIrqOff(cs);
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd: interrupt: LSR=0x%02X, LIU is in state %d", lsr, ((lsr & 0x7) +2));
|
||
|
||
cs->dc.amd7930.ph_state = (lsr & 0x7) + 2;
|
||
|
||
schedule_event(cs, D_L1STATECHANGE);
|
||
/* AMD interrupts on */
|
||
AmdIrqOn(cs);
|
||
}
|
||
|
||
/* reads Interrupt-Register again. If there is a new interrupt-flag: restart handler */
|
||
irflags = rByteAMD(cs, 0x00);
|
||
}
|
||
|
||
}
|
||
|
||
static void
|
||
Amd7930_l1hw(struct PStack *st, int pr, void *arg)
|
||
{
|
||
struct IsdnCardState *cs = (struct IsdnCardState *) st->l1.hardware;
|
||
struct sk_buff *skb = arg;
|
||
u_long flags;
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: l1hw called, pr: 0x%04X", pr);
|
||
|
||
switch (pr) {
|
||
case (PH_DATA | REQUEST):
|
||
if (cs->debug & DEB_DLOG_HEX)
|
||
LogFrame(cs, skb->data, skb->len);
|
||
if (cs->debug & DEB_DLOG_VERBOSE)
|
||
dlogframe(cs, skb, 0);
|
||
spin_lock_irqsave(&cs->lock, flags);
|
||
if (cs->tx_skb) {
|
||
skb_queue_tail(&cs->sq, skb);
|
||
#ifdef L2FRAME_DEBUG /* psa */
|
||
if (cs->debug & L1_DEB_LAPD)
|
||
Logl2Frame(cs, skb, "Amd7930: l1hw: PH_DATA Queued", 0);
|
||
#endif
|
||
} else {
|
||
cs->tx_skb = skb;
|
||
cs->tx_cnt = 0;
|
||
cs->dc.amd7930.tx_xmtlen=0;
|
||
#ifdef L2FRAME_DEBUG /* psa */
|
||
if (cs->debug & L1_DEB_LAPD)
|
||
Logl2Frame(cs, skb, "Amd7930: l1hw: PH_DATA", 0);
|
||
#endif
|
||
Amd7930_fill_Dfifo(cs);
|
||
}
|
||
spin_unlock_irqrestore(&cs->lock, flags);
|
||
break;
|
||
case (PH_PULL | INDICATION):
|
||
spin_lock_irqsave(&cs->lock, flags);
|
||
if (cs->tx_skb) {
|
||
if (cs->debug & L1_DEB_WARN)
|
||
debugl1(cs, "Amd7930: l1hw: l2l1 tx_skb exist this shouldn't happen");
|
||
skb_queue_tail(&cs->sq, skb);
|
||
break;
|
||
}
|
||
if (cs->debug & DEB_DLOG_HEX)
|
||
LogFrame(cs, skb->data, skb->len);
|
||
if (cs->debug & DEB_DLOG_VERBOSE)
|
||
dlogframe(cs, skb, 0);
|
||
cs->tx_skb = skb;
|
||
cs->tx_cnt = 0;
|
||
cs->dc.amd7930.tx_xmtlen=0;
|
||
#ifdef L2FRAME_DEBUG /* psa */
|
||
if (cs->debug & L1_DEB_LAPD)
|
||
Logl2Frame(cs, skb, "Amd7930: l1hw: PH_DATA_PULLED", 0);
|
||
#endif
|
||
Amd7930_fill_Dfifo(cs);
|
||
spin_unlock_irqrestore(&cs->lock, flags);
|
||
break;
|
||
case (PH_PULL | REQUEST):
|
||
#ifdef L2FRAME_DEBUG /* psa */
|
||
if (cs->debug & L1_DEB_LAPD)
|
||
debugl1(cs, "Amd7930: l1hw: -> PH_REQUEST_PULL, skb: %s", (cs->tx_skb)? "yes":"no");
|
||
#endif
|
||
if (!cs->tx_skb) {
|
||
test_and_clear_bit(FLG_L1_PULL_REQ, &st->l1.Flags);
|
||
st->l1.l1l2(st, PH_PULL | CONFIRM, NULL);
|
||
} else
|
||
test_and_set_bit(FLG_L1_PULL_REQ, &st->l1.Flags);
|
||
break;
|
||
case (HW_RESET | REQUEST):
|
||
spin_lock_irqsave(&cs->lock, flags);
|
||
if ((cs->dc.amd7930.ph_state == 8)) {
|
||
/* b-channels off, PH-AR cleared
|
||
* change to F3 */
|
||
Amd7930_ph_command(cs, 0x20, "HW_RESET REQEST"); //LMR1 bit 5
|
||
spin_unlock_irqrestore(&cs->lock, flags);
|
||
} else {
|
||
Amd7930_ph_command(cs, 0x40, "HW_RESET REQUEST");
|
||
cs->dc.amd7930.ph_state = 2;
|
||
spin_unlock_irqrestore(&cs->lock, flags);
|
||
Amd7930_new_ph(cs);
|
||
}
|
||
break;
|
||
case (HW_ENABLE | REQUEST):
|
||
cs->dc.amd7930.ph_state = 9;
|
||
Amd7930_new_ph(cs);
|
||
break;
|
||
case (HW_INFO3 | REQUEST):
|
||
// automatic
|
||
break;
|
||
case (HW_TESTLOOP | REQUEST):
|
||
/* not implemented yet */
|
||
break;
|
||
case (HW_DEACTIVATE | RESPONSE):
|
||
skb_queue_purge(&cs->rq);
|
||
skb_queue_purge(&cs->sq);
|
||
if (cs->tx_skb) {
|
||
dev_kfree_skb(cs->tx_skb);
|
||
cs->tx_skb = NULL;
|
||
}
|
||
if (test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags))
|
||
del_timer(&cs->dbusytimer);
|
||
if (test_and_clear_bit(FLG_L1_DBUSY, &cs->HW_Flags))
|
||
schedule_event(cs, D_CLEARBUSY);
|
||
break;
|
||
default:
|
||
if (cs->debug & L1_DEB_WARN)
|
||
debugl1(cs, "Amd7930: l1hw: unknown %04x", pr);
|
||
break;
|
||
}
|
||
}
|
||
|
||
static void
|
||
setstack_Amd7930(struct PStack *st, struct IsdnCardState *cs)
|
||
{
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: setstack called");
|
||
|
||
st->l1.l1hw = Amd7930_l1hw;
|
||
}
|
||
|
||
|
||
static void
|
||
DC_Close_Amd7930(struct IsdnCardState *cs) {
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: DC_Close called");
|
||
}
|
||
|
||
|
||
static void
|
||
dbusy_timer_handler(struct IsdnCardState *cs)
|
||
{
|
||
u_long flags;
|
||
struct PStack *stptr;
|
||
WORD dtcr, der;
|
||
BYTE dsr1, dsr2;
|
||
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: dbusy_timer expired!");
|
||
|
||
if (test_bit(FLG_DBUSY_TIMER, &cs->HW_Flags)) {
|
||
spin_lock_irqsave(&cs->lock, flags);
|
||
/* D Transmit Byte Count Register:
|
||
* Counts down packet's number of Bytes, 0 if packet ready */
|
||
dtcr = rWordAMD(cs, 0x85);
|
||
dsr1 = rByteAMD(cs, 0x02);
|
||
dsr2 = rByteAMD(cs, 0x07);
|
||
der = rWordAMD(cs, 0x03);
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: dbusy_timer_handler: DSR1=0x%02X, DSR2=0x%02X, DER=0x%04X, cs->tx_skb->len=%u, tx_stat=%u, dtcr=%u, cs->tx_cnt=%u", dsr1, dsr2, der, cs->tx_skb->len, cs->dc.amd7930.tx_xmtlen, dtcr, cs->tx_cnt);
|
||
|
||
if ((cs->dc.amd7930.tx_xmtlen - dtcr) < cs->tx_cnt) { /* D-Channel Busy */
|
||
test_and_set_bit(FLG_L1_DBUSY, &cs->HW_Flags);
|
||
stptr = cs->stlist;
|
||
spin_unlock_irqrestore(&cs->lock, flags);
|
||
while (stptr != NULL) {
|
||
stptr->l1.l1l2(stptr, PH_PAUSE | INDICATION, NULL);
|
||
stptr = stptr->next;
|
||
}
|
||
|
||
} else {
|
||
/* discard frame; reset transceiver */
|
||
test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags);
|
||
if (cs->tx_skb) {
|
||
dev_kfree_skb_any(cs->tx_skb);
|
||
cs->tx_cnt = 0;
|
||
cs->tx_skb = NULL;
|
||
cs->dc.amd7930.tx_xmtlen = 0;
|
||
} else {
|
||
printk(KERN_WARNING "HiSax: Amd7930: D-Channel Busy no skb\n");
|
||
debugl1(cs, "Amd7930: D-Channel Busy no skb");
|
||
|
||
}
|
||
/* Transmitter reset, abort transmit */
|
||
wByteAMD(cs, 0x21, 0x82);
|
||
wByteAMD(cs, 0x21, 0x02);
|
||
spin_unlock_irqrestore(&cs->lock, flags);
|
||
cs->irq_func(cs->irq, cs, NULL);
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: dbusy_timer_handler: Transmitter reset");
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
|
||
void __devinit
|
||
Amd7930_init(struct IsdnCardState *cs)
|
||
{
|
||
WORD *ptr;
|
||
BYTE cmd, cnt;
|
||
|
||
if (cs->debug & L1_DEB_ISAC)
|
||
debugl1(cs, "Amd7930: initamd called");
|
||
|
||
cs->dc.amd7930.tx_xmtlen = 0;
|
||
cs->dc.amd7930.old_state = 0;
|
||
cs->dc.amd7930.lmr1 = 0x40;
|
||
cs->dc.amd7930.ph_command = Amd7930_ph_command;
|
||
cs->setstack_d = setstack_Amd7930;
|
||
cs->DC_Close = DC_Close_Amd7930;
|
||
|
||
/* AMD Initialisation */
|
||
for (ptr = initAMD; *ptr != 0xFFFF; ) {
|
||
cmd = LOBYTE(*ptr);
|
||
|
||
/* read */
|
||
if (*ptr++ >= 0x100) {
|
||
if (cmd < 8)
|
||
/* setzt Register zur<75>ck */
|
||
rByteAMD(cs, cmd);
|
||
else {
|
||
wByteAMD(cs, 0x00, cmd);
|
||
for (cnt = *ptr++; cnt > 0; cnt--)
|
||
rByteAMD(cs, 0x01);
|
||
}
|
||
}
|
||
/* write */
|
||
else if (cmd < 8)
|
||
wByteAMD(cs, cmd, LOBYTE(*ptr++));
|
||
|
||
else {
|
||
wByteAMD(cs, 0x00, cmd);
|
||
for (cnt = *ptr++; cnt > 0; cnt--)
|
||
wByteAMD(cs, 0x01, LOBYTE(*ptr++));
|
||
}
|
||
}
|
||
}
|
||
|
||
void __devinit
|
||
setup_Amd7930(struct IsdnCardState *cs)
|
||
{
|
||
INIT_WORK(&cs->tqueue, (void *)(void *) Amd7930_bh, cs);
|
||
cs->dbusytimer.function = (void *) dbusy_timer_handler;
|
||
cs->dbusytimer.data = (long) cs;
|
||
init_timer(&cs->dbusytimer);
|
||
}
|