jade.c revision 672c3fd9069e5a138f9d4afc9aeb5aa34aacce32
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 77672c3fd9069e5a138f9d4afc9aeb5aa34aacce32Adrian Bunkstatic void 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 193672c3fd9069e5a138f9d4afc9aeb5aa34aacce32Adrian Bunkstatic void 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 246672c3fd9069e5a138f9d4afc9aeb5aa34aacce32Adrian Bunkstatic int 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