x25_asy.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:21k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * Things to sort out:
  3.  *
  4.  * o tbusy handling
  5.  * o allow users to set the parameters
  6.  * o sync/async switching ?
  7.  *
  8.  * Note: This does _not_ implement CCITT X.25 asynchronous framing
  9.  * recommendations. Its primarily for testing purposes. If you wanted
  10.  * to do CCITT then in theory all you need is to nick the HDLC async
  11.  * checksum routines from ppp.c
  12.  *      Changes:
  13.  *
  14.  * 2000-10-29 Henner Eisen lapb_data_indication() return status.
  15.  */
  16. #include <linux/module.h>
  17. #include <asm/system.h>
  18. #include <asm/uaccess.h>
  19. #include <asm/bitops.h>
  20. #include <linux/string.h>
  21. #include <linux/mm.h>
  22. #include <linux/interrupt.h>
  23. #include <linux/in.h>
  24. #include <linux/tty.h>
  25. #include <linux/errno.h>
  26. #include <linux/netdevice.h>
  27. #include <linux/etherdevice.h>
  28. #include <linux/skbuff.h>
  29. #include <linux/if_arp.h>
  30. #include <linux/x25.h>
  31. #include <linux/lapb.h>
  32. #include <linux/init.h>
  33. #include "x25_asy.h"
  34. typedef struct x25_ctrl {
  35. struct x25_asy ctrl; /* X.25 things */
  36. struct net_device dev; /* the device */
  37. } x25_asy_ctrl_t;
  38. static x25_asy_ctrl_t **x25_asy_ctrls = NULL;
  39. int x25_asy_maxdev = SL_NRUNIT; /* Can be overridden with insmod! */
  40. MODULE_PARM(x25_asy_maxdev, "i");
  41. MODULE_LICENSE("GPL");
  42. static struct tty_ldisc x25_ldisc;
  43. static int x25_asy_esc(unsigned char *p, unsigned char *d, int len);
  44. static void x25_asy_unesc(struct x25_asy *sl, unsigned char c);
  45. /* Find a free X.25 channel, and link in this `tty' line. */
  46. static inline struct x25_asy *x25_asy_alloc(void)
  47. {
  48. x25_asy_ctrl_t *slp = NULL;
  49. int i;
  50. if (x25_asy_ctrls == NULL)
  51. return NULL; /* Master array missing ! */
  52. for (i = 0; i < x25_asy_maxdev; i++) 
  53. {
  54. slp = x25_asy_ctrls[i];
  55. /* Not allocated ? */
  56. if (slp == NULL)
  57. break;
  58. /* Not in use ? */
  59. if (!test_and_set_bit(SLF_INUSE, &slp->ctrl.flags))
  60. break;
  61. }
  62. /* SLP is set.. */
  63. /* Sorry, too many, all slots in use */
  64. if (i >= x25_asy_maxdev)
  65. return NULL;
  66. /* If no channels are available, allocate one */
  67. if (!slp &&
  68.     (x25_asy_ctrls[i] = (x25_asy_ctrl_t *)kmalloc(sizeof(x25_asy_ctrl_t),
  69.     GFP_KERNEL)) != NULL) {
  70. slp = x25_asy_ctrls[i];
  71. memset(slp, 0, sizeof(x25_asy_ctrl_t));
  72. /* Initialize channel control data */
  73. set_bit(SLF_INUSE, &slp->ctrl.flags);
  74. slp->ctrl.tty         = NULL;
  75. sprintf(slp->dev.name, "x25asy%d", i);
  76. slp->dev.base_addr    = i;
  77. slp->dev.priv         = (void*)&(slp->ctrl);
  78. slp->dev.next         = NULL;
  79. slp->dev.init         = x25_asy_init;
  80. }
  81. if (slp != NULL) 
  82. {
  83. /* register device so that it can be ifconfig'ed       */
  84. /* x25_asy_init() will be called as a side-effect      */
  85. /* SIDE-EFFECT WARNING: x25_asy_init() CLEARS slp->ctrl ! */
  86. if (register_netdev(&(slp->dev)) == 0) 
  87. {
  88. /* (Re-)Set the INUSE bit.   Very Important! */
  89. set_bit(SLF_INUSE, &slp->ctrl.flags);
  90. slp->ctrl.dev = &(slp->dev);
  91. slp->dev.priv = (void*)&(slp->ctrl);
  92. return (&(slp->ctrl));
  93. }
  94. else
  95. {
  96. clear_bit(SLF_INUSE,&(slp->ctrl.flags));
  97. printk("x25_asy_alloc() - register_netdev() failure.n");
  98. }
  99. }
  100. return NULL;
  101. }
  102. /* Free an X.25 channel. */
  103. static inline void x25_asy_free(struct x25_asy *sl)
  104. {
  105. /* Free all X.25 frame buffers. */
  106. if (sl->rbuff)  {
  107. kfree(sl->rbuff);
  108. }
  109. sl->rbuff = NULL;
  110. if (sl->xbuff)  {
  111. kfree(sl->xbuff);
  112. }
  113. sl->xbuff = NULL;
  114. if (!test_and_clear_bit(SLF_INUSE, &sl->flags)) {
  115. printk("%s: x25_asy_free for already free unit.n", sl->dev->name);
  116. }
  117. }
  118. /* MTU has been changed by the IP layer. Unfortunately we are not told
  119.    about this, but we spot it ourselves and fix things up. We could be
  120.    in an upcall from the tty driver, or in an ip packet queue. */
  121. static void x25_asy_changed_mtu(struct x25_asy *sl)
  122. {
  123. struct net_device *dev = sl->dev;
  124. unsigned char *xbuff, *rbuff, *oxbuff, *orbuff;
  125. int len;
  126. unsigned long flags;
  127. len = dev->mtu * 2;
  128. xbuff = (unsigned char *) kmalloc (len + 4, GFP_ATOMIC);
  129. rbuff = (unsigned char *) kmalloc (len + 4, GFP_ATOMIC);
  130. if (xbuff == NULL || rbuff == NULL)  
  131. {
  132. printk("%s: unable to grow X.25 buffers, MTU change cancelled.n",
  133.        sl->dev->name);
  134. dev->mtu = sl->mtu;
  135. if (xbuff != NULL)  
  136. kfree(xbuff);
  137. if (rbuff != NULL)  
  138. kfree(rbuff);
  139. return;
  140. }
  141. save_flags(flags); 
  142. cli();
  143. oxbuff    = sl->xbuff;
  144. sl->xbuff = xbuff;
  145. orbuff    = sl->rbuff;
  146. sl->rbuff = rbuff;
  147. if (sl->xleft)  {
  148. if (sl->xleft <= len)  {
  149. memcpy(sl->xbuff, sl->xhead, sl->xleft);
  150. } else  {
  151. sl->xleft = 0;
  152. sl->tx_dropped++;
  153. }
  154. }
  155. sl->xhead = sl->xbuff;
  156. if (sl->rcount)  {
  157. if (sl->rcount <= len) {
  158. memcpy(sl->rbuff, orbuff, sl->rcount);
  159. } else  {
  160. sl->rcount = 0;
  161. sl->rx_over_errors++;
  162. set_bit(SLF_ERROR, &sl->flags);
  163. }
  164. }
  165. sl->mtu      = dev->mtu;
  166. sl->buffsize = len;
  167. restore_flags(flags);
  168. if (oxbuff != NULL) 
  169. kfree(oxbuff);
  170. if (orbuff != NULL)
  171. kfree(orbuff);
  172. }
  173. /* Set the "sending" flag.  This must be atomic, hence the ASM. */
  174. static inline void x25_asy_lock(struct x25_asy *sl)
  175. {
  176. netif_stop_queue(sl->dev);
  177. }
  178. /* Clear the "sending" flag.  This must be atomic, hence the ASM. */
  179. static inline void x25_asy_unlock(struct x25_asy *sl)
  180. {
  181. netif_wake_queue(sl->dev);
  182. }
  183. /* Send one completely decapsulated IP datagram to the IP layer. */
  184. static void x25_asy_bump(struct x25_asy *sl)
  185. {
  186. struct sk_buff *skb;
  187. int count;
  188. int err;
  189. count = sl->rcount;
  190. sl->rx_bytes+=count;
  191. skb = dev_alloc_skb(count+1);
  192. if (skb == NULL)  
  193. {
  194. printk("%s: memory squeeze, dropping packet.n", sl->dev->name);
  195. sl->rx_dropped++;
  196. return;
  197. }
  198. skb_push(skb,1); /* LAPB internal control */
  199. skb->dev = sl->dev;
  200. memcpy(skb_put(skb,count), sl->rbuff, count);
  201. skb->mac.raw=skb->data;
  202. skb->protocol=htons(ETH_P_X25);
  203. if((err=lapb_data_received(sl,skb))!=LAPB_OK)
  204. {
  205. kfree_skb(skb);
  206. printk(KERN_DEBUG "x25_asy: data received err - %dn",err);
  207. }
  208. else
  209. {
  210. netif_rx(skb);
  211. sl->rx_packets++;
  212. }
  213. }
  214. /* Encapsulate one IP datagram and stuff into a TTY queue. */
  215. static void x25_asy_encaps(struct x25_asy *sl, unsigned char *icp, int len)
  216. {
  217. unsigned char *p;
  218. int actual, count;
  219. if (sl->mtu != sl->dev->mtu) { /* Someone has been ifconfigging */
  220. x25_asy_changed_mtu(sl);
  221. }
  222. if (len > sl->mtu) 
  223. { /* Sigh, shouldn't occur BUT ... */
  224. len = sl->mtu;
  225. printk ("%s: truncating oversized transmit packet!n", sl->dev->name);
  226. sl->tx_dropped++;
  227. x25_asy_unlock(sl);
  228. return;
  229. }
  230. p = icp;
  231. count = x25_asy_esc(p, (unsigned char *) sl->xbuff, len);
  232. /* Order of next two lines is *very* important.
  233.  * When we are sending a little amount of data,
  234.  * the transfer may be completed inside driver.write()
  235.  * routine, because it's running with interrupts enabled.
  236.  * In this case we *never* got WRITE_WAKEUP event,
  237.  * if we did not request it before write operation.
  238.  *       14 Oct 1994  Dmitry Gorodchanin.
  239.  */
  240. sl->tty->flags |= (1 << TTY_DO_WRITE_WAKEUP);
  241. actual = sl->tty->driver.write(sl->tty, 0, sl->xbuff, count);
  242. sl->xleft = count - actual;
  243. sl->xhead = sl->xbuff + actual;
  244. /* VSV */
  245. clear_bit(SLF_OUTWAIT, &sl->flags); /* reset outfill flag */
  246. }
  247. /*
  248.  * Called by the driver when there's room for more data.  If we have
  249.  * more packets to send, we send them here.
  250.  */
  251. static void x25_asy_write_wakeup(struct tty_struct *tty)
  252. {
  253. int actual;
  254. struct x25_asy *sl = (struct x25_asy *) tty->disc_data;
  255. /* First make sure we're connected. */
  256. if (!sl || sl->magic != X25_ASY_MAGIC || !netif_running(sl->dev))
  257. return;
  258. if (sl->xleft <= 0)  
  259. {
  260. /* Now serial buffer is almost free & we can start
  261.  * transmission of another packet */
  262. sl->tx_packets++;
  263. tty->flags &= ~(1 << TTY_DO_WRITE_WAKEUP);
  264. x25_asy_unlock(sl);
  265. return;
  266. }
  267. actual = tty->driver.write(tty, 0, sl->xhead, sl->xleft);
  268. sl->xleft -= actual;
  269. sl->xhead += actual;
  270. }
  271. static void x25_asy_timeout(struct net_device *dev)
  272. {
  273. struct x25_asy *sl = (struct x25_asy*)(dev->priv);
  274. /* May be we must check transmitter timeout here ?
  275.  *      14 Oct 1994 Dmitry Gorodchanin.
  276.  */
  277. printk(KERN_WARNING "%s: transmit timed out, %s?n", dev->name,
  278.        (sl->tty->driver.chars_in_buffer(sl->tty) || sl->xleft) ?
  279.        "bad line quality" : "driver error");
  280. sl->xleft = 0;
  281. sl->tty->flags &= ~(1 << TTY_DO_WRITE_WAKEUP);
  282. x25_asy_unlock(sl);
  283. }
  284. /* Encapsulate an IP datagram and kick it into a TTY queue. */
  285. static int x25_asy_xmit(struct sk_buff *skb, struct net_device *dev)
  286. {
  287. struct x25_asy *sl = (struct x25_asy*)(dev->priv);
  288. int err;
  289. if (!netif_running(sl->dev))
  290. {
  291. printk("%s: xmit call when iface is downn", dev->name);
  292. return 1;
  293. }
  294. switch(skb->data[0])
  295. {
  296. case 0x00:break;
  297. case 0x01: /* Connection request .. do nothing */
  298. if((err=lapb_connect_request(sl))!=LAPB_OK)
  299. printk(KERN_ERR "x25_asy: lapb_connect_request error - %dn", err);
  300. kfree_skb(skb);
  301. return 0;
  302. case 0x02: /* Disconnect request .. do nothing - hang up ?? */
  303. if((err=lapb_disconnect_request(sl))!=LAPB_OK)
  304. printk(KERN_ERR "x25_asy: lapb_disconnect_request error - %dn", err);
  305. default:
  306. kfree_skb(skb);
  307. return  0;
  308. }
  309. skb_pull(skb,1); /* Remove control byte */
  310. /*
  311.  * If we are busy already- too bad.  We ought to be able
  312.  * to queue things at this point, to allow for a little
  313.  * frame buffer.  Oh well...
  314.  * -----------------------------------------------------
  315.  * I hate queues in X.25 driver. May be it's efficient,
  316.  * but for me latency is more important. ;)
  317.  * So, no queues !
  318.  *        14 Oct 1994  Dmitry Gorodchanin.
  319.  */
  320. if((err=lapb_data_request(sl,skb))!=LAPB_OK)
  321. {
  322. printk(KERN_ERR "lapbeth: lapb_data_request error - %dn", err);
  323. kfree_skb(skb);
  324. return 0;
  325. }
  326. return 0;
  327. }
  328. /*
  329.  * LAPB interface boilerplate
  330.  */
  331. /*
  332.  * Called when I frame data arrives. We did the work above - throw it
  333.  * at the net layer.
  334.  */
  335.   
  336. static int x25_asy_data_indication(void *token, struct sk_buff *skb)
  337. {
  338. return netif_rx(skb);
  339. }
  340. /*
  341.  * Data has emerged from the LAPB protocol machine. We don't handle
  342.  * busy cases too well. Its tricky to see how to do this nicely -
  343.  * perhaps lapb should allow us to bounce this ?
  344.  */
  345.  
  346. static void x25_asy_data_transmit(void *token, struct sk_buff *skb)
  347. {
  348. struct x25_asy *sl=token;
  349. if (netif_queue_stopped(sl->dev))
  350. {
  351. printk(KERN_ERR "x25_asy: tbusy dropn");
  352. kfree_skb(skb);
  353. return;
  354. }
  355. /* We were not busy, so we are now... :-) */
  356. if (skb != NULL) 
  357. {
  358. x25_asy_lock(sl);
  359. sl->tx_bytes+=skb->len;
  360. x25_asy_encaps(sl, skb->data, skb->len);
  361. dev_kfree_skb(skb);
  362. }
  363. }
  364. /*
  365.  * LAPB connection establish/down information.
  366.  */
  367.  
  368. static void x25_asy_connected(void *token, int reason)
  369. {
  370. struct x25_asy *sl = token;
  371. struct sk_buff *skb;
  372. unsigned char *ptr;
  373. if ((skb = dev_alloc_skb(1)) == NULL) {
  374. printk(KERN_ERR "lapbeth: out of memoryn");
  375. return;
  376. }
  377. ptr  = skb_put(skb, 1);
  378. *ptr = 0x01;
  379. skb->dev      = sl->dev;
  380. skb->protocol = htons(ETH_P_X25);
  381. skb->mac.raw  = skb->data;
  382. skb->pkt_type = PACKET_HOST;
  383. netif_rx(skb);
  384. }
  385. static void x25_asy_disconnected(void *token, int reason)
  386. {
  387. struct x25_asy *sl = token;
  388. struct sk_buff *skb;
  389. unsigned char *ptr;
  390. if ((skb = dev_alloc_skb(1)) == NULL) {
  391. printk(KERN_ERR "x25_asy: out of memoryn");
  392. return;
  393. }
  394. ptr  = skb_put(skb, 1);
  395. *ptr = 0x02;
  396. skb->dev      = sl->dev;
  397. skb->protocol = htons(ETH_P_X25);
  398. skb->mac.raw  = skb->data;
  399. skb->pkt_type = PACKET_HOST;
  400. netif_rx(skb);
  401. }
  402. /* Open the low-level part of the X.25 channel. Easy! */
  403. static int x25_asy_open(struct net_device *dev)
  404. {
  405. struct lapb_register_struct x25_asy_callbacks;
  406. struct x25_asy *sl = (struct x25_asy*)(dev->priv);
  407. unsigned long len;
  408. int err;
  409. if (sl->tty == NULL)
  410. return -ENODEV;
  411. /*
  412.  * Allocate the X.25 frame buffers:
  413.  *
  414.  * rbuff Receive buffer.
  415.  * xbuff Transmit buffer.
  416.  */
  417. len = dev->mtu * 2;
  418. sl->rbuff = (unsigned char *) kmalloc(len + 4, GFP_KERNEL);
  419. if (sl->rbuff == NULL)   {
  420. goto norbuff;
  421. }
  422. sl->xbuff = (unsigned char *) kmalloc(len + 4, GFP_KERNEL);
  423. if (sl->xbuff == NULL)   {
  424. goto noxbuff;
  425. }
  426. sl->mtu      = dev->mtu;
  427. sl->buffsize = len;
  428. sl->rcount   = 0;
  429. sl->xleft    = 0;
  430. sl->flags   &= (1 << SLF_INUSE);      /* Clear ESCAPE & ERROR flags */
  431. netif_start_queue(dev);
  432. /*
  433.  * Now attach LAPB
  434.  */
  435.  
  436. x25_asy_callbacks.connect_confirmation=x25_asy_connected;
  437. x25_asy_callbacks.connect_indication=x25_asy_connected;
  438. x25_asy_callbacks.disconnect_confirmation=x25_asy_disconnected;
  439. x25_asy_callbacks.disconnect_indication=x25_asy_disconnected;
  440. x25_asy_callbacks.data_indication=x25_asy_data_indication;
  441. x25_asy_callbacks.data_transmit=x25_asy_data_transmit;
  442. if((err=lapb_register(sl, &x25_asy_callbacks))==LAPB_OK)
  443. return 0;
  444. /* Cleanup */
  445. kfree(sl->xbuff);
  446. noxbuff:
  447. kfree(sl->rbuff);
  448. norbuff:
  449. return -ENOMEM;
  450. }
  451. /* Close the low-level part of the X.25 channel. Easy! */
  452. static int x25_asy_close(struct net_device *dev)
  453. {
  454. struct x25_asy *sl = (struct x25_asy*)(dev->priv);
  455. int err;
  456. if (sl->tty == NULL)
  457. return -EBUSY;
  458. sl->tty->flags &= ~(1 << TTY_DO_WRITE_WAKEUP);
  459. netif_stop_queue(dev);
  460. if((err=lapb_unregister(sl))!=LAPB_OK)
  461. printk(KERN_ERR "x25_asy_close: lapb_unregister error -%dn",err);
  462. return 0;
  463. }
  464. static int x25_asy_receive_room(struct tty_struct *tty)
  465. {
  466. return 65536;  /* We can handle an infinite amount of data. :-) */
  467. }
  468. /*
  469.  * Handle the 'receiver data ready' interrupt.
  470.  * This function is called by the 'tty_io' module in the kernel when
  471.  * a block of X.25 data has been received, which can now be decapsulated
  472.  * and sent on to some IP layer for further processing.
  473.  */
  474.  
  475. static void x25_asy_receive_buf(struct tty_struct *tty, const unsigned char *cp, char *fp, int count)
  476. {
  477. struct x25_asy *sl = (struct x25_asy *) tty->disc_data;
  478. if (!sl || sl->magic != X25_ASY_MAGIC || !netif_running(sl->dev))
  479. return;
  480. /*
  481.  * Argh! mtu change time! - costs us the packet part received
  482.  * at the change
  483.  */
  484. if (sl->mtu != sl->dev->mtu)  {
  485. x25_asy_changed_mtu(sl);
  486. }
  487. /* Read the characters out of the buffer */
  488. while (count--) {
  489. if (fp && *fp++) {
  490. if (!test_and_set_bit(SLF_ERROR, &sl->flags))  {
  491. sl->rx_errors++;
  492. }
  493. cp++;
  494. continue;
  495. }
  496. x25_asy_unesc(sl, *cp++);
  497. }
  498. }
  499. /*
  500.  * Open the high-level part of the X.25 channel.
  501.  * This function is called by the TTY module when the
  502.  * X.25 line discipline is called for.  Because we are
  503.  * sure the tty line exists, we only have to link it to
  504.  * a free X.25 channel...
  505.  */
  506. static int x25_asy_open_tty(struct tty_struct *tty)
  507. {
  508. struct x25_asy *sl = (struct x25_asy *) tty->disc_data;
  509. int err;
  510. /* First make sure we're not already connected. */
  511. if (sl && sl->magic == X25_ASY_MAGIC) {
  512. return -EEXIST;
  513. }
  514. /* OK.  Find a free X.25 channel to use. */
  515. if ((sl = x25_asy_alloc()) == NULL) {
  516. return -ENFILE;
  517. }
  518. sl->tty = tty;
  519. tty->disc_data = sl;
  520. if (tty->driver.flush_buffer)  {
  521. tty->driver.flush_buffer(tty);
  522. }
  523. if (tty->ldisc.flush_buffer)  {
  524. tty->ldisc.flush_buffer(tty);
  525. }
  526. /* Restore default settings */
  527. sl->dev->type = ARPHRD_X25;
  528. /* Perform the low-level X.25 async init */
  529. if ((err = x25_asy_open(sl->dev)))
  530. return err;
  531. MOD_INC_USE_COUNT;
  532. /* Done.  We have linked the TTY line to a channel. */
  533. return sl->dev->base_addr;
  534. }
  535. /*
  536.  * Close down an X.25 channel.
  537.  * This means flushing out any pending queues, and then restoring the
  538.  * TTY line discipline to what it was before it got hooked to X.25
  539.  * (which usually is TTY again).
  540.  */
  541. static void x25_asy_close_tty(struct tty_struct *tty)
  542. {
  543. struct x25_asy *sl = (struct x25_asy *) tty->disc_data;
  544. /* First make sure we're connected. */
  545. if (!sl || sl->magic != X25_ASY_MAGIC)
  546. return;
  547. if (sl->dev->flags & IFF_UP)
  548. {
  549. (void) dev_close(sl->dev);
  550. }
  551. tty->disc_data = 0;
  552. sl->tty = NULL;
  553. x25_asy_free(sl);
  554. unregister_netdev(sl->dev);
  555. MOD_DEC_USE_COUNT;
  556. }
  557. static struct net_device_stats *x25_asy_get_stats(struct net_device *dev)
  558. {
  559. static struct net_device_stats stats;
  560. struct x25_asy *sl = (struct x25_asy*)(dev->priv);
  561. memset(&stats, 0, sizeof(struct net_device_stats));
  562. stats.rx_packets     = sl->rx_packets;
  563. stats.tx_packets     = sl->tx_packets;
  564. stats.rx_bytes      = sl->rx_bytes;
  565. stats.tx_bytes      = sl->tx_bytes;
  566. stats.rx_dropped     = sl->rx_dropped;
  567. stats.tx_dropped     = sl->tx_dropped;
  568. stats.tx_errors      = sl->tx_errors;
  569. stats.rx_errors      = sl->rx_errors;
  570. stats.rx_over_errors = sl->rx_over_errors;
  571. return (&stats);
  572. }
  573.  /************************************************************************
  574.   * STANDARD X.25 ENCAPSULATION     *
  575.   ************************************************************************/
  576. int x25_asy_esc(unsigned char *s, unsigned char *d, int len)
  577. {
  578. unsigned char *ptr = d;
  579. unsigned char c;
  580. /*
  581.  * Send an initial END character to flush out any
  582.  * data that may have accumulated in the receiver
  583.  * due to line noise.
  584.  */
  585. *ptr++ = X25_END; /* Send 10111110 bit seq */
  586. /*
  587.  * For each byte in the packet, send the appropriate
  588.  * character sequence, according to the X.25 protocol.
  589.  */
  590. while (len-- > 0) 
  591. {
  592. switch(c = *s++) 
  593. {
  594. case X25_END:
  595. *ptr++ = X25_ESC;
  596. *ptr++ = X25_ESCAPE(X25_END);
  597. break;
  598. case X25_ESC:
  599. *ptr++ = X25_ESC;
  600. *ptr++ = X25_ESCAPE(X25_ESC);
  601. break;
  602.  default:
  603. *ptr++ = c;
  604. break;
  605. }
  606. }
  607. *ptr++ = X25_END;
  608. return (ptr - d);
  609. }
  610. static void x25_asy_unesc(struct x25_asy *sl, unsigned char s)
  611. {
  612. switch(s) 
  613. {
  614. case X25_END:
  615. if (!test_and_clear_bit(SLF_ERROR, &sl->flags) && (sl->rcount > 2))  
  616. {
  617. x25_asy_bump(sl);
  618. }
  619. clear_bit(SLF_ESCAPE, &sl->flags);
  620. sl->rcount = 0;
  621. return;
  622. case X25_ESC:
  623. set_bit(SLF_ESCAPE, &sl->flags);
  624. return;
  625. case X25_ESCAPE(X25_ESC):
  626. case X25_ESCAPE(X25_END):
  627. if (test_and_clear_bit(SLF_ESCAPE, &sl->flags))
  628. s = X25_UNESCAPE(s);
  629. break;
  630. }
  631. if (!test_bit(SLF_ERROR, &sl->flags))  
  632. {
  633. if (sl->rcount < sl->buffsize)  
  634. {
  635. sl->rbuff[sl->rcount++] = s;
  636. return;
  637. }
  638. sl->rx_over_errors++;
  639. set_bit(SLF_ERROR, &sl->flags);
  640. }
  641. }
  642. /* Perform I/O control on an active X.25 channel. */
  643. static int x25_asy_ioctl(struct tty_struct *tty, void *file, int cmd, void *arg)
  644. {
  645. struct x25_asy *sl = (struct x25_asy *) tty->disc_data;
  646. /* First make sure we're connected. */
  647. if (!sl || sl->magic != X25_ASY_MAGIC) {
  648. return -EINVAL;
  649. }
  650. switch(cmd) 
  651. {
  652. case SIOCGIFNAME:
  653. if(copy_to_user(arg, sl->dev->name, strlen(sl->dev->name) + 1))
  654. return -EFAULT;
  655. return 0;
  656. case SIOCSIFHWADDR:
  657. return -EINVAL;
  658. /* Allow stty to read, but not set, the serial port */
  659. case TCGETS:
  660. case TCGETA:
  661. return n_tty_ioctl(tty, (struct file *) file, cmd, (unsigned long) arg);
  662. default:
  663. return -ENOIOCTLCMD;
  664. }
  665. }
  666. static int x25_asy_open_dev(struct net_device *dev)
  667. {
  668. struct x25_asy *sl = (struct x25_asy*)(dev->priv);
  669. if(sl->tty==NULL)
  670. return -ENODEV;
  671. return 0;
  672. }
  673. /* Initialize X.25 control device -- register X.25 line discipline */
  674. int __init x25_asy_init_ctrl_dev(void)
  675. {
  676. int status;
  677. if (x25_asy_maxdev < 4) x25_asy_maxdev = 4; /* Sanity */
  678. printk(KERN_INFO "X.25 async: version 0.00 ALPHA (dynamic channels, max=%d).n",
  679. x25_asy_maxdev );
  680. x25_asy_ctrls = (x25_asy_ctrl_t **) kmalloc(sizeof(void*)*x25_asy_maxdev, GFP_KERNEL);
  681. if (x25_asy_ctrls == NULL)
  682. {
  683. printk("X25 async: Can't allocate x25_asy_ctrls[] array!  Uaargh! (-> No X.25 available)n");
  684. return -ENOMEM;
  685. }
  686. /* Clear the pointer array, we allocate devices when we need them */
  687. memset(x25_asy_ctrls, 0, sizeof(void*)*x25_asy_maxdev); /* Pointers */
  688. /* Fill in our line protocol discipline, and register it */
  689. memset(&x25_ldisc, 0, sizeof(x25_ldisc));
  690. x25_ldisc.magic  = TTY_LDISC_MAGIC;
  691. x25_ldisc.name   = "X.25";
  692. x25_ldisc.flags  = 0;
  693. x25_ldisc.open   = x25_asy_open_tty;
  694. x25_ldisc.close  = x25_asy_close_tty;
  695. x25_ldisc.read   = NULL;
  696. x25_ldisc.write  = NULL;
  697. x25_ldisc.ioctl  = (int (*)(struct tty_struct *, struct file *,
  698.    unsigned int, unsigned long)) x25_asy_ioctl;
  699. x25_ldisc.poll   = NULL;
  700. x25_ldisc.receive_buf = x25_asy_receive_buf;
  701. x25_ldisc.receive_room = x25_asy_receive_room;
  702. x25_ldisc.write_wakeup = x25_asy_write_wakeup;
  703. if ((status = tty_register_ldisc(N_X25, &x25_ldisc)) != 0)  {
  704. printk("X.25 async: can't register line discipline (err = %d)n", status);
  705. }
  706. return status;
  707. }
  708. /* Initialise the X.25 driver.  Called by the device init code */
  709. int x25_asy_init(struct net_device *dev)
  710. {
  711. struct x25_asy *sl = (struct x25_asy*)(dev->priv);
  712. if (sl == NULL) /* Allocation failed ?? */
  713. return -ENODEV;
  714. /* Set up the control block. (And clear statistics) */
  715. memset(sl, 0, sizeof (struct x25_asy));
  716. sl->magic  = X25_ASY_MAGIC;
  717. sl->dev    = dev;
  718. /*
  719.  * Finish setting up the DEVICE info. 
  720.  */
  721.  
  722. dev->mtu = SL_MTU;
  723. dev->hard_start_xmit = x25_asy_xmit;
  724. dev->tx_timeout = x25_asy_timeout;
  725. dev->watchdog_timeo = HZ*20;
  726. dev->open = x25_asy_open_dev;
  727. dev->stop = x25_asy_close;
  728. dev->get_stats         = x25_asy_get_stats;
  729. dev->hard_header_len = 0;
  730. dev->addr_len = 0;
  731. dev->type = ARPHRD_X25;
  732. dev->tx_queue_len = 10;
  733. /* New-style flags. */
  734. dev->flags = IFF_NOARP;
  735. return 0;
  736. }
  737. #ifdef MODULE
  738. int
  739. init_module(void)
  740. {
  741. return x25_asy_init_ctrl_dev();
  742. }
  743. void
  744. cleanup_module(void)
  745. {
  746. int i;
  747. if (x25_asy_ctrls != NULL)
  748. {
  749. for (i = 0; i < x25_asy_maxdev; i++)
  750. {
  751. if (x25_asy_ctrls[i])
  752. {
  753. /*
  754.  * VSV = if dev->start==0, then device
  755.  * unregistered while close proc.
  756.  */
  757. if (netif_running(&(x25_asy_ctrls[i]->dev)))
  758. unregister_netdev(&(x25_asy_ctrls[i]->dev));
  759. kfree(x25_asy_ctrls[i]);
  760. x25_asy_ctrls[i] = NULL;
  761. }
  762. }
  763. kfree(x25_asy_ctrls);
  764. x25_asy_ctrls = NULL;
  765. }
  766. if ((i = tty_register_ldisc(N_X25, NULL)))
  767. {
  768. printk("X.25 async: can't unregister line discipline (err = %d)n", i);
  769. }
  770. }
  771. #endif /* MODULE */