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 <asm/uaccess.h>
39
40#include "ipoib.h"
41
42static 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}
50static DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
51
52int __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	result = ipoib_set_dev_features(priv, ppriv->ca);
65	if (result)
66		goto err;
67
68	priv->pkey = pkey;
69
70	memcpy(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
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
108sysfs_failed:
109	result = -ENOMEM;
110	ipoib_delete_debug_files(priv->dev);
111	unregister_netdevice(priv->dev);
112
113register_failed:
114	ipoib_dev_cleanup(priv->dev);
115
116err:
117	return result;
118}
119
120int 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	snprintf(intf_name, sizeof intf_name, "%s.%04x",
133		 ppriv->dev->name, pkey);
134	priv = ipoib_intf_alloc(intf_name);
135	if (!priv)
136		return -ENOMEM;
137
138	if (!rtnl_trylock())
139		return restart_syscall();
140
141	down_write(&ppriv->vlan_rwsem);
142
143	/*
144	 * First ensure this isn't a duplicate. We check the parent device and
145	 * then all of the legacy child interfaces to make sure the Pkey
146	 * doesn't match.
147	 */
148	if (ppriv->pkey == pkey) {
149		result = -ENOTUNIQ;
150		goto out;
151	}
152
153	list_for_each_entry(tpriv, &ppriv->child_intfs, list) {
154		if (tpriv->pkey == pkey &&
155		    tpriv->child_type == IPOIB_LEGACY_CHILD) {
156			result = -ENOTUNIQ;
157			goto out;
158		}
159	}
160
161	result = __ipoib_vlan_add(ppriv, priv, pkey, IPOIB_LEGACY_CHILD);
162
163out:
164	up_write(&ppriv->vlan_rwsem);
165
166	if (result)
167		free_netdev(priv->dev);
168
169	rtnl_unlock();
170
171	return result;
172}
173
174int ipoib_vlan_delete(struct net_device *pdev, unsigned short pkey)
175{
176	struct ipoib_dev_priv *ppriv, *priv, *tpriv;
177	struct net_device *dev = NULL;
178
179	if (!capable(CAP_NET_ADMIN))
180		return -EPERM;
181
182	ppriv = netdev_priv(pdev);
183
184	if (!rtnl_trylock())
185		return restart_syscall();
186
187	down_write(&ppriv->vlan_rwsem);
188	list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
189		if (priv->pkey == pkey &&
190		    priv->child_type == IPOIB_LEGACY_CHILD) {
191			unregister_netdevice(priv->dev);
192			list_del(&priv->list);
193			dev = priv->dev;
194			break;
195		}
196	}
197	up_write(&ppriv->vlan_rwsem);
198
199	rtnl_unlock();
200
201	if (dev) {
202		free_netdev(dev);
203		return 0;
204	}
205
206	return -ENODEV;
207}
208