jade.c revision 1da177e4c3f41524e886b7f1b8a0c1fc7321cac
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* $Id: jade.c,v 1.9.2.4 2004/01/14 16:04:48 keil Exp $
21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * JADE stuff (derived from original hscx.c)
41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Author       Roland Klabunde
61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright    by Roland Klabunde   <R.Klabunde@Berkom.de>
71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This software may be used and distributed according to the terms
91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * of the GNU General Public License, incorporated herein by reference.
101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */
121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h>
151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "hisax.h"
161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "hscx.h"
171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "jade.h"
181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "isdnl1.h"
191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/interrupt.h>
201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint __init
231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsJadeVersion(struct IsdnCardState *cs, char *s)
241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    int ver,i;
261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    int to = 50;
271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    cs->BC_Write_Reg(cs, -1, 0x50, 0x19);
281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    i=0;
291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    while (to) {
301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    	udelay(1);
311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	ver = cs->BC_Read_Reg(cs, -1, 0x60);
321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	to--;
331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (ver)
341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    	    break;
351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (!to) {
361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	    printk(KERN_INFO "%s JADE version not obtainable\n", s);
371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    	    return (0);
381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds        }
391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    }
401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    /* Wait for the JADE */
411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    udelay(10);
421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    /* Read version */
431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    ver = cs->BC_Read_Reg(cs, -1, 0x60);
441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    printk(KERN_INFO "%s JADE version: %d\n", s, ver);
451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    return (1);
461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Write to indirect accessible jade register set */
491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void
501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsjade_write_indirect(struct IsdnCardState *cs, u_char reg, u_char value)
511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    int to = 50;
531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    u_char ret;
541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    /* Write the data */
561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    cs->BC_Write_Reg(cs, -1, COMM_JADE+1, value);
571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    /* Say JADE we wanna write indirect reg 'reg' */
581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    cs->BC_Write_Reg(cs, -1, COMM_JADE, reg);
591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    to = 50;
601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    /* Wait for RDY goes high */
611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    while (to) {
621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    	udelay(1);
631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	ret = cs->BC_Read_Reg(cs, -1, COMM_JADE);
641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	to--;
651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (ret & 1)
661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	    /* Got acknowledge */
671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	    break;
681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (!to) {
691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    	    printk(KERN_INFO "Can not see ready bit from JADE DSP (reg=0x%X, value=0x%X)\n", reg, value);
701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	    return;
711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    }
731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid
781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodejade(struct BCState *bcs, int mode, int bc)
791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    struct IsdnCardState *cs = bcs->cs;
811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    int jade = bcs->hw.hscx.hscx;
821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    if (cs->debug & L1_DEB_HSCX) {
841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	char tmp[40];
851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	sprintf(tmp, "jade %c mode %d ichan %d",
861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		'A' + jade, mode, bc);
871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	debugl1(cs, tmp);
881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    }
891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    bcs->mode = mode;
901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    bcs->channel = bc;
911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    cs->BC_Write_Reg(cs, jade, jade_HDLC_MODE, (mode == L1_MODE_TRANS ? jadeMODE_TMO:0x00));
931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    cs->BC_Write_Reg(cs, jade, jade_HDLC_CCR0, (jadeCCR0_PU|jadeCCR0_ITF));
941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    cs->BC_Write_Reg(cs, jade, jade_HDLC_CCR1, 0x00);
951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    jade_write_indirect(cs, jade_HDLC1SERRXPATH, 0x08);
971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    jade_write_indirect(cs, jade_HDLC2SERRXPATH, 0x08);
981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    jade_write_indirect(cs, jade_HDLC1SERTXPATH, 0x00);
991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    jade_write_indirect(cs, jade_HDLC2SERTXPATH, 0x00);
1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    cs->BC_Write_Reg(cs, jade, jade_HDLC_XCCR, 0x07);
1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    cs->BC_Write_Reg(cs, jade, jade_HDLC_RCCR, 0x07);
1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    if (bc == 0) {
1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, jade, jade_HDLC_TSAX, 0x00);
1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, jade, jade_HDLC_TSAR, 0x00);
1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    } else {
1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, jade, jade_HDLC_TSAX, 0x04);
1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, jade, jade_HDLC_TSAR, 0x04);
1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    }
1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    switch (mode) {
1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (L1_MODE_NULL):
1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		cs->BC_Write_Reg(cs, jade, jade_HDLC_MODE, jadeMODE_TMO);
1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (L1_MODE_TRANS):
1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		cs->BC_Write_Reg(cs, jade, jade_HDLC_MODE, (jadeMODE_TMO|jadeMODE_RAC|jadeMODE_XAC));
1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (L1_MODE_HDLC):
1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		cs->BC_Write_Reg(cs, jade, jade_HDLC_MODE, (jadeMODE_RAC|jadeMODE_XAC));
1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    }
1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    if (mode) {
1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, jade, jade_HDLC_RCMD, (jadeRCMD_RRES|jadeRCMD_RMC));
1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, jade, jade_HDLC_XCMD, jadeXCMD_XRES);
1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Unmask ints */
1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, jade, jade_HDLC_IMR, 0xF8);
1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    }
1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    else
1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Mask ints */
1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, jade, jade_HDLC_IMR, 0x00);
1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void
1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsjade_l2l1(struct PStack *st, int pr, void *arg)
1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    struct BCState *bcs = st->l1.bcs;
1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    struct sk_buff *skb = arg;
1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    u_long flags;
1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    switch (pr) {
1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (PH_DATA | REQUEST):
1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		spin_lock_irqsave(&bcs->cs->lock, flags);
1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (bcs->tx_skb) {
1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			skb_queue_tail(&bcs->squeue, skb);
1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		} else {
1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			bcs->tx_skb = skb;
1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);
1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			bcs->hw.hscx.count = 0;
1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			bcs->cs->BC_Send_Data(bcs);
1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		spin_unlock_irqrestore(&bcs->cs->lock, flags);
1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (PH_PULL | INDICATION):
1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		spin_lock_irqsave(&bcs->cs->lock, flags);
1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (bcs->tx_skb) {
1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			printk(KERN_WARNING "jade_l2l1: this shouldn't happen\n");
1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		} else {
1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);
1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			bcs->tx_skb = skb;
1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			bcs->hw.hscx.count = 0;
1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			bcs->cs->BC_Send_Data(bcs);
1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		spin_unlock_irqrestore(&bcs->cs->lock, flags);
1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (PH_PULL | REQUEST):
1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (!bcs->tx_skb) {
1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		    test_and_clear_bit(FLG_L1_PULL_REQ, &st->l1.Flags);
1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		    st->l1.l1l2(st, PH_PULL | CONFIRM, NULL);
1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		} else
1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		    test_and_set_bit(FLG_L1_PULL_REQ, &st->l1.Flags);
1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (PH_ACTIVATE | REQUEST):
1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		spin_lock_irqsave(&bcs->cs->lock, flags);
1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		test_and_set_bit(BC_FLG_ACTIV, &bcs->Flag);
1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		modejade(bcs, st->l1.mode, st->l1.bc);
1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		spin_unlock_irqrestore(&bcs->cs->lock, flags);
1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		l1_msg_b(st, pr, arg);
1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (PH_DEACTIVATE | REQUEST):
1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		l1_msg_b(st, pr, arg);
1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	case (PH_DEACTIVATE | CONFIRM):
1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		spin_lock_irqsave(&bcs->cs->lock, flags);
1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		test_and_clear_bit(BC_FLG_ACTIV, &bcs->Flag);
1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		modejade(bcs, 0, st->l1.bc);
1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		spin_unlock_irqrestore(&bcs->cs->lock, flags);
1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		st->l1.l1l2(st, PH_DEACTIVATE | CONFIRM, NULL);
1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		break;
1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    }
1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid
1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsclose_jadestate(struct BCState *bcs)
1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    modejade(bcs, 0, bcs->channel);
1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    if (test_and_clear_bit(BC_FLG_INIT, &bcs->Flag)) {
1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (bcs->hw.hscx.rcvbuf) {
1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		kfree(bcs->hw.hscx.rcvbuf);
2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		bcs->hw.hscx.rcvbuf = NULL;
2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (bcs->blog) {
2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		kfree(bcs->blog);
2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		bcs->blog = NULL;
2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	skb_queue_purge(&bcs->rqueue);
2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	skb_queue_purge(&bcs->squeue);
2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (bcs->tx_skb) {
2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		dev_kfree_skb_any(bcs->tx_skb);
2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		bcs->tx_skb = NULL;
2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds    }
2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int
2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsopen_jadestate(struct IsdnCardState *cs, struct BCState *bcs)
2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (!test_and_set_bit(BC_FLG_INIT, &bcs->Flag)) {
2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (!(bcs->hw.hscx.rcvbuf = kmalloc(HSCX_BUFMAX, GFP_ATOMIC))) {
2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			printk(KERN_WARNING
2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			       "HiSax: No memory for hscx.rcvbuf\n");
2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			test_and_clear_bit(BC_FLG_INIT, &bcs->Flag);
2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			return (1);
2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (!(bcs->blog = kmalloc(MAX_BLOG_SPACE, GFP_ATOMIC))) {
2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			printk(KERN_WARNING
2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds				"HiSax: No memory for bcs->blog\n");
2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			test_and_clear_bit(BC_FLG_INIT, &bcs->Flag);
2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			kfree(bcs->hw.hscx.rcvbuf);
2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			bcs->hw.hscx.rcvbuf = NULL;
2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			return (2);
2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		skb_queue_head_init(&bcs->rqueue);
2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		skb_queue_head_init(&bcs->squeue);
2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	bcs->tx_skb = NULL;
2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	bcs->event = 0;
2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	bcs->hw.hscx.rcvidx = 0;
2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	bcs->tx_cnt = 0;
2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	return (0);
2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint
2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldssetstack_jade(struct PStack *st, struct BCState *bcs)
2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	bcs->channel = st->l1.bc;
2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (open_jadestate(st->l1.hardware, bcs))
2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		return (-1);
2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	st->l1.bcs = bcs;
2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	st->l2.l2l1 = jade_l2l1;
2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	setstack_manager(st);
2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	bcs->st = st;
2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	setstack_l1_B(st);
2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	return (0);
2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid __init
2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsclear_pending_jade_ints(struct IsdnCardState *cs)
2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	int val;
2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	char tmp[64];
2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 0, jade_HDLC_IMR, 0x00);
2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 1, jade_HDLC_IMR, 0x00);
2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	val = cs->BC_Read_Reg(cs, 1, jade_HDLC_ISR);
2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	sprintf(tmp, "jade B ISTA %x", val);
2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	debugl1(cs, tmp);
2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	val = cs->BC_Read_Reg(cs, 0, jade_HDLC_ISR);
2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	sprintf(tmp, "jade A ISTA %x", val);
2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	debugl1(cs, tmp);
2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	val = cs->BC_Read_Reg(cs, 1, jade_HDLC_STAR);
2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	sprintf(tmp, "jade B STAR %x", val);
2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	debugl1(cs, tmp);
2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	val = cs->BC_Read_Reg(cs, 0, jade_HDLC_STAR);
2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	sprintf(tmp, "jade A STAR %x", val);
2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	debugl1(cs, tmp);
2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Unmask ints */
2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 0, jade_HDLC_IMR, 0xF8);
2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 1, jade_HDLC_IMR, 0xF8);
2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid __init
2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsinitjade(struct IsdnCardState *cs)
2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->bcs[0].BC_SetStack = setstack_jade;
2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->bcs[1].BC_SetStack = setstack_jade;
2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->bcs[0].BC_Close = close_jadestate;
2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->bcs[1].BC_Close = close_jadestate;
2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->bcs[0].hw.hscx.hscx = 0;
2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->bcs[1].hw.hscx.hscx = 1;
2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Stop DSP audio tx/rx */
2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	jade_write_indirect(cs, 0x11, 0x0f);
2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	jade_write_indirect(cs, 0x17, 0x2f);
2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Transparent Mode, RxTx inactive, No Test, No RFS/TFS */
3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 0, jade_HDLC_MODE, jadeMODE_TMO);
3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 1, jade_HDLC_MODE, jadeMODE_TMO);
3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Power down, 1-Idle, RxTx least significant bit first */
3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 0, jade_HDLC_CCR0, 0x00);
3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 1, jade_HDLC_CCR0, 0x00);
3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Mask all interrupts */
3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 0, jade_HDLC_IMR,  0x00);
3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, 1, jade_HDLC_IMR,  0x00);
3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Setup host access to hdlc controller */
3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	jade_write_indirect(cs, jade_HDLCCNTRACCESS, (jadeINDIRECT_HAH1|jadeINDIRECT_HAH2));
3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Unmask HDLC int (don�t forget DSP int later on)*/
3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	cs->BC_Write_Reg(cs, -1,jade_INT, (jadeINT_HDLC1|jadeINT_HDLC2));
3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* once again TRANSPARENT */
3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	modejade(cs->bcs, 0, 0);
3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	modejade(cs->bcs + 1, 0, 0);
3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
319