static void l3_1tr6_disc(struct l3_process *pc, u_char pr, void *arg) { struct sk_buff *skb = arg; u_char *p; int i, tmpcharge = 0; char a_charge[8], tmp[32]; StopAllL3Timer(pc); p = skb->data; if ((p = findie(p, skb->len, WE6_chargingInfo, 6))) { iecpy(a_charge, p, 1); for (i = 0; i < strlen(a_charge); i++) { tmpcharge *= 10; tmpcharge += a_charge[i] & 0xf; } if (tmpcharge > pc->para.chargeinfo) { pc->para.chargeinfo = tmpcharge; pc->st->l3.l3l4(pc->st, CC_CHARGE | INDICATION, pc); } if (pc->st->l3.debug & L3_DEB_CHARGE) { sprintf(tmp, "charging info %d", pc->para.chargeinfo); l3_debug(pc->st, tmp); } } else if (pc->st->l3.debug & L3_DEB_CHARGE) l3_debug(pc->st, "charging info not found"); p = skb->data; if ((p = findie(p, skb->len, WE0_cause, 0))) { if (p[1] > 0) { pc->para.cause = p[2]; if (p[1] > 1) pc->para.loc = p[3]; else pc->para.loc = 0; } else { pc->para.cause = 0; pc->para.loc = 0; } } else { if (pc->st->l3.debug & L3_DEB_WARN) l3_debug(pc->st, "cause not found"); pc->para.cause = NO_CAUSE; } if (!findie(skb->data, skb->len, WE6_date, 6)) { l3_1tr6_error(pc, "missing connack date", skb); return; } dev_kfree_skb(skb); newl3state(pc, 12); pc->st->l3.l3l4(pc->st, CC_DISCONNECT | INDICATION, pc); }
static void l3_1tr6_disc(struct PStack *st, u_char pr, void *arg) { struct sk_buff *skb = arg; u_char *p; int i, tmpcharge = 0; char a_charge[8], tmp[32]; StopAllL3Timer(st); p = skb->data; if ((p = findie(p, skb->len, WE6_chargingInfo, 6))) { iecpy(a_charge, p, 1); for (i = 0; i < strlen(a_charge); i++) { tmpcharge *= 10; tmpcharge += a_charge[i] & 0xf; } if (tmpcharge > st->pa->chargeinfo) { st->pa->chargeinfo = tmpcharge; st->l3.l3l4(st, CC_INFO_CHARGE, NULL); } if (st->l3.debug & L3_DEB_CHARGE) { sprintf(tmp, "charging info %d", st->pa->chargeinfo); l3_debug(st, tmp); } } else if (st->l3.debug & L3_DEB_CHARGE) l3_debug(st, "charging info not found"); p = skb->data; if ((p = findie(p, skb->len, WE0_cause, 0))) { if (p[1] > 0) { st->pa->cause = p[2]; if (p[1] > 1) st->pa->loc = p[3]; else st->pa->loc = 0; } else { st->pa->cause = 0; st->pa->loc = 0; } } else { if (st->l3.debug & L3_DEB_WARN) l3_debug(st, "cause not found"); st->pa->cause = -1; } SET_SKB_FREE(skb); dev_kfree_skb(skb, FREE_READ); newl3state(st, 12); st->l3.l3l4(st, CC_DISCONNECT_IND, NULL); }
static void l3_1tr6_setup(struct l3_process *pc, u_char pr, void *arg) { u_char *p; int bcfound = 0; char tmp[80]; struct sk_buff *skb = arg; p = skb->data; /* Channel Identification */ p = skb->data; if ((p = findie(p, skb->len, WE0_chanID, 0))) { if (p[1] != 1) { l3_1tr6_error(pc, "setup wrong chanID len", skb); return; } if ((p[2] & 0xf4) != 0x80) { l3_1tr6_error(pc, "setup wrong WE0_chanID", skb); return; } if ((pc->para.bchannel = p[2] & 0x3)) bcfound++; } else { l3_1tr6_error(pc, "missing setup chanID", skb); return; } p = skb->data; if ((p = findie(p, skb->len, WE6_serviceInd, 6))) { pc->para.setup.si1 = p[2]; pc->para.setup.si2 = p[3]; } else { l3_1tr6_error(pc, "missing setup SI", skb); return; } p = skb->data; if ((p = findie(p, skb->len, WE0_destAddr, 0))) iecpy(pc->para.setup.eazmsn, p, 1); else pc->para.setup.eazmsn[0] = 0; p = skb->data; if ((p = findie(p, skb->len, WE0_origAddr, 0))) { iecpy(pc->para.setup.phone, p, 1); } else pc->para.setup.phone[0] = 0; p = skb->data; pc->para.spv = 0; if ((p = findie(p, skb->len, WE0_netSpecFac, 0))) { if ((FAC_SPV == p[3]) || (FAC_Activate == p[3])) pc->para.spv = 1; } dev_kfree_skb(skb); /* Signal all services, linklevel takes care of Service-Indicator */ if (bcfound) { if ((pc->para.setup.si1 != 7) && (pc->st->l3.debug & L3_DEB_WARN)) { sprintf(tmp, "non-digital call: %s -> %s", pc->para.setup.phone, pc->para.setup.eazmsn); l3_debug(pc->st, tmp); } newl3state(pc, 6); pc->st->l3.l3l4(pc->st, CC_SETUP | INDICATION, pc); } else release_l3_process(pc); }