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 
35 #include <linux/init.h>
36 #include <linux/seq_file.h>
37 
38 #include <linux/uaccess.h>
39 
40 #include "ipoib.h"
41 
42 static ssize_t show_parent(struct device *d, struct device_attribute *attr,
43 			   char *buf)
44 {
45 	struct net_device *dev = to_net_dev(d);
46 	struct ipoib_dev_priv *priv = netdev_priv(dev);
47 
48 	return sprintf(buf, "%s\n", priv->parent->name);
49 }
50 static DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
51 
52 int __ipoib_vlan_add(struct ipoib_dev_priv *ppriv, struct ipoib_dev_priv *priv,
53 		     u16 pkey, int type)
54 {
55 	int result;
56 
57 	priv->max_ib_mtu = ppriv->max_ib_mtu;
58 	/* MTU will be reset when mcast join happens */
59 	priv->dev->mtu   = IPOIB_UD_MTU(priv->max_ib_mtu);
60 	priv->mcast_mtu  = priv->admin_mtu = priv->dev->mtu;
61 	priv->parent = ppriv->dev;
62 	set_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags);
63 
64 	ipoib_set_dev_features(priv, ppriv->ca);
65 
66 	priv->pkey = pkey;
67 
68 	memcpy(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
69 	memcpy(&priv->local_gid, &ppriv->local_gid, sizeof(priv->local_gid));
70 	set_bit(IPOIB_FLAG_DEV_ADDR_SET, &priv->flags);
71 	priv->dev->broadcast[8] = pkey >> 8;
72 	priv->dev->broadcast[9] = pkey & 0xff;
73 
74 	result = ipoib_dev_init(priv->dev, ppriv->ca, ppriv->port);
75 	if (result < 0) {
76 		ipoib_warn(ppriv, "failed to initialize subinterface: "
77 			   "device %s, port %d",
78 			   ppriv->ca->name, ppriv->port);
79 		goto err;
80 	}
81 
82 	result = register_netdevice(priv->dev);
83 	if (result) {
84 		ipoib_warn(priv, "failed to initialize; error %i", result);
85 		goto register_failed;
86 	}
87 
88 	ipoib_create_debug_files(priv->dev);
89 
90 	/* RTNL childs don't need proprietary sysfs entries */
91 	if (type == IPOIB_LEGACY_CHILD) {
92 		if (ipoib_cm_add_mode_attr(priv->dev))
93 			goto sysfs_failed;
94 		if (ipoib_add_pkey_attr(priv->dev))
95 			goto sysfs_failed;
96 		if (ipoib_add_umcast_attr(priv->dev))
97 			goto sysfs_failed;
98 
99 		if (device_create_file(&priv->dev->dev, &dev_attr_parent))
100 			goto sysfs_failed;
101 	}
102 
103 	priv->child_type  = type;
104 	list_add_tail(&priv->list, &ppriv->child_intfs);
105 
106 	return 0;
107 
108 sysfs_failed:
109 	result = -ENOMEM;
110 	ipoib_delete_debug_files(priv->dev);
111 	unregister_netdevice(priv->dev);
112 
113 register_failed:
114 	ipoib_dev_cleanup(priv->dev);
115 
116 err:
117 	return result;
118 }
119 
120 int ipoib_vlan_add(struct net_device *pdev, unsigned short pkey)
121 {
122 	struct ipoib_dev_priv *ppriv, *priv;
123 	char intf_name[IFNAMSIZ];
124 	struct ipoib_dev_priv *tpriv;
125 	int result;
126 
127 	if (!capable(CAP_NET_ADMIN))
128 		return -EPERM;
129 
130 	ppriv = netdev_priv(pdev);
131 
132 	if (test_bit(IPOIB_FLAG_GOING_DOWN, &ppriv->flags))
133 		return -EPERM;
134 
135 	snprintf(intf_name, sizeof intf_name, "%s.%04x",
136 		 ppriv->dev->name, pkey);
137 	priv = ipoib_intf_alloc(intf_name);
138 	if (!priv)
139 		return -ENOMEM;
140 
141 	if (!rtnl_trylock())
142 		return restart_syscall();
143 
144 	down_write(&ppriv->vlan_rwsem);
145 
146 	/*
147 	 * First ensure this isn't a duplicate. We check the parent device and
148 	 * then all of the legacy child interfaces to make sure the Pkey
149 	 * doesn't match.
150 	 */
151 	if (ppriv->pkey == pkey) {
152 		result = -ENOTUNIQ;
153 		goto out;
154 	}
155 
156 	list_for_each_entry(tpriv, &ppriv->child_intfs, list) {
157 		if (tpriv->pkey == pkey &&
158 		    tpriv->child_type == IPOIB_LEGACY_CHILD) {
159 			result = -ENOTUNIQ;
160 			goto out;
161 		}
162 	}
163 
164 	result = __ipoib_vlan_add(ppriv, priv, pkey, IPOIB_LEGACY_CHILD);
165 
166 out:
167 	up_write(&ppriv->vlan_rwsem);
168 
169 	rtnl_unlock();
170 
171 	if (result)
172 		free_netdev(priv->dev);
173 
174 	return result;
175 }
176 
177 int ipoib_vlan_delete(struct net_device *pdev, unsigned short pkey)
178 {
179 	struct ipoib_dev_priv *ppriv, *priv, *tpriv;
180 	struct net_device *dev = NULL;
181 
182 	if (!capable(CAP_NET_ADMIN))
183 		return -EPERM;
184 
185 	ppriv = netdev_priv(pdev);
186 
187 	if (test_bit(IPOIB_FLAG_GOING_DOWN, &ppriv->flags))
188 		return -EPERM;
189 
190 	if (!rtnl_trylock())
191 		return restart_syscall();
192 
193 	down_write(&ppriv->vlan_rwsem);
194 	list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
195 		if (priv->pkey == pkey &&
196 		    priv->child_type == IPOIB_LEGACY_CHILD) {
197 			list_del(&priv->list);
198 			dev = priv->dev;
199 			break;
200 		}
201 	}
202 	up_write(&ppriv->vlan_rwsem);
203 
204 	if (dev) {
205 		ipoib_dbg(ppriv, "delete child vlan %s\n", dev->name);
206 		unregister_netdevice(dev);
207 	}
208 
209 	rtnl_unlock();
210 
211 	if (dev) {
212 		free_netdev(dev);
213 		return 0;
214 	}
215 
216 	return -ENODEV;
217 }
218