net/x25/x25_route.c

   1 /*
   2  *      X.25 Packet Layer release 002
   3  *
   4  *      This is ALPHA test software. This code may break your machine,
   5  *      randomly fail to work with new releases, misbehave and/or generally
   6  *      screw up. It might even work.
   7  *
   8  *      This code REQUIRES 2.1.15 or higher
   9  *
  10  *      This module:
  11  *              This module is free software; you can redistribute it and/or
  12  *              modify it under the terms of the GNU General Public License
  13  *              as published by the Free Software Foundation; either version
  14  *              2 of the License, or (at your option) any later version.
  15  *
  16  *      History
  17  *      X.25 001        Jonathan Naylor Started coding.
  18  */
  19
  20 #include <linux/if_arp.h>
  21 #include <linux/init.h>
  22 #include <linux/slab.h>
  23 #include <net/x25.h>
  24
  25 LIST_HEAD(x25_route_list);
  26 DEFINE_RWLOCK(x25_route_list_lock);
  27
  28 /*
  29  *      Add a new route.
  30  */
  31 static int x25_add_route(struct x25_address *address, unsigned int sigdigits,
  32                          struct net_device *dev)
  33 {
  34         struct x25_route *rt;
  35         struct list_head *entry;
  36         int rc = -EINVAL;
  37
  38         write_lock_bh(&x25_route_list_lock);
  39
  40         list_for_each(entry, &x25_route_list) {
  41                 rt = list_entry(entry, struct x25_route, node);
  42
  43                 if (!memcmp(&rt->address, address, sigdigits) &&
  44                     rt->sigdigits == sigdigits)
  45                         goto out;
  46         }
  47
  48         rt = kmalloc(sizeof(*rt), GFP_ATOMIC);
  49         rc = -ENOMEM;
  50         if (!rt)
  51                 goto out;
  52
  53         strcpy(rt->address.x25_addr, "000000000000000");
  54         memcpy(rt->address.x25_addr, address->x25_addr, sigdigits);
  55
  56         rt->sigdigits = sigdigits;
  57         rt->dev       = dev;
  58         refcount_set(&rt->refcnt, 1);
  59
  60         list_add(&rt->node, &x25_route_list);
  61         rc = 0;
  62 out:
  63         write_unlock_bh(&x25_route_list_lock);
  64         return rc;
  65 }
  66
  67 /**
  68  * __x25_remove_route - remove route from x25_route_list
  69  * @rt: route to remove
  70  *
  71  * Remove route from x25_route_list. If it was there.
  72  * Caller must hold x25_route_list_lock.
  73  */
  74 static void __x25_remove_route(struct x25_route *rt)
  75 {
  76         if (rt->node.next) {
  77                 list_del(&rt->node);
  78                 x25_route_put(rt);
  79         }
  80 }
  81
  82 static int x25_del_route(struct x25_address *address, unsigned int sigdigits,
  83                          struct net_device *dev)
  84 {
  85         struct x25_route *rt;
  86         struct list_head *entry;
  87         int rc = -EINVAL;
  88
  89         write_lock_bh(&x25_route_list_lock);
  90
  91         list_for_each(entry, &x25_route_list) {
  92                 rt = list_entry(entry, struct x25_route, node);
  93
  94                 if (!memcmp(&rt->address, address, sigdigits) &&
  95                     rt->sigdigits == sigdigits && rt->dev == dev) {
  96                         __x25_remove_route(rt);
  97                         rc = 0;
  98                         break;
  99                 }
 100         }
 101
 102         write_unlock_bh(&x25_route_list_lock);
 103         return rc;
 104 }
 105
 106 /*
 107  *      A device has been removed, remove its routes.
 108  */
 109 void x25_route_device_down(struct net_device *dev)
 110 {
 111         struct x25_route *rt;
 112         struct list_head *entry, *tmp;
 113
 114         write_lock_bh(&x25_route_list_lock);
 115
 116         list_for_each_safe(entry, tmp, &x25_route_list) {
 117                 rt = list_entry(entry, struct x25_route, node);
 118
 119                 if (rt->dev == dev)
 120                         __x25_remove_route(rt);
 121         }
 122         write_unlock_bh(&x25_route_list_lock);
 123
 124         /* Remove any related forwarding */
 125         x25_clear_forward_by_dev(dev);
 126 }
 127
 128 /*
 129  *      Check that the device given is a valid X.25 interface that is "up".
 130  */
 131 struct net_device *x25_dev_get(char *devname)
 132 {
 133         struct net_device *dev = dev_get_by_name(&init_net, devname);
 134
 135         if (dev &&
 136             (!(dev->flags & IFF_UP) || (dev->type != ARPHRD_X25
 137 #if IS_ENABLED(CONFIG_LLC)
 138                                         && dev->type != ARPHRD_ETHER
 139 #endif
 140                                         ))){
 141                 dev_put(dev);
 142                 dev = NULL;
 143         }
 144
 145         return dev;
 146 }
 147
 148 /**
 149  *      x25_get_route - Find a route given an X.25 address.
 150  *      @addr - address to find a route for
 151  *
 152  *      Find a route given an X.25 address.
 153  */
 154 struct x25_route *x25_get_route(struct x25_address *addr)
 155 {
 156         struct x25_route *rt, *use = NULL;
 157         struct list_head *entry;
 158
 159         read_lock_bh(&x25_route_list_lock);
 160
 161         list_for_each(entry, &x25_route_list) {
 162                 rt = list_entry(entry, struct x25_route, node);
 163
 164                 if (!memcmp(&rt->address, addr, rt->sigdigits)) {
 165                         if (!use)
 166                                 use = rt;
 167                         else if (rt->sigdigits > use->sigdigits)
 168                                 use = rt;
 169                 }
 170         }
 171
 172         if (use)
 173                 x25_route_hold(use);
 174
 175         read_unlock_bh(&x25_route_list_lock);
 176         return use;
 177 }
 178
 179 /*
 180  *      Handle the ioctls that control the routing functions.
 181  */
 182 int x25_route_ioctl(unsigned int cmd, void __user *arg)
 183 {
 184         struct x25_route_struct rt;
 185         struct net_device *dev;
 186         int rc = -EINVAL;
 187
 188         if (cmd != SIOCADDRT && cmd != SIOCDELRT)
 189                 goto out;
 190
 191         rc = -EFAULT;
 192         if (copy_from_user(&rt, arg, sizeof(rt)))
 193                 goto out;
 194
 195         rc = -EINVAL;
 196         if (rt.sigdigits > 15)
 197                 goto out;
 198
 199         dev = x25_dev_get(rt.device);
 200         if (!dev)
 201                 goto out;
 202
 203         if (cmd == SIOCADDRT)
 204                 rc = x25_add_route(&rt.address, rt.sigdigits, dev);
 205         else
 206                 rc = x25_del_route(&rt.address, rt.sigdigits, dev);
 207         dev_put(dev);
 208 out:
 209         return rc;
 210 }
 211
 212 /*
 213  *      Release all memory associated with X.25 routing structures.
 214  */
 215 void __exit x25_route_free(void)
 216 {
 217         struct x25_route *rt;
 218         struct list_head *entry, *tmp;
 219
 220         write_lock_bh(&x25_route_list_lock);
 221         list_for_each_safe(entry, tmp, &x25_route_list) {
 222                 rt = list_entry(entry, struct x25_route, node);
 223                 __x25_remove_route(rt);
 224         }
 225         write_unlock_bh(&x25_route_list_lock);
 226 }