net/rose/rose_loopback.c

   1 /*
   2  *      ROSE release 003
   3  *
   4  *      This code REQUIRES 2.1.15 or higher/ NET3.038
   5  *
   6  *      This module:
   7  *              This module is free software; you can redistribute it and/or
   8  *              modify it under the terms of the GNU General Public License
   9  *              as published by the Free Software Foundation; either version
  10  *              2 of the License, or (at your option) any later version.
  11  *
  12  *      History
  13  *      ROSE 003        Jonathan(G4KLX) Created this file from nr_loopback.c.
  14  *
  15  */
  16
  17 #include <linux/types.h>
  18 #include <linux/socket.h>
  19 #include <linux/timer.h>
  20 #include <net/ax25.h>
  21 #include <linux/skbuff.h>
  22 #include <net/rose.h>
  23 #include <linux/init.h>
  24
  25 static struct sk_buff_head loopback_queue;
  26 static struct timer_list loopback_timer;
  27
  28 static void rose_set_loopback_timer(void);
  29
  30 void rose_loopback_init(void)
  31 {
  32         skb_queue_head_init(&loopback_queue);
  33
  34         init_timer(&loopback_timer);
  35 }
  36
  37 static int rose_loopback_running(void)
  38 {
  39         return timer_pending(&loopback_timer);
  40 }
  41
  42 int rose_loopback_queue(struct sk_buff *skb, struct rose_neigh *neigh)
  43 {
  44         struct sk_buff *skbn;
  45
  46         skbn = skb_clone(skb, GFP_ATOMIC);
  47
  48         kfree_skb(skb);
  49
  50         if (skbn != NULL) {
  51                 skb_queue_tail(&loopback_queue, skbn);
  52
  53                 if (!rose_loopback_running())
  54                         rose_set_loopback_timer();
  55         }
  56
  57         return 1;
  58 }
  59
  60 static void rose_loopback_timer(unsigned long);
  61
  62 static void rose_set_loopback_timer(void)
  63 {
  64         del_timer(&loopback_timer);
  65
  66         loopback_timer.data     = 0;
  67         loopback_timer.function = &rose_loopback_timer;
  68         loopback_timer.expires  = jiffies + 10;
  69
  70         add_timer(&loopback_timer);
  71 }
  72
  73 static void rose_loopback_timer(unsigned long param)
  74 {
  75         struct sk_buff *skb;
  76         struct net_device *dev;
  77         rose_address *dest;
  78         struct sock *sk;
  79         unsigned short frametype;
  80         unsigned int lci_i, lci_o;
  81
  82         while ((skb = skb_dequeue(&loopback_queue)) != NULL) {
  83                 lci_i     = ((skb->data[0] << 8) & 0xF00) + ((skb->data[1] << 0) & 0x0FF);
  84                 frametype = skb->data[2];
  85                 dest      = (rose_address *)(skb->data + 4);
  86                 lci_o     = 0xFFF - lci_i;
  87
  88                 skb->h.raw = skb->data;
  89
  90                 if ((sk = rose_find_socket(lci_o, rose_loopback_neigh)) != NULL) {
  91                         if (rose_process_rx_frame(sk, skb) == 0)
  92                                 kfree_skb(skb);
  93                         continue;
  94                 }
  95
  96                 if (frametype == ROSE_CALL_REQUEST) {
  97                         if ((dev = rose_dev_get(dest)) != NULL) {
  98                                 if (rose_rx_call_request(skb, dev, rose_loopback_neigh, lci_o) == 0)
  99                                         kfree_skb(skb);
 100                         } else {
 101                                 kfree_skb(skb);
 102                         }
 103                 } else {
 104                         kfree_skb(skb);
 105                 }
 106         }
 107 }
 108
 109 void __exit rose_loopback_clear(void)
 110 {
 111         struct sk_buff *skb;
 112
 113         del_timer(&loopback_timer);
 114
 115         while ((skb = skb_dequeue(&loopback_queue)) != NULL) {
 116                 skb->sk = NULL;
 117                 kfree_skb(skb);
 118         }
 119 }