Root/
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 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9