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/slab.h>
37 #include <linux/seq_file.h>
38 
39 #include <asm/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 ifnet *dev = to_net_dev(d);
47 	struct ipoib_dev_priv *priv = dev->if_softc;
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 ifnet *pdev, unsigned short pkey)
54 {
55 	struct ipoib_dev_priv *ppriv, *priv;
56 	char intf_name[IFNAMSIZ];
57 	int result;
58 
59 	if (!capable(CAP_NET_ADMIN))
60 		return -EPERM;
61 
62 	ppriv = pdev->if_softc;
63 
64 	rtnl_lock();
65 	mutex_lock(&ppriv->vlan_mutex);
66 
67 	/*
68 	 * First ensure this isn't a duplicate. We check the parent device and
69 	 * then all of the child interfaces to make sure the Pkey doesn't match.
70 	 */
71 	if (ppriv->pkey == pkey) {
72 		result = -ENOTUNIQ;
73 		priv = NULL;
74 		goto err;
75 	}
76 
77 	list_for_each_entry(priv, &ppriv->child_intfs, list) {
78 		if (priv->pkey == pkey) {
79 			result = -ENOTUNIQ;
80 			priv = NULL;
81 			goto err;
82 		}
83 	}
84 
85 	snprintf(intf_name, sizeof intf_name, "%s.%04x",
86 		 ppriv->dev->name, pkey);
87 	priv = ipoib_intf_alloc(intf_name);
88 	if (!priv) {
89 		result = -ENOMEM;
90 		goto err;
91 	}
92 
93 	priv->max_ib_mtu = ppriv->max_ib_mtu;
94 	/* MTU will be reset when mcast join happens */
95 	priv->dev->mtu   = IPOIB_UD_MTU(priv->max_ib_mtu);
96 	priv->mcast_mtu  = priv->admin_mtu = priv->dev->mtu;
97 	set_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags);
98 
99 	result = ipoib_set_dev_features(priv, ppriv->ca);
100 	if (result)
101 		goto err;
102 
103 	priv->pkey = pkey;
104 
105 	memcpy(IF_LLADDR(priv->dev), ppriv->dev->dev_addr, INFINIBAND_ALEN);
106 	priv->broadcastaddr[8] = pkey >> 8;
107 	priv->broadcastaddr[9] = pkey & 0xff;
108 
109 	result = ipoib_dev_init(priv->dev, ppriv->ca, ppriv->port);
110 	if (result < 0) {
111 		ipoib_warn(ppriv, "failed to initialize subinterface: "
112 			   "device %s, port %d",
113 			   ppriv->ca->name, ppriv->port);
114 		goto err;
115 	}
116 
117 	result = register_netdevice(priv->dev);
118 	if (result) {
119 		ipoib_warn(priv, "failed to initialize; error %i", result);
120 		goto register_failed;
121 	}
122 
123 	priv->parent = ppriv->dev;
124 
125 	ipoib_create_debug_files(priv->dev);
126 
127 	if (ipoib_cm_add_mode_attr(priv->dev))
128 		goto sysfs_failed;
129 	if (ipoib_add_pkey_attr(priv->dev))
130 		goto sysfs_failed;
131 	if (ipoib_add_umcast_attr(priv->dev))
132 		goto sysfs_failed;
133 
134 	if (device_create_file(&priv->dev->dev, &dev_attr_parent))
135 		goto sysfs_failed;
136 
137 	list_add_tail(&priv->list, &ppriv->child_intfs);
138 
139 	mutex_unlock(&ppriv->vlan_mutex);
140 	rtnl_unlock();
141 
142 	return 0;
143 
144 sysfs_failed:
145 	ipoib_delete_debug_files(priv->dev);
146 	unregister_netdevice(priv->dev);
147 
148 register_failed:
149 	ipoib_dev_cleanup(priv->dev);
150 
151 err:
152 	mutex_unlock(&ppriv->vlan_mutex);
153 	rtnl_unlock();
154 	if (priv)
155 		free_netdev(priv->dev);
156 
157 	return result;
158 }
159 
160 int ipoib_vlan_delete(struct ifnet *pdev, unsigned short pkey)
161 {
162 	struct ipoib_dev_priv *ppriv, *priv, *tpriv;
163 	struct ifnet *dev = NULL;
164 
165 	if (!capable(CAP_NET_ADMIN))
166 		return -EPERM;
167 
168 	ppriv = pdev->if_softc;
169 
170 	rtnl_lock();
171 	mutex_lock(&ppriv->vlan_mutex);
172 	list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
173 		if (priv->pkey == pkey) {
174 			unregister_netdevice(priv->dev);
175 			ipoib_dev_cleanup(priv->dev);
176 			list_del(&priv->list);
177 			dev = priv->dev;
178 			break;
179 		}
180 	}
181 	mutex_unlock(&ppriv->vlan_mutex);
182 	rtnl_unlock();
183 
184 	if (dev) {
185 		free_netdev(dev);
186 		return 0;
187 	}
188 
189 	return -ENODEV;
190 }
191