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