1 // SPDX-License-Identifier: GPL-2.0
18 nsim_do_psp(struct sk_buff *skb, struct netdevsim *ns,  in nsim_do_psp()  argument
40 	if (*ptr != ns) {  in nsim_do_psp()
45 	net = sock_net(skb->sk);  in nsim_do_psp()
46 	if (!psp_dev_encapsulate(net, skb, pas->tx.spi, pas->version, 0)) {  in nsim_do_psp()
52 	peer_psd = rcu_dereference(peer_ns->psp.dev);  in nsim_do_psp()
53 	if (peer_psd && peer_psd->config.versions & (1 << pas->version)) {  in nsim_do_psp()
62 		generation = pas->tx.key[0];  in nsim_do_psp()
65 		skb->mac_len = ETH_HLEN;  in nsim_do_psp()
66 		if (psp_dev_rcv(skb, peer_psd->id, generation, strip_icv)) {  in nsim_do_psp()
71 		*psp_ext = skb->extensions;  in nsim_do_psp()
72 		refcount_inc(&(*psp_ext)->refcnt);  in nsim_do_psp()
73 		skb->decrypted = 1;  in nsim_do_psp()
75 		u64_stats_update_begin(&ns->psp.syncp);  in nsim_do_psp()
76 		u64_stats_inc(&ns->psp.tx_packets);  in nsim_do_psp()
77 		u64_stats_inc(&ns->psp.rx_packets);  in nsim_do_psp()
78 		u64_stats_add(&ns->psp.tx_bytes,  in nsim_do_psp()
79 			      skb->len - skb_inner_transport_offset(skb));  in nsim_do_psp()
80 		u64_stats_add(&ns->psp.rx_bytes,  in nsim_do_psp()
81 			      skb->len - skb_inner_transport_offset(skb));  in nsim_do_psp()
82 		u64_stats_update_end(&ns->psp.syncp);  in nsim_do_psp()
96 				    ntohs(uh->len), 0);  in nsim_do_psp()
98 		switch (skb->protocol) {  in nsim_do_psp()
101 			uh->check = udp_v4_check(ntohs(uh->len), iph->saddr,  in nsim_do_psp()
102 						 iph->daddr, csum);  in nsim_do_psp()
107 			uh->check = udp_v6_check(ntohs(uh->len), &ip6h->saddr,  in nsim_do_psp()
108 						 &ip6h->daddr, csum);  in nsim_do_psp()
113 		uh->check	= uh->check ?: CSUM_MANGLED_0;  in nsim_do_psp()
114 		skb->ip_summed	= CHECKSUM_NONE;  in nsim_do_psp()
134 	struct netdevsim *ns = psd->drv_priv;  in nsim_rx_spi_alloc()  local
138 	new = ++ns->psp.spi & PSP_SPI_KEY_ID;  in nsim_rx_spi_alloc()
139 	if (psd->generation & 1)  in nsim_rx_spi_alloc()
142 	assoc->spi = cpu_to_be32(new);  in nsim_rx_spi_alloc()
143 	assoc->key[0] = psd->generation;  in nsim_rx_spi_alloc()
145 		assoc->key[i] = ns->psp.spi + i;  in nsim_rx_spi_alloc()
153 	struct netdevsim *ns = psd->drv_priv;  in nsim_assoc_add()  local
157 	*ptr = psd->drv_priv;  in nsim_assoc_add()
158 	ns->psp.assoc_cnt++;  in nsim_assoc_add()
170 	struct netdevsim *ns = psd->drv_priv;  in nsim_assoc_del()  local
174 	ns->psp.assoc_cnt--;  in nsim_assoc_del()
179 	struct netdevsim *ns = psd->drv_priv;  in nsim_get_stats()  local
188 		start = u64_stats_fetch_begin(&ns->psp.syncp);  in nsim_get_stats()
189 		stats->rx_bytes = u64_stats_read(&ns->psp.rx_bytes);  in nsim_get_stats()
190 		stats->rx_packets = u64_stats_read(&ns->psp.rx_packets);  in nsim_get_stats()
191 		stats->tx_bytes = u64_stats_read(&ns->psp.tx_bytes);  in nsim_get_stats()
192 		stats->tx_packets = u64_stats_read(&ns->psp.tx_packets);  in nsim_get_stats()
193 	} while (u64_stats_fetch_retry(&ns->psp.syncp, start));  in nsim_get_stats()
213 static void __nsim_psp_uninit(struct netdevsim *ns, bool teardown)  in __nsim_psp_uninit()  argument
217 	psd = rcu_dereference_protected(ns->psp.dev,  in __nsim_psp_uninit()
219 					lockdep_is_held(&ns->psp.rereg_lock));  in __nsim_psp_uninit()
221 		rcu_assign_pointer(ns->psp.dev, NULL);  in __nsim_psp_uninit()
225 	WARN_ON(ns->psp.assoc_cnt);  in __nsim_psp_uninit()
228 void nsim_psp_uninit(struct netdevsim *ns)  in nsim_psp_uninit()  argument
230 	debugfs_remove(ns->psp.rereg);  in nsim_psp_uninit()
231 	mutex_destroy(&ns->psp.rereg_lock);  in nsim_psp_uninit()
232 	__nsim_psp_uninit(ns, true);  in nsim_psp_uninit()
239 	struct netdevsim *ns = file->private_data;  in nsim_psp_rereg_write()  local
243 	mutex_lock(&ns->psp.rereg_lock);  in nsim_psp_rereg_write()
244 	__nsim_psp_uninit(ns, false);  in nsim_psp_rereg_write()
246 	psd = psp_dev_create(ns->netdev, &nsim_psp_ops, &nsim_psp_caps, ns);  in nsim_psp_rereg_write()
252 	rcu_assign_pointer(ns->psp.dev, psd);  in nsim_psp_rereg_write()
255 	mutex_unlock(&ns->psp.rereg_lock);  in nsim_psp_rereg_write()
266 int nsim_psp_init(struct netdevsim *ns)  in nsim_psp_init()  argument
268 	struct dentry *ddir = ns->nsim_dev_port->ddir;  in nsim_psp_init()
271 	psd = psp_dev_create(ns->netdev, &nsim_psp_ops, &nsim_psp_caps, ns);  in nsim_psp_init()
275 	rcu_assign_pointer(ns->psp.dev, psd);  in nsim_psp_init()
277 	mutex_init(&ns->psp.rereg_lock);  in nsim_psp_init()
278 	ns->psp.rereg = debugfs_create_file("psp_rereg", 0200, ddir, ns,  in nsim_psp_init()