Merge branch 'fix/asoc' into for-linus
[linux-2.6] / 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(const 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(const struct sockaddr_atmsvc *a, const 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(const 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, const 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, const 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 }