1 // SPDX-License-Identifier: GPL-2.0-only
2 // Copyright (c) 2020 Facebook Inc.
3
4 #include <linux/debugfs.h>
5 #include <linux/netdevice.h>
6 #include <linux/slab.h>
7 #include <net/udp_tunnel.h>
8
9 #include "netdevsim.h"
10
11 static int
nsim_udp_tunnel_set_port(struct net_device * dev,unsigned int table,unsigned int entry,struct udp_tunnel_info * ti)12 nsim_udp_tunnel_set_port(struct net_device *dev, unsigned int table,
13 unsigned int entry, struct udp_tunnel_info *ti)
14 {
15 struct netdevsim *ns = netdev_priv(dev);
16 int ret;
17
18 ret = -ns->udp_ports.inject_error;
19 ns->udp_ports.inject_error = 0;
20
21 if (!ret) {
22 if (ns->udp_ports.ports[table][entry]) {
23 WARN(1, "entry already in use\n");
24 ret = -EBUSY;
25 } else {
26 ns->udp_ports.ports[table][entry] =
27 be16_to_cpu(ti->port) << 16 | ti->type;
28 }
29 }
30
31 netdev_info(dev, "set [%d, %d] type %d family %d port %d - %d\n",
32 table, entry, ti->type, ti->sa_family, ntohs(ti->port),
33 ret);
34 return ret;
35 }
36
37 static int
nsim_udp_tunnel_unset_port(struct net_device * dev,unsigned int table,unsigned int entry,struct udp_tunnel_info * ti)38 nsim_udp_tunnel_unset_port(struct net_device *dev, unsigned int table,
39 unsigned int entry, struct udp_tunnel_info *ti)
40 {
41 struct netdevsim *ns = netdev_priv(dev);
42 int ret;
43
44 ret = -ns->udp_ports.inject_error;
45 ns->udp_ports.inject_error = 0;
46
47 if (!ret) {
48 u32 val = be16_to_cpu(ti->port) << 16 | ti->type;
49
50 if (val == ns->udp_ports.ports[table][entry]) {
51 ns->udp_ports.ports[table][entry] = 0;
52 } else {
53 WARN(1, "entry not installed %x vs %x\n",
54 val, ns->udp_ports.ports[table][entry]);
55 ret = -ENOENT;
56 }
57 }
58
59 netdev_info(dev, "unset [%d, %d] type %d family %d port %d - %d\n",
60 table, entry, ti->type, ti->sa_family, ntohs(ti->port),
61 ret);
62 return ret;
63 }
64
65 static int
nsim_udp_tunnel_sync_table(struct net_device * dev,unsigned int table)66 nsim_udp_tunnel_sync_table(struct net_device *dev, unsigned int table)
67 {
68 struct netdevsim *ns = netdev_priv(dev);
69 struct udp_tunnel_info ti;
70 unsigned int i;
71 int ret;
72
73 ret = -ns->udp_ports.inject_error;
74 ns->udp_ports.inject_error = 0;
75
76 for (i = 0; i < NSIM_UDP_TUNNEL_N_PORTS; i++) {
77 udp_tunnel_nic_get_port(dev, table, i, &ti);
78 ns->udp_ports.ports[table][i] =
79 be16_to_cpu(ti.port) << 16 | ti.type;
80 }
81
82 return ret;
83 }
84
85 static const struct udp_tunnel_nic_info nsim_udp_tunnel_info = {
86 .set_port = nsim_udp_tunnel_set_port,
87 .unset_port = nsim_udp_tunnel_unset_port,
88 .sync_table = nsim_udp_tunnel_sync_table,
89
90 .tables = {
91 {
92 .n_entries = NSIM_UDP_TUNNEL_N_PORTS,
93 .tunnel_types = UDP_TUNNEL_TYPE_VXLAN,
94 },
95 {
96 .n_entries = NSIM_UDP_TUNNEL_N_PORTS,
97 .tunnel_types = UDP_TUNNEL_TYPE_GENEVE |
98 UDP_TUNNEL_TYPE_VXLAN_GPE,
99 },
100 },
101 };
102
103 static ssize_t
nsim_udp_tunnels_info_reset_write(struct file * file,const char __user * data,size_t count,loff_t * ppos)104 nsim_udp_tunnels_info_reset_write(struct file *file, const char __user *data,
105 size_t count, loff_t *ppos)
106 {
107 struct net_device *dev = file->private_data;
108 struct netdevsim *ns = netdev_priv(dev);
109
110 if (dev->reg_state == NETREG_REGISTERED) {
111 memset(ns->udp_ports.ports, 0, sizeof(ns->udp_ports.__ports));
112 udp_tunnel_nic_reset_ntf(dev);
113 }
114
115 return count;
116 }
117
118 static const struct file_operations nsim_udp_tunnels_info_reset_fops = {
119 .open = simple_open,
120 .write = nsim_udp_tunnels_info_reset_write,
121 .llseek = generic_file_llseek,
122 .owner = THIS_MODULE,
123 };
124
nsim_udp_tunnels_info_create(struct nsim_dev * nsim_dev,struct net_device * dev)125 int nsim_udp_tunnels_info_create(struct nsim_dev *nsim_dev,
126 struct net_device *dev)
127 {
128 struct netdevsim *ns = netdev_priv(dev);
129 struct udp_tunnel_nic_info *info;
130
131 if (nsim_dev->udp_ports.shared && nsim_dev->udp_ports.open_only) {
132 dev_err(&nsim_dev->nsim_bus_dev->dev,
133 "shared can't be used in conjunction with open_only\n");
134 return -EINVAL;
135 }
136
137 if (!nsim_dev->udp_ports.shared)
138 ns->udp_ports.ports = ns->udp_ports.__ports;
139 else
140 ns->udp_ports.ports = nsim_dev->udp_ports.__ports;
141
142 ns->udp_ports.ddir = debugfs_create_dir("udp_ports",
143 ns->nsim_dev_port->ddir);
144
145 debugfs_create_u32("inject_error", 0600, ns->udp_ports.ddir,
146 &ns->udp_ports.inject_error);
147
148 ns->udp_ports.dfs_ports[0].array = ns->udp_ports.ports[0];
149 ns->udp_ports.dfs_ports[0].n_elements = NSIM_UDP_TUNNEL_N_PORTS;
150 debugfs_create_u32_array("table0", 0400, ns->udp_ports.ddir,
151 &ns->udp_ports.dfs_ports[0]);
152
153 ns->udp_ports.dfs_ports[1].array = ns->udp_ports.ports[1];
154 ns->udp_ports.dfs_ports[1].n_elements = NSIM_UDP_TUNNEL_N_PORTS;
155 debugfs_create_u32_array("table1", 0400, ns->udp_ports.ddir,
156 &ns->udp_ports.dfs_ports[1]);
157
158 debugfs_create_file("reset", 0200, ns->udp_ports.ddir,
159 dev, &nsim_udp_tunnels_info_reset_fops);
160
161 /* Note: it's not normal to allocate the info struct like this!
162 * Drivers are expected to use a static const one, here we're testing.
163 */
164 info = kmemdup(&nsim_udp_tunnel_info, sizeof(nsim_udp_tunnel_info),
165 GFP_KERNEL);
166 if (!info)
167 return -ENOMEM;
168
169 if (nsim_dev->udp_ports.sync_all) {
170 info->set_port = NULL;
171 info->unset_port = NULL;
172 } else {
173 info->sync_table = NULL;
174 }
175
176 if (nsim_dev->udp_ports.open_only)
177 info->flags |= UDP_TUNNEL_NIC_INFO_OPEN_ONLY;
178 if (nsim_dev->udp_ports.ipv4_only)
179 info->flags |= UDP_TUNNEL_NIC_INFO_IPV4_ONLY;
180 if (nsim_dev->udp_ports.shared)
181 info->shared = &nsim_dev->udp_ports.utn_shared;
182 if (nsim_dev->udp_ports.static_iana_vxlan)
183 info->flags |= UDP_TUNNEL_NIC_INFO_STATIC_IANA_VXLAN;
184
185 dev->udp_tunnel_nic_info = info;
186 return 0;
187 }
188
nsim_udp_tunnels_info_destroy(struct net_device * dev)189 void nsim_udp_tunnels_info_destroy(struct net_device *dev)
190 {
191 struct netdevsim *ns = netdev_priv(dev);
192
193 debugfs_remove_recursive(ns->udp_ports.ddir);
194 kfree(dev->udp_tunnel_nic_info);
195 dev->udp_tunnel_nic_info = NULL;
196 }
197
nsim_udp_tunnels_debugfs_create(struct nsim_dev * nsim_dev)198 void nsim_udp_tunnels_debugfs_create(struct nsim_dev *nsim_dev)
199 {
200 debugfs_create_bool("udp_ports_sync_all", 0600, nsim_dev->ddir,
201 &nsim_dev->udp_ports.sync_all);
202 debugfs_create_bool("udp_ports_open_only", 0600, nsim_dev->ddir,
203 &nsim_dev->udp_ports.open_only);
204 debugfs_create_bool("udp_ports_ipv4_only", 0600, nsim_dev->ddir,
205 &nsim_dev->udp_ports.ipv4_only);
206 debugfs_create_bool("udp_ports_shared", 0600, nsim_dev->ddir,
207 &nsim_dev->udp_ports.shared);
208 debugfs_create_bool("udp_ports_static_iana_vxlan", 0600, nsim_dev->ddir,
209 &nsim_dev->udp_ports.static_iana_vxlan);
210 }
211