treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / net / wireguard / ratelimiter.c
blob3fedd1d21f5ee019917a7280294cfc7398e65b11
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2015-2019 Jason A. Donenfeld <Jason@zx2c4.com>. All Rights Reserved.
4 */
6 #include "ratelimiter.h"
7 #include <linux/siphash.h>
8 #include <linux/mm.h>
9 #include <linux/slab.h>
10 #include <net/ip.h>
12 static struct kmem_cache *entry_cache;
13 static hsiphash_key_t key;
14 static spinlock_t table_lock = __SPIN_LOCK_UNLOCKED("ratelimiter_table_lock");
15 static DEFINE_MUTEX(init_lock);
16 static u64 init_refcnt; /* Protected by init_lock, hence not atomic. */
17 static atomic_t total_entries = ATOMIC_INIT(0);
18 static unsigned int max_entries, table_size;
19 static void wg_ratelimiter_gc_entries(struct work_struct *);
20 static DECLARE_DEFERRABLE_WORK(gc_work, wg_ratelimiter_gc_entries);
21 static struct hlist_head *table_v4;
22 #if IS_ENABLED(CONFIG_IPV6)
23 static struct hlist_head *table_v6;
24 #endif
26 struct ratelimiter_entry {
27 u64 last_time_ns, tokens, ip;
28 void *net;
29 spinlock_t lock;
30 struct hlist_node hash;
31 struct rcu_head rcu;
34 enum {
35 PACKETS_PER_SECOND = 20,
36 PACKETS_BURSTABLE = 5,
37 PACKET_COST = NSEC_PER_SEC / PACKETS_PER_SECOND,
38 TOKEN_MAX = PACKET_COST * PACKETS_BURSTABLE
41 static void entry_free(struct rcu_head *rcu)
43 kmem_cache_free(entry_cache,
44 container_of(rcu, struct ratelimiter_entry, rcu));
45 atomic_dec(&total_entries);
48 static void entry_uninit(struct ratelimiter_entry *entry)
50 hlist_del_rcu(&entry->hash);
51 call_rcu(&entry->rcu, entry_free);
54 /* Calling this function with a NULL work uninits all entries. */
55 static void wg_ratelimiter_gc_entries(struct work_struct *work)
57 const u64 now = ktime_get_coarse_boottime_ns();
58 struct ratelimiter_entry *entry;
59 struct hlist_node *temp;
60 unsigned int i;
62 for (i = 0; i < table_size; ++i) {
63 spin_lock(&table_lock);
64 hlist_for_each_entry_safe(entry, temp, &table_v4[i], hash) {
65 if (unlikely(!work) ||
66 now - entry->last_time_ns > NSEC_PER_SEC)
67 entry_uninit(entry);
69 #if IS_ENABLED(CONFIG_IPV6)
70 hlist_for_each_entry_safe(entry, temp, &table_v6[i], hash) {
71 if (unlikely(!work) ||
72 now - entry->last_time_ns > NSEC_PER_SEC)
73 entry_uninit(entry);
75 #endif
76 spin_unlock(&table_lock);
77 if (likely(work))
78 cond_resched();
80 if (likely(work))
81 queue_delayed_work(system_power_efficient_wq, &gc_work, HZ);
84 bool wg_ratelimiter_allow(struct sk_buff *skb, struct net *net)
86 /* We only take the bottom half of the net pointer, so that we can hash
87 * 3 words in the end. This way, siphash's len param fits into the final
88 * u32, and we don't incur an extra round.
90 const u32 net_word = (unsigned long)net;
91 struct ratelimiter_entry *entry;
92 struct hlist_head *bucket;
93 u64 ip;
95 if (skb->protocol == htons(ETH_P_IP)) {
96 ip = (u64 __force)ip_hdr(skb)->saddr;
97 bucket = &table_v4[hsiphash_2u32(net_word, ip, &key) &
98 (table_size - 1)];
100 #if IS_ENABLED(CONFIG_IPV6)
101 else if (skb->protocol == htons(ETH_P_IPV6)) {
102 /* Only use 64 bits, so as to ratelimit the whole /64. */
103 memcpy(&ip, &ipv6_hdr(skb)->saddr, sizeof(ip));
104 bucket = &table_v6[hsiphash_3u32(net_word, ip >> 32, ip, &key) &
105 (table_size - 1)];
107 #endif
108 else
109 return false;
110 rcu_read_lock();
111 hlist_for_each_entry_rcu(entry, bucket, hash) {
112 if (entry->net == net && entry->ip == ip) {
113 u64 now, tokens;
114 bool ret;
115 /* Quasi-inspired by nft_limit.c, but this is actually a
116 * slightly different algorithm. Namely, we incorporate
117 * the burst as part of the maximum tokens, rather than
118 * as part of the rate.
120 spin_lock(&entry->lock);
121 now = ktime_get_coarse_boottime_ns();
122 tokens = min_t(u64, TOKEN_MAX,
123 entry->tokens + now -
124 entry->last_time_ns);
125 entry->last_time_ns = now;
126 ret = tokens >= PACKET_COST;
127 entry->tokens = ret ? tokens - PACKET_COST : tokens;
128 spin_unlock(&entry->lock);
129 rcu_read_unlock();
130 return ret;
133 rcu_read_unlock();
135 if (atomic_inc_return(&total_entries) > max_entries)
136 goto err_oom;
138 entry = kmem_cache_alloc(entry_cache, GFP_KERNEL);
139 if (unlikely(!entry))
140 goto err_oom;
142 entry->net = net;
143 entry->ip = ip;
144 INIT_HLIST_NODE(&entry->hash);
145 spin_lock_init(&entry->lock);
146 entry->last_time_ns = ktime_get_coarse_boottime_ns();
147 entry->tokens = TOKEN_MAX - PACKET_COST;
148 spin_lock(&table_lock);
149 hlist_add_head_rcu(&entry->hash, bucket);
150 spin_unlock(&table_lock);
151 return true;
153 err_oom:
154 atomic_dec(&total_entries);
155 return false;
158 int wg_ratelimiter_init(void)
160 mutex_lock(&init_lock);
161 if (++init_refcnt != 1)
162 goto out;
164 entry_cache = KMEM_CACHE(ratelimiter_entry, 0);
165 if (!entry_cache)
166 goto err;
168 /* xt_hashlimit.c uses a slightly different algorithm for ratelimiting,
169 * but what it shares in common is that it uses a massive hashtable. So,
170 * we borrow their wisdom about good table sizes on different systems
171 * dependent on RAM. This calculation here comes from there.
173 table_size = (totalram_pages() > (1U << 30) / PAGE_SIZE) ? 8192 :
174 max_t(unsigned long, 16, roundup_pow_of_two(
175 (totalram_pages() << PAGE_SHIFT) /
176 (1U << 14) / sizeof(struct hlist_head)));
177 max_entries = table_size * 8;
179 table_v4 = kvzalloc(table_size * sizeof(*table_v4), GFP_KERNEL);
180 if (unlikely(!table_v4))
181 goto err_kmemcache;
183 #if IS_ENABLED(CONFIG_IPV6)
184 table_v6 = kvzalloc(table_size * sizeof(*table_v6), GFP_KERNEL);
185 if (unlikely(!table_v6)) {
186 kvfree(table_v4);
187 goto err_kmemcache;
189 #endif
191 queue_delayed_work(system_power_efficient_wq, &gc_work, HZ);
192 get_random_bytes(&key, sizeof(key));
193 out:
194 mutex_unlock(&init_lock);
195 return 0;
197 err_kmemcache:
198 kmem_cache_destroy(entry_cache);
199 err:
200 --init_refcnt;
201 mutex_unlock(&init_lock);
202 return -ENOMEM;
205 void wg_ratelimiter_uninit(void)
207 mutex_lock(&init_lock);
208 if (!init_refcnt || --init_refcnt)
209 goto out;
211 cancel_delayed_work_sync(&gc_work);
212 wg_ratelimiter_gc_entries(NULL);
213 rcu_barrier();
214 kvfree(table_v4);
215 #if IS_ENABLED(CONFIG_IPV6)
216 kvfree(table_v6);
217 #endif
218 kmem_cache_destroy(entry_cache);
219 out:
220 mutex_unlock(&init_lock);
223 #include "selftest/ratelimiter.c"