net/atm/addr.c

   1 /* net/atm/addr.c - Local ATM address registry */
   2
   3 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
   4
   5 #include <linux/atm.h>
   6 #include <linux/atmdev.h>
   7 #include <asm/uaccess.h>
   8
   9 #include "signaling.h"
  10 #include "addr.h"
  11
  12 static int check_addr(struct sockaddr_atmsvc *addr)
  13 {
  14         int i;
  15
  16         if (addr->sas_family != AF_ATMSVC)
  17                 return -EAFNOSUPPORT;
  18         if (!*addr->sas_addr.pub)
  19                 return *addr->sas_addr.prv ? 0 : -EINVAL;
  20         for (i = 1; i < ATM_E164_LEN + 1; i++)  /* make sure it's \0-terminated */
  21                 if (!addr->sas_addr.pub[i])
  22                         return 0;
  23         return -EINVAL;
  24 }
  25
  26 static int identical(struct sockaddr_atmsvc *a, struct sockaddr_atmsvc *b)
  27 {
  28         if (*a->sas_addr.prv)
  29                 if (memcmp(a->sas_addr.prv, b->sas_addr.prv, ATM_ESA_LEN))
  30                         return 0;
  31         if (!*a->sas_addr.pub)
  32                 return !*b->sas_addr.pub;
  33         if (!*b->sas_addr.pub)
  34                 return 0;
  35         return !strcmp(a->sas_addr.pub, b->sas_addr.pub);
  36 }
  37
  38 static void notify_sigd(struct atm_dev *dev)
  39 {
  40         struct sockaddr_atmpvc pvc;
  41
  42         pvc.sap_addr.itf = dev->number;
  43         sigd_enq(NULL, as_itf_notify, NULL, &pvc, NULL);
  44 }
  45
  46 void atm_reset_addr(struct atm_dev *dev, enum atm_addr_type_t atype)
  47 {
  48         unsigned long flags;
  49         struct atm_dev_addr *this, *p;
  50         struct list_head *head;
  51
  52         spin_lock_irqsave(&dev->lock, flags);
  53         if (atype == ATM_ADDR_LECS)
  54                 head = &dev->lecs;
  55         else
  56                 head = &dev->local;
  57         list_for_each_entry_safe(this, p, head, entry) {
  58                 list_del(&this->entry);
  59                 kfree(this);
  60         }
  61         spin_unlock_irqrestore(&dev->lock, flags);
  62         if (head == &dev->local)
  63                 notify_sigd(dev);
  64 }
  65
  66 int atm_add_addr(struct atm_dev *dev, struct sockaddr_atmsvc *addr,
  67                  enum atm_addr_type_t atype)
  68 {
  69         unsigned long flags;
  70         struct atm_dev_addr *this;
  71         struct list_head *head;
  72         int error;
  73
  74         error = check_addr(addr);
  75         if (error)
  76                 return error;
  77         spin_lock_irqsave(&dev->lock, flags);
  78         if (atype == ATM_ADDR_LECS)
  79                 head = &dev->lecs;
  80         else
  81                 head = &dev->local;
  82         list_for_each_entry(this, head, entry) {
  83                 if (identical(&this->addr, addr)) {
  84                         spin_unlock_irqrestore(&dev->lock, flags);
  85                         return -EEXIST;
  86                 }
  87         }
  88         this = kmalloc(sizeof(struct atm_dev_addr), GFP_ATOMIC);
  89         if (!this) {
  90                 spin_unlock_irqrestore(&dev->lock, flags);
  91                 return -ENOMEM;
  92         }
  93         this->addr = *addr;
  94         list_add(&this->entry, head);
  95         spin_unlock_irqrestore(&dev->lock, flags);
  96         if (head == &dev->local)
  97                 notify_sigd(dev);
  98         return 0;
  99 }
 100
 101 int atm_del_addr(struct atm_dev *dev, struct sockaddr_atmsvc *addr,
 102                  enum atm_addr_type_t atype)
 103 {
 104         unsigned long flags;
 105         struct atm_dev_addr *this;
 106         struct list_head *head;
 107         int error;
 108
 109         error = check_addr(addr);
 110         if (error)
 111                 return error;
 112         spin_lock_irqsave(&dev->lock, flags);
 113         if (atype == ATM_ADDR_LECS)
 114                 head = &dev->lecs;
 115         else
 116                 head = &dev->local;
 117         list_for_each_entry(this, head, entry) {
 118                 if (identical(&this->addr, addr)) {
 119                         list_del(&this->entry);
 120                         spin_unlock_irqrestore(&dev->lock, flags);
 121                         kfree(this);
 122                         if (head == &dev->local)
 123                                 notify_sigd(dev);
 124                         return 0;
 125                 }
 126         }
 127         spin_unlock_irqrestore(&dev->lock, flags);
 128         return -ENOENT;
 129 }
 130
 131 int atm_get_addr(struct atm_dev *dev, struct sockaddr_atmsvc __user * buf,
 132                  size_t size, enum atm_addr_type_t atype)
 133 {
 134         unsigned long flags;
 135         struct atm_dev_addr *this;
 136         struct list_head *head;
 137         int total = 0, error;
 138         struct sockaddr_atmsvc *tmp_buf, *tmp_bufp;
 139
 140         spin_lock_irqsave(&dev->lock, flags);
 141         if (atype == ATM_ADDR_LECS)
 142                 head = &dev->lecs;
 143         else
 144                 head = &dev->local;
 145         list_for_each_entry(this, head, entry)
 146             total += sizeof(struct sockaddr_atmsvc);
 147         tmp_buf = tmp_bufp = kmalloc(total, GFP_ATOMIC);
 148         if (!tmp_buf) {
 149                 spin_unlock_irqrestore(&dev->lock, flags);
 150                 return -ENOMEM;
 151         }
 152         list_for_each_entry(this, head, entry)
 153             memcpy(tmp_bufp++, &this->addr, sizeof(struct sockaddr_atmsvc));
 154         spin_unlock_irqrestore(&dev->lock, flags);
 155         error = total > size ? -E2BIG : total;
 156         if (copy_to_user(buf, tmp_buf, total < size ? total : size))
 157                 error = -EFAULT;
 158         kfree(tmp_buf);
 159         return error;
 160 }