1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33#include <linux/percpu.h>
34#include <linux/seq_file.h>
35#include <linux/slab.h>
36#include <linux/proc_fs.h>
37#include <linux/export.h>
38
39#include "rds.h"
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64struct rds_info_iterator {
65 struct page **pages;
66 void *addr;
67 unsigned long offset;
68};
69
70static DEFINE_SPINLOCK(rds_info_lock);
71static rds_info_func rds_info_funcs[RDS_INFO_LAST - RDS_INFO_FIRST + 1];
72
73void rds_info_register_func(int optname, rds_info_func func)
74{
75 int offset = optname - RDS_INFO_FIRST;
76
77 BUG_ON(optname < RDS_INFO_FIRST || optname > RDS_INFO_LAST);
78
79 spin_lock(&rds_info_lock);
80 BUG_ON(rds_info_funcs[offset]);
81 rds_info_funcs[offset] = func;
82 spin_unlock(&rds_info_lock);
83}
84EXPORT_SYMBOL_GPL(rds_info_register_func);
85
86void rds_info_deregister_func(int optname, rds_info_func func)
87{
88 int offset = optname - RDS_INFO_FIRST;
89
90 BUG_ON(optname < RDS_INFO_FIRST || optname > RDS_INFO_LAST);
91
92 spin_lock(&rds_info_lock);
93 BUG_ON(rds_info_funcs[offset] != func);
94 rds_info_funcs[offset] = NULL;
95 spin_unlock(&rds_info_lock);
96}
97EXPORT_SYMBOL_GPL(rds_info_deregister_func);
98
99
100
101
102
103
104void rds_info_iter_unmap(struct rds_info_iterator *iter)
105{
106 if (iter->addr) {
107 kunmap_atomic(iter->addr);
108 iter->addr = NULL;
109 }
110}
111
112
113
114
115void rds_info_copy(struct rds_info_iterator *iter, void *data,
116 unsigned long bytes)
117{
118 unsigned long this;
119
120 while (bytes) {
121 if (!iter->addr)
122 iter->addr = kmap_atomic(*iter->pages);
123
124 this = min(bytes, PAGE_SIZE - iter->offset);
125
126 rdsdebug("page %p addr %p offset %lu this %lu data %p "
127 "bytes %lu\n", *iter->pages, iter->addr,
128 iter->offset, this, data, bytes);
129
130 memcpy(iter->addr + iter->offset, data, this);
131
132 data += this;
133 bytes -= this;
134 iter->offset += this;
135
136 if (iter->offset == PAGE_SIZE) {
137 kunmap_atomic(iter->addr);
138 iter->addr = NULL;
139 iter->offset = 0;
140 iter->pages++;
141 }
142 }
143}
144EXPORT_SYMBOL_GPL(rds_info_copy);
145
146
147
148
149
150
151
152
153
154
155
156
157
158int rds_info_getsockopt(struct socket *sock, int optname, char __user *optval,
159 int __user *optlen)
160{
161 struct rds_info_iterator iter;
162 struct rds_info_lengths lens;
163 unsigned long nr_pages = 0;
164 unsigned long start;
165 unsigned long i;
166 rds_info_func func;
167 struct page **pages = NULL;
168 int ret;
169 int len;
170 int total;
171
172 if (get_user(len, optlen)) {
173 ret = -EFAULT;
174 goto out;
175 }
176
177
178 start = (unsigned long)optval;
179 if (len < 0 || len > INT_MAX - PAGE_SIZE + 1 || start + len < start) {
180 ret = -EINVAL;
181 goto out;
182 }
183
184
185 if (len == 0)
186 goto call_func;
187
188 nr_pages = (PAGE_ALIGN(start + len) - (start & PAGE_MASK))
189 >> PAGE_SHIFT;
190
191 pages = kmalloc_array(nr_pages, sizeof(struct page *), GFP_KERNEL);
192 if (!pages) {
193 ret = -ENOMEM;
194 goto out;
195 }
196 ret = get_user_pages_fast(start, nr_pages, 1, pages);
197 if (ret != nr_pages) {
198 if (ret > 0)
199 nr_pages = ret;
200 else
201 nr_pages = 0;
202 ret = -EAGAIN;
203 goto out;
204 }
205
206 rdsdebug("len %d nr_pages %lu\n", len, nr_pages);
207
208call_func:
209 func = rds_info_funcs[optname - RDS_INFO_FIRST];
210 if (!func) {
211 ret = -ENOPROTOOPT;
212 goto out;
213 }
214
215 iter.pages = pages;
216 iter.addr = NULL;
217 iter.offset = start & (PAGE_SIZE - 1);
218
219 func(sock, len, &iter, &lens);
220 BUG_ON(lens.each == 0);
221
222 total = lens.nr * lens.each;
223
224 rds_info_iter_unmap(&iter);
225
226 if (total > len) {
227 len = total;
228 ret = -ENOSPC;
229 } else {
230 len = total;
231 ret = lens.each;
232 }
233
234 if (put_user(len, optlen))
235 ret = -EFAULT;
236
237out:
238 for (i = 0; pages && i < nr_pages; i++)
239 put_page(pages[i]);
240 kfree(pages);
241
242 return ret;
243}
244