1 /*
2  * Copyright (c) 2004 Topspin Communications.  All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * OpenIB.org BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  */
32 
33 #include <linux/module.h>
34 #include <linux/sched/signal.h>
35 
36 #include <linux/init.h>
37 #include <linux/seq_file.h>
38 
39 #include <linux/uaccess.h>
40 
41 #include "ipoib.h"
42 
43 static ssize_t show_parent(struct device *d, struct device_attribute *attr,
44 			   char *buf)
45 {
46 	struct net_device *dev = to_net_dev(d);
47 	struct ipoib_dev_priv *priv = ipoib_priv(dev);
48 
49 	return sprintf(buf, "%s\n", priv->parent->name);
50 }
51 static DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
52 
53 int __ipoib_vlan_add(struct ipoib_dev_priv *ppriv, struct ipoib_dev_priv *priv,
54 		     u16 pkey, int type)
55 {
56 	int result;
57 
58 	priv->max_ib_mtu = ppriv->max_ib_mtu;
59 	/* MTU will be reset when mcast join happens */
60 	priv->dev->mtu   = IPOIB_UD_MTU(priv->max_ib_mtu);
61 	priv->mcast_mtu  = priv->admin_mtu = priv->dev->mtu;
62 	priv->parent = ppriv->dev;
63 	set_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags);
64 
65 	ipoib_set_dev_features(priv, ppriv->ca);
66 
67 	priv->pkey = pkey;
68 
69 	memcpy(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
70 	memcpy(&priv->local_gid, &ppriv->local_gid, sizeof(priv->local_gid));
71 	set_bit(IPOIB_FLAG_DEV_ADDR_SET, &priv->flags);
72 	priv->dev->broadcast[8] = pkey >> 8;
73 	priv->dev->broadcast[9] = pkey & 0xff;
74 
75 	result = ipoib_dev_init(priv->dev, ppriv->ca, ppriv->port);
76 	if (result < 0) {
77 		ipoib_warn(ppriv, "failed to initialize subinterface: "
78 			   "device %s, port %d",
79 			   ppriv->ca->name, ppriv->port);
80 		goto err;
81 	}
82 
83 	result = register_netdevice(priv->dev);
84 	if (result) {
85 		ipoib_warn(priv, "failed to initialize; error %i", result);
86 		goto register_failed;
87 	}
88 
89 	/* RTNL childs don't need proprietary sysfs entries */
90 	if (type == IPOIB_LEGACY_CHILD) {
91 		if (ipoib_cm_add_mode_attr(priv->dev))
92 			goto sysfs_failed;
93 		if (ipoib_add_pkey_attr(priv->dev))
94 			goto sysfs_failed;
95 		if (ipoib_add_umcast_attr(priv->dev))
96 			goto sysfs_failed;
97 
98 		if (device_create_file(&priv->dev->dev, &dev_attr_parent))
99 			goto sysfs_failed;
100 	}
101 
102 	priv->child_type  = type;
103 	list_add_tail(&priv->list, &ppriv->child_intfs);
104 
105 	return 0;
106 
107 sysfs_failed:
108 	result = -ENOMEM;
109 	unregister_netdevice(priv->dev);
110 
111 register_failed:
112 	ipoib_dev_cleanup(priv->dev);
113 
114 err:
115 	return result;
116 }
117 
118 int ipoib_vlan_add(struct net_device *pdev, unsigned short pkey)
119 {
120 	struct ipoib_dev_priv *ppriv, *priv;
121 	char intf_name[IFNAMSIZ];
122 	struct ipoib_dev_priv *tpriv;
123 	int result;
124 
125 	if (!capable(CAP_NET_ADMIN))
126 		return -EPERM;
127 
128 	ppriv = ipoib_priv(pdev);
129 
130 	if (test_bit(IPOIB_FLAG_GOING_DOWN, &ppriv->flags))
131 		return -EPERM;
132 
133 	snprintf(intf_name, sizeof intf_name, "%s.%04x",
134 		 ppriv->dev->name, pkey);
135 
136 	if (!mutex_trylock(&ppriv->sysfs_mutex))
137 		return restart_syscall();
138 
139 	if (!rtnl_trylock()) {
140 		mutex_unlock(&ppriv->sysfs_mutex);
141 		return restart_syscall();
142 	}
143 
144 	if (!down_write_trylock(&ppriv->vlan_rwsem)) {
145 		rtnl_unlock();
146 		mutex_unlock(&ppriv->sysfs_mutex);
147 		return restart_syscall();
148 	}
149 
150 	priv = ipoib_intf_alloc(ppriv->ca, ppriv->port, intf_name);
151 	if (!priv) {
152 		result = -ENOMEM;
153 		goto out;
154 	}
155 
156 	/*
157 	 * First ensure this isn't a duplicate. We check the parent device and
158 	 * then all of the legacy child interfaces to make sure the Pkey
159 	 * doesn't match.
160 	 */
161 	if (ppriv->pkey == pkey) {
162 		result = -ENOTUNIQ;
163 		goto out;
164 	}
165 
166 	list_for_each_entry(tpriv, &ppriv->child_intfs, list) {
167 		if (tpriv->pkey == pkey &&
168 		    tpriv->child_type == IPOIB_LEGACY_CHILD) {
169 			result = -ENOTUNIQ;
170 			goto out;
171 		}
172 	}
173 
174 	result = __ipoib_vlan_add(ppriv, priv, pkey, IPOIB_LEGACY_CHILD);
175 
176 out:
177 	up_write(&ppriv->vlan_rwsem);
178 	rtnl_unlock();
179 	mutex_unlock(&ppriv->sysfs_mutex);
180 
181 	if (result && priv) {
182 		struct rdma_netdev *rn;
183 
184 		rn = netdev_priv(priv->dev);
185 		rn->free_rdma_netdev(priv->dev);
186 		kfree(priv);
187 	}
188 
189 	return result;
190 }
191 
192 int ipoib_vlan_delete(struct net_device *pdev, unsigned short pkey)
193 {
194 	struct ipoib_dev_priv *ppriv, *priv, *tpriv;
195 	struct net_device *dev = NULL;
196 
197 	if (!capable(CAP_NET_ADMIN))
198 		return -EPERM;
199 
200 	ppriv = ipoib_priv(pdev);
201 
202 	if (test_bit(IPOIB_FLAG_GOING_DOWN, &ppriv->flags))
203 		return -EPERM;
204 
205 	if (!mutex_trylock(&ppriv->sysfs_mutex))
206 		return restart_syscall();
207 
208 	if (!rtnl_trylock()) {
209 		mutex_unlock(&ppriv->sysfs_mutex);
210 		return restart_syscall();
211 	}
212 
213 	if (!down_write_trylock(&ppriv->vlan_rwsem)) {
214 		rtnl_unlock();
215 		mutex_unlock(&ppriv->sysfs_mutex);
216 		return restart_syscall();
217 	}
218 
219 	list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
220 		if (priv->pkey == pkey &&
221 		    priv->child_type == IPOIB_LEGACY_CHILD) {
222 			list_del(&priv->list);
223 			dev = priv->dev;
224 			break;
225 		}
226 	}
227 	up_write(&ppriv->vlan_rwsem);
228 
229 	if (dev) {
230 		ipoib_dbg(ppriv, "delete child vlan %s\n", dev->name);
231 		unregister_netdevice(dev);
232 	}
233 
234 	rtnl_unlock();
235 	mutex_unlock(&ppriv->sysfs_mutex);
236 
237 	if (dev) {
238 		struct rdma_netdev *rn;
239 
240 		rn = netdev_priv(dev);
241 		rn->free_rdma_netdev(priv->dev);
242 		kfree(priv);
243 		return 0;
244 	}
245 
246 	return -ENODEV;
247 }
248