git.oblomov.eu Git - linux-2.6/blob - drivers/net/slip.c

   1 /*
   2  * slip.c       This module implements the SLIP protocol for kernel-based
   3  *              devices like TTY.  It interfaces between a raw TTY, and the
   4  *              kernel's INET protocol layers.
   5  *
   6  * Version:     @(#)slip.c      0.8.3   12/24/94
   7  *
   8  * Authors:     Laurence Culhane, <loz@holmes.demon.co.uk>
   9  *              Fred N. van Kempen, <waltje@uwalt.nl.mugnet.org>
  10  *
  11  * Fixes:
  12  *              Alan Cox        :       Sanity checks and avoid tx overruns.
  13  *                                      Has a new sl->mtu field.
  14  *              Alan Cox        :       Found cause of overrun. ifconfig sl0 mtu upwards.
  15  *                                      Driver now spots this and grows/shrinks its buffers(hack!).
  16  *                                      Memory leak if you run out of memory setting up a slip driver fixed.
  17  *              Matt Dillon     :       Printable slip (borrowed from NET2E)
  18  *      Pauline Middelink       :       Slip driver fixes.
  19  *              Alan Cox        :       Honours the old SL_COMPRESSED flag
  20  *              Alan Cox        :       KISS AX.25 and AXUI IP support
  21  *              Michael Riepe   :       Automatic CSLIP recognition added
  22  *              Charles Hedrick :       CSLIP header length problem fix.
  23  *              Alan Cox        :       Corrected non-IP cases of the above.
  24  *              Alan Cox        :       Now uses hardware type as per FvK.
  25  *              Alan Cox        :       Default to 192.168.0.0 (RFC 1597)
  26  *              A.N.Kuznetsov   :       dev_tint() recursion fix.
  27  *      Dmitry Gorodchanin      :       SLIP memory leaks
  28  *      Dmitry Gorodchanin      :       Code cleanup. Reduce tty driver
  29  *                                      buffering from 4096 to 256 bytes.
  30  *                                      Improving SLIP response time.
  31  *                                      CONFIG_SLIP_MODE_SLIP6.
  32  *                                      ifconfig sl? up & down now works correctly.
  33  *                                      Modularization.
  34  *              Alan Cox        :       Oops - fix AX.25 buffer lengths
  35  *      Dmitry Gorodchanin      :       Even more cleanups. Preserve CSLIP
  36  *                                      statistics. Include CSLIP code only
  37  *                                      if it really needed.
  38  *              Alan Cox        :       Free slhc buffers in the right place.
  39  *              Alan Cox        :       Allow for digipeated IP over AX.25
  40  *              Matti Aarnio    :       Dynamic SLIP devices, with ideas taken
  41  *                                      from Jim Freeman's <jfree@caldera.com>
  42  *                                      dynamic PPP devices.  We do NOT kfree()
  43  *                                      device entries, just reg./unreg. them
  44  *                                      as they are needed.  We kfree() them
  45  *                                      at module cleanup.
  46  *                                      With MODULE-loading ``insmod'', user can
  47  *                                      issue parameter:   slip_maxdev=1024
  48  *                                      (Or how much he/she wants.. Default is 256)
  49  * *    Stanislav Voronyi       :       Slip line checking, with ideas taken
  50  *                                      from multislip BSDI driver which was written
  51  *                                      by Igor Chechik, RELCOM Corp. Only algorithms
  52  *                                      have been ported to Linux SLIP driver.
  53  *      Vitaly E. Lavrov        :       Sane behaviour on tty hangup.
  54  *      Alexey Kuznetsov        :       Cleanup interfaces to tty&netdevice modules.
  55  */
  56
  57 #define SL_CHECK_TRANSMIT
  58 #include <linux/config.h>
  59 #include <linux/module.h>
  60 #include <linux/moduleparam.h>
  61
  62 #include <asm/system.h>
  63 #include <asm/uaccess.h>
  64 #include <linux/bitops.h>
  65 #include <linux/string.h>
  66 #include <linux/mm.h>
  67 #include <linux/interrupt.h>
  68 #include <linux/in.h>
  69 #include <linux/tty.h>
  70 #include <linux/errno.h>
  71 #include <linux/netdevice.h>
  72 #include <linux/etherdevice.h>
  73 #include <linux/skbuff.h>
  74 #include <linux/rtnetlink.h>
  75 #include <linux/if_arp.h>
  76 #include <linux/if_slip.h>
  77 #include <linux/delay.h>
  78 #include <linux/init.h>
  79 #include "slip.h"
  80 #ifdef CONFIG_INET
  81 #include <linux/ip.h>
  82 #include <linux/tcp.h>
  83 #include <net/slhc_vj.h>
  84 #endif
  85
  86 #define SLIP_VERSION    "0.8.4-NET3.019-NEWTTY"
  87
  88 static struct net_device **slip_devs;
  89
  90 static int slip_maxdev = SL_NRUNIT;
  91 module_param(slip_maxdev, int, 0);
  92 MODULE_PARM_DESC(slip_maxdev, "Maximum number of slip devices");
  93
  94 static int slip_esc(unsigned char *p, unsigned char *d, int len);
  95 static void slip_unesc(struct slip *sl, unsigned char c);
  96 #ifdef CONFIG_SLIP_MODE_SLIP6
  97 static int slip_esc6(unsigned char *p, unsigned char *d, int len);
  98 static void slip_unesc6(struct slip *sl, unsigned char c);
  99 #endif
 100 #ifdef CONFIG_SLIP_SMART
 101 static void sl_keepalive(unsigned long sls);
 102 static void sl_outfill(unsigned long sls);
 103 static int sl_ioctl(struct net_device *dev,struct ifreq *rq,int cmd);
 104 #endif
 105
 106 /********************************
 107 *  Buffer administration routines:
 108 *       sl_alloc_bufs()
 109 *       sl_free_bufs()
 110 *       sl_realloc_bufs()
 111 *
 112 * NOTE: sl_realloc_bufs != sl_free_bufs + sl_alloc_bufs, because
 113 *       sl_realloc_bufs provides strong atomicity and reallocation
 114 *       on actively running device.
 115 *********************************/
 116
 117 /*
 118    Allocate channel buffers.
 119  */
 120
 121 static int
 122 sl_alloc_bufs(struct slip *sl, int mtu)
 123 {
 124         int err = -ENOBUFS;
 125         unsigned long len;
 126         char * rbuff = NULL;
 127         char * xbuff = NULL;
 128 #ifdef SL_INCLUDE_CSLIP
 129         char * cbuff = NULL;
 130         struct slcompress *slcomp = NULL;
 131 #endif
 132
 133         /*
 134          * Allocate the SLIP frame buffers:
 135          *
 136          * rbuff        Receive buffer.
 137          * xbuff        Transmit buffer.
 138          * cbuff        Temporary compression buffer.
 139          */
 140         len = mtu * 2;
 141
 142         /*
 143          * allow for arrival of larger UDP packets, even if we say not to
 144          * also fixes a bug in which SunOS sends 512-byte packets even with
 145          * an MSS of 128
 146          */
 147         if (len < 576 * 2)
 148                 len = 576 * 2;
 149         rbuff = kmalloc(len + 4, GFP_KERNEL);
 150         if (rbuff == NULL)
 151                 goto err_exit;
 152         xbuff = kmalloc(len + 4, GFP_KERNEL);
 153         if (xbuff == NULL)
 154                 goto err_exit;
 155 #ifdef SL_INCLUDE_CSLIP
 156         cbuff = kmalloc(len + 4, GFP_KERNEL);
 157         if (cbuff == NULL)
 158                 goto err_exit;
 159         slcomp = slhc_init(16, 16);
 160         if (slcomp == NULL)
 161                 goto err_exit;
 162 #endif
 163         spin_lock_bh(&sl->lock);
 164         if (sl->tty == NULL) {
 165                 spin_unlock_bh(&sl->lock);
 166                 err = -ENODEV;
 167                 goto err_exit;
 168         }
 169         sl->mtu      = mtu;
 170         sl->buffsize = len;
 171         sl->rcount   = 0;
 172         sl->xleft    = 0;
 173         rbuff = xchg(&sl->rbuff, rbuff);
 174         xbuff = xchg(&sl->xbuff, xbuff);
 175 #ifdef SL_INCLUDE_CSLIP
 176         cbuff = xchg(&sl->cbuff, cbuff);
 177         slcomp = xchg(&sl->slcomp, slcomp);
 178 #ifdef CONFIG_SLIP_MODE_SLIP6
 179         sl->xdata    = 0;
 180         sl->xbits    = 0;
 181 #endif
 182 #endif
 183         spin_unlock_bh(&sl->lock);
 184         err = 0;
 185
 186         /* Cleanup */
 187 err_exit:
 188 #ifdef SL_INCLUDE_CSLIP
 189         kfree(cbuff);
 190         if (slcomp)
 191                 slhc_free(slcomp);
 192 #endif
 193         kfree(xbuff);
 194         kfree(rbuff);
 195         return err;
 196 }
 197
 198 /* Free a SLIP channel buffers. */
 199 static void
 200 sl_free_bufs(struct slip *sl)
 201 {
 202         /* Free all SLIP frame buffers. */
 203         kfree(xchg(&sl->rbuff, NULL));
 204         kfree(xchg(&sl->xbuff, NULL));
 205 #ifdef SL_INCLUDE_CSLIP
 206         kfree(xchg(&sl->cbuff, NULL));
 207         slhc_free(xchg(&sl->slcomp, NULL));
 208 #endif
 209 }
 210
 211 /*
 212    Reallocate slip channel buffers.
 213  */
 214
 215 static int sl_realloc_bufs(struct slip *sl, int mtu)
 216 {
 217         int err = 0;
 218         struct net_device *dev = sl->dev;
 219         unsigned char *xbuff, *rbuff;
 220 #ifdef SL_INCLUDE_CSLIP
 221         unsigned char *cbuff;
 222 #endif
 223         int len = mtu * 2;
 224
 225 /*
 226  * allow for arrival of larger UDP packets, even if we say not to
 227  * also fixes a bug in which SunOS sends 512-byte packets even with
 228  * an MSS of 128
 229  */
 230         if (len < 576 * 2)
 231                 len = 576 * 2;
 232
 233         xbuff = (unsigned char *) kmalloc (len + 4, GFP_ATOMIC);
 234         rbuff = (unsigned char *) kmalloc (len + 4, GFP_ATOMIC);
 235 #ifdef SL_INCLUDE_CSLIP
 236         cbuff = (unsigned char *) kmalloc (len + 4, GFP_ATOMIC);
 237 #endif
 238
 239
 240 #ifdef SL_INCLUDE_CSLIP
 241         if (xbuff == NULL || rbuff == NULL || cbuff == NULL)  {
 242 #else
 243         if (xbuff == NULL || rbuff == NULL)  {
 244 #endif
 245                 if (mtu >= sl->mtu) {
 246                         printk(KERN_WARNING "%s: unable to grow slip buffers, MTU change cancelled.\n",
 247                                dev->name);
 248                         err = -ENOBUFS;
 249                 }
 250                 goto done;
 251         }
 252
 253         spin_lock_bh(&sl->lock);
 254
 255         err = -ENODEV;
 256         if (sl->tty == NULL)
 257                 goto done_on_bh;
 258
 259         xbuff    = xchg(&sl->xbuff, xbuff);
 260         rbuff    = xchg(&sl->rbuff, rbuff);
 261 #ifdef SL_INCLUDE_CSLIP
 262         cbuff    = xchg(&sl->cbuff, cbuff);
 263 #endif
 264         if (sl->xleft)  {
 265                 if (sl->xleft <= len)  {
 266                         memcpy(sl->xbuff, sl->xhead, sl->xleft);
 267                 } else  {
 268                         sl->xleft = 0;
 269                         sl->tx_dropped++;
 270                 }
 271         }
 272         sl->xhead = sl->xbuff;
 273
 274         if (sl->rcount)  {
 275                 if (sl->rcount <= len) {
 276                         memcpy(sl->rbuff, rbuff, sl->rcount);
 277                 } else  {
 278                         sl->rcount = 0;
 279                         sl->rx_over_errors++;
 280                         set_bit(SLF_ERROR, &sl->flags);
 281                 }
 282         }
 283         sl->mtu      = mtu;
 284         dev->mtu      = mtu;
 285         sl->buffsize = len;
 286         err = 0;
 287
 288 done_on_bh:
 289         spin_unlock_bh(&sl->lock);
 290
 291 done:
 292         kfree(xbuff);
 293         kfree(rbuff);
 294 #ifdef SL_INCLUDE_CSLIP
 295         kfree(cbuff);
 296 #endif
 297         return err;
 298 }
 299
 300
 301 /* Set the "sending" flag.  This must be atomic hence the set_bit. */
 302 static inline void
 303 sl_lock(struct slip *sl)
 304 {
 305         netif_stop_queue(sl->dev);
 306 }
 307
 308
 309 /* Clear the "sending" flag.  This must be atomic, hence the ASM. */
 310 static inline void
 311 sl_unlock(struct slip *sl)
 312 {
 313         netif_wake_queue(sl->dev);
 314 }
 315
 316 /* Send one completely decapsulated IP datagram to the IP layer. */
 317 static void
 318 sl_bump(struct slip *sl)
 319 {
 320         struct sk_buff *skb;
 321         int count;
 322
 323         count = sl->rcount;
 324 #ifdef SL_INCLUDE_CSLIP
 325         if (sl->mode & (SL_MODE_ADAPTIVE | SL_MODE_CSLIP)) {
 326                 unsigned char c;
 327                 if ((c = sl->rbuff[0]) & SL_TYPE_COMPRESSED_TCP) {
 328                         /* ignore compressed packets when CSLIP is off */
 329                         if (!(sl->mode & SL_MODE_CSLIP)) {
 330                                 printk(KERN_WARNING "%s: compressed packet ignored\n", sl->dev->name);
 331                                 return;
 332                         }
 333                         /* make sure we've reserved enough space for uncompress to use */
 334                         if (count + 80 > sl->buffsize) {
 335                                 sl->rx_over_errors++;
 336                                 return;
 337                         }
 338                         count = slhc_uncompress(sl->slcomp, sl->rbuff, count);
 339                         if (count <= 0) {
 340                                 return;
 341                         }
 342                 } else if (c >= SL_TYPE_UNCOMPRESSED_TCP) {
 343                         if (!(sl->mode & SL_MODE_CSLIP)) {
 344                                 /* turn on header compression */
 345                                 sl->mode |= SL_MODE_CSLIP;
 346                                 sl->mode &= ~SL_MODE_ADAPTIVE;
 347                                 printk(KERN_INFO "%s: header compression turned on\n", sl->dev->name);
 348                         }
 349                         sl->rbuff[0] &= 0x4f;
 350                         if (slhc_remember(sl->slcomp, sl->rbuff, count) <= 0) {
 351                                 return;
 352                         }
 353                 }
 354         }
 355 #endif  /* SL_INCLUDE_CSLIP */
 356
 357         sl->rx_bytes+=count;
 358
 359         skb = dev_alloc_skb(count);
 360         if (skb == NULL)  {
 361                 printk(KERN_WARNING "%s: memory squeeze, dropping packet.\n", sl->dev->name);
 362                 sl->rx_dropped++;
 363                 return;
 364         }
 365         skb->dev = sl->dev;
 366         memcpy(skb_put(skb,count), sl->rbuff, count);
 367         skb->mac.raw=skb->data;
 368         skb->protocol=htons(ETH_P_IP);
 369         netif_rx(skb);
 370         sl->dev->last_rx = jiffies;
 371         sl->rx_packets++;
 372 }
 373
 374 /* Encapsulate one IP datagram and stuff into a TTY queue. */
 375 static void
 376 sl_encaps(struct slip *sl, unsigned char *icp, int len)
 377 {
 378         unsigned char *p;
 379         int actual, count;
 380
 381         if (len > sl->mtu) {            /* Sigh, shouldn't occur BUT ... */
 382                 printk(KERN_WARNING "%s: truncating oversized transmit packet!\n", sl->dev->name);
 383                 sl->tx_dropped++;
 384                 sl_unlock(sl);
 385                 return;
 386         }
 387
 388         p = icp;
 389 #ifdef SL_INCLUDE_CSLIP
 390         if (sl->mode & SL_MODE_CSLIP)  {
 391                 len = slhc_compress(sl->slcomp, p, len, sl->cbuff, &p, 1);
 392         }
 393 #endif
 394 #ifdef CONFIG_SLIP_MODE_SLIP6
 395         if(sl->mode & SL_MODE_SLIP6)
 396                 count = slip_esc6(p, (unsigned char *) sl->xbuff, len);
 397         else
 398 #endif
 399                 count = slip_esc(p, (unsigned char *) sl->xbuff, len);
 400
 401         /* Order of next two lines is *very* important.
 402          * When we are sending a little amount of data,
 403          * the transfer may be completed inside driver.write()
 404          * routine, because it's running with interrupts enabled.
 405          * In this case we *never* got WRITE_WAKEUP event,
 406          * if we did not request it before write operation.
 407          *       14 Oct 1994  Dmitry Gorodchanin.
 408          */
 409         sl->tty->flags |= (1 << TTY_DO_WRITE_WAKEUP);
 410         actual = sl->tty->driver->write(sl->tty, sl->xbuff, count);
 411 #ifdef SL_CHECK_TRANSMIT
 412         sl->dev->trans_start = jiffies;
 413 #endif
 414         sl->xleft = count - actual;
 415         sl->xhead = sl->xbuff + actual;
 416 #ifdef CONFIG_SLIP_SMART
 417         /* VSV */
 418         clear_bit(SLF_OUTWAIT, &sl->flags);     /* reset outfill flag */
 419 #endif
 420 }
 421
 422 /*
 423  * Called by the driver when there's room for more data.  If we have
 424  * more packets to send, we send them here.
 425  */
 426 static void slip_write_wakeup(struct tty_struct *tty)
 427 {
 428         int actual;
 429         struct slip *sl = (struct slip *) tty->disc_data;
 430
 431         /* First make sure we're connected. */
 432         if (!sl || sl->magic != SLIP_MAGIC || !netif_running(sl->dev)) {
 433                 return;
 434         }
 435         if (sl->xleft <= 0)  {
 436                 /* Now serial buffer is almost free & we can start
 437                  * transmission of another packet */
 438                 sl->tx_packets++;
 439                 tty->flags &= ~(1 << TTY_DO_WRITE_WAKEUP);
 440                 sl_unlock(sl);
 441                 return;
 442         }
 443
 444         actual = tty->driver->write(tty, sl->xhead, sl->xleft);
 445         sl->xleft -= actual;
 446         sl->xhead += actual;
 447 }
 448
 449 static void sl_tx_timeout(struct net_device *dev)
 450 {
 451         struct slip *sl = netdev_priv(dev);
 452
 453         spin_lock(&sl->lock);
 454
 455         if (netif_queue_stopped(dev)) {
 456                 if (!netif_running(dev))
 457                         goto out;
 458
 459                 /* May be we must check transmitter timeout here ?
 460                  *      14 Oct 1994 Dmitry Gorodchanin.
 461                  */
 462 #ifdef SL_CHECK_TRANSMIT
 463                 if (time_before(jiffies, dev->trans_start + 20 * HZ))  {
 464                         /* 20 sec timeout not reached */
 465                         goto out;
 466                 }
 467                 printk(KERN_WARNING "%s: transmit timed out, %s?\n", dev->name,
 468                        (sl->tty->driver->chars_in_buffer(sl->tty) || sl->xleft) ?
 469                        "bad line quality" : "driver error");
 470                 sl->xleft = 0;
 471                 sl->tty->flags &= ~(1 << TTY_DO_WRITE_WAKEUP);
 472                 sl_unlock(sl);
 473 #endif
 474         }
 475
 476 out:
 477         spin_unlock(&sl->lock);
 478 }
 479
 480
 481 /* Encapsulate an IP datagram and kick it into a TTY queue. */
 482 static int
 483 sl_xmit(struct sk_buff *skb, struct net_device *dev)
 484 {
 485         struct slip *sl = netdev_priv(dev);
 486
 487         spin_lock(&sl->lock);
 488         if (!netif_running(dev))  {
 489                 spin_unlock(&sl->lock);
 490                 printk(KERN_WARNING "%s: xmit call when iface is down\n", dev->name);
 491                 dev_kfree_skb(skb);
 492                 return 0;
 493         }
 494         if (sl->tty == NULL) {
 495                 spin_unlock(&sl->lock);
 496                 dev_kfree_skb(skb);
 497                 return 0;
 498         }
 499
 500         sl_lock(sl);
 501         sl->tx_bytes+=skb->len;
 502         sl_encaps(sl, skb->data, skb->len);
 503         spin_unlock(&sl->lock);
 504
 505         dev_kfree_skb(skb);
 506         return 0;
 507 }
 508
 509
 510 /******************************************
 511  *   Routines looking at netdevice side.
 512  ******************************************/
 513
 514 /* Netdevice UP -> DOWN routine */
 515
 516 static int
 517 sl_close(struct net_device *dev)
 518 {
 519         struct slip *sl = netdev_priv(dev);
 520
 521         spin_lock_bh(&sl->lock);
 522         if (sl->tty) {
 523                 /* TTY discipline is running. */
 524                 sl->tty->flags &= ~(1 << TTY_DO_WRITE_WAKEUP);
 525         }
 526         netif_stop_queue(dev);
 527         sl->rcount   = 0;
 528         sl->xleft    = 0;
 529         spin_unlock_bh(&sl->lock);
 530
 531         return 0;
 532 }
 533
 534 /* Netdevice DOWN -> UP routine */
 535
 536 static int sl_open(struct net_device *dev)
 537 {
 538         struct slip *sl = netdev_priv(dev);
 539
 540         if (sl->tty==NULL)
 541                 return -ENODEV;
 542
 543         sl->flags &= (1 << SLF_INUSE);
 544         netif_start_queue(dev);
 545         return 0;
 546 }
 547
 548 /* Netdevice change MTU request */
 549
 550 static int sl_change_mtu(struct net_device *dev, int new_mtu)
 551 {
 552         struct slip *sl = netdev_priv(dev);
 553
 554         if (new_mtu < 68 || new_mtu > 65534)
 555                 return -EINVAL;
 556
 557         if (new_mtu != dev->mtu)
 558                 return sl_realloc_bufs(sl, new_mtu);
 559         return 0;
 560 }
 561
 562 /* Netdevice get statistics request */
 563
 564 static struct net_device_stats *
 565 sl_get_stats(struct net_device *dev)
 566 {
 567         static struct net_device_stats stats;
 568         struct slip *sl = netdev_priv(dev);
 569 #ifdef SL_INCLUDE_CSLIP
 570         struct slcompress *comp;
 571 #endif
 572
 573         memset(&stats, 0, sizeof(struct net_device_stats));
 574
 575         stats.rx_packets     = sl->rx_packets;
 576         stats.tx_packets     = sl->tx_packets;
 577         stats.rx_bytes       = sl->rx_bytes;
 578         stats.tx_bytes       = sl->tx_bytes;
 579         stats.rx_dropped     = sl->rx_dropped;
 580         stats.tx_dropped     = sl->tx_dropped;
 581         stats.tx_errors      = sl->tx_errors;
 582         stats.rx_errors      = sl->rx_errors;
 583         stats.rx_over_errors = sl->rx_over_errors;
 584 #ifdef SL_INCLUDE_CSLIP
 585         stats.rx_fifo_errors = sl->rx_compressed;
 586         stats.tx_fifo_errors = sl->tx_compressed;
 587         stats.collisions     = sl->tx_misses;
 588         comp = sl->slcomp;
 589         if (comp) {
 590                 stats.rx_fifo_errors += comp->sls_i_compressed;
 591                 stats.rx_dropped     += comp->sls_i_tossed;
 592                 stats.tx_fifo_errors += comp->sls_o_compressed;
 593                 stats.collisions     += comp->sls_o_misses;
 594         }
 595 #endif /* CONFIG_INET */
 596         return (&stats);
 597 }
 598
 599 /* Netdevice register callback */
 600
 601 static int sl_init(struct net_device *dev)
 602 {
 603         struct slip *sl = netdev_priv(dev);
 604
 605         /*
 606          *      Finish setting up the DEVICE info.
 607          */
 608
 609         dev->mtu                = sl->mtu;
 610         dev->type               = ARPHRD_SLIP + sl->mode;
 611 #ifdef SL_CHECK_TRANSMIT
 612         dev->tx_timeout         = sl_tx_timeout;
 613         dev->watchdog_timeo     = 20*HZ;
 614 #endif
 615         return 0;
 616 }
 617
 618
 619 static void sl_uninit(struct net_device *dev)
 620 {
 621         struct slip *sl = netdev_priv(dev);
 622
 623         sl_free_bufs(sl);
 624 }
 625
 626 static void sl_setup(struct net_device *dev)
 627 {
 628         dev->init               = sl_init;
 629         dev->uninit             = sl_uninit;
 630         dev->open               = sl_open;
 631         dev->destructor         = free_netdev;
 632         dev->stop               = sl_close;
 633         dev->get_stats          = sl_get_stats;
 634         dev->change_mtu         = sl_change_mtu;
 635         dev->hard_start_xmit    = sl_xmit;
 636 #ifdef CONFIG_SLIP_SMART
 637         dev->do_ioctl           = sl_ioctl;
 638 #endif
 639         dev->hard_header_len    = 0;
 640         dev->addr_len           = 0;
 641         dev->tx_queue_len       = 10;
 642
 643         SET_MODULE_OWNER(dev);
 644
 645         /* New-style flags. */
 646         dev->flags              = IFF_NOARP|IFF_POINTOPOINT|IFF_MULTICAST;
 647 }
 648
 649 /******************************************
 650   Routines looking at TTY side.
 651  ******************************************/
 652
 653
 654 /*
 655  * Handle the 'receiver data ready' interrupt.
 656  * This function is called by the 'tty_io' module in the kernel when
 657  * a block of SLIP data has been received, which can now be decapsulated
 658  * and sent on to some IP layer for further processing. This will not
 659  * be re-entered while running but other ldisc functions may be called
 660  * in parallel
 661  */
 662
 663 static void slip_receive_buf(struct tty_struct *tty, const unsigned char *cp, char *fp, int count)
 664 {
 665         struct slip *sl = (struct slip *) tty->disc_data;
 666
 667         if (!sl || sl->magic != SLIP_MAGIC ||
 668             !netif_running(sl->dev))
 669                 return;
 670
 671         /* Read the characters out of the buffer */
 672         while (count--) {
 673                 if (fp && *fp++) {
 674                         if (!test_and_set_bit(SLF_ERROR, &sl->flags))  {
 675                                 sl->rx_errors++;
 676                         }
 677                         cp++;
 678                         continue;
 679                 }
 680 #ifdef CONFIG_SLIP_MODE_SLIP6
 681                 if (sl->mode & SL_MODE_SLIP6)
 682                         slip_unesc6(sl, *cp++);
 683                 else
 684 #endif
 685                         slip_unesc(sl, *cp++);
 686         }
 687 }
 688
 689 /************************************
 690  *  slip_open helper routines.
 691  ************************************/
 692
 693 /* Collect hanged up channels */
 694
 695 static void sl_sync(void)
 696 {
 697         int i;
 698         struct net_device *dev;
 699         struct slip       *sl;
 700
 701         for (i = 0; i < slip_maxdev; i++) {
 702                 if ((dev = slip_devs[i]) == NULL)
 703                         break;
 704
 705                 sl = netdev_priv(dev);
 706                 if (sl->tty || sl->leased)
 707                         continue;
 708                 if (dev->flags&IFF_UP)
 709                         dev_close(dev);
 710         }
 711 }
 712
 713
 714 /* Find a free SLIP channel, and link in this `tty' line. */
 715 static struct slip *
 716 sl_alloc(dev_t line)
 717 {
 718         int i;
 719         int sel = -1;
 720         int score = -1;
 721         struct net_device *dev = NULL;
 722         struct slip       *sl;
 723
 724         if (slip_devs == NULL)
 725                 return NULL;    /* Master array missing ! */
 726
 727         for (i = 0; i < slip_maxdev; i++) {
 728                 dev = slip_devs[i];
 729                 if (dev == NULL)
 730                         break;
 731
 732                 sl = netdev_priv(dev);
 733                 if (sl->leased) {
 734                         if (sl->line != line)
 735                                 continue;
 736                         if (sl->tty)
 737                                 return NULL;
 738
 739                         /* Clear ESCAPE & ERROR flags */
 740                         sl->flags &= (1 << SLF_INUSE);
 741                         return sl;
 742                 }
 743
 744                 if (sl->tty)
 745                         continue;
 746
 747                 if (current->pid == sl->pid) {
 748                         if (sl->line == line && score < 3) {
 749                                 sel = i;
 750                                 score = 3;
 751                                 continue;
 752                         }
 753                         if (score < 2) {
 754                                 sel = i;
 755                                 score = 2;
 756                         }
 757                         continue;
 758                 }
 759                 if (sl->line == line && score < 1) {
 760                         sel = i;
 761                         score = 1;
 762                         continue;
 763                 }
 764                 if (score < 0) {
 765                         sel = i;
 766                         score = 0;
 767                 }
 768         }
 769
 770         if (sel >= 0) {
 771                 i = sel;
 772                 dev = slip_devs[i];
 773                 if (score > 1) {
 774                         sl = netdev_priv(dev);
 775                         sl->flags &= (1 << SLF_INUSE);
 776                         return sl;
 777                 }
 778         }
 779
 780         /* Sorry, too many, all slots in use */
 781         if (i >= slip_maxdev)
 782                 return NULL;
 783
 784         if (dev) {
 785                 sl = netdev_priv(dev);
 786                 if (test_bit(SLF_INUSE, &sl->flags)) {
 787                         unregister_netdevice(dev);
 788                         dev = NULL;
 789                         slip_devs[i] = NULL;
 790                 }
 791         }
 792
 793         if (!dev) {
 794                 char name[IFNAMSIZ];
 795                 sprintf(name, "sl%d", i);
 796
 797                 dev = alloc_netdev(sizeof(*sl), name, sl_setup);
 798                 if (!dev)
 799                         return NULL;
 800                 dev->base_addr  = i;
 801         }
 802
 803         sl = netdev_priv(dev);
 804
 805         /* Initialize channel control data */
 806         sl->magic       = SLIP_MAGIC;
 807         sl->dev         = dev;
 808         spin_lock_init(&sl->lock);
 809         sl->mode        = SL_MODE_DEFAULT;
 810 #ifdef CONFIG_SLIP_SMART
 811         init_timer(&sl->keepalive_timer);       /* initialize timer_list struct */
 812         sl->keepalive_timer.data=(unsigned long)sl;
 813         sl->keepalive_timer.function=sl_keepalive;
 814         init_timer(&sl->outfill_timer);
 815         sl->outfill_timer.data=(unsigned long)sl;
 816         sl->outfill_timer.function=sl_outfill;
 817 #endif
 818         slip_devs[i] = dev;
 819
 820         return sl;
 821 }
 822
 823 /*
 824  * Open the high-level part of the SLIP channel.
 825  * This function is called by the TTY module when the
 826  * SLIP line discipline is called for.  Because we are
 827  * sure the tty line exists, we only have to link it to
 828  * a free SLIP channel...
 829  *
 830  * Called in process context serialized from other ldisc calls.
 831  */
 832
 833 static int slip_open(struct tty_struct *tty)
 834 {
 835         struct slip *sl;
 836         int err;
 837
 838         if(!capable(CAP_NET_ADMIN))
 839                 return -EPERM;
 840
 841         /* RTnetlink lock is misused here to serialize concurrent
 842            opens of slip channels. There are better ways, but it is
 843            the simplest one.
 844          */
 845         rtnl_lock();
 846
 847         /* Collect hanged up channels. */
 848         sl_sync();
 849
 850         sl = (struct slip *) tty->disc_data;
 851
 852         err = -EEXIST;
 853         /* First make sure we're not already connected. */
 854         if (sl && sl->magic == SLIP_MAGIC)
 855                 goto err_exit;
 856
 857         /* OK.  Find a free SLIP channel to use. */
 858         err = -ENFILE;
 859         if ((sl = sl_alloc(tty_devnum(tty))) == NULL)
 860                 goto err_exit;
 861
 862         sl->tty = tty;
 863         tty->disc_data = sl;
 864         sl->line = tty_devnum(tty);
 865         sl->pid = current->pid;
 866
 867         if (!test_bit(SLF_INUSE, &sl->flags)) {
 868                 /* Perform the low-level SLIP initialization. */
 869                 if ((err = sl_alloc_bufs(sl, SL_MTU)) != 0)
 870                         goto err_free_chan;
 871
 872                 set_bit(SLF_INUSE, &sl->flags);
 873
 874                 if ((err = register_netdevice(sl->dev)))
 875                         goto err_free_bufs;
 876         }
 877
 878 #ifdef CONFIG_SLIP_SMART
 879         if (sl->keepalive) {
 880                 sl->keepalive_timer.expires=jiffies+sl->keepalive*HZ;
 881                 add_timer (&sl->keepalive_timer);
 882         }
 883         if (sl->outfill) {
 884                 sl->outfill_timer.expires=jiffies+sl->outfill*HZ;
 885                 add_timer (&sl->outfill_timer);
 886         }
 887 #endif
 888
 889         /* Done.  We have linked the TTY line to a channel. */
 890         rtnl_unlock();
 891         tty->receive_room = 65536;      /* We don't flow control */
 892         return sl->dev->base_addr;
 893
 894 err_free_bufs:
 895         sl_free_bufs(sl);
 896
 897 err_free_chan:
 898         sl->tty = NULL;
 899         tty->disc_data = NULL;
 900         clear_bit(SLF_INUSE, &sl->flags);
 901
 902 err_exit:
 903         rtnl_unlock();
 904
 905         /* Count references from TTY module */
 906         return err;
 907 }
 908
 909 /*
 910
 911   FIXME: 1,2 are fixed 3 was never true anyway.
 912
 913    Let me to blame a bit.
 914    1. TTY module calls this funstion on soft interrupt.
 915    2. TTY module calls this function WITH MASKED INTERRUPTS!
 916    3. TTY module does not notify us about line discipline
 917       shutdown,
 918
 919    Seems, now it is clean. The solution is to consider netdevice and
 920    line discipline sides as two independent threads.
 921
 922    By-product (not desired): sl? does not feel hangups and remains open.
 923    It is supposed, that user level program (dip, diald, slattach...)
 924    will catch SIGHUP and make the rest of work.
 925
 926    I see no way to make more with current tty code. --ANK
 927  */
 928
 929 /*
 930  * Close down a SLIP channel.
 931  * This means flushing out any pending queues, and then returning. This
 932  * call is serialized against other ldisc functions.
 933  */
 934 static void
 935 slip_close(struct tty_struct *tty)
 936 {
 937         struct slip *sl = (struct slip *) tty->disc_data;
 938
 939         /* First make sure we're connected. */
 940         if (!sl || sl->magic != SLIP_MAGIC || sl->tty != tty)
 941                 return;
 942
 943         tty->disc_data = NULL;
 944         sl->tty = NULL;
 945         if (!sl->leased)
 946                 sl->line = 0;
 947
 948         /* VSV = very important to remove timers */
 949 #ifdef CONFIG_SLIP_SMART
 950         del_timer_sync(&sl->keepalive_timer);
 951         del_timer_sync(&sl->outfill_timer);
 952 #endif
 953
 954         /* Count references from TTY module */
 955 }
 956
 957  /************************************************************************
 958   *                     STANDARD SLIP ENCAPSULATION                      *
 959   ************************************************************************/
 960
 961 int
 962 slip_esc(unsigned char *s, unsigned char *d, int len)
 963 {
 964         unsigned char *ptr = d;
 965         unsigned char c;
 966
 967         /*
 968          * Send an initial END character to flush out any
 969          * data that may have accumulated in the receiver
 970          * due to line noise.
 971          */
 972
 973         *ptr++ = END;
 974
 975         /*
 976          * For each byte in the packet, send the appropriate
 977          * character sequence, according to the SLIP protocol.
 978          */
 979
 980         while (len-- > 0) {
 981                 switch(c = *s++) {
 982                  case END:
 983                         *ptr++ = ESC;
 984                         *ptr++ = ESC_END;
 985                         break;
 986                  case ESC:
 987                         *ptr++ = ESC;
 988                         *ptr++ = ESC_ESC;
 989                         break;
 990                  default:
 991                         *ptr++ = c;
 992                         break;
 993                 }
 994         }
 995         *ptr++ = END;
 996         return (ptr - d);
 997 }
 998
 999 static void slip_unesc(struct slip *sl, unsigned char s)
1000 {
1001
1002         switch(s) {
1003          case END:
1004 #ifdef CONFIG_SLIP_SMART
1005                 /* drop keeptest bit = VSV */
1006                 if (test_bit(SLF_KEEPTEST, &sl->flags))
1007                         clear_bit(SLF_KEEPTEST, &sl->flags);
1008 #endif
1009
1010                 if (!test_and_clear_bit(SLF_ERROR, &sl->flags) && (sl->rcount > 2))  {
1011                         sl_bump(sl);
1012                 }
1013                 clear_bit(SLF_ESCAPE, &sl->flags);
1014                 sl->rcount = 0;
1015                 return;
1016
1017          case ESC:
1018                 set_bit(SLF_ESCAPE, &sl->flags);
1019                 return;
1020          case ESC_ESC:
1021                 if (test_and_clear_bit(SLF_ESCAPE, &sl->flags))  {
1022                         s = ESC;
1023                 }
1024                 break;
1025          case ESC_END:
1026                 if (test_and_clear_bit(SLF_ESCAPE, &sl->flags))  {
1027                         s = END;
1028                 }
1029                 break;
1030         }
1031         if (!test_bit(SLF_ERROR, &sl->flags))  {
1032                 if (sl->rcount < sl->buffsize)  {
1033                         sl->rbuff[sl->rcount++] = s;
1034                         return;
1035                 }
1036                 sl->rx_over_errors++;
1037                 set_bit(SLF_ERROR, &sl->flags);
1038         }
1039 }
1040
1041
1042 #ifdef CONFIG_SLIP_MODE_SLIP6
1043 /************************************************************************
1044  *                       6 BIT SLIP ENCAPSULATION                       *
1045  ************************************************************************/
1046
1047 int
1048 slip_esc6(unsigned char *s, unsigned char *d, int len)
1049 {
1050         unsigned char *ptr = d;
1051         unsigned char c;
1052         int i;
1053         unsigned short v = 0;
1054         short bits = 0;
1055
1056         /*
1057          * Send an initial END character to flush out any
1058          * data that may have accumulated in the receiver
1059          * due to line noise.
1060          */
1061
1062         *ptr++ = 0x70;
1063
1064         /*
1065          * Encode the packet into printable ascii characters
1066          */
1067
1068         for (i = 0; i < len; ++i) {
1069                 v = (v << 8) | s[i];
1070                 bits += 8;
1071                 while (bits >= 6) {
1072                         bits -= 6;
1073                         c = 0x30 + ((v >> bits) & 0x3F);
1074                         *ptr++ = c;
1075                 }
1076         }
1077         if (bits) {
1078                 c = 0x30 + ((v << (6 - bits)) & 0x3F);
1079                 *ptr++ = c;
1080         }
1081         *ptr++ = 0x70;
1082         return ptr - d;
1083 }
1084
1085 void
1086 slip_unesc6(struct slip *sl, unsigned char s)
1087 {
1088         unsigned char c;
1089
1090         if (s == 0x70) {
1091 #ifdef CONFIG_SLIP_SMART
1092                 /* drop keeptest bit = VSV */
1093                 if (test_bit(SLF_KEEPTEST, &sl->flags))
1094                         clear_bit(SLF_KEEPTEST, &sl->flags);
1095 #endif
1096
1097                 if (!test_and_clear_bit(SLF_ERROR, &sl->flags) && (sl->rcount > 2))  {
1098                         sl_bump(sl);
1099                 }
1100                 sl->rcount = 0;
1101                 sl->xbits = 0;
1102                 sl->xdata = 0;
1103         } else if (s >= 0x30 && s < 0x70) {
1104                 sl->xdata = (sl->xdata << 6) | ((s - 0x30) & 0x3F);
1105                 sl->xbits += 6;
1106                 if (sl->xbits >= 8) {
1107                         sl->xbits -= 8;
1108                         c = (unsigned char)(sl->xdata >> sl->xbits);
1109                         if (!test_bit(SLF_ERROR, &sl->flags))  {
1110                                 if (sl->rcount < sl->buffsize)  {
1111                                         sl->rbuff[sl->rcount++] = c;
1112                                         return;
1113                                 }
1114                                 sl->rx_over_errors++;
1115                                 set_bit(SLF_ERROR, &sl->flags);
1116                         }
1117                 }
1118         }
1119 }
1120 #endif /* CONFIG_SLIP_MODE_SLIP6 */
1121
1122 /* Perform I/O control on an active SLIP channel. */
1123 static int slip_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg)
1124 {
1125         struct slip *sl = (struct slip *) tty->disc_data;
1126         unsigned int tmp;
1127         int __user *p = (int __user *)arg;
1128
1129         /* First make sure we're connected. */
1130         if (!sl || sl->magic != SLIP_MAGIC) {
1131                 return -EINVAL;
1132         }
1133
1134         switch(cmd) {
1135          case SIOCGIFNAME:
1136                 tmp = strlen(sl->dev->name) + 1;
1137                 if (copy_to_user((void __user *)arg, sl->dev->name, tmp))
1138                         return -EFAULT;
1139                 return 0;
1140
1141         case SIOCGIFENCAP:
1142                 if (put_user(sl->mode, p))
1143                         return -EFAULT;
1144                 return 0;
1145
1146         case SIOCSIFENCAP:
1147                 if (get_user(tmp, p))
1148                         return -EFAULT;
1149 #ifndef SL_INCLUDE_CSLIP
1150                 if (tmp & (SL_MODE_CSLIP|SL_MODE_ADAPTIVE))  {
1151                         return -EINVAL;
1152                 }
1153 #else
1154                 if ((tmp & (SL_MODE_ADAPTIVE | SL_MODE_CSLIP)) ==
1155                     (SL_MODE_ADAPTIVE | SL_MODE_CSLIP))  {
1156                         /* return -EINVAL; */
1157                         tmp &= ~SL_MODE_ADAPTIVE;
1158                 }
1159 #endif
1160 #ifndef CONFIG_SLIP_MODE_SLIP6
1161                 if (tmp & SL_MODE_SLIP6)  {
1162                         return -EINVAL;
1163                 }
1164 #endif
1165                 sl->mode = tmp;
1166                 sl->dev->type = ARPHRD_SLIP+sl->mode;
1167                 return 0;
1168
1169          case SIOCSIFHWADDR:
1170                 return -EINVAL;
1171
1172 #ifdef CONFIG_SLIP_SMART
1173         /* VSV changes start here */
1174         case SIOCSKEEPALIVE:
1175                 if (get_user(tmp, p))
1176                         return -EFAULT;
1177                 if (tmp > 255) /* max for unchar */
1178                         return -EINVAL;
1179
1180                 spin_lock_bh(&sl->lock);
1181                 if (!sl->tty) {
1182                         spin_unlock_bh(&sl->lock);
1183                         return -ENODEV;
1184                 }
1185                 if ((sl->keepalive = (unchar) tmp) != 0) {
1186                         mod_timer(&sl->keepalive_timer, jiffies+sl->keepalive*HZ);
1187                         set_bit(SLF_KEEPTEST, &sl->flags);
1188                 } else {
1189                         del_timer (&sl->keepalive_timer);
1190                 }
1191                 spin_unlock_bh(&sl->lock);
1192                 return 0;
1193
1194         case SIOCGKEEPALIVE:
1195                 if (put_user(sl->keepalive, p))
1196                         return -EFAULT;
1197                 return 0;
1198
1199         case SIOCSOUTFILL:
1200                 if (get_user(tmp, p))
1201                         return -EFAULT;
1202                 if (tmp > 255) /* max for unchar */
1203                         return -EINVAL;
1204                 spin_lock_bh(&sl->lock);
1205                 if (!sl->tty) {
1206                         spin_unlock_bh(&sl->lock);
1207                         return -ENODEV;
1208                 }
1209                 if ((sl->outfill = (unchar) tmp) != 0){
1210                         mod_timer(&sl->outfill_timer, jiffies+sl->outfill*HZ);
1211                         set_bit(SLF_OUTWAIT, &sl->flags);
1212                 } else {
1213                         del_timer (&sl->outfill_timer);
1214                 }
1215                 spin_unlock_bh(&sl->lock);
1216                 return 0;
1217
1218         case SIOCGOUTFILL:
1219                 if (put_user(sl->outfill, p))
1220                         return -EFAULT;
1221                 return 0;
1222         /* VSV changes end */
1223 #endif
1224
1225         /* Allow stty to read, but not set, the serial port */
1226         case TCGETS:
1227         case TCGETA:
1228                 return n_tty_ioctl(tty, file, cmd, arg);
1229
1230         default:
1231                 return -ENOIOCTLCMD;
1232         }
1233 }
1234
1235 /* VSV changes start here */
1236 #ifdef CONFIG_SLIP_SMART
1237 /* function do_ioctl called from net/core/dev.c
1238    to allow get/set outfill/keepalive parameter
1239    by ifconfig                                 */
1240
1241 static int sl_ioctl(struct net_device *dev,struct ifreq *rq,int cmd)
1242 {
1243         struct slip *sl = netdev_priv(dev);
1244         unsigned long *p = (unsigned long *)&rq->ifr_ifru;
1245
1246         if (sl == NULL)         /* Allocation failed ?? */
1247                 return -ENODEV;
1248
1249         spin_lock_bh(&sl->lock);
1250
1251         if (!sl->tty) {
1252                 spin_unlock_bh(&sl->lock);
1253                 return -ENODEV;
1254         }
1255
1256         switch(cmd){
1257         case SIOCSKEEPALIVE:
1258                 /* max for unchar */
1259                 if ((unsigned)*p > 255) {
1260                         spin_unlock_bh(&sl->lock);
1261                         return -EINVAL;
1262                 }
1263                 sl->keepalive = (unchar) *p;
1264                 if (sl->keepalive != 0) {
1265                         sl->keepalive_timer.expires=jiffies+sl->keepalive*HZ;
1266                         mod_timer(&sl->keepalive_timer, jiffies+sl->keepalive*HZ);
1267                         set_bit(SLF_KEEPTEST, &sl->flags);
1268                 } else {
1269                         del_timer(&sl->keepalive_timer);
1270                 }
1271                 break;
1272
1273         case SIOCGKEEPALIVE:
1274                 *p = sl->keepalive;
1275                 break;
1276
1277         case SIOCSOUTFILL:
1278                 if ((unsigned)*p > 255) { /* max for unchar */
1279                         spin_unlock_bh(&sl->lock);
1280                         return -EINVAL;
1281                 }
1282                 if ((sl->outfill = (unchar)*p) != 0){
1283                         mod_timer(&sl->outfill_timer, jiffies+sl->outfill*HZ);
1284                         set_bit(SLF_OUTWAIT, &sl->flags);
1285                 } else {
1286                         del_timer (&sl->outfill_timer);
1287                 }
1288                 break;
1289
1290         case SIOCGOUTFILL:
1291                 *p = sl->outfill;
1292                 break;
1293
1294         case SIOCSLEASE:
1295                 /* Resolve race condition, when ioctl'ing hanged up
1296                    and opened by another process device.
1297                  */
1298                 if (sl->tty != current->signal->tty && sl->pid != current->pid) {
1299                         spin_unlock_bh(&sl->lock);
1300                         return -EPERM;
1301                 }
1302                 sl->leased = 0;
1303                 if (*p)
1304                         sl->leased = 1;
1305                 break;
1306
1307         case SIOCGLEASE:
1308                 *p = sl->leased;
1309         };
1310         spin_unlock_bh(&sl->lock);
1311         return 0;
1312 }
1313 #endif
1314 /* VSV changes end */
1315
1316 static struct tty_ldisc sl_ldisc = {
1317         .owner          = THIS_MODULE,
1318         .magic          = TTY_LDISC_MAGIC,
1319         .name           = "slip",
1320         .open           = slip_open,
1321         .close          = slip_close,
1322         .ioctl          = slip_ioctl,
1323         .receive_buf    = slip_receive_buf,
1324         .write_wakeup   = slip_write_wakeup,
1325 };
1326
1327 static int __init slip_init(void)
1328 {
1329         int status;
1330
1331         if (slip_maxdev < 4)
1332                 slip_maxdev = 4; /* Sanity */
1333
1334         printk(KERN_INFO "SLIP: version %s (dynamic channels, max=%d)"
1335 #ifdef CONFIG_SLIP_MODE_SLIP6
1336                " (6 bit encapsulation enabled)"
1337 #endif
1338                ".\n",
1339                SLIP_VERSION, slip_maxdev );
1340 #if defined(SL_INCLUDE_CSLIP)
1341         printk(KERN_INFO "CSLIP: code copyright 1989 Regents of the University of California.\n");
1342 #endif
1343 #ifdef CONFIG_SLIP_SMART
1344         printk(KERN_INFO "SLIP linefill/keepalive option.\n");
1345 #endif
1346
1347         slip_devs = kmalloc(sizeof(struct net_device *)*slip_maxdev, GFP_KERNEL);
1348         if (!slip_devs) {
1349                 printk(KERN_ERR "SLIP: Can't allocate slip devices array!  Uaargh! (-> No SLIP available)\n");
1350                 return -ENOMEM;
1351         }
1352
1353         /* Clear the pointer array, we allocate devices when we need them */
1354         memset(slip_devs, 0, sizeof(struct net_device *)*slip_maxdev);
1355
1356         /* Fill in our line protocol discipline, and register it */
1357         if ((status = tty_register_ldisc(N_SLIP, &sl_ldisc)) != 0)  {
1358                 printk(KERN_ERR "SLIP: can't register line discipline (err = %d)\n", status);
1359                 kfree(slip_devs);
1360         }
1361         return status;
1362 }
1363
1364 static void __exit slip_exit(void)
1365 {
1366         int i;
1367         struct net_device *dev;
1368         struct slip *sl;
1369         unsigned long timeout = jiffies + HZ;
1370         int busy = 0;
1371
1372         if (slip_devs == NULL)
1373                 return;
1374
1375         /* First of all: check for active disciplines and hangup them.
1376          */
1377         do {
1378                 if (busy)
1379                         msleep_interruptible(100);
1380
1381                 busy = 0;
1382                 for (i = 0; i < slip_maxdev; i++) {
1383                         dev = slip_devs[i];
1384                         if (!dev)
1385                                 continue;
1386                         sl = netdev_priv(dev);
1387                         spin_lock_bh(&sl->lock);
1388                         if (sl->tty) {
1389                                 busy++;
1390                                 tty_hangup(sl->tty);
1391                         }
1392                         spin_unlock_bh(&sl->lock);
1393                 }
1394         } while (busy && time_before(jiffies, timeout));
1395
1396
1397         for (i = 0; i < slip_maxdev; i++) {
1398                 dev = slip_devs[i];
1399                 if (!dev)
1400                         continue;
1401                 slip_devs[i] = NULL;
1402
1403                 sl = netdev_priv(dev);
1404                 if (sl->tty) {
1405                         printk(KERN_ERR "%s: tty discipline still running\n",
1406                                dev->name);
1407                         /* Intentionally leak the control block. */
1408                         dev->destructor = NULL;
1409                 }
1410
1411                 unregister_netdev(dev);
1412         }
1413
1414         kfree(slip_devs);
1415         slip_devs = NULL;
1416
1417         if ((i = tty_unregister_ldisc(N_SLIP)))
1418         {
1419                 printk(KERN_ERR "SLIP: can't unregister line discipline (err = %d)\n", i);
1420         }
1421 }
1422
1423 module_init(slip_init);
1424 module_exit(slip_exit);
1425
1426 #ifdef CONFIG_SLIP_SMART
1427 /*
1428  * This is start of the code for multislip style line checking
1429  * added by Stanislav Voronyi. All changes before marked VSV
1430  */
1431
1432 static void sl_outfill(unsigned long sls)
1433 {
1434         struct slip *sl=(struct slip *)sls;
1435
1436         spin_lock(&sl->lock);
1437
1438         if (sl->tty == NULL)
1439                 goto out;
1440
1441         if(sl->outfill)
1442         {
1443                 if( test_bit(SLF_OUTWAIT, &sl->flags) )
1444                 {
1445                         /* no packets were transmitted, do outfill */
1446 #ifdef CONFIG_SLIP_MODE_SLIP6
1447                         unsigned char s = (sl->mode & SL_MODE_SLIP6)?0x70:END;
1448 #else
1449                         unsigned char s = END;
1450 #endif
1451                         /* put END into tty queue. Is it right ??? */
1452                         if (!netif_queue_stopped(sl->dev))
1453                         {
1454                                 /* if device busy no outfill */
1455                                 sl->tty->driver->write(sl->tty, &s, 1);
1456                         }
1457                 }
1458                 else
1459                         set_bit(SLF_OUTWAIT, &sl->flags);
1460
1461                 mod_timer(&sl->outfill_timer, jiffies+sl->outfill*HZ);
1462         }
1463 out:
1464         spin_unlock(&sl->lock);
1465 }
1466
1467 static void sl_keepalive(unsigned long sls)
1468 {
1469         struct slip *sl=(struct slip *)sls;
1470
1471         spin_lock(&sl->lock);
1472
1473         if (sl->tty == NULL)
1474                 goto out;
1475
1476         if( sl->keepalive)
1477         {
1478                 if(test_bit(SLF_KEEPTEST, &sl->flags))
1479                 {
1480                         /* keepalive still high :(, we must hangup */
1481                         if( sl->outfill ) /* outfill timer must be deleted too */
1482                                 (void)del_timer(&sl->outfill_timer);
1483                         printk(KERN_DEBUG "%s: no packets received during keepalive timeout, hangup.\n", sl->dev->name);
1484                         tty_hangup(sl->tty); /* this must hangup tty & close slip */
1485                         /* I think we need not something else */
1486                         goto out;
1487                 }
1488                 else
1489                         set_bit(SLF_KEEPTEST, &sl->flags);
1490
1491                 mod_timer(&sl->keepalive_timer, jiffies+sl->keepalive*HZ);
1492         }
1493
1494 out:
1495         spin_unlock(&sl->lock);
1496 }
1497
1498 #endif
1499 MODULE_LICENSE("GPL");
1500 MODULE_ALIAS_LDISC(N_SLIP);