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/highmem.h>
34#include <linux/gfp.h>
35
36#include "rds.h"
37
38struct rds_page_remainder {
39 struct page *r_page;
40 unsigned long r_offset;
41};
42
43DEFINE_PER_CPU_SHARED_ALIGNED(struct rds_page_remainder, rds_page_remainders);
44
45
46
47
48
49
50
51
52
53int rds_page_copy_user(struct page *page, unsigned long offset,
54 void __user *ptr, unsigned long bytes,
55 int to_user)
56{
57 unsigned long ret;
58 void *addr;
59
60 if (to_user)
61 rds_stats_add(s_copy_to_user, bytes);
62 else
63 rds_stats_add(s_copy_from_user, bytes);
64
65 addr = kmap_atomic(page, KM_USER0);
66 if (to_user)
67 ret = __copy_to_user_inatomic(ptr, addr + offset, bytes);
68 else
69 ret = __copy_from_user_inatomic(addr + offset, ptr, bytes);
70 kunmap_atomic(addr, KM_USER0);
71
72 if (ret) {
73 addr = kmap(page);
74 if (to_user)
75 ret = copy_to_user(ptr, addr + offset, bytes);
76 else
77 ret = copy_from_user(addr + offset, ptr, bytes);
78 kunmap(page);
79 if (ret)
80 return -EFAULT;
81 }
82
83 return 0;
84}
85EXPORT_SYMBOL_GPL(rds_page_copy_user);
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106int rds_page_remainder_alloc(struct scatterlist *scat, unsigned long bytes,
107 gfp_t gfp)
108{
109 struct rds_page_remainder *rem;
110 unsigned long flags;
111 struct page *page;
112 int ret;
113
114 gfp |= __GFP_HIGHMEM;
115
116
117 if (bytes >= PAGE_SIZE) {
118 page = alloc_page(gfp);
119 if (page == NULL) {
120 ret = -ENOMEM;
121 } else {
122 sg_set_page(scat, page, PAGE_SIZE, 0);
123 ret = 0;
124 }
125 goto out;
126 }
127
128 rem = &per_cpu(rds_page_remainders, get_cpu());
129 local_irq_save(flags);
130
131 while (1) {
132
133 if (rem->r_page && bytes > (PAGE_SIZE - rem->r_offset)) {
134 rds_stats_inc(s_page_remainder_miss);
135 __free_page(rem->r_page);
136 rem->r_page = NULL;
137 }
138
139
140 if (rem->r_page && bytes <= (PAGE_SIZE - rem->r_offset)) {
141 sg_set_page(scat, rem->r_page, bytes, rem->r_offset);
142 get_page(sg_page(scat));
143
144 if (rem->r_offset != 0)
145 rds_stats_inc(s_page_remainder_hit);
146
147 rem->r_offset += bytes;
148 if (rem->r_offset == PAGE_SIZE) {
149 __free_page(rem->r_page);
150 rem->r_page = NULL;
151 }
152 ret = 0;
153 break;
154 }
155
156
157 local_irq_restore(flags);
158 put_cpu();
159
160 page = alloc_page(gfp);
161
162 rem = &per_cpu(rds_page_remainders, get_cpu());
163 local_irq_save(flags);
164
165 if (page == NULL) {
166 ret = -ENOMEM;
167 break;
168 }
169
170
171 if (rem->r_page) {
172 __free_page(page);
173 continue;
174 }
175
176
177 rem->r_page = page;
178 rem->r_offset = 0;
179 }
180
181 local_irq_restore(flags);
182 put_cpu();
183out:
184 rdsdebug("bytes %lu ret %d %p %u %u\n", bytes, ret,
185 ret ? NULL : sg_page(scat), ret ? 0 : scat->offset,
186 ret ? 0 : scat->length);
187 return ret;
188}
189
190static int rds_page_remainder_cpu_notify(struct notifier_block *self,
191 unsigned long action, void *hcpu)
192{
193 struct rds_page_remainder *rem;
194 long cpu = (long)hcpu;
195
196 rem = &per_cpu(rds_page_remainders, cpu);
197
198 rdsdebug("cpu %ld action 0x%lx\n", cpu, action);
199
200 switch (action) {
201 case CPU_DEAD:
202 if (rem->r_page)
203 __free_page(rem->r_page);
204 rem->r_page = NULL;
205 break;
206 }
207
208 return 0;
209}
210
211static struct notifier_block rds_page_remainder_nb = {
212 .notifier_call = rds_page_remainder_cpu_notify,
213};
214
215void rds_page_exit(void)
216{
217 int i;
218
219 for_each_possible_cpu(i)
220 rds_page_remainder_cpu_notify(&rds_page_remainder_nb,
221 (unsigned long)CPU_DEAD,
222 (void *)(long)i);
223}
224