isdnloop.c 38 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551
  1. /* $Id: isdnloop.c,v 1.11.6.7 2001/11/11 19:54:31 kai Exp $
  2. *
  3. * ISDN low-level module implementing a dummy loop driver.
  4. *
  5. * Copyright 1997 by Fritz Elfert (fritz@isdn4linux.de)
  6. *
  7. * This software may be used and distributed according to the terms
  8. * of the GNU General Public License, incorporated herein by reference.
  9. *
  10. */
  11. #include <linux/config.h>
  12. #include <linux/module.h>
  13. #include <linux/interrupt.h>
  14. #include <linux/init.h>
  15. #include <linux/sched.h>
  16. #include "isdnloop.h"
  17. static char *revision = "$Revision: 1.11.6.7 $";
  18. static char *isdnloop_id = "loop0";
  19. MODULE_DESCRIPTION("ISDN4Linux: Pseudo Driver that simulates an ISDN card");
  20. MODULE_AUTHOR("Fritz Elfert");
  21. MODULE_LICENSE("GPL");
  22. MODULE_PARM(isdnloop_id, "s");
  23. MODULE_PARM_DESC(isdnloop_id, "ID-String of first card");
  24. static int isdnloop_addcard(char *);
  25. /*
  26. * Free queue completely.
  27. *
  28. * Parameter:
  29. * card = pointer to card struct
  30. * channel = channel number
  31. */
  32. static void
  33. isdnloop_free_queue(isdnloop_card * card, int channel)
  34. {
  35. struct sk_buff_head *queue = &card->bqueue[channel];
  36. skb_queue_purge(queue);
  37. card->sndcount[channel] = 0;
  38. }
  39. /*
  40. * Send B-Channel data to another virtual card.
  41. * This routine is called via timer-callback from isdnloop_pollbchan().
  42. *
  43. * Parameter:
  44. * card = pointer to card struct.
  45. * ch = channel number (0-based)
  46. */
  47. static void
  48. isdnloop_bchan_send(isdnloop_card * card, int ch)
  49. {
  50. isdnloop_card *rcard = card->rcard[ch];
  51. int rch = card->rch[ch], len, ack;
  52. struct sk_buff *skb;
  53. isdn_ctrl cmd;
  54. while (card->sndcount[ch]) {
  55. if ((skb = skb_dequeue(&card->bqueue[ch]))) {
  56. len = skb->len;
  57. card->sndcount[ch] -= len;
  58. ack = *(skb->head); /* used as scratch area */
  59. cmd.driver = card->myid;
  60. cmd.arg = ch;
  61. if (rcard){
  62. rcard->interface.rcvcallb_skb(rcard->myid, rch, skb);
  63. } else {
  64. printk(KERN_WARNING "isdnloop: no rcard, skb dropped\n");
  65. dev_kfree_skb(skb);
  66. };
  67. cmd.command = ISDN_STAT_BSENT;
  68. cmd.parm.length = len;
  69. card->interface.statcallb(&cmd);
  70. } else
  71. card->sndcount[ch] = 0;
  72. }
  73. }
  74. /*
  75. * Send/Receive Data to/from the B-Channel.
  76. * This routine is called via timer-callback.
  77. * It schedules itself while any B-Channel is open.
  78. *
  79. * Parameter:
  80. * data = pointer to card struct, set by kernel timer.data
  81. */
  82. static void
  83. isdnloop_pollbchan(unsigned long data)
  84. {
  85. isdnloop_card *card = (isdnloop_card *) data;
  86. unsigned long flags;
  87. if (card->flags & ISDNLOOP_FLAGS_B1ACTIVE)
  88. isdnloop_bchan_send(card, 0);
  89. if (card->flags & ISDNLOOP_FLAGS_B2ACTIVE)
  90. isdnloop_bchan_send(card, 1);
  91. if (card->flags & (ISDNLOOP_FLAGS_B1ACTIVE | ISDNLOOP_FLAGS_B2ACTIVE)) {
  92. /* schedule b-channel polling again */
  93. save_flags(flags);
  94. cli();
  95. card->rb_timer.expires = jiffies + ISDNLOOP_TIMER_BCREAD;
  96. add_timer(&card->rb_timer);
  97. card->flags |= ISDNLOOP_FLAGS_RBTIMER;
  98. restore_flags(flags);
  99. } else
  100. card->flags &= ~ISDNLOOP_FLAGS_RBTIMER;
  101. }
  102. /*
  103. * Parse ICN-type setup string and fill fields of setup-struct
  104. * with parsed data.
  105. *
  106. * Parameter:
  107. * setup = setup string, format: [caller-id],si1,si2,[called-id]
  108. * cmd = pointer to struct to be filled.
  109. */
  110. static void
  111. isdnloop_parse_setup(char *setup, isdn_ctrl * cmd)
  112. {
  113. char *t = setup;
  114. char *s = strchr(t, ',');
  115. *s++ = '\0';
  116. strlcpy(cmd->parm.setup.phone, t, sizeof(cmd->parm.setup.phone));
  117. s = strchr(t = s, ',');
  118. *s++ = '\0';
  119. if (!strlen(t))
  120. cmd->parm.setup.si1 = 0;
  121. else
  122. cmd->parm.setup.si1 = simple_strtoul(t, NULL, 10);
  123. s = strchr(t = s, ',');
  124. *s++ = '\0';
  125. if (!strlen(t))
  126. cmd->parm.setup.si2 = 0;
  127. else
  128. cmd->parm.setup.si2 =
  129. simple_strtoul(t, NULL, 10);
  130. strlcpy(cmd->parm.setup.eazmsn, s, sizeof(cmd->parm.setup.eazmsn));
  131. cmd->parm.setup.plan = 0;
  132. cmd->parm.setup.screen = 0;
  133. }
  134. typedef struct isdnloop_stat {
  135. char *statstr;
  136. int command;
  137. int action;
  138. } isdnloop_stat;
  139. /* *INDENT-OFF* */
  140. static isdnloop_stat isdnloop_stat_table[] =
  141. {
  142. {"BCON_", ISDN_STAT_BCONN, 1}, /* B-Channel connected */
  143. {"BDIS_", ISDN_STAT_BHUP, 2}, /* B-Channel disconnected */
  144. {"DCON_", ISDN_STAT_DCONN, 0}, /* D-Channel connected */
  145. {"DDIS_", ISDN_STAT_DHUP, 0}, /* D-Channel disconnected */
  146. {"DCAL_I", ISDN_STAT_ICALL, 3}, /* Incoming call dialup-line */
  147. {"DSCA_I", ISDN_STAT_ICALL, 3}, /* Incoming call 1TR6-SPV */
  148. {"FCALL", ISDN_STAT_ICALL, 4}, /* Leased line connection up */
  149. {"CIF", ISDN_STAT_CINF, 5}, /* Charge-info, 1TR6-type */
  150. {"AOC", ISDN_STAT_CINF, 6}, /* Charge-info, DSS1-type */
  151. {"CAU", ISDN_STAT_CAUSE, 7}, /* Cause code */
  152. {"TEI OK", ISDN_STAT_RUN, 0}, /* Card connected to wallplug */
  153. {"E_L1: ACT FAIL", ISDN_STAT_BHUP, 8}, /* Layer-1 activation failed */
  154. {"E_L2: DATA LIN", ISDN_STAT_BHUP, 8}, /* Layer-2 data link lost */
  155. {"E_L1: ACTIVATION FAILED",
  156. ISDN_STAT_BHUP, 8}, /* Layer-1 activation failed */
  157. {NULL, 0, -1}
  158. };
  159. /* *INDENT-ON* */
  160. /*
  161. * Parse Status message-strings from virtual card.
  162. * Depending on status, call statcallb for sending messages to upper
  163. * levels. Also set/reset B-Channel active-flags.
  164. *
  165. * Parameter:
  166. * status = status string to parse.
  167. * channel = channel where message comes from.
  168. * card = card where message comes from.
  169. */
  170. static void
  171. isdnloop_parse_status(u_char * status, int channel, isdnloop_card * card)
  172. {
  173. isdnloop_stat *s = isdnloop_stat_table;
  174. int action = -1;
  175. isdn_ctrl cmd;
  176. while (s->statstr) {
  177. if (!strncmp(status, s->statstr, strlen(s->statstr))) {
  178. cmd.command = s->command;
  179. action = s->action;
  180. break;
  181. }
  182. s++;
  183. }
  184. if (action == -1)
  185. return;
  186. cmd.driver = card->myid;
  187. cmd.arg = channel;
  188. switch (action) {
  189. case 1:
  190. /* BCON_x */
  191. card->flags |= (channel) ?
  192. ISDNLOOP_FLAGS_B2ACTIVE : ISDNLOOP_FLAGS_B1ACTIVE;
  193. break;
  194. case 2:
  195. /* BDIS_x */
  196. card->flags &= ~((channel) ?
  197. ISDNLOOP_FLAGS_B2ACTIVE : ISDNLOOP_FLAGS_B1ACTIVE);
  198. isdnloop_free_queue(card, channel);
  199. break;
  200. case 3:
  201. /* DCAL_I and DSCA_I */
  202. isdnloop_parse_setup(status + 6, &cmd);
  203. break;
  204. case 4:
  205. /* FCALL */
  206. sprintf(cmd.parm.setup.phone, "LEASED%d", card->myid);
  207. sprintf(cmd.parm.setup.eazmsn, "%d", channel + 1);
  208. cmd.parm.setup.si1 = 7;
  209. cmd.parm.setup.si2 = 0;
  210. cmd.parm.setup.plan = 0;
  211. cmd.parm.setup.screen = 0;
  212. break;
  213. case 5:
  214. /* CIF */
  215. strlcpy(cmd.parm.num, status + 3, sizeof(cmd.parm.num));
  216. break;
  217. case 6:
  218. /* AOC */
  219. snprintf(cmd.parm.num, sizeof(cmd.parm.num), "%d",
  220. (int) simple_strtoul(status + 7, NULL, 16));
  221. break;
  222. case 7:
  223. /* CAU */
  224. status += 3;
  225. if (strlen(status) == 4)
  226. snprintf(cmd.parm.num, sizeof(cmd.parm.num), "%s%c%c",
  227. status + 2, *status, *(status + 1));
  228. else
  229. strlcpy(cmd.parm.num, status + 1, sizeof(cmd.parm.num));
  230. break;
  231. case 8:
  232. /* Misc Errors on L1 and L2 */
  233. card->flags &= ~ISDNLOOP_FLAGS_B1ACTIVE;
  234. isdnloop_free_queue(card, 0);
  235. cmd.arg = 0;
  236. cmd.driver = card->myid;
  237. card->interface.statcallb(&cmd);
  238. cmd.command = ISDN_STAT_DHUP;
  239. cmd.arg = 0;
  240. cmd.driver = card->myid;
  241. card->interface.statcallb(&cmd);
  242. cmd.command = ISDN_STAT_BHUP;
  243. card->flags &= ~ISDNLOOP_FLAGS_B2ACTIVE;
  244. isdnloop_free_queue(card, 1);
  245. cmd.arg = 1;
  246. cmd.driver = card->myid;
  247. card->interface.statcallb(&cmd);
  248. cmd.command = ISDN_STAT_DHUP;
  249. cmd.arg = 1;
  250. cmd.driver = card->myid;
  251. break;
  252. }
  253. card->interface.statcallb(&cmd);
  254. }
  255. /*
  256. * Store a cwcharacter into ringbuffer for reading from /dev/isdnctrl
  257. *
  258. * Parameter:
  259. * card = pointer to card struct.
  260. * c = char to store.
  261. */
  262. static void
  263. isdnloop_putmsg(isdnloop_card * card, unsigned char c)
  264. {
  265. ulong flags;
  266. save_flags(flags);
  267. cli();
  268. *card->msg_buf_write++ = (c == 0xff) ? '\n' : c;
  269. if (card->msg_buf_write == card->msg_buf_read) {
  270. if (++card->msg_buf_read > card->msg_buf_end)
  271. card->msg_buf_read = card->msg_buf;
  272. }
  273. if (card->msg_buf_write > card->msg_buf_end)
  274. card->msg_buf_write = card->msg_buf;
  275. restore_flags(flags);
  276. }
  277. /*
  278. * Poll a virtual cards message queue.
  279. * If there are new status-replies from the card, copy them to
  280. * ringbuffer for reading on /dev/isdnctrl and call
  281. * isdnloop_parse_status() for processing them. Watch for special
  282. * Firmware bootmessage and parse it, to get the D-Channel protocol.
  283. * If there are B-Channels open, initiate a timer-callback to
  284. * isdnloop_pollbchan().
  285. * This routine is called periodically via timer interrupt.
  286. *
  287. * Parameter:
  288. * data = pointer to card struct
  289. */
  290. static void
  291. isdnloop_polldchan(unsigned long data)
  292. {
  293. isdnloop_card *card = (isdnloop_card *) data;
  294. struct sk_buff *skb;
  295. int avail;
  296. int left;
  297. u_char c;
  298. int ch;
  299. unsigned long flags;
  300. u_char *p;
  301. isdn_ctrl cmd;
  302. if ((skb = skb_dequeue(&card->dqueue)))
  303. avail = skb->len;
  304. else
  305. avail = 0;
  306. for (left = avail; left > 0; left--) {
  307. c = *skb->data;
  308. skb_pull(skb, 1);
  309. isdnloop_putmsg(card, c);
  310. card->imsg[card->iptr] = c;
  311. if (card->iptr < 59)
  312. card->iptr++;
  313. if (!skb->len) {
  314. avail++;
  315. isdnloop_putmsg(card, '\n');
  316. card->imsg[card->iptr] = 0;
  317. card->iptr = 0;
  318. if (card->imsg[0] == '0' && card->imsg[1] >= '0' &&
  319. card->imsg[1] <= '2' && card->imsg[2] == ';') {
  320. ch = (card->imsg[1] - '0') - 1;
  321. p = &card->imsg[3];
  322. isdnloop_parse_status(p, ch, card);
  323. } else {
  324. p = card->imsg;
  325. if (!strncmp(p, "DRV1.", 5)) {
  326. printk(KERN_INFO "isdnloop: (%s) %s\n", CID, p);
  327. if (!strncmp(p + 7, "TC", 2)) {
  328. card->ptype = ISDN_PTYPE_1TR6;
  329. card->interface.features |= ISDN_FEATURE_P_1TR6;
  330. printk(KERN_INFO
  331. "isdnloop: (%s) 1TR6-Protocol loaded and running\n", CID);
  332. }
  333. if (!strncmp(p + 7, "EC", 2)) {
  334. card->ptype = ISDN_PTYPE_EURO;
  335. card->interface.features |= ISDN_FEATURE_P_EURO;
  336. printk(KERN_INFO
  337. "isdnloop: (%s) Euro-Protocol loaded and running\n", CID);
  338. }
  339. continue;
  340. }
  341. }
  342. }
  343. }
  344. if (avail) {
  345. cmd.command = ISDN_STAT_STAVAIL;
  346. cmd.driver = card->myid;
  347. cmd.arg = avail;
  348. card->interface.statcallb(&cmd);
  349. }
  350. if (card->flags & (ISDNLOOP_FLAGS_B1ACTIVE | ISDNLOOP_FLAGS_B2ACTIVE))
  351. if (!(card->flags & ISDNLOOP_FLAGS_RBTIMER)) {
  352. /* schedule b-channel polling */
  353. card->flags |= ISDNLOOP_FLAGS_RBTIMER;
  354. save_flags(flags);
  355. cli();
  356. del_timer(&card->rb_timer);
  357. card->rb_timer.function = isdnloop_pollbchan;
  358. card->rb_timer.data = (unsigned long) card;
  359. card->rb_timer.expires = jiffies + ISDNLOOP_TIMER_BCREAD;
  360. add_timer(&card->rb_timer);
  361. restore_flags(flags);
  362. }
  363. /* schedule again */
  364. save_flags(flags);
  365. cli();
  366. card->st_timer.expires = jiffies + ISDNLOOP_TIMER_DCREAD;
  367. add_timer(&card->st_timer);
  368. restore_flags(flags);
  369. }
  370. /*
  371. * Append a packet to the transmit buffer-queue.
  372. *
  373. * Parameter:
  374. * channel = Number of B-channel
  375. * skb = packet to send.
  376. * card = pointer to card-struct
  377. * Return:
  378. * Number of bytes transferred, -E??? on error
  379. */
  380. static int
  381. isdnloop_sendbuf(int channel, struct sk_buff *skb, isdnloop_card * card)
  382. {
  383. int len = skb->len;
  384. unsigned long flags;
  385. struct sk_buff *nskb;
  386. if (len > 4000) {
  387. printk(KERN_WARNING
  388. "isdnloop: Send packet too large\n");
  389. return -EINVAL;
  390. }
  391. if (len) {
  392. if (!(card->flags & (channel) ? ISDNLOOP_FLAGS_B2ACTIVE : ISDNLOOP_FLAGS_B1ACTIVE))
  393. return 0;
  394. if (card->sndcount[channel] > ISDNLOOP_MAX_SQUEUE)
  395. return 0;
  396. save_flags(flags);
  397. cli();
  398. nskb = dev_alloc_skb(skb->len);
  399. if (nskb) {
  400. memcpy(skb_put(nskb, len), skb->data, len);
  401. skb_queue_tail(&card->bqueue[channel], nskb);
  402. dev_kfree_skb(skb);
  403. } else
  404. len = 0;
  405. card->sndcount[channel] += len;
  406. restore_flags(flags);
  407. }
  408. return len;
  409. }
  410. /*
  411. * Read the messages from the card's ringbuffer
  412. *
  413. * Parameter:
  414. * buf = pointer to buffer.
  415. * len = number of bytes to read.
  416. * user = flag, 1: called from userlevel 0: called from kernel.
  417. * card = pointer to card struct.
  418. * Return:
  419. * number of bytes actually transferred.
  420. */
  421. static int
  422. isdnloop_readstatus(u_char __user *buf, int len, isdnloop_card * card)
  423. {
  424. int count;
  425. u_char __user *p;
  426. for (p = buf, count = 0; count < len; p++, count++) {
  427. if (card->msg_buf_read == card->msg_buf_write)
  428. return count;
  429. put_user(*card->msg_buf_read++, p);
  430. if (card->msg_buf_read > card->msg_buf_end)
  431. card->msg_buf_read = card->msg_buf;
  432. }
  433. return count;
  434. }
  435. /*
  436. * Simulate a card's response by appending it to the cards
  437. * message queue.
  438. *
  439. * Parameter:
  440. * card = pointer to card struct.
  441. * s = pointer to message-string.
  442. * ch = channel: 0 = generic messages, 1 and 2 = D-channel messages.
  443. * Return:
  444. * 0 on success, 1 on memory squeeze.
  445. */
  446. static int
  447. isdnloop_fake(isdnloop_card * card, char *s, int ch)
  448. {
  449. struct sk_buff *skb;
  450. int len = strlen(s) + ((ch >= 0) ? 3 : 0);
  451. if (!(skb = dev_alloc_skb(len))) {
  452. printk(KERN_WARNING "isdnloop: Out of memory in isdnloop_fake\n");
  453. return 1;
  454. }
  455. if (ch >= 0)
  456. sprintf(skb_put(skb, 3), "%02d;", ch);
  457. memcpy(skb_put(skb, strlen(s)), s, strlen(s));
  458. skb_queue_tail(&card->dqueue, skb);
  459. return 0;
  460. }
  461. /* *INDENT-OFF* */
  462. static isdnloop_stat isdnloop_cmd_table[] =
  463. {
  464. {"BCON_R", 0, 1}, /* B-Channel connect */
  465. {"BCON_I", 0, 17}, /* B-Channel connect ind */
  466. {"BDIS_R", 0, 2}, /* B-Channel disconnect */
  467. {"DDIS_R", 0, 3}, /* D-Channel disconnect */
  468. {"DCON_R", 0, 16}, /* D-Channel connect */
  469. {"DSCA_R", 0, 4}, /* Dial 1TR6-SPV */
  470. {"DCAL_R", 0, 5}, /* Dial */
  471. {"EAZC", 0, 6}, /* Clear EAZ listener */
  472. {"EAZ", 0, 7}, /* Set EAZ listener */
  473. {"SEEAZ", 0, 8}, /* Get EAZ listener */
  474. {"MSN", 0, 9}, /* Set/Clear MSN listener */
  475. {"MSALL", 0, 10}, /* Set multi MSN listeners */
  476. {"SETSIL", 0, 11}, /* Set SI list */
  477. {"SEESIL", 0, 12}, /* Get SI list */
  478. {"SILC", 0, 13}, /* Clear SI list */
  479. {"LOCK", 0, -1}, /* LOCK channel */
  480. {"UNLOCK", 0, -1}, /* UNLOCK channel */
  481. {"FV2ON", 1, 14}, /* Leased mode on */
  482. {"FV2OFF", 1, 15}, /* Leased mode off */
  483. {NULL, 0, -1}
  484. };
  485. /* *INDENT-ON* */
  486. /*
  487. * Simulate an error-response from a card.
  488. *
  489. * Parameter:
  490. * card = pointer to card struct.
  491. */
  492. static void
  493. isdnloop_fake_err(isdnloop_card * card)
  494. {
  495. char buf[60];
  496. sprintf(buf, "E%s", card->omsg);
  497. isdnloop_fake(card, buf, -1);
  498. isdnloop_fake(card, "NAK", -1);
  499. }
  500. static u_char ctable_eu[] =
  501. {0x00, 0x11, 0x01, 0x12};
  502. static u_char ctable_1t[] =
  503. {0x00, 0x3b, 0x01, 0x3a};
  504. /*
  505. * Assemble a simplified cause message depending on the
  506. * D-channel protocol used.
  507. *
  508. * Parameter:
  509. * card = pointer to card struct.
  510. * loc = location: 0 = local, 1 = remote.
  511. * cau = cause: 1 = busy, 2 = nonexistent callerid, 3 = no user responding.
  512. * Return:
  513. * Pointer to buffer containing the assembled message.
  514. */
  515. static char *
  516. isdnloop_unicause(isdnloop_card * card, int loc, int cau)
  517. {
  518. static char buf[6];
  519. switch (card->ptype) {
  520. case ISDN_PTYPE_EURO:
  521. sprintf(buf, "E%02X%02X", (loc) ? 4 : 2, ctable_eu[cau]);
  522. break;
  523. case ISDN_PTYPE_1TR6:
  524. sprintf(buf, "%02X44", ctable_1t[cau]);
  525. break;
  526. default:
  527. return ("0000");
  528. }
  529. return (buf);
  530. }
  531. /*
  532. * Release a virtual connection. Called from timer interrupt, when
  533. * called party did not respond.
  534. *
  535. * Parameter:
  536. * card = pointer to card struct.
  537. * ch = channel (0-based)
  538. */
  539. static void
  540. isdnloop_atimeout(isdnloop_card * card, int ch)
  541. {
  542. unsigned long flags;
  543. char buf[60];
  544. save_flags(flags);
  545. cli();
  546. if (card->rcard) {
  547. isdnloop_fake(card->rcard[ch], "DDIS_I", card->rch[ch] + 1);
  548. card->rcard[ch]->rcard[card->rch[ch]] = NULL;
  549. card->rcard[ch] = NULL;
  550. }
  551. isdnloop_fake(card, "DDIS_I", ch + 1);
  552. /* No user responding */
  553. sprintf(buf, "CAU%s", isdnloop_unicause(card, 1, 3));
  554. isdnloop_fake(card, buf, ch + 1);
  555. restore_flags(flags);
  556. }
  557. /*
  558. * Wrapper for isdnloop_atimeout().
  559. */
  560. static void
  561. isdnloop_atimeout0(unsigned long data)
  562. {
  563. isdnloop_card *card = (isdnloop_card *) data;
  564. isdnloop_atimeout(card, 0);
  565. }
  566. /*
  567. * Wrapper for isdnloop_atimeout().
  568. */
  569. static void
  570. isdnloop_atimeout1(unsigned long data)
  571. {
  572. isdnloop_card *card = (isdnloop_card *) data;
  573. isdnloop_atimeout(card, 1);
  574. }
  575. /*
  576. * Install a watchdog for a user, not responding.
  577. *
  578. * Parameter:
  579. * card = pointer to card struct.
  580. * ch = channel to watch for.
  581. */
  582. static void
  583. isdnloop_start_ctimer(isdnloop_card * card, int ch)
  584. {
  585. unsigned long flags;
  586. save_flags(flags);
  587. cli();
  588. init_timer(&card->c_timer[ch]);
  589. card->c_timer[ch].expires = jiffies + ISDNLOOP_TIMER_ALERTWAIT;
  590. if (ch)
  591. card->c_timer[ch].function = isdnloop_atimeout1;
  592. else
  593. card->c_timer[ch].function = isdnloop_atimeout0;
  594. card->c_timer[ch].data = (unsigned long) card;
  595. add_timer(&card->c_timer[ch]);
  596. restore_flags(flags);
  597. }
  598. /*
  599. * Kill a pending channel watchdog.
  600. *
  601. * Parameter:
  602. * card = pointer to card struct.
  603. * ch = channel (0-based).
  604. */
  605. static void
  606. isdnloop_kill_ctimer(isdnloop_card * card, int ch)
  607. {
  608. unsigned long flags;
  609. save_flags(flags);
  610. cli();
  611. del_timer(&card->c_timer[ch]);
  612. restore_flags(flags);
  613. }
  614. static u_char si2bit[] =
  615. {0, 1, 0, 0, 0, 2, 0, 4, 0, 0};
  616. static u_char bit2si[] =
  617. {1, 5, 7};
  618. /*
  619. * Try finding a listener for an outgoing call.
  620. *
  621. * Parameter:
  622. * card = pointer to calling card.
  623. * p = pointer to ICN-type setup-string.
  624. * lch = channel of calling card.
  625. * cmd = pointer to struct to be filled when parsing setup.
  626. * Return:
  627. * 0 = found match, alerting should happen.
  628. * 1 = found matching number but it is busy.
  629. * 2 = no matching listener.
  630. * 3 = found matching number but SI does not match.
  631. */
  632. static int
  633. isdnloop_try_call(isdnloop_card * card, char *p, int lch, isdn_ctrl * cmd)
  634. {
  635. isdnloop_card *cc = cards;
  636. unsigned long flags;
  637. int ch;
  638. int num_match;
  639. int i;
  640. char *e;
  641. char nbuf[32];
  642. isdnloop_parse_setup(p, cmd);
  643. while (cc) {
  644. for (ch = 0; ch < 2; ch++) {
  645. /* Exclude ourself */
  646. if ((cc == card) && (ch == lch))
  647. continue;
  648. num_match = 0;
  649. switch (cc->ptype) {
  650. case ISDN_PTYPE_EURO:
  651. for (i = 0; i < 3; i++)
  652. if (!(strcmp(cc->s0num[i], cmd->parm.setup.phone)))
  653. num_match = 1;
  654. break;
  655. case ISDN_PTYPE_1TR6:
  656. e = cc->eazlist[ch];
  657. while (*e) {
  658. sprintf(nbuf, "%s%c", cc->s0num[0], *e);
  659. if (!(strcmp(nbuf, cmd->parm.setup.phone)))
  660. num_match = 1;
  661. e++;
  662. }
  663. }
  664. if (num_match) {
  665. save_flags(flags);
  666. cli();
  667. /* channel idle? */
  668. if (!(cc->rcard[ch])) {
  669. /* Check SI */
  670. if (!(si2bit[cmd->parm.setup.si1] & cc->sil[ch])) {
  671. restore_flags(flags);
  672. return 3;
  673. }
  674. /* ch is idle, si and number matches */
  675. cc->rcard[ch] = card;
  676. cc->rch[ch] = lch;
  677. card->rcard[lch] = cc;
  678. card->rch[lch] = ch;
  679. restore_flags(flags);
  680. return 0;
  681. } else {
  682. restore_flags(flags);
  683. /* num matches, but busy */
  684. if (ch == 1)
  685. return 1;
  686. }
  687. }
  688. }
  689. cc = cc->next;
  690. }
  691. return 2;
  692. }
  693. /*
  694. * Depending on D-channel protocol and caller/called, modify
  695. * phone number.
  696. *
  697. * Parameter:
  698. * card = pointer to card struct.
  699. * phone = pointer phone number.
  700. * caller = flag: 1 = caller, 0 = called.
  701. * Return:
  702. * pointer to new phone number.
  703. */
  704. static char *
  705. isdnloop_vstphone(isdnloop_card * card, char *phone, int caller)
  706. {
  707. int i;
  708. static char nphone[30];
  709. if (!card) {
  710. printk("BUG!!!\n");
  711. return "";
  712. }
  713. switch (card->ptype) {
  714. case ISDN_PTYPE_EURO:
  715. if (caller) {
  716. for (i = 0; i < 2; i++)
  717. if (!(strcmp(card->s0num[i], phone)))
  718. return (phone);
  719. return (card->s0num[0]);
  720. }
  721. return (phone);
  722. break;
  723. case ISDN_PTYPE_1TR6:
  724. if (caller) {
  725. sprintf(nphone, "%s%c", card->s0num[0], phone[0]);
  726. return (nphone);
  727. } else
  728. return (&phone[strlen(phone) - 1]);
  729. break;
  730. }
  731. return "";
  732. }
  733. /*
  734. * Parse an ICN-type command string sent to the 'card'.
  735. * Perform misc. actions depending on the command.
  736. *
  737. * Parameter:
  738. * card = pointer to card struct.
  739. */
  740. static void
  741. isdnloop_parse_cmd(isdnloop_card * card)
  742. {
  743. char *p = card->omsg;
  744. isdn_ctrl cmd;
  745. char buf[60];
  746. isdnloop_stat *s = isdnloop_cmd_table;
  747. int action = -1;
  748. int i;
  749. int ch;
  750. if ((card->omsg[0] != '0') && (card->omsg[2] != ';')) {
  751. isdnloop_fake_err(card);
  752. return;
  753. }
  754. ch = card->omsg[1] - '0';
  755. if ((ch < 0) || (ch > 2)) {
  756. isdnloop_fake_err(card);
  757. return;
  758. }
  759. p += 3;
  760. while (s->statstr) {
  761. if (!strncmp(p, s->statstr, strlen(s->statstr))) {
  762. action = s->action;
  763. if (s->command && (ch != 0)) {
  764. isdnloop_fake_err(card);
  765. return;
  766. }
  767. break;
  768. }
  769. s++;
  770. }
  771. if (action == -1)
  772. return;
  773. switch (action) {
  774. case 1:
  775. /* 0x;BCON_R */
  776. if (card->rcard[ch - 1]) {
  777. isdnloop_fake(card->rcard[ch - 1], "BCON_I",
  778. card->rch[ch - 1] + 1);
  779. isdnloop_fake(card, "BCON_C", ch);
  780. }
  781. break;
  782. case 17:
  783. /* 0x;BCON_I */
  784. if (card->rcard[ch - 1]) {
  785. isdnloop_fake(card->rcard[ch - 1], "BCON_C",
  786. card->rch[ch - 1] + 1);
  787. }
  788. break;
  789. case 2:
  790. /* 0x;BDIS_R */
  791. isdnloop_fake(card, "BDIS_C", ch);
  792. if (card->rcard[ch - 1]) {
  793. isdnloop_fake(card->rcard[ch - 1], "BDIS_I",
  794. card->rch[ch - 1] + 1);
  795. }
  796. break;
  797. case 16:
  798. /* 0x;DCON_R */
  799. isdnloop_kill_ctimer(card, ch - 1);
  800. if (card->rcard[ch - 1]) {
  801. isdnloop_kill_ctimer(card->rcard[ch - 1], card->rch[ch - 1]);
  802. isdnloop_fake(card->rcard[ch - 1], "DCON_C",
  803. card->rch[ch - 1] + 1);
  804. isdnloop_fake(card, "DCON_C", ch);
  805. }
  806. break;
  807. case 3:
  808. /* 0x;DDIS_R */
  809. isdnloop_kill_ctimer(card, ch - 1);
  810. if (card->rcard[ch - 1]) {
  811. isdnloop_kill_ctimer(card->rcard[ch - 1], card->rch[ch - 1]);
  812. isdnloop_fake(card->rcard[ch - 1], "DDIS_I",
  813. card->rch[ch - 1] + 1);
  814. card->rcard[ch - 1] = NULL;
  815. }
  816. isdnloop_fake(card, "DDIS_C", ch);
  817. break;
  818. case 4:
  819. /* 0x;DSCA_Rdd,yy,zz,oo */
  820. if (card->ptype != ISDN_PTYPE_1TR6) {
  821. isdnloop_fake_err(card);
  822. return;
  823. }
  824. /* Fall through */
  825. case 5:
  826. /* 0x;DCAL_Rdd,yy,zz,oo */
  827. p += 6;
  828. switch (isdnloop_try_call(card, p, ch - 1, &cmd)) {
  829. case 0:
  830. /* Alerting */
  831. sprintf(buf, "D%s_I%s,%02d,%02d,%s",
  832. (action == 4) ? "SCA" : "CAL",
  833. isdnloop_vstphone(card, cmd.parm.setup.eazmsn, 1),
  834. cmd.parm.setup.si1,
  835. cmd.parm.setup.si2,
  836. isdnloop_vstphone(card->rcard[ch - 1],
  837. cmd.parm.setup.phone, 0));
  838. isdnloop_fake(card->rcard[ch - 1], buf, card->rch[ch - 1] + 1);
  839. /* Fall through */
  840. case 3:
  841. /* si1 does not match, don't alert but start timer */
  842. isdnloop_start_ctimer(card, ch - 1);
  843. break;
  844. case 1:
  845. /* Remote busy */
  846. isdnloop_fake(card, "DDIS_I", ch);
  847. sprintf(buf, "CAU%s", isdnloop_unicause(card, 1, 1));
  848. isdnloop_fake(card, buf, ch);
  849. break;
  850. case 2:
  851. /* No such user */
  852. isdnloop_fake(card, "DDIS_I", ch);
  853. sprintf(buf, "CAU%s", isdnloop_unicause(card, 1, 2));
  854. isdnloop_fake(card, buf, ch);
  855. break;
  856. }
  857. break;
  858. case 6:
  859. /* 0x;EAZC */
  860. card->eazlist[ch - 1][0] = '\0';
  861. break;
  862. case 7:
  863. /* 0x;EAZ */
  864. p += 3;
  865. strcpy(card->eazlist[ch - 1], p);
  866. break;
  867. case 8:
  868. /* 0x;SEEAZ */
  869. sprintf(buf, "EAZ-LIST: %s", card->eazlist[ch - 1]);
  870. isdnloop_fake(card, buf, ch + 1);
  871. break;
  872. case 9:
  873. /* 0x;MSN */
  874. break;
  875. case 10:
  876. /* 0x;MSNALL */
  877. break;
  878. case 11:
  879. /* 0x;SETSIL */
  880. p += 6;
  881. i = 0;
  882. while (strchr("0157", *p)) {
  883. if (i)
  884. card->sil[ch - 1] |= si2bit[*p - '0'];
  885. i = (*p++ == '0');
  886. }
  887. if (*p)
  888. isdnloop_fake_err(card);
  889. break;
  890. case 12:
  891. /* 0x;SEESIL */
  892. sprintf(buf, "SIN-LIST: ");
  893. p = buf + 10;
  894. for (i = 0; i < 3; i++)
  895. if (card->sil[ch - 1] & (1 << i))
  896. p += sprintf(p, "%02d", bit2si[i]);
  897. isdnloop_fake(card, buf, ch + 1);
  898. break;
  899. case 13:
  900. /* 0x;SILC */
  901. card->sil[ch - 1] = 0;
  902. break;
  903. case 14:
  904. /* 00;FV2ON */
  905. break;
  906. case 15:
  907. /* 00;FV2OFF */
  908. break;
  909. }
  910. }
  911. /*
  912. * Put command-strings into the of the 'card'. In reality, execute them
  913. * right in place by calling isdnloop_parse_cmd(). Also copy every
  914. * command to the read message ringbuffer, preceeding it with a '>'.
  915. * These mesagges can be read at /dev/isdnctrl.
  916. *
  917. * Parameter:
  918. * buf = pointer to command buffer.
  919. * len = length of buffer data.
  920. * user = flag: 1 = called form userlevel, 0 called from kernel.
  921. * card = pointer to card struct.
  922. * Return:
  923. * number of bytes transferred (currently always equals len).
  924. */
  925. static int
  926. isdnloop_writecmd(const u_char * buf, int len, int user, isdnloop_card * card)
  927. {
  928. int xcount = 0;
  929. int ocount = 1;
  930. isdn_ctrl cmd;
  931. while (len) {
  932. int count = len;
  933. u_char *p;
  934. u_char msg[0x100];
  935. if (count > 255)
  936. count = 255;
  937. if (user) {
  938. if (copy_from_user(msg, buf, count))
  939. return -EFAULT;
  940. } else
  941. memcpy(msg, buf, count);
  942. isdnloop_putmsg(card, '>');
  943. for (p = msg; count > 0; count--, p++) {
  944. len--;
  945. xcount++;
  946. isdnloop_putmsg(card, *p);
  947. card->omsg[card->optr] = *p;
  948. if (*p == '\n') {
  949. card->omsg[card->optr] = '\0';
  950. card->optr = 0;
  951. isdnloop_parse_cmd(card);
  952. if (len) {
  953. isdnloop_putmsg(card, '>');
  954. ocount++;
  955. }
  956. } else {
  957. if (card->optr < 59)
  958. card->optr++;
  959. }
  960. ocount++;
  961. }
  962. }
  963. cmd.command = ISDN_STAT_STAVAIL;
  964. cmd.driver = card->myid;
  965. cmd.arg = ocount;
  966. card->interface.statcallb(&cmd);
  967. return xcount;
  968. }
  969. /*
  970. * Delete card's pending timers, send STOP to linklevel
  971. */
  972. static void
  973. isdnloop_stopcard(isdnloop_card * card)
  974. {
  975. unsigned long flags;
  976. isdn_ctrl cmd;
  977. save_flags(flags);
  978. cli();
  979. if (card->flags & ISDNLOOP_FLAGS_RUNNING) {
  980. card->flags &= ~ISDNLOOP_FLAGS_RUNNING;
  981. del_timer(&card->st_timer);
  982. del_timer(&card->rb_timer);
  983. del_timer(&card->c_timer[0]);
  984. del_timer(&card->c_timer[1]);
  985. cmd.command = ISDN_STAT_STOP;
  986. cmd.driver = card->myid;
  987. card->interface.statcallb(&cmd);
  988. }
  989. restore_flags(flags);
  990. }
  991. /*
  992. * Stop all cards before unload.
  993. */
  994. static void
  995. isdnloop_stopallcards(void)
  996. {
  997. isdnloop_card *p = cards;
  998. while (p) {
  999. isdnloop_stopcard(p);
  1000. p = p->next;
  1001. }
  1002. }
  1003. /*
  1004. * Start a 'card'. Simulate card's boot message and set the phone
  1005. * number(s) of the virtual 'S0-Interface'. Install D-channel
  1006. * poll timer.
  1007. *
  1008. * Parameter:
  1009. * card = pointer to card struct.
  1010. * sdefp = pointer to struct holding ioctl parameters.
  1011. * Return:
  1012. * 0 on success, -E??? otherwise.
  1013. */
  1014. static int
  1015. isdnloop_start(isdnloop_card * card, isdnloop_sdef * sdefp)
  1016. {
  1017. unsigned long flags;
  1018. isdnloop_sdef sdef;
  1019. int i;
  1020. if (card->flags & ISDNLOOP_FLAGS_RUNNING)
  1021. return -EBUSY;
  1022. if (copy_from_user((char *) &sdef, (char *) sdefp, sizeof(sdef)))
  1023. return -EFAULT;
  1024. save_flags(flags);
  1025. cli();
  1026. switch (sdef.ptype) {
  1027. case ISDN_PTYPE_EURO:
  1028. if (isdnloop_fake(card, "DRV1.23EC-Q.931-CAPI-CNS-BASIS-20.02.96",
  1029. -1)) {
  1030. restore_flags(flags);
  1031. return -ENOMEM;
  1032. }
  1033. card->sil[0] = card->sil[1] = 4;
  1034. if (isdnloop_fake(card, "TEI OK", 0)) {
  1035. restore_flags(flags);
  1036. return -ENOMEM;
  1037. }
  1038. for (i = 0; i < 3; i++)
  1039. strcpy(card->s0num[i], sdef.num[i]);
  1040. break;
  1041. case ISDN_PTYPE_1TR6:
  1042. if (isdnloop_fake(card, "DRV1.04TC-1TR6-CAPI-CNS-BASIS-29.11.95",
  1043. -1)) {
  1044. restore_flags(flags);
  1045. return -ENOMEM;
  1046. }
  1047. card->sil[0] = card->sil[1] = 4;
  1048. if (isdnloop_fake(card, "TEI OK", 0)) {
  1049. restore_flags(flags);
  1050. return -ENOMEM;
  1051. }
  1052. strcpy(card->s0num[0], sdef.num[0]);
  1053. card->s0num[1][0] = '\0';
  1054. card->s0num[2][0] = '\0';
  1055. break;
  1056. default:
  1057. restore_flags(flags);
  1058. printk(KERN_WARNING "isdnloop: Illegal D-channel protocol %d\n",
  1059. sdef.ptype);
  1060. return -EINVAL;
  1061. }
  1062. init_timer(&card->st_timer);
  1063. card->st_timer.expires = jiffies + ISDNLOOP_TIMER_DCREAD;
  1064. card->st_timer.function = isdnloop_polldchan;
  1065. card->st_timer.data = (unsigned long) card;
  1066. add_timer(&card->st_timer);
  1067. card->flags |= ISDNLOOP_FLAGS_RUNNING;
  1068. restore_flags(flags);
  1069. return 0;
  1070. }
  1071. /*
  1072. * Main handler for commands sent by linklevel.
  1073. */
  1074. static int
  1075. isdnloop_command(isdn_ctrl * c, isdnloop_card * card)
  1076. {
  1077. ulong a;
  1078. int i;
  1079. char cbuf[60];
  1080. isdn_ctrl cmd;
  1081. isdnloop_cdef cdef;
  1082. switch (c->command) {
  1083. case ISDN_CMD_IOCTL:
  1084. memcpy(&a, c->parm.num, sizeof(ulong));
  1085. switch (c->arg) {
  1086. case ISDNLOOP_IOCTL_DEBUGVAR:
  1087. return (ulong) card;
  1088. case ISDNLOOP_IOCTL_STARTUP:
  1089. if (!access_ok(VERIFY_READ, (void *) a, sizeof(isdnloop_sdef)))
  1090. return -EFAULT;
  1091. return (isdnloop_start(card, (isdnloop_sdef *) a));
  1092. break;
  1093. case ISDNLOOP_IOCTL_ADDCARD:
  1094. if (copy_from_user((char *)&cdef,
  1095. (char *)a,
  1096. sizeof(cdef)))
  1097. return -EFAULT;
  1098. return (isdnloop_addcard(cdef.id1));
  1099. break;
  1100. case ISDNLOOP_IOCTL_LEASEDCFG:
  1101. if (a) {
  1102. if (!card->leased) {
  1103. card->leased = 1;
  1104. while (card->ptype == ISDN_PTYPE_UNKNOWN)
  1105. schedule_timeout_interruptible(10);
  1106. schedule_timeout_interruptible(10);
  1107. sprintf(cbuf, "00;FV2ON\n01;EAZ1\n02;EAZ2\n");
  1108. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1109. printk(KERN_INFO
  1110. "isdnloop: (%s) Leased-line mode enabled\n",
  1111. CID);
  1112. cmd.command = ISDN_STAT_RUN;
  1113. cmd.driver = card->myid;
  1114. cmd.arg = 0;
  1115. card->interface.statcallb(&cmd);
  1116. }
  1117. } else {
  1118. if (card->leased) {
  1119. card->leased = 0;
  1120. sprintf(cbuf, "00;FV2OFF\n");
  1121. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1122. printk(KERN_INFO
  1123. "isdnloop: (%s) Leased-line mode disabled\n",
  1124. CID);
  1125. cmd.command = ISDN_STAT_RUN;
  1126. cmd.driver = card->myid;
  1127. cmd.arg = 0;
  1128. card->interface.statcallb(&cmd);
  1129. }
  1130. }
  1131. return 0;
  1132. default:
  1133. return -EINVAL;
  1134. }
  1135. break;
  1136. case ISDN_CMD_DIAL:
  1137. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1138. return -ENODEV;
  1139. if (card->leased)
  1140. break;
  1141. if ((c->arg & 255) < ISDNLOOP_BCH) {
  1142. char *p;
  1143. char dial[50];
  1144. char dcode[4];
  1145. a = c->arg;
  1146. p = c->parm.setup.phone;
  1147. if (*p == 's' || *p == 'S') {
  1148. /* Dial for SPV */
  1149. p++;
  1150. strcpy(dcode, "SCA");
  1151. } else
  1152. /* Normal Dial */
  1153. strcpy(dcode, "CAL");
  1154. strcpy(dial, p);
  1155. sprintf(cbuf, "%02d;D%s_R%s,%02d,%02d,%s\n", (int) (a + 1),
  1156. dcode, dial, c->parm.setup.si1,
  1157. c->parm.setup.si2, c->parm.setup.eazmsn);
  1158. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1159. }
  1160. break;
  1161. case ISDN_CMD_ACCEPTD:
  1162. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1163. return -ENODEV;
  1164. if (c->arg < ISDNLOOP_BCH) {
  1165. a = c->arg + 1;
  1166. cbuf[0] = 0;
  1167. switch (card->l2_proto[a - 1]) {
  1168. case ISDN_PROTO_L2_X75I:
  1169. sprintf(cbuf, "%02d;BX75\n", (int) a);
  1170. break;
  1171. #ifdef CONFIG_ISDN_X25
  1172. case ISDN_PROTO_L2_X25DTE:
  1173. sprintf(cbuf, "%02d;BX2T\n", (int) a);
  1174. break;
  1175. case ISDN_PROTO_L2_X25DCE:
  1176. sprintf(cbuf, "%02d;BX2C\n", (int) a);
  1177. break;
  1178. #endif
  1179. case ISDN_PROTO_L2_HDLC:
  1180. sprintf(cbuf, "%02d;BTRA\n", (int) a);
  1181. break;
  1182. }
  1183. if (strlen(cbuf))
  1184. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1185. sprintf(cbuf, "%02d;DCON_R\n", (int) a);
  1186. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1187. }
  1188. break;
  1189. case ISDN_CMD_ACCEPTB:
  1190. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1191. return -ENODEV;
  1192. if (c->arg < ISDNLOOP_BCH) {
  1193. a = c->arg + 1;
  1194. switch (card->l2_proto[a - 1]) {
  1195. case ISDN_PROTO_L2_X75I:
  1196. sprintf(cbuf, "%02d;BCON_R,BX75\n", (int) a);
  1197. break;
  1198. #ifdef CONFIG_ISDN_X25
  1199. case ISDN_PROTO_L2_X25DTE:
  1200. sprintf(cbuf, "%02d;BCON_R,BX2T\n", (int) a);
  1201. break;
  1202. case ISDN_PROTO_L2_X25DCE:
  1203. sprintf(cbuf, "%02d;BCON_R,BX2C\n", (int) a);
  1204. break;
  1205. #endif
  1206. case ISDN_PROTO_L2_HDLC:
  1207. sprintf(cbuf, "%02d;BCON_R,BTRA\n", (int) a);
  1208. break;
  1209. default:
  1210. sprintf(cbuf, "%02d;BCON_R\n", (int) a);
  1211. }
  1212. printk(KERN_DEBUG "isdnloop writecmd '%s'\n", cbuf);
  1213. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1214. break;
  1215. case ISDN_CMD_HANGUP:
  1216. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1217. return -ENODEV;
  1218. if (c->arg < ISDNLOOP_BCH) {
  1219. a = c->arg + 1;
  1220. sprintf(cbuf, "%02d;BDIS_R\n%02d;DDIS_R\n", (int) a, (int) a);
  1221. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1222. }
  1223. break;
  1224. case ISDN_CMD_SETEAZ:
  1225. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1226. return -ENODEV;
  1227. if (card->leased)
  1228. break;
  1229. if (c->arg < ISDNLOOP_BCH) {
  1230. a = c->arg + 1;
  1231. if (card->ptype == ISDN_PTYPE_EURO) {
  1232. sprintf(cbuf, "%02d;MS%s%s\n", (int) a,
  1233. c->parm.num[0] ? "N" : "ALL", c->parm.num);
  1234. } else
  1235. sprintf(cbuf, "%02d;EAZ%s\n", (int) a,
  1236. c->parm.num[0] ? c->parm.num : (u_char *) "0123456789");
  1237. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1238. }
  1239. break;
  1240. case ISDN_CMD_CLREAZ:
  1241. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1242. return -ENODEV;
  1243. if (card->leased)
  1244. break;
  1245. if (c->arg < ISDNLOOP_BCH) {
  1246. a = c->arg + 1;
  1247. if (card->ptype == ISDN_PTYPE_EURO)
  1248. sprintf(cbuf, "%02d;MSNC\n", (int) a);
  1249. else
  1250. sprintf(cbuf, "%02d;EAZC\n", (int) a);
  1251. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1252. }
  1253. break;
  1254. case ISDN_CMD_SETL2:
  1255. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1256. return -ENODEV;
  1257. if ((c->arg & 255) < ISDNLOOP_BCH) {
  1258. a = c->arg;
  1259. switch (a >> 8) {
  1260. case ISDN_PROTO_L2_X75I:
  1261. sprintf(cbuf, "%02d;BX75\n", (int) (a & 255) + 1);
  1262. break;
  1263. #ifdef CONFIG_ISDN_X25
  1264. case ISDN_PROTO_L2_X25DTE:
  1265. sprintf(cbuf, "%02d;BX2T\n", (int) (a & 255) + 1);
  1266. break;
  1267. case ISDN_PROTO_L2_X25DCE:
  1268. sprintf(cbuf, "%02d;BX2C\n", (int) (a & 255) + 1);
  1269. break;
  1270. #endif
  1271. case ISDN_PROTO_L2_HDLC:
  1272. sprintf(cbuf, "%02d;BTRA\n", (int) (a & 255) + 1);
  1273. break;
  1274. case ISDN_PROTO_L2_TRANS:
  1275. sprintf(cbuf, "%02d;BTRA\n", (int) (a & 255) + 1);
  1276. break;
  1277. default:
  1278. return -EINVAL;
  1279. }
  1280. i = isdnloop_writecmd(cbuf, strlen(cbuf), 0, card);
  1281. card->l2_proto[a & 255] = (a >> 8);
  1282. }
  1283. break;
  1284. case ISDN_CMD_SETL3:
  1285. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1286. return -ENODEV;
  1287. return 0;
  1288. default:
  1289. return -EINVAL;
  1290. }
  1291. }
  1292. return 0;
  1293. }
  1294. /*
  1295. * Find card with given driverId
  1296. */
  1297. static inline isdnloop_card *
  1298. isdnloop_findcard(int driverid)
  1299. {
  1300. isdnloop_card *p = cards;
  1301. while (p) {
  1302. if (p->myid == driverid)
  1303. return p;
  1304. p = p->next;
  1305. }
  1306. return (isdnloop_card *) 0;
  1307. }
  1308. /*
  1309. * Wrapper functions for interface to linklevel
  1310. */
  1311. static int
  1312. if_command(isdn_ctrl * c)
  1313. {
  1314. isdnloop_card *card = isdnloop_findcard(c->driver);
  1315. if (card)
  1316. return (isdnloop_command(c, card));
  1317. printk(KERN_ERR
  1318. "isdnloop: if_command called with invalid driverId!\n");
  1319. return -ENODEV;
  1320. }
  1321. static int
  1322. if_writecmd(const u_char __user *buf, int len, int id, int channel)
  1323. {
  1324. isdnloop_card *card = isdnloop_findcard(id);
  1325. if (card) {
  1326. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1327. return -ENODEV;
  1328. return (isdnloop_writecmd(buf, len, 1, card));
  1329. }
  1330. printk(KERN_ERR
  1331. "isdnloop: if_writecmd called with invalid driverId!\n");
  1332. return -ENODEV;
  1333. }
  1334. static int
  1335. if_readstatus(u_char __user *buf, int len, int id, int channel)
  1336. {
  1337. isdnloop_card *card = isdnloop_findcard(id);
  1338. if (card) {
  1339. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1340. return -ENODEV;
  1341. return (isdnloop_readstatus(buf, len, card));
  1342. }
  1343. printk(KERN_ERR
  1344. "isdnloop: if_readstatus called with invalid driverId!\n");
  1345. return -ENODEV;
  1346. }
  1347. static int
  1348. if_sendbuf(int id, int channel, int ack, struct sk_buff *skb)
  1349. {
  1350. isdnloop_card *card = isdnloop_findcard(id);
  1351. if (card) {
  1352. if (!card->flags & ISDNLOOP_FLAGS_RUNNING)
  1353. return -ENODEV;
  1354. /* ack request stored in skb scratch area */
  1355. *(skb->head) = ack;
  1356. return (isdnloop_sendbuf(channel, skb, card));
  1357. }
  1358. printk(KERN_ERR
  1359. "isdnloop: if_sendbuf called with invalid driverId!\n");
  1360. return -ENODEV;
  1361. }
  1362. /*
  1363. * Allocate a new card-struct, initialize it
  1364. * link it into cards-list and register it at linklevel.
  1365. */
  1366. static isdnloop_card *
  1367. isdnloop_initcard(char *id)
  1368. {
  1369. isdnloop_card *card;
  1370. int i;
  1371. if (!(card = (isdnloop_card *) kmalloc(sizeof(isdnloop_card), GFP_KERNEL))) {
  1372. printk(KERN_WARNING
  1373. "isdnloop: (%s) Could not allocate card-struct.\n", id);
  1374. return (isdnloop_card *) 0;
  1375. }
  1376. memset((char *) card, 0, sizeof(isdnloop_card));
  1377. card->interface.owner = THIS_MODULE;
  1378. card->interface.channels = ISDNLOOP_BCH;
  1379. card->interface.hl_hdrlen = 1; /* scratch area for storing ack flag*/
  1380. card->interface.maxbufsize = 4000;
  1381. card->interface.command = if_command;
  1382. card->interface.writebuf_skb = if_sendbuf;
  1383. card->interface.writecmd = if_writecmd;
  1384. card->interface.readstat = if_readstatus;
  1385. card->interface.features = ISDN_FEATURE_L2_X75I |
  1386. #ifdef CONFIG_ISDN_X25
  1387. ISDN_FEATURE_L2_X25DTE |
  1388. ISDN_FEATURE_L2_X25DCE |
  1389. #endif
  1390. ISDN_FEATURE_L2_HDLC |
  1391. ISDN_FEATURE_L3_TRANS |
  1392. ISDN_FEATURE_P_UNKNOWN;
  1393. card->ptype = ISDN_PTYPE_UNKNOWN;
  1394. strlcpy(card->interface.id, id, sizeof(card->interface.id));
  1395. card->msg_buf_write = card->msg_buf;
  1396. card->msg_buf_read = card->msg_buf;
  1397. card->msg_buf_end = &card->msg_buf[sizeof(card->msg_buf) - 1];
  1398. for (i = 0; i < ISDNLOOP_BCH; i++) {
  1399. card->l2_proto[i] = ISDN_PROTO_L2_X75I;
  1400. skb_queue_head_init(&card->bqueue[i]);
  1401. }
  1402. skb_queue_head_init(&card->dqueue);
  1403. card->next = cards;
  1404. cards = card;
  1405. if (!register_isdn(&card->interface)) {
  1406. cards = cards->next;
  1407. printk(KERN_WARNING
  1408. "isdnloop: Unable to register %s\n", id);
  1409. kfree(card);
  1410. return (isdnloop_card *) 0;
  1411. }
  1412. card->myid = card->interface.channels;
  1413. return card;
  1414. }
  1415. static int
  1416. isdnloop_addcard(char *id1)
  1417. {
  1418. isdnloop_card *card;
  1419. if (!(card = isdnloop_initcard(id1))) {
  1420. return -EIO;
  1421. }
  1422. printk(KERN_INFO
  1423. "isdnloop: (%s) virtual card added\n",
  1424. card->interface.id);
  1425. return 0;
  1426. }
  1427. static int __init
  1428. isdnloop_init(void)
  1429. {
  1430. char *p;
  1431. char rev[10];
  1432. if ((p = strchr(revision, ':'))) {
  1433. strcpy(rev, p + 1);
  1434. p = strchr(rev, '$');
  1435. *p = 0;
  1436. } else
  1437. strcpy(rev, " ??? ");
  1438. printk(KERN_NOTICE "isdnloop-ISDN-driver Rev%s\n", rev);
  1439. if (isdnloop_id)
  1440. return (isdnloop_addcard(isdnloop_id));
  1441. return 0;
  1442. }
  1443. static void __exit
  1444. isdnloop_exit(void)
  1445. {
  1446. isdn_ctrl cmd;
  1447. isdnloop_card *card = cards;
  1448. isdnloop_card *last;
  1449. int i;
  1450. isdnloop_stopallcards();
  1451. while (card) {
  1452. cmd.command = ISDN_STAT_UNLOAD;
  1453. cmd.driver = card->myid;
  1454. card->interface.statcallb(&cmd);
  1455. for (i = 0; i < ISDNLOOP_BCH; i++)
  1456. isdnloop_free_queue(card, i);
  1457. card = card->next;
  1458. }
  1459. card = cards;
  1460. while (card) {
  1461. last = card;
  1462. skb_queue_purge(&card->dqueue);
  1463. card = card->next;
  1464. kfree(last);
  1465. }
  1466. printk(KERN_NOTICE "isdnloop-ISDN-driver unloaded\n");
  1467. }
  1468. module_init(isdnloop_init);
  1469. module_exit(isdnloop_exit);