patch-2.0.31 linux/drivers/isdn/hisax/tei.c

• Lines: 318
• Date: Mon Aug 4 17:34:00 1997
• Orig file: v2.0.30/linux/drivers/isdn/hisax/tei.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.0.30/linux/drivers/isdn/hisax/tei.c linux/drivers/isdn/hisax/tei.c
@@ -0,0 +1,317 @@
+/* $Id: tei.c,v 1.8 1997/04/07 22:59:08 keil Exp $
+
+ * Author       Karsten Keil (keil@temic-ech.spacenet.de)
+ *              based on the teles driver from Jan den Ouden
+ *
+ * Thanks to    Jan den Ouden
+ *              Fritz Elfert
+ *
+ * $Log: tei.c,v $
+ * Revision 1.8  1997/04/07 22:59:08  keil
+ * GFP_KERNEL --> GFP_ATOMIC
+ *
+ * Revision 1.7  1997/04/06 22:54:03  keil
+ * Using SKB's
+ *
+ * Revision 1.6  1997/02/09 00:25:12  keil
+ * new interface handling, one interface per card
+ *
+ * Revision 1.5  1997/01/27 15:57:51  keil
+ * cosmetics
+ *
+ * Revision 1.4  1997/01/21 22:32:44  keil
+ * Tei verify request
+ *
+ * Revision 1.3  1997/01/04 13:45:02  keil
+ * cleanup,adding remove tei request (thanks to Sim Yskes)
+ *
+ * Revision 1.2  1996/12/08 19:52:39  keil
+ * minor debug fix
+ *
+ * Revision 1.1  1996/10/13 20:04:57  keil
+ * Initial revision
+ *
+ *
+ *
+ */
+#define __NO_VERSION__
+#include "hisax.h"
+
+extern struct IsdnCard cards[];
+extern int nrcards;
+
+const char *tei_revision = "$Revision: 1.8 $";
+
+static struct PStack *
+findces(struct PStack *st, int ces)
+{
+	struct PStack *ptr = *(st->l1.stlistp);
+
+	while (ptr)
+		if (ptr->l2.ces == ces)
+			return (ptr);
+		else
+			ptr = ptr->next;
+	return (NULL);
+}
+
+static struct PStack *
+findtei(struct PStack *st, int tei)
+{
+	struct PStack *ptr = *(st->l1.stlistp);
+
+	if (tei == 127)
+		return (NULL);
+
+	while (ptr)
+		if (ptr->l2.tei == tei)
+			return (ptr);
+		else
+			ptr = ptr->next;
+	return (NULL);
+}
+
+static void
+mdl_unit_data_res(struct PStack *st, unsigned int ri, u_char mt, u_char ai)
+{
+	struct sk_buff *skb;
+	u_char *bp;
+
+	if (!(skb = alloc_skb(6 + MAX_HEADER_LEN, GFP_ATOMIC))) {
+		printk(KERN_WARNING "HiSax: No skb for TEI manager\n");
+		return;
+	}
+	SET_SKB_FREE(skb);
+	skb_reserve(skb, MAX_HEADER_LEN);
+	bp = skb_put(skb, 5);
+	bp[0] = 0xf;
+	bp[1] = ri >> 8;
+	bp[2] = ri & 0xff;
+	bp[3] = mt;
+	bp[4] = (ai << 1) | 1;
+	st->l3.l3l2(st, DL_UNIT_DATA, skb);
+}
+
+static void
+mdl_unit_data_ind(struct PStack *st, unsigned int ri, u_char mt, u_char ai)
+{
+	unsigned int tces;
+	struct PStack *otsp, *ptr;
+	char tmp[64];
+
+	switch (mt) {
+		case (2):
+			tces = ri;
+			if (st->l3.debug) {
+				sprintf(tmp, "identity assign ces %d ai %d", tces, ai);
+				st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+			}
+			if ((otsp = findces(st, tces))) {
+				if (st->l3.debug) {
+					sprintf(tmp, "ces %d --> tei %d", tces, ai);
+					st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+				}
+				otsp->ma.teil2(otsp, MDL_ASSIGN, (void *) (int) ai);
+			}
+			break;
+		case (3):
+			tces = ri;
+			if (st->l3.debug) {
+				sprintf(tmp, "identity denied for ces %d ai %d", tces, ai);
+				st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+			}
+			if ((otsp = findces(st, tces))) {
+				if (st->l3.debug) {
+					sprintf(tmp, "ces %d denied tei %d", tces, ai);
+					st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+				}
+				otsp->l2.tei = 255;
+				otsp->l2.ces = randomces();
+				otsp->ma.teil2(otsp, MDL_REMOVE, 0);
+			}
+			break;
+		case (4):
+			if (st->l3.debug) {
+				sprintf(tmp, "checking identity for %d", ai);
+				st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+			}
+			if (ai == 0x7f) {
+				ptr = *(st->l1.stlistp);
+				while (ptr) {
+					if ((ptr->l2.tei & 0x7f) != 0x7f) {
+						if (st->l3.debug) {
+							sprintf(tmp, "check response for ces %d with tei %d",
+								ptr->l2.ces, ptr->l2.tei);
+							st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+						}
+						/* send identity check response (user->network) */
+						mdl_unit_data_res(st, ptr->l2.ces, 5, ptr->l2.tei);
+					}
+					ptr = ptr->next;
+				}
+			} else {
+				otsp = findtei(st, ai);
+				if (!otsp)
+					break;
+				if (st->l3.debug) {
+					sprintf(tmp, "check response for ces %d with tei %d",
+					     otsp->l2.ces, otsp->l2.tei);
+					st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+				}
+				/* send identity check response (user->network) */
+				mdl_unit_data_res(st, otsp->l2.ces, 5, otsp->l2.tei);
+			}
+			break;
+		case (6):
+			if (st->l3.debug) {
+				sprintf(tmp, "removal for %d", ai);
+				st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+			}
+			if (ai == 0x7f) {
+				ptr = *(st->l1.stlistp);
+				while (ptr) {
+					if ((ptr->l2.tei & 0x7f) != 0x7f) {
+						if (st->l3.debug) {
+							sprintf(tmp, "rem ces %d with tei %d",
+								ptr->l2.ces, ptr->l2.tei);
+							st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+						}
+						ptr->ma.teil2(ptr, MDL_REMOVE, 0);
+					}
+					ptr = ptr->next;
+				}
+			} else {
+				otsp = findtei(st, ai);
+				if (!otsp)
+					break;
+				if (st->l3.debug) {
+					sprintf(tmp, "rem ces %d with tei %d",
+					     otsp->l2.ces, otsp->l2.tei);
+					st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+				}
+				otsp->ma.teil2(otsp, MDL_REMOVE, 0);
+			}
+			break;
+		default:
+			if (st->l3.debug) {
+				sprintf(tmp, "message unknown %d ai %d", mt, ai);
+				st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+			}
+	}
+}
+
+void
+tei_handler(struct PStack *st,
+	    u_char pr, struct sk_buff *skb)
+{
+	u_char *bp;
+	unsigned int data;
+	char tmp[32];
+
+	switch (pr) {
+		case (MDL_ASSIGN):
+			data = (unsigned int) skb;
+			if (st->l3.debug) {
+				sprintf(tmp, "ces %d assign request", data);
+				st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+			}
+			mdl_unit_data_res(st, data, 1, 127);
+			break;
+		case (MDL_VERIFY):
+			data = (unsigned int) skb;
+			if (st->l3.debug) {
+				sprintf(tmp, "%d id verify request", data);
+				st->l2.l2m.printdebug(&st->l2.l2m, tmp);
+			}
+			mdl_unit_data_res(st, 0, 7, data);
+			break;
+		case (DL_UNIT_DATA):
+			bp = skb->data;
+			if (bp[0] != 0xf) {
+				/* wrong management entity identifier, ignore */
+				/* shouldn't ibh be released??? */
+				printk(KERN_WARNING "tei handler wrong entity id %x\n", bp[0]);
+			} else
+				mdl_unit_data_ind(st, (bp[1] << 8) | bp[2], bp[3], bp[4] >> 1);
+			dev_kfree_skb(skb, FREE_READ);
+			break;
+		default:
+			break;
+	}
+}
+
+unsigned int
+randomces(void)
+{
+	int x = jiffies & 0xffff;
+
+	return (x);
+}
+
+static void
+tei_man(struct PStack *sp, int i, void *v)
+{
+
+	printk(KERN_DEBUG "tei_man\n");
+}
+
+static void
+tei_l2tei(struct PStack *st, int pr, void *arg)
+{
+	struct IsdnCardState *sp = st->l1.hardware;
+
+	tei_handler(sp->teistack, pr, arg);
+}
+
+void
+setstack_tei(struct PStack *st)
+{
+	st->l2.l2tei = tei_l2tei;
+}
+
+void
+init_tei(struct IsdnCardState *sp, int protocol)
+{
+	struct PStack *st;
+	char tmp[128];
+
+	st = (struct PStack *) kmalloc(sizeof(struct PStack), GFP_ATOMIC);
+	setstack_HiSax(st, sp);
+	st->l2.extended = !0;
+	st->l2.laptype = LAPD;
+	st->l2.window = 1;
+	st->l2.orig = !0;
+	st->protocol = protocol;
+/*
+ * the following is not necessary for tei mng. (broadcast only)
+ */
+	st->l2.t200 = 500;	/* 500 milliseconds */
+	st->l2.n200 = 4;	/* try 4 times */
+
+	st->l2.sap = 63;
+	st->l2.tei = 127;
+
+	sprintf(tmp, "Card %d tei", sp->cardnr + 1);
+	setstack_isdnl2(st, tmp);
+	st->l2.debug = 0;
+	st->l3.debug = 0;
+
+	st->ma.manl2(st, MDL_NOTEIPROC, NULL);
+
+	st->l2.l2l3 = (void *) tei_handler;
+	st->l1.l1man = tei_man;
+	st->l2.l2man = tei_man;
+	st->l4.l2writewakeup = NULL;
+
+	HiSax_addlist(sp, st);
+	sp->teistack = st;
+}
+
+void
+release_tei(struct IsdnCardState *sp)
+{
+	struct PStack *st = sp->teistack;
+
+	HiSax_rmlist(sp, st);
+	kfree((void *) st);
+}