l3_1tr6.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932
  1. /* $Id: l3_1tr6.c,v 2.15.2.3 2004/01/13 14:31:25 keil Exp $
  2. *
  3. * German 1TR6 D-channel protocol
  4. *
  5. * Author Karsten Keil
  6. * Copyright by Karsten Keil <keil@isdn4linux.de>
  7. *
  8. * This software may be used and distributed according to the terms
  9. * of the GNU General Public License, incorporated herein by reference.
  10. *
  11. * For changes and modifications please read
  12. * Documentation/isdn/HiSax.cert
  13. *
  14. */
  15. #include "hisax.h"
  16. #include "l3_1tr6.h"
  17. #include "isdnl3.h"
  18. #include <linux/ctype.h>
  19. extern char *HiSax_getrev(const char *revision);
  20. static const char *l3_1tr6_revision = "$Revision: 2.15.2.3 $";
  21. #define MsgHead(ptr, cref, mty, dis) \
  22. *ptr++ = dis; \
  23. *ptr++ = 0x1; \
  24. *ptr++ = cref ^ 0x80; \
  25. *ptr++ = mty
  26. static void
  27. l3_1TR6_message(struct l3_process *pc, u_char mt, u_char pd)
  28. {
  29. struct sk_buff *skb;
  30. u_char *p;
  31. if (!(skb = l3_alloc_skb(4)))
  32. return;
  33. p = skb_put(skb, 4);
  34. MsgHead(p, pc->callref, mt, pd);
  35. l3_msg(pc->st, DL_DATA | REQUEST, skb);
  36. }
  37. static void
  38. l3_1tr6_release_req(struct l3_process *pc, u_char pr, void *arg)
  39. {
  40. StopAllL3Timer(pc);
  41. newl3state(pc, 19);
  42. l3_1TR6_message(pc, MT_N1_REL, PROTO_DIS_N1);
  43. L3AddTimer(&pc->timer, T308, CC_T308_1);
  44. }
  45. static void
  46. l3_1tr6_invalid(struct l3_process *pc, u_char pr, void *arg)
  47. {
  48. struct sk_buff *skb = arg;
  49. dev_kfree_skb(skb);
  50. l3_1tr6_release_req(pc, 0, NULL);
  51. }
  52. static void
  53. l3_1tr6_error(struct l3_process *pc, u_char *msg, struct sk_buff *skb)
  54. {
  55. dev_kfree_skb(skb);
  56. if (pc->st->l3.debug & L3_DEB_WARN)
  57. l3_debug(pc->st, "%s", msg);
  58. l3_1tr6_release_req(pc, 0, NULL);
  59. }
  60. static void
  61. l3_1tr6_setup_req(struct l3_process *pc, u_char pr, void *arg)
  62. {
  63. struct sk_buff *skb;
  64. u_char tmp[128];
  65. u_char *p = tmp;
  66. u_char *teln;
  67. u_char *eaz;
  68. u_char channel = 0;
  69. int l;
  70. MsgHead(p, pc->callref, MT_N1_SETUP, PROTO_DIS_N1);
  71. teln = pc->para.setup.phone;
  72. pc->para.spv = 0;
  73. if (!isdigit(*teln)) {
  74. switch (0x5f & *teln) {
  75. case 'S':
  76. pc->para.spv = 1;
  77. break;
  78. case 'C':
  79. channel = 0x08;
  80. /* fall through */
  81. case 'P':
  82. channel |= 0x80;
  83. teln++;
  84. if (*teln == '1')
  85. channel |= 0x01;
  86. else
  87. channel |= 0x02;
  88. break;
  89. default:
  90. if (pc->st->l3.debug & L3_DEB_WARN)
  91. l3_debug(pc->st, "Wrong MSN Code");
  92. break;
  93. }
  94. teln++;
  95. }
  96. if (channel) {
  97. *p++ = 0x18; /* channel indicator */
  98. *p++ = 1;
  99. *p++ = channel;
  100. }
  101. if (pc->para.spv) { /* SPV ? */
  102. /* NSF SPV */
  103. *p++ = WE0_netSpecFac;
  104. *p++ = 4; /* Laenge */
  105. *p++ = 0;
  106. *p++ = FAC_SPV; /* SPV */
  107. *p++ = pc->para.setup.si1; /* 0 for all Services */
  108. *p++ = pc->para.setup.si2; /* 0 for all Services */
  109. *p++ = WE0_netSpecFac;
  110. *p++ = 4; /* Laenge */
  111. *p++ = 0;
  112. *p++ = FAC_Activate; /* aktiviere SPV (default) */
  113. *p++ = pc->para.setup.si1; /* 0 for all Services */
  114. *p++ = pc->para.setup.si2; /* 0 for all Services */
  115. }
  116. eaz = pc->para.setup.eazmsn;
  117. if (*eaz) {
  118. *p++ = WE0_origAddr;
  119. *p++ = strlen(eaz) + 1;
  120. /* Classify as AnyPref. */
  121. *p++ = 0x81; /* Ext = '1'B, Type = '000'B, Plan = '0001'B. */
  122. while (*eaz)
  123. *p++ = *eaz++ & 0x7f;
  124. }
  125. *p++ = WE0_destAddr;
  126. *p++ = strlen(teln) + 1;
  127. /* Classify as AnyPref. */
  128. *p++ = 0x81; /* Ext = '1'B, Type = '000'B, Plan = '0001'B. */
  129. while (*teln)
  130. *p++ = *teln++ & 0x7f;
  131. *p++ = WE_Shift_F6;
  132. /* Codesatz 6 fuer Service */
  133. *p++ = WE6_serviceInd;
  134. *p++ = 2; /* len=2 info,info2 */
  135. *p++ = pc->para.setup.si1;
  136. *p++ = pc->para.setup.si2;
  137. l = p - tmp;
  138. if (!(skb = l3_alloc_skb(l)))
  139. return;
  140. skb_put_data(skb, tmp, l);
  141. L3DelTimer(&pc->timer);
  142. L3AddTimer(&pc->timer, T303, CC_T303);
  143. newl3state(pc, 1);
  144. l3_msg(pc->st, DL_DATA | REQUEST, skb);
  145. }
  146. static void
  147. l3_1tr6_setup(struct l3_process *pc, u_char pr, void *arg)
  148. {
  149. u_char *p;
  150. int bcfound = 0;
  151. struct sk_buff *skb = arg;
  152. /* Channel Identification */
  153. p = findie(skb->data, skb->len, WE0_chanID, 0);
  154. if (p) {
  155. if (p[1] != 1) {
  156. l3_1tr6_error(pc, "setup wrong chanID len", skb);
  157. return;
  158. }
  159. if ((p[2] & 0xf4) != 0x80) {
  160. l3_1tr6_error(pc, "setup wrong WE0_chanID", skb);
  161. return;
  162. }
  163. if ((pc->para.bchannel = p[2] & 0x3))
  164. bcfound++;
  165. } else {
  166. l3_1tr6_error(pc, "missing setup chanID", skb);
  167. return;
  168. }
  169. p = skb->data;
  170. if ((p = findie(p, skb->len, WE6_serviceInd, 6))) {
  171. pc->para.setup.si1 = p[2];
  172. pc->para.setup.si2 = p[3];
  173. } else {
  174. l3_1tr6_error(pc, "missing setup SI", skb);
  175. return;
  176. }
  177. p = skb->data;
  178. if ((p = findie(p, skb->len, WE0_destAddr, 0)))
  179. iecpy(pc->para.setup.eazmsn, p, 1);
  180. else
  181. pc->para.setup.eazmsn[0] = 0;
  182. p = skb->data;
  183. if ((p = findie(p, skb->len, WE0_origAddr, 0))) {
  184. iecpy(pc->para.setup.phone, p, 1);
  185. } else
  186. pc->para.setup.phone[0] = 0;
  187. p = skb->data;
  188. pc->para.spv = 0;
  189. if ((p = findie(p, skb->len, WE0_netSpecFac, 0))) {
  190. if ((FAC_SPV == p[3]) || (FAC_Activate == p[3]))
  191. pc->para.spv = 1;
  192. }
  193. dev_kfree_skb(skb);
  194. /* Signal all services, linklevel takes care of Service-Indicator */
  195. if (bcfound) {
  196. if ((pc->para.setup.si1 != 7) && (pc->st->l3.debug & L3_DEB_WARN)) {
  197. l3_debug(pc->st, "non-digital call: %s -> %s",
  198. pc->para.setup.phone,
  199. pc->para.setup.eazmsn);
  200. }
  201. newl3state(pc, 6);
  202. pc->st->l3.l3l4(pc->st, CC_SETUP | INDICATION, pc);
  203. } else
  204. release_l3_process(pc);
  205. }
  206. static void
  207. l3_1tr6_setup_ack(struct l3_process *pc, u_char pr, void *arg)
  208. {
  209. u_char *p;
  210. struct sk_buff *skb = arg;
  211. L3DelTimer(&pc->timer);
  212. p = skb->data;
  213. newl3state(pc, 2);
  214. if ((p = findie(p, skb->len, WE0_chanID, 0))) {
  215. if (p[1] != 1) {
  216. l3_1tr6_error(pc, "setup_ack wrong chanID len", skb);
  217. return;
  218. }
  219. if ((p[2] & 0xf4) != 0x80) {
  220. l3_1tr6_error(pc, "setup_ack wrong WE0_chanID", skb);
  221. return;
  222. }
  223. pc->para.bchannel = p[2] & 0x3;
  224. } else {
  225. l3_1tr6_error(pc, "missing setup_ack WE0_chanID", skb);
  226. return;
  227. }
  228. dev_kfree_skb(skb);
  229. L3AddTimer(&pc->timer, T304, CC_T304);
  230. pc->st->l3.l3l4(pc->st, CC_MORE_INFO | INDICATION, pc);
  231. }
  232. static void
  233. l3_1tr6_call_sent(struct l3_process *pc, u_char pr, void *arg)
  234. {
  235. u_char *p;
  236. struct sk_buff *skb = arg;
  237. L3DelTimer(&pc->timer);
  238. p = skb->data;
  239. if ((p = findie(p, skb->len, WE0_chanID, 0))) {
  240. if (p[1] != 1) {
  241. l3_1tr6_error(pc, "call sent wrong chanID len", skb);
  242. return;
  243. }
  244. if ((p[2] & 0xf4) != 0x80) {
  245. l3_1tr6_error(pc, "call sent wrong WE0_chanID", skb);
  246. return;
  247. }
  248. if ((pc->state == 2) && (pc->para.bchannel != (p[2] & 0x3))) {
  249. l3_1tr6_error(pc, "call sent wrong chanID value", skb);
  250. return;
  251. }
  252. pc->para.bchannel = p[2] & 0x3;
  253. } else {
  254. l3_1tr6_error(pc, "missing call sent WE0_chanID", skb);
  255. return;
  256. }
  257. dev_kfree_skb(skb);
  258. L3AddTimer(&pc->timer, T310, CC_T310);
  259. newl3state(pc, 3);
  260. pc->st->l3.l3l4(pc->st, CC_PROCEEDING | INDICATION, pc);
  261. }
  262. static void
  263. l3_1tr6_alert(struct l3_process *pc, u_char pr, void *arg)
  264. {
  265. struct sk_buff *skb = arg;
  266. dev_kfree_skb(skb);
  267. L3DelTimer(&pc->timer); /* T304 */
  268. newl3state(pc, 4);
  269. pc->st->l3.l3l4(pc->st, CC_ALERTING | INDICATION, pc);
  270. }
  271. static void
  272. l3_1tr6_info(struct l3_process *pc, u_char pr, void *arg)
  273. {
  274. u_char *p;
  275. int i, tmpcharge = 0;
  276. char a_charge[8];
  277. struct sk_buff *skb = arg;
  278. p = skb->data;
  279. if ((p = findie(p, skb->len, WE6_chargingInfo, 6))) {
  280. iecpy(a_charge, p, 1);
  281. for (i = 0; i < strlen(a_charge); i++) {
  282. tmpcharge *= 10;
  283. tmpcharge += a_charge[i] & 0xf;
  284. }
  285. if (tmpcharge > pc->para.chargeinfo) {
  286. pc->para.chargeinfo = tmpcharge;
  287. pc->st->l3.l3l4(pc->st, CC_CHARGE | INDICATION, pc);
  288. }
  289. if (pc->st->l3.debug & L3_DEB_CHARGE) {
  290. l3_debug(pc->st, "charging info %d",
  291. pc->para.chargeinfo);
  292. }
  293. } else if (pc->st->l3.debug & L3_DEB_CHARGE)
  294. l3_debug(pc->st, "charging info not found");
  295. dev_kfree_skb(skb);
  296. }
  297. static void
  298. l3_1tr6_info_s2(struct l3_process *pc, u_char pr, void *arg)
  299. {
  300. struct sk_buff *skb = arg;
  301. dev_kfree_skb(skb);
  302. }
  303. static void
  304. l3_1tr6_connect(struct l3_process *pc, u_char pr, void *arg)
  305. {
  306. struct sk_buff *skb = arg;
  307. L3DelTimer(&pc->timer); /* T310 */
  308. if (!findie(skb->data, skb->len, WE6_date, 6)) {
  309. l3_1tr6_error(pc, "missing connect date", skb);
  310. return;
  311. }
  312. newl3state(pc, 10);
  313. dev_kfree_skb(skb);
  314. pc->para.chargeinfo = 0;
  315. pc->st->l3.l3l4(pc->st, CC_SETUP | CONFIRM, pc);
  316. }
  317. static void
  318. l3_1tr6_rel(struct l3_process *pc, u_char pr, void *arg)
  319. {
  320. struct sk_buff *skb = arg;
  321. u_char *p;
  322. p = skb->data;
  323. if ((p = findie(p, skb->len, WE0_cause, 0))) {
  324. if (p[1] > 0) {
  325. pc->para.cause = p[2];
  326. if (p[1] > 1)
  327. pc->para.loc = p[3];
  328. else
  329. pc->para.loc = 0;
  330. } else {
  331. pc->para.cause = 0;
  332. pc->para.loc = 0;
  333. }
  334. } else {
  335. pc->para.cause = NO_CAUSE;
  336. l3_1tr6_error(pc, "missing REL cause", skb);
  337. return;
  338. }
  339. dev_kfree_skb(skb);
  340. StopAllL3Timer(pc);
  341. newl3state(pc, 0);
  342. l3_1TR6_message(pc, MT_N1_REL_ACK, PROTO_DIS_N1);
  343. pc->st->l3.l3l4(pc->st, CC_RELEASE | INDICATION, pc);
  344. release_l3_process(pc);
  345. }
  346. static void
  347. l3_1tr6_rel_ack(struct l3_process *pc, u_char pr, void *arg)
  348. {
  349. struct sk_buff *skb = arg;
  350. dev_kfree_skb(skb);
  351. StopAllL3Timer(pc);
  352. newl3state(pc, 0);
  353. pc->para.cause = NO_CAUSE;
  354. pc->st->l3.l3l4(pc->st, CC_RELEASE | CONFIRM, pc);
  355. release_l3_process(pc);
  356. }
  357. static void
  358. l3_1tr6_disc(struct l3_process *pc, u_char pr, void *arg)
  359. {
  360. struct sk_buff *skb = arg;
  361. u_char *p;
  362. int i, tmpcharge = 0;
  363. char a_charge[8];
  364. StopAllL3Timer(pc);
  365. p = skb->data;
  366. if ((p = findie(p, skb->len, WE6_chargingInfo, 6))) {
  367. iecpy(a_charge, p, 1);
  368. for (i = 0; i < strlen(a_charge); i++) {
  369. tmpcharge *= 10;
  370. tmpcharge += a_charge[i] & 0xf;
  371. }
  372. if (tmpcharge > pc->para.chargeinfo) {
  373. pc->para.chargeinfo = tmpcharge;
  374. pc->st->l3.l3l4(pc->st, CC_CHARGE | INDICATION, pc);
  375. }
  376. if (pc->st->l3.debug & L3_DEB_CHARGE) {
  377. l3_debug(pc->st, "charging info %d",
  378. pc->para.chargeinfo);
  379. }
  380. } else if (pc->st->l3.debug & L3_DEB_CHARGE)
  381. l3_debug(pc->st, "charging info not found");
  382. p = skb->data;
  383. if ((p = findie(p, skb->len, WE0_cause, 0))) {
  384. if (p[1] > 0) {
  385. pc->para.cause = p[2];
  386. if (p[1] > 1)
  387. pc->para.loc = p[3];
  388. else
  389. pc->para.loc = 0;
  390. } else {
  391. pc->para.cause = 0;
  392. pc->para.loc = 0;
  393. }
  394. } else {
  395. if (pc->st->l3.debug & L3_DEB_WARN)
  396. l3_debug(pc->st, "cause not found");
  397. pc->para.cause = NO_CAUSE;
  398. }
  399. if (!findie(skb->data, skb->len, WE6_date, 6)) {
  400. l3_1tr6_error(pc, "missing connack date", skb);
  401. return;
  402. }
  403. dev_kfree_skb(skb);
  404. newl3state(pc, 12);
  405. pc->st->l3.l3l4(pc->st, CC_DISCONNECT | INDICATION, pc);
  406. }
  407. static void
  408. l3_1tr6_connect_ack(struct l3_process *pc, u_char pr, void *arg)
  409. {
  410. struct sk_buff *skb = arg;
  411. if (!findie(skb->data, skb->len, WE6_date, 6)) {
  412. l3_1tr6_error(pc, "missing connack date", skb);
  413. return;
  414. }
  415. dev_kfree_skb(skb);
  416. newl3state(pc, 10);
  417. pc->para.chargeinfo = 0;
  418. L3DelTimer(&pc->timer);
  419. pc->st->l3.l3l4(pc->st, CC_SETUP_COMPL | INDICATION, pc);
  420. }
  421. static void
  422. l3_1tr6_alert_req(struct l3_process *pc, u_char pr, void *arg)
  423. {
  424. newl3state(pc, 7);
  425. l3_1TR6_message(pc, MT_N1_ALERT, PROTO_DIS_N1);
  426. }
  427. static void
  428. l3_1tr6_setup_rsp(struct l3_process *pc, u_char pr, void *arg)
  429. {
  430. struct sk_buff *skb;
  431. u_char tmp[24];
  432. u_char *p = tmp;
  433. int l;
  434. MsgHead(p, pc->callref, MT_N1_CONN, PROTO_DIS_N1);
  435. if (pc->para.spv) { /* SPV ? */
  436. /* NSF SPV */
  437. *p++ = WE0_netSpecFac;
  438. *p++ = 4; /* Laenge */
  439. *p++ = 0;
  440. *p++ = FAC_SPV; /* SPV */
  441. *p++ = pc->para.setup.si1;
  442. *p++ = pc->para.setup.si2;
  443. *p++ = WE0_netSpecFac;
  444. *p++ = 4; /* Laenge */
  445. *p++ = 0;
  446. *p++ = FAC_Activate; /* aktiviere SPV */
  447. *p++ = pc->para.setup.si1;
  448. *p++ = pc->para.setup.si2;
  449. }
  450. newl3state(pc, 8);
  451. l = p - tmp;
  452. if (!(skb = l3_alloc_skb(l)))
  453. return;
  454. skb_put_data(skb, tmp, l);
  455. l3_msg(pc->st, DL_DATA | REQUEST, skb);
  456. L3DelTimer(&pc->timer);
  457. L3AddTimer(&pc->timer, T313, CC_T313);
  458. }
  459. static void
  460. l3_1tr6_reset(struct l3_process *pc, u_char pr, void *arg)
  461. {
  462. release_l3_process(pc);
  463. }
  464. static void
  465. l3_1tr6_disconnect_req(struct l3_process *pc, u_char pr, void *arg)
  466. {
  467. struct sk_buff *skb;
  468. u_char tmp[16];
  469. u_char *p = tmp;
  470. int l;
  471. u_char cause = 0x10;
  472. u_char clen = 1;
  473. if (pc->para.cause > 0)
  474. cause = pc->para.cause;
  475. /* Map DSS1 causes */
  476. switch (cause & 0x7f) {
  477. case 0x10:
  478. clen = 0;
  479. break;
  480. case 0x11:
  481. cause = CAUSE_UserBusy;
  482. break;
  483. case 0x15:
  484. cause = CAUSE_CallRejected;
  485. break;
  486. }
  487. StopAllL3Timer(pc);
  488. MsgHead(p, pc->callref, MT_N1_DISC, PROTO_DIS_N1);
  489. *p++ = WE0_cause;
  490. *p++ = clen; /* Laenge */
  491. if (clen)
  492. *p++ = cause | 0x80;
  493. newl3state(pc, 11);
  494. l = p - tmp;
  495. if (!(skb = l3_alloc_skb(l)))
  496. return;
  497. skb_put_data(skb, tmp, l);
  498. l3_msg(pc->st, DL_DATA | REQUEST, skb);
  499. L3AddTimer(&pc->timer, T305, CC_T305);
  500. }
  501. static void
  502. l3_1tr6_t303(struct l3_process *pc, u_char pr, void *arg)
  503. {
  504. if (pc->N303 > 0) {
  505. pc->N303--;
  506. L3DelTimer(&pc->timer);
  507. l3_1tr6_setup_req(pc, pr, arg);
  508. } else {
  509. L3DelTimer(&pc->timer);
  510. pc->para.cause = 0;
  511. l3_1tr6_disconnect_req(pc, 0, NULL);
  512. }
  513. }
  514. static void
  515. l3_1tr6_t304(struct l3_process *pc, u_char pr, void *arg)
  516. {
  517. L3DelTimer(&pc->timer);
  518. pc->para.cause = 0xE6;
  519. l3_1tr6_disconnect_req(pc, pr, NULL);
  520. pc->st->l3.l3l4(pc->st, CC_SETUP_ERR, pc);
  521. }
  522. static void
  523. l3_1tr6_t305(struct l3_process *pc, u_char pr, void *arg)
  524. {
  525. struct sk_buff *skb;
  526. u_char tmp[16];
  527. u_char *p = tmp;
  528. int l;
  529. u_char cause = 0x90;
  530. u_char clen = 1;
  531. L3DelTimer(&pc->timer);
  532. if (pc->para.cause != NO_CAUSE)
  533. cause = pc->para.cause;
  534. /* Map DSS1 causes */
  535. switch (cause & 0x7f) {
  536. case 0x10:
  537. clen = 0;
  538. break;
  539. case 0x15:
  540. cause = CAUSE_CallRejected;
  541. break;
  542. }
  543. MsgHead(p, pc->callref, MT_N1_REL, PROTO_DIS_N1);
  544. *p++ = WE0_cause;
  545. *p++ = clen; /* Laenge */
  546. if (clen)
  547. *p++ = cause;
  548. newl3state(pc, 19);
  549. l = p - tmp;
  550. if (!(skb = l3_alloc_skb(l)))
  551. return;
  552. skb_put_data(skb, tmp, l);
  553. l3_msg(pc->st, DL_DATA | REQUEST, skb);
  554. L3AddTimer(&pc->timer, T308, CC_T308_1);
  555. }
  556. static void
  557. l3_1tr6_t310(struct l3_process *pc, u_char pr, void *arg)
  558. {
  559. L3DelTimer(&pc->timer);
  560. pc->para.cause = 0xE6;
  561. l3_1tr6_disconnect_req(pc, pr, NULL);
  562. pc->st->l3.l3l4(pc->st, CC_SETUP_ERR, pc);
  563. }
  564. static void
  565. l3_1tr6_t313(struct l3_process *pc, u_char pr, void *arg)
  566. {
  567. L3DelTimer(&pc->timer);
  568. pc->para.cause = 0xE6;
  569. l3_1tr6_disconnect_req(pc, pr, NULL);
  570. pc->st->l3.l3l4(pc->st, CC_CONNECT_ERR, pc);
  571. }
  572. static void
  573. l3_1tr6_t308_1(struct l3_process *pc, u_char pr, void *arg)
  574. {
  575. L3DelTimer(&pc->timer);
  576. l3_1TR6_message(pc, MT_N1_REL, PROTO_DIS_N1);
  577. L3AddTimer(&pc->timer, T308, CC_T308_2);
  578. newl3state(pc, 19);
  579. }
  580. static void
  581. l3_1tr6_t308_2(struct l3_process *pc, u_char pr, void *arg)
  582. {
  583. L3DelTimer(&pc->timer);
  584. pc->st->l3.l3l4(pc->st, CC_RELEASE_ERR, pc);
  585. release_l3_process(pc);
  586. }
  587. static void
  588. l3_1tr6_dl_reset(struct l3_process *pc, u_char pr, void *arg)
  589. {
  590. pc->para.cause = CAUSE_LocalProcErr;
  591. l3_1tr6_disconnect_req(pc, pr, NULL);
  592. pc->st->l3.l3l4(pc->st, CC_SETUP_ERR, pc);
  593. }
  594. static void
  595. l3_1tr6_dl_release(struct l3_process *pc, u_char pr, void *arg)
  596. {
  597. newl3state(pc, 0);
  598. pc->para.cause = 0x1b; /* Destination out of order */
  599. pc->para.loc = 0;
  600. pc->st->l3.l3l4(pc->st, CC_RELEASE | INDICATION, pc);
  601. release_l3_process(pc);
  602. }
  603. /* *INDENT-OFF* */
  604. static struct stateentry downstl[] =
  605. {
  606. {SBIT(0),
  607. CC_SETUP | REQUEST, l3_1tr6_setup_req},
  608. {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(6) | SBIT(7) | SBIT(8) |
  609. SBIT(10),
  610. CC_DISCONNECT | REQUEST, l3_1tr6_disconnect_req},
  611. {SBIT(12),
  612. CC_RELEASE | REQUEST, l3_1tr6_release_req},
  613. {SBIT(6),
  614. CC_IGNORE | REQUEST, l3_1tr6_reset},
  615. {SBIT(6),
  616. CC_REJECT | REQUEST, l3_1tr6_disconnect_req},
  617. {SBIT(6),
  618. CC_ALERTING | REQUEST, l3_1tr6_alert_req},
  619. {SBIT(6) | SBIT(7),
  620. CC_SETUP | RESPONSE, l3_1tr6_setup_rsp},
  621. {SBIT(1),
  622. CC_T303, l3_1tr6_t303},
  623. {SBIT(2),
  624. CC_T304, l3_1tr6_t304},
  625. {SBIT(3),
  626. CC_T310, l3_1tr6_t310},
  627. {SBIT(8),
  628. CC_T313, l3_1tr6_t313},
  629. {SBIT(11),
  630. CC_T305, l3_1tr6_t305},
  631. {SBIT(19),
  632. CC_T308_1, l3_1tr6_t308_1},
  633. {SBIT(19),
  634. CC_T308_2, l3_1tr6_t308_2},
  635. };
  636. static struct stateentry datastln1[] =
  637. {
  638. {SBIT(0),
  639. MT_N1_INVALID, l3_1tr6_invalid},
  640. {SBIT(0),
  641. MT_N1_SETUP, l3_1tr6_setup},
  642. {SBIT(1),
  643. MT_N1_SETUP_ACK, l3_1tr6_setup_ack},
  644. {SBIT(1) | SBIT(2),
  645. MT_N1_CALL_SENT, l3_1tr6_call_sent},
  646. {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(10),
  647. MT_N1_DISC, l3_1tr6_disc},
  648. {SBIT(2) | SBIT(3) | SBIT(4),
  649. MT_N1_ALERT, l3_1tr6_alert},
  650. {SBIT(2) | SBIT(3) | SBIT(4),
  651. MT_N1_CONN, l3_1tr6_connect},
  652. {SBIT(2),
  653. MT_N1_INFO, l3_1tr6_info_s2},
  654. {SBIT(8),
  655. MT_N1_CONN_ACK, l3_1tr6_connect_ack},
  656. {SBIT(10),
  657. MT_N1_INFO, l3_1tr6_info},
  658. {SBIT(0) | SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) |
  659. SBIT(10) | SBIT(11) | SBIT(12) | SBIT(15) | SBIT(17),
  660. MT_N1_REL, l3_1tr6_rel},
  661. {SBIT(19),
  662. MT_N1_REL, l3_1tr6_rel_ack},
  663. {SBIT(0) | SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) |
  664. SBIT(10) | SBIT(11) | SBIT(12) | SBIT(15) | SBIT(17),
  665. MT_N1_REL_ACK, l3_1tr6_invalid},
  666. {SBIT(19),
  667. MT_N1_REL_ACK, l3_1tr6_rel_ack}
  668. };
  669. static struct stateentry manstatelist[] =
  670. {
  671. {SBIT(2),
  672. DL_ESTABLISH | INDICATION, l3_1tr6_dl_reset},
  673. {ALL_STATES,
  674. DL_RELEASE | INDICATION, l3_1tr6_dl_release},
  675. };
  676. /* *INDENT-ON* */
  677. static void
  678. up1tr6(struct PStack *st, int pr, void *arg)
  679. {
  680. int i, mt, cr;
  681. struct l3_process *proc;
  682. struct sk_buff *skb = arg;
  683. switch (pr) {
  684. case (DL_DATA | INDICATION):
  685. case (DL_UNIT_DATA | INDICATION):
  686. break;
  687. case (DL_ESTABLISH | CONFIRM):
  688. case (DL_ESTABLISH | INDICATION):
  689. case (DL_RELEASE | INDICATION):
  690. case (DL_RELEASE | CONFIRM):
  691. l3_msg(st, pr, arg);
  692. return;
  693. break;
  694. }
  695. if (skb->len < 4) {
  696. if (st->l3.debug & L3_DEB_PROTERR) {
  697. l3_debug(st, "up1tr6 len only %d", skb->len);
  698. }
  699. dev_kfree_skb(skb);
  700. return;
  701. }
  702. if ((skb->data[0] & 0xfe) != PROTO_DIS_N0) {
  703. if (st->l3.debug & L3_DEB_PROTERR) {
  704. l3_debug(st, "up1tr6%sunexpected discriminator %x message len %d",
  705. (pr == (DL_DATA | INDICATION)) ? " " : "(broadcast) ",
  706. skb->data[0], skb->len);
  707. }
  708. dev_kfree_skb(skb);
  709. return;
  710. }
  711. if (skb->data[1] != 1) {
  712. if (st->l3.debug & L3_DEB_PROTERR) {
  713. l3_debug(st, "up1tr6 CR len not 1");
  714. }
  715. dev_kfree_skb(skb);
  716. return;
  717. }
  718. cr = skb->data[2];
  719. mt = skb->data[3];
  720. if (skb->data[0] == PROTO_DIS_N0) {
  721. dev_kfree_skb(skb);
  722. if (st->l3.debug & L3_DEB_STATE) {
  723. l3_debug(st, "up1tr6%s N0 mt %x unhandled",
  724. (pr == (DL_DATA | INDICATION)) ? " " : "(broadcast) ", mt);
  725. }
  726. } else if (skb->data[0] == PROTO_DIS_N1) {
  727. if (!(proc = getl3proc(st, cr))) {
  728. if (mt == MT_N1_SETUP) {
  729. if (cr < 128) {
  730. if (!(proc = new_l3_process(st, cr))) {
  731. if (st->l3.debug & L3_DEB_PROTERR) {
  732. l3_debug(st, "up1tr6 no roc mem");
  733. }
  734. dev_kfree_skb(skb);
  735. return;
  736. }
  737. } else {
  738. dev_kfree_skb(skb);
  739. return;
  740. }
  741. } else if ((mt == MT_N1_REL) || (mt == MT_N1_REL_ACK) ||
  742. (mt == MT_N1_CANC_ACK) || (mt == MT_N1_CANC_REJ) ||
  743. (mt == MT_N1_REG_ACK) || (mt == MT_N1_REG_REJ) ||
  744. (mt == MT_N1_SUSP_ACK) || (mt == MT_N1_RES_REJ) ||
  745. (mt == MT_N1_INFO)) {
  746. dev_kfree_skb(skb);
  747. return;
  748. } else {
  749. if (!(proc = new_l3_process(st, cr))) {
  750. if (st->l3.debug & L3_DEB_PROTERR) {
  751. l3_debug(st, "up1tr6 no roc mem");
  752. }
  753. dev_kfree_skb(skb);
  754. return;
  755. }
  756. mt = MT_N1_INVALID;
  757. }
  758. }
  759. for (i = 0; i < ARRAY_SIZE(datastln1); i++)
  760. if ((mt == datastln1[i].primitive) &&
  761. ((1 << proc->state) & datastln1[i].state))
  762. break;
  763. if (i == ARRAY_SIZE(datastln1)) {
  764. dev_kfree_skb(skb);
  765. if (st->l3.debug & L3_DEB_STATE) {
  766. l3_debug(st, "up1tr6%sstate %d mt %x unhandled",
  767. (pr == (DL_DATA | INDICATION)) ? " " : "(broadcast) ",
  768. proc->state, mt);
  769. }
  770. return;
  771. } else {
  772. if (st->l3.debug & L3_DEB_STATE) {
  773. l3_debug(st, "up1tr6%sstate %d mt %x",
  774. (pr == (DL_DATA | INDICATION)) ? " " : "(broadcast) ",
  775. proc->state, mt);
  776. }
  777. datastln1[i].rout(proc, pr, skb);
  778. }
  779. }
  780. }
  781. static void
  782. down1tr6(struct PStack *st, int pr, void *arg)
  783. {
  784. int i, cr;
  785. struct l3_process *proc;
  786. struct Channel *chan;
  787. if ((DL_ESTABLISH | REQUEST) == pr) {
  788. l3_msg(st, pr, NULL);
  789. return;
  790. } else if ((CC_SETUP | REQUEST) == pr) {
  791. chan = arg;
  792. cr = newcallref();
  793. cr |= 0x80;
  794. if (!(proc = new_l3_process(st, cr))) {
  795. return;
  796. } else {
  797. proc->chan = chan;
  798. chan->proc = proc;
  799. memcpy(&proc->para.setup, &chan->setup, sizeof(setup_parm));
  800. proc->callref = cr;
  801. }
  802. } else {
  803. proc = arg;
  804. }
  805. for (i = 0; i < ARRAY_SIZE(downstl); i++)
  806. if ((pr == downstl[i].primitive) &&
  807. ((1 << proc->state) & downstl[i].state))
  808. break;
  809. if (i == ARRAY_SIZE(downstl)) {
  810. if (st->l3.debug & L3_DEB_STATE) {
  811. l3_debug(st, "down1tr6 state %d prim %d unhandled",
  812. proc->state, pr);
  813. }
  814. } else {
  815. if (st->l3.debug & L3_DEB_STATE) {
  816. l3_debug(st, "down1tr6 state %d prim %d",
  817. proc->state, pr);
  818. }
  819. downstl[i].rout(proc, pr, arg);
  820. }
  821. }
  822. static void
  823. man1tr6(struct PStack *st, int pr, void *arg)
  824. {
  825. int i;
  826. struct l3_process *proc = arg;
  827. if (!proc) {
  828. printk(KERN_ERR "HiSax man1tr6 without proc pr=%04x\n", pr);
  829. return;
  830. }
  831. for (i = 0; i < ARRAY_SIZE(manstatelist); i++)
  832. if ((pr == manstatelist[i].primitive) &&
  833. ((1 << proc->state) & manstatelist[i].state))
  834. break;
  835. if (i == ARRAY_SIZE(manstatelist)) {
  836. if (st->l3.debug & L3_DEB_STATE) {
  837. l3_debug(st, "cr %d man1tr6 state %d prim %d unhandled",
  838. proc->callref & 0x7f, proc->state, pr);
  839. }
  840. } else {
  841. if (st->l3.debug & L3_DEB_STATE) {
  842. l3_debug(st, "cr %d man1tr6 state %d prim %d",
  843. proc->callref & 0x7f, proc->state, pr);
  844. }
  845. manstatelist[i].rout(proc, pr, arg);
  846. }
  847. }
  848. void
  849. setstack_1tr6(struct PStack *st)
  850. {
  851. char tmp[64];
  852. st->lli.l4l3 = down1tr6;
  853. st->l2.l2l3 = up1tr6;
  854. st->l3.l3ml3 = man1tr6;
  855. st->l3.N303 = 0;
  856. strcpy(tmp, l3_1tr6_revision);
  857. printk(KERN_INFO "HiSax: 1TR6 Rev. %s\n", HiSax_getrev(tmp));
  858. }