1179237Sjb/*
2179237Sjb * Copyright (c) 2004 Topspin Communications.  All rights reserved.
3179237Sjb *
4179237Sjb * This software is available to you under a choice of one of two
5179237Sjb * licenses.  You may choose to be licensed under the terms of the GNU
6179237Sjb * General Public License (GPL) Version 2, available from the file
7179237Sjb * COPYING in the main directory of this source tree, or the
8179237Sjb * OpenIB.org BSD license below:
9179237Sjb *
10179237Sjb *     Redistribution and use in source and binary forms, with or
11179237Sjb *     without modification, are permitted provided that the following
12179237Sjb *     conditions are met:
13179237Sjb *
14179237Sjb *      - Redistributions of source code must retain the above
15179237Sjb *        copyright notice, this list of conditions and the following
16179237Sjb *        disclaimer.
17179237Sjb *
18179237Sjb *      - Redistributions in binary form must reproduce the above
19179237Sjb *        copyright notice, this list of conditions and the following
20179237Sjb *        disclaimer in the documentation and/or other materials
21179237Sjb *        provided with the distribution.
22179237Sjb *
23179237Sjb * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24179237Sjb * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25179237Sjb * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26179237Sjb * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27179237Sjb * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28179237Sjb * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29179237Sjb * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30179237Sjb * SOFTWARE.
31179237Sjb */
32179237Sjb
33179237Sjb#include <linux/module.h>
34179237Sjb
35179237Sjb#include <linux/init.h>
36179237Sjb#include <linux/slab.h>
37179237Sjb#include <linux/seq_file.h>
38179237Sjb
39179237Sjb#include <asm/uaccess.h>
40179237Sjb
41179237Sjb#include "ipoib.h"
42179237Sjb
43179237Sjbstatic ssize_t show_parent(struct device *d, struct device_attribute *attr,
44179237Sjb			   char *buf)
45179237Sjb{
46179237Sjb	struct ifnet *dev = to_net_dev(d);
47179237Sjb	struct ipoib_dev_priv *priv = dev->if_softc;
48179237Sjb
49179237Sjb	return sprintf(buf, "%s\n", priv->parent->name);
50179237Sjb}
51179237Sjbstatic DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
52179237Sjb
53179237Sjbint ipoib_vlan_add(struct ifnet *pdev, unsigned short pkey)
54179237Sjb{
55179237Sjb	struct ipoib_dev_priv *ppriv, *priv;
56179237Sjb	char intf_name[IFNAMSIZ];
57179237Sjb	int result;
58179237Sjb
59179237Sjb	if (!capable(CAP_NET_ADMIN))
60179237Sjb		return -EPERM;
61179237Sjb
62179237Sjb	ppriv = pdev->if_softc;
63179237Sjb
64179237Sjb	rtnl_lock();
65179237Sjb	mutex_lock(&ppriv->vlan_mutex);
66179237Sjb
67179237Sjb	/*
68179237Sjb	 * First ensure this isn't a duplicate. We check the parent device and
69179237Sjb	 * then all of the child interfaces to make sure the Pkey doesn't match.
70179237Sjb	 */
71179237Sjb	if (ppriv->pkey == pkey) {
72179237Sjb		result = -ENOTUNIQ;
73179237Sjb		priv = NULL;
74179237Sjb		goto err;
75179237Sjb	}
76179237Sjb
77179237Sjb	list_for_each_entry(priv, &ppriv->child_intfs, list) {
78179237Sjb		if (priv->pkey == pkey) {
79179237Sjb			result = -ENOTUNIQ;
80179237Sjb			priv = NULL;
81179237Sjb			goto err;
82179237Sjb		}
83179237Sjb	}
84179237Sjb
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
144sysfs_failed:
145	ipoib_delete_debug_files(priv->dev);
146	unregister_netdevice(priv->dev);
147
148register_failed:
149	ipoib_dev_cleanup(priv->dev);
150
151err:
152	mutex_unlock(&ppriv->vlan_mutex);
153	rtnl_unlock();
154	if (priv)
155		free_netdev(priv->dev);
156
157	return result;
158}
159
160int 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