Commit | Line | Data |
---|---|---|
40d8abde PD |
1 | /* |
2 | * Copyright (c) 2016 Citrix Systems Inc. | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU General Public License version 2 | |
6 | * as published by the Free Softare Foundation; or, when distributed | |
7 | * separately from the Linux kernel or incorporated into other | |
8 | * software packages, subject to the following license: | |
9 | * | |
10 | * Permission is hereby granted, free of charge, to any person obtaining a copy | |
11 | * of this source file (the "Software"), to deal in the Software without | |
12 | * restriction, including without limitation the rights to use, copy, modify, | |
13 | * merge, publish, distribute, sublicense, and/or sell copies of the Software, | |
14 | * and to permit persons to whom the Software is furnished to do so, subject to | |
15 | * the following conditions: | |
16 | * | |
17 | * The above copyright notice and this permission notice shall be included in | |
18 | * all copies or substantial portions of the Software. | |
19 | * | |
20 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
21 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
22 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE | |
23 | * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |
24 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING | |
25 | * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS | |
26 | * IN THE SOFTWARE. | |
27 | */ | |
28 | ||
29 | #define XEN_NETIF_DEFINE_TOEPLITZ | |
30 | ||
31 | #include "common.h" | |
32 | #include <linux/vmalloc.h> | |
33 | #include <linux/rculist.h> | |
34 | ||
40d8abde PD |
35 | static void xenvif_add_hash(struct xenvif *vif, const u8 *tag, |
36 | unsigned int len, u32 val) | |
37 | { | |
38 | struct xenvif_hash_cache_entry *new, *entry, *oldest; | |
39 | unsigned long flags; | |
40 | bool found; | |
41 | ||
42 | new = kmalloc(sizeof(*entry), GFP_KERNEL); | |
43 | if (!new) | |
44 | return; | |
45 | ||
46 | memcpy(new->tag, tag, len); | |
47 | new->len = len; | |
48 | new->val = val; | |
49 | ||
50 | spin_lock_irqsave(&vif->hash.cache.lock, flags); | |
51 | ||
52 | found = false; | |
53 | oldest = NULL; | |
54 | list_for_each_entry_rcu(entry, &vif->hash.cache.list, link) { | |
55 | /* Make sure we don't add duplicate entries */ | |
56 | if (entry->len == len && | |
57 | memcmp(entry->tag, tag, len) == 0) | |
58 | found = true; | |
59 | if (!oldest || entry->seq < oldest->seq) | |
60 | oldest = entry; | |
61 | } | |
62 | ||
63 | if (!found) { | |
64 | new->seq = atomic_inc_return(&vif->hash.cache.seq); | |
65 | list_add_rcu(&new->link, &vif->hash.cache.list); | |
66 | ||
67 | if (++vif->hash.cache.count > xenvif_hash_cache_size) { | |
68 | list_del_rcu(&oldest->link); | |
69 | vif->hash.cache.count--; | |
1345b1ac | 70 | kfree_rcu(oldest, rcu); |
40d8abde PD |
71 | } |
72 | } | |
73 | ||
74 | spin_unlock_irqrestore(&vif->hash.cache.lock, flags); | |
75 | ||
76 | if (found) | |
77 | kfree(new); | |
78 | } | |
79 | ||
80 | static u32 xenvif_new_hash(struct xenvif *vif, const u8 *data, | |
81 | unsigned int len) | |
82 | { | |
83 | u32 val; | |
84 | ||
85 | val = xen_netif_toeplitz_hash(vif->hash.key, | |
86 | sizeof(vif->hash.key), | |
87 | data, len); | |
88 | ||
89 | if (xenvif_hash_cache_size != 0) | |
90 | xenvif_add_hash(vif, data, len, val); | |
91 | ||
92 | return val; | |
93 | } | |
94 | ||
95 | static void xenvif_flush_hash(struct xenvif *vif) | |
96 | { | |
97 | struct xenvif_hash_cache_entry *entry; | |
98 | unsigned long flags; | |
99 | ||
100 | if (xenvif_hash_cache_size == 0) | |
101 | return; | |
102 | ||
103 | spin_lock_irqsave(&vif->hash.cache.lock, flags); | |
104 | ||
105 | list_for_each_entry_rcu(entry, &vif->hash.cache.list, link) { | |
106 | list_del_rcu(&entry->link); | |
107 | vif->hash.cache.count--; | |
1345b1ac | 108 | kfree_rcu(entry, rcu); |
40d8abde PD |
109 | } |
110 | ||
111 | spin_unlock_irqrestore(&vif->hash.cache.lock, flags); | |
112 | } | |
113 | ||
114 | static u32 xenvif_find_hash(struct xenvif *vif, const u8 *data, | |
115 | unsigned int len) | |
116 | { | |
117 | struct xenvif_hash_cache_entry *entry; | |
118 | u32 val; | |
119 | bool found; | |
120 | ||
121 | if (len >= XEN_NETBK_HASH_TAG_SIZE) | |
122 | return 0; | |
123 | ||
124 | if (xenvif_hash_cache_size == 0) | |
125 | return xenvif_new_hash(vif, data, len); | |
126 | ||
127 | rcu_read_lock(); | |
128 | ||
129 | found = false; | |
130 | ||
131 | list_for_each_entry_rcu(entry, &vif->hash.cache.list, link) { | |
132 | if (entry->len == len && | |
133 | memcmp(entry->tag, data, len) == 0) { | |
134 | val = entry->val; | |
135 | entry->seq = atomic_inc_return(&vif->hash.cache.seq); | |
136 | found = true; | |
137 | break; | |
138 | } | |
139 | } | |
140 | ||
141 | rcu_read_unlock(); | |
142 | ||
143 | if (!found) | |
144 | val = xenvif_new_hash(vif, data, len); | |
145 | ||
146 | return val; | |
147 | } | |
148 | ||
149 | void xenvif_set_skb_hash(struct xenvif *vif, struct sk_buff *skb) | |
150 | { | |
151 | struct flow_keys flow; | |
152 | u32 hash = 0; | |
153 | enum pkt_hash_types type = PKT_HASH_TYPE_NONE; | |
154 | u32 flags = vif->hash.flags; | |
155 | bool has_tcp_hdr; | |
156 | ||
157 | /* Quick rejection test: If the network protocol doesn't | |
158 | * correspond to any enabled hash type then there's no point | |
159 | * in parsing the packet header. | |
160 | */ | |
161 | switch (skb->protocol) { | |
162 | case htons(ETH_P_IP): | |
163 | if (flags & (XEN_NETIF_CTRL_HASH_TYPE_IPV4_TCP | | |
164 | XEN_NETIF_CTRL_HASH_TYPE_IPV4)) | |
165 | break; | |
166 | ||
167 | goto done; | |
168 | ||
169 | case htons(ETH_P_IPV6): | |
170 | if (flags & (XEN_NETIF_CTRL_HASH_TYPE_IPV6_TCP | | |
171 | XEN_NETIF_CTRL_HASH_TYPE_IPV6)) | |
172 | break; | |
173 | ||
174 | goto done; | |
175 | ||
176 | default: | |
177 | goto done; | |
178 | } | |
179 | ||
180 | memset(&flow, 0, sizeof(flow)); | |
181 | if (!skb_flow_dissect_flow_keys(skb, &flow, 0)) | |
182 | goto done; | |
183 | ||
184 | has_tcp_hdr = (flow.basic.ip_proto == IPPROTO_TCP) && | |
185 | !(flow.control.flags & FLOW_DIS_IS_FRAGMENT); | |
186 | ||
187 | switch (skb->protocol) { | |
188 | case htons(ETH_P_IP): | |
189 | if (has_tcp_hdr && | |
190 | (flags & XEN_NETIF_CTRL_HASH_TYPE_IPV4_TCP)) { | |
191 | u8 data[12]; | |
192 | ||
193 | memcpy(&data[0], &flow.addrs.v4addrs.src, 4); | |
194 | memcpy(&data[4], &flow.addrs.v4addrs.dst, 4); | |
195 | memcpy(&data[8], &flow.ports.src, 2); | |
196 | memcpy(&data[10], &flow.ports.dst, 2); | |
197 | ||
198 | hash = xenvif_find_hash(vif, data, sizeof(data)); | |
199 | type = PKT_HASH_TYPE_L4; | |
200 | } else if (flags & XEN_NETIF_CTRL_HASH_TYPE_IPV4) { | |
201 | u8 data[8]; | |
202 | ||
203 | memcpy(&data[0], &flow.addrs.v4addrs.src, 4); | |
204 | memcpy(&data[4], &flow.addrs.v4addrs.dst, 4); | |
205 | ||
206 | hash = xenvif_find_hash(vif, data, sizeof(data)); | |
207 | type = PKT_HASH_TYPE_L3; | |
208 | } | |
209 | ||
210 | break; | |
211 | ||
212 | case htons(ETH_P_IPV6): | |
213 | if (has_tcp_hdr && | |
214 | (flags & XEN_NETIF_CTRL_HASH_TYPE_IPV6_TCP)) { | |
215 | u8 data[36]; | |
216 | ||
217 | memcpy(&data[0], &flow.addrs.v6addrs.src, 16); | |
218 | memcpy(&data[16], &flow.addrs.v6addrs.dst, 16); | |
219 | memcpy(&data[32], &flow.ports.src, 2); | |
220 | memcpy(&data[34], &flow.ports.dst, 2); | |
221 | ||
222 | hash = xenvif_find_hash(vif, data, sizeof(data)); | |
223 | type = PKT_HASH_TYPE_L4; | |
224 | } else if (flags & XEN_NETIF_CTRL_HASH_TYPE_IPV6) { | |
225 | u8 data[32]; | |
226 | ||
227 | memcpy(&data[0], &flow.addrs.v6addrs.src, 16); | |
228 | memcpy(&data[16], &flow.addrs.v6addrs.dst, 16); | |
229 | ||
230 | hash = xenvif_find_hash(vif, data, sizeof(data)); | |
231 | type = PKT_HASH_TYPE_L3; | |
232 | } | |
233 | ||
234 | break; | |
235 | } | |
236 | ||
237 | done: | |
238 | if (type == PKT_HASH_TYPE_NONE) | |
239 | skb_clear_hash(skb); | |
240 | else | |
241 | __skb_set_sw_hash(skb, hash, type == PKT_HASH_TYPE_L4); | |
242 | } | |
243 | ||
244 | u32 xenvif_set_hash_alg(struct xenvif *vif, u32 alg) | |
245 | { | |
246 | switch (alg) { | |
247 | case XEN_NETIF_CTRL_HASH_ALGORITHM_NONE: | |
248 | case XEN_NETIF_CTRL_HASH_ALGORITHM_TOEPLITZ: | |
249 | break; | |
250 | ||
251 | default: | |
252 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
253 | } | |
254 | ||
255 | vif->hash.alg = alg; | |
256 | ||
257 | return XEN_NETIF_CTRL_STATUS_SUCCESS; | |
258 | } | |
259 | ||
260 | u32 xenvif_get_hash_flags(struct xenvif *vif, u32 *flags) | |
261 | { | |
262 | if (vif->hash.alg == XEN_NETIF_CTRL_HASH_ALGORITHM_NONE) | |
263 | return XEN_NETIF_CTRL_STATUS_NOT_SUPPORTED; | |
264 | ||
265 | *flags = XEN_NETIF_CTRL_HASH_TYPE_IPV4 | | |
266 | XEN_NETIF_CTRL_HASH_TYPE_IPV4_TCP | | |
267 | XEN_NETIF_CTRL_HASH_TYPE_IPV6 | | |
268 | XEN_NETIF_CTRL_HASH_TYPE_IPV6_TCP; | |
269 | ||
270 | return XEN_NETIF_CTRL_STATUS_SUCCESS; | |
271 | } | |
272 | ||
273 | u32 xenvif_set_hash_flags(struct xenvif *vif, u32 flags) | |
274 | { | |
275 | if (flags & ~(XEN_NETIF_CTRL_HASH_TYPE_IPV4 | | |
276 | XEN_NETIF_CTRL_HASH_TYPE_IPV4_TCP | | |
277 | XEN_NETIF_CTRL_HASH_TYPE_IPV6 | | |
278 | XEN_NETIF_CTRL_HASH_TYPE_IPV6_TCP)) | |
279 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
280 | ||
281 | if (vif->hash.alg == XEN_NETIF_CTRL_HASH_ALGORITHM_NONE) | |
282 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
283 | ||
284 | vif->hash.flags = flags; | |
285 | ||
286 | return XEN_NETIF_CTRL_STATUS_SUCCESS; | |
287 | } | |
288 | ||
289 | u32 xenvif_set_hash_key(struct xenvif *vif, u32 gref, u32 len) | |
290 | { | |
291 | u8 *key = vif->hash.key; | |
292 | struct gnttab_copy copy_op = { | |
293 | .source.u.ref = gref, | |
294 | .source.domid = vif->domid, | |
295 | .dest.u.gmfn = virt_to_gfn(key), | |
296 | .dest.domid = DOMID_SELF, | |
297 | .dest.offset = xen_offset_in_page(key), | |
298 | .len = len, | |
299 | .flags = GNTCOPY_source_gref | |
300 | }; | |
301 | ||
302 | if (len > XEN_NETBK_MAX_HASH_KEY_SIZE) | |
303 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
304 | ||
f86911e2 | 305 | if (copy_op.len != 0) { |
40d8abde PD |
306 | gnttab_batch_copy(©_op, 1); |
307 | ||
308 | if (copy_op.status != GNTST_okay) | |
309 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
310 | } | |
311 | ||
312 | /* Clear any remaining key octets */ | |
313 | if (len < XEN_NETBK_MAX_HASH_KEY_SIZE) | |
314 | memset(key + len, 0, XEN_NETBK_MAX_HASH_KEY_SIZE - len); | |
315 | ||
316 | xenvif_flush_hash(vif); | |
317 | ||
318 | return XEN_NETIF_CTRL_STATUS_SUCCESS; | |
319 | } | |
320 | ||
321 | u32 xenvif_set_hash_mapping_size(struct xenvif *vif, u32 size) | |
322 | { | |
323 | if (size > XEN_NETBK_MAX_HASH_MAPPING_SIZE) | |
324 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
325 | ||
326 | vif->hash.size = size; | |
327 | memset(vif->hash.mapping, 0, sizeof(u32) * size); | |
328 | ||
329 | return XEN_NETIF_CTRL_STATUS_SUCCESS; | |
330 | } | |
331 | ||
332 | u32 xenvif_set_hash_mapping(struct xenvif *vif, u32 gref, u32 len, | |
333 | u32 off) | |
334 | { | |
335 | u32 *mapping = &vif->hash.mapping[off]; | |
336 | struct gnttab_copy copy_op = { | |
337 | .source.u.ref = gref, | |
338 | .source.domid = vif->domid, | |
339 | .dest.u.gmfn = virt_to_gfn(mapping), | |
340 | .dest.domid = DOMID_SELF, | |
341 | .dest.offset = xen_offset_in_page(mapping), | |
342 | .len = len * sizeof(u32), | |
343 | .flags = GNTCOPY_source_gref | |
344 | }; | |
345 | ||
346 | if ((off + len > vif->hash.size) || copy_op.len > XEN_PAGE_SIZE) | |
347 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
348 | ||
349 | while (len-- != 0) | |
350 | if (mapping[off++] >= vif->num_queues) | |
351 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
352 | ||
f86911e2 | 353 | if (copy_op.len != 0) { |
40d8abde PD |
354 | gnttab_batch_copy(©_op, 1); |
355 | ||
356 | if (copy_op.status != GNTST_okay) | |
357 | return XEN_NETIF_CTRL_STATUS_INVALID_PARAMETER; | |
358 | } | |
359 | ||
360 | return XEN_NETIF_CTRL_STATUS_SUCCESS; | |
361 | } | |
362 | ||
c0c64c15 PD |
363 | #ifdef CONFIG_DEBUG_FS |
364 | void xenvif_dump_hash_info(struct xenvif *vif, struct seq_file *m) | |
365 | { | |
366 | unsigned int i; | |
367 | ||
368 | switch (vif->hash.alg) { | |
369 | case XEN_NETIF_CTRL_HASH_ALGORITHM_TOEPLITZ: | |
370 | seq_puts(m, "Hash Algorithm: TOEPLITZ\n"); | |
371 | break; | |
372 | ||
373 | case XEN_NETIF_CTRL_HASH_ALGORITHM_NONE: | |
374 | seq_puts(m, "Hash Algorithm: NONE\n"); | |
375 | /* FALLTHRU */ | |
376 | default: | |
377 | return; | |
378 | } | |
379 | ||
380 | if (vif->hash.flags) { | |
381 | seq_puts(m, "\nHash Flags:\n"); | |
382 | ||
383 | if (vif->hash.flags & XEN_NETIF_CTRL_HASH_TYPE_IPV4) | |
384 | seq_puts(m, "- IPv4\n"); | |
385 | if (vif->hash.flags & XEN_NETIF_CTRL_HASH_TYPE_IPV4_TCP) | |
386 | seq_puts(m, "- IPv4 + TCP\n"); | |
387 | if (vif->hash.flags & XEN_NETIF_CTRL_HASH_TYPE_IPV6) | |
388 | seq_puts(m, "- IPv6\n"); | |
389 | if (vif->hash.flags & XEN_NETIF_CTRL_HASH_TYPE_IPV6_TCP) | |
390 | seq_puts(m, "- IPv6 + TCP\n"); | |
391 | } | |
392 | ||
393 | seq_puts(m, "\nHash Key:\n"); | |
394 | ||
395 | for (i = 0; i < XEN_NETBK_MAX_HASH_KEY_SIZE; ) { | |
396 | unsigned int j, n; | |
397 | ||
398 | n = 8; | |
399 | if (i + n >= XEN_NETBK_MAX_HASH_KEY_SIZE) | |
400 | n = XEN_NETBK_MAX_HASH_KEY_SIZE - i; | |
401 | ||
402 | seq_printf(m, "[%2u - %2u]: ", i, i + n - 1); | |
403 | ||
404 | for (j = 0; j < n; j++, i++) | |
405 | seq_printf(m, "%02x ", vif->hash.key[i]); | |
406 | ||
407 | seq_puts(m, "\n"); | |
408 | } | |
409 | ||
410 | if (vif->hash.size != 0) { | |
411 | seq_puts(m, "\nHash Mapping:\n"); | |
412 | ||
413 | for (i = 0; i < vif->hash.size; ) { | |
414 | unsigned int j, n; | |
415 | ||
416 | n = 8; | |
417 | if (i + n >= vif->hash.size) | |
418 | n = vif->hash.size - i; | |
419 | ||
420 | seq_printf(m, "[%4u - %4u]: ", i, i + n - 1); | |
421 | ||
422 | for (j = 0; j < n; j++, i++) | |
423 | seq_printf(m, "%4u ", vif->hash.mapping[i]); | |
424 | ||
425 | seq_puts(m, "\n"); | |
426 | } | |
427 | } | |
428 | } | |
429 | #endif /* CONFIG_DEBUG_FS */ | |
430 | ||
40d8abde PD |
431 | void xenvif_init_hash(struct xenvif *vif) |
432 | { | |
433 | if (xenvif_hash_cache_size == 0) | |
434 | return; | |
435 | ||
436 | spin_lock_init(&vif->hash.cache.lock); | |
437 | INIT_LIST_HEAD(&vif->hash.cache.list); | |
438 | } | |
439 | ||
440 | void xenvif_deinit_hash(struct xenvif *vif) | |
441 | { | |
442 | xenvif_flush_hash(vif); | |
443 | } |