PageRenderTime 36ms CodeModel.GetById 27ms app.highlight 7ms RepoModel.GetById 0ms app.codeStats 0ms

/drivers/infiniband/ulp/ipoib/ipoib_vlan.c

https://bitbucket.org/ndreys/linux-sunxi
C | 191 lines | 119 code | 36 blank | 36 comment | 20 complexity | 875c3166a2db44da4535a17c55582f6e MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0
  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 net_device *pdev, unsigned short pkey)
 53{
 54	struct ipoib_dev_priv *ppriv, *priv;
 55	char intf_name[IFNAMSIZ];
 56	int result;
 57
 58	if (!capable(CAP_NET_ADMIN))
 59		return -EPERM;
 60
 61	ppriv = netdev_priv(pdev);
 62
 63	if (!rtnl_trylock())
 64		return restart_syscall();
 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(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
106	priv->dev->broadcast[8] = pkey >> 8;
107	priv->dev->broadcast[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 net_device *pdev, unsigned short pkey)
161{
162	struct ipoib_dev_priv *ppriv, *priv, *tpriv;
163	struct net_device *dev = NULL;
164
165	if (!capable(CAP_NET_ADMIN))
166		return -EPERM;
167
168	ppriv = netdev_priv(pdev);
169
170	if (!rtnl_trylock())
171		return restart_syscall();
172	mutex_lock(&ppriv->vlan_mutex);
173	list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
174		if (priv->pkey == pkey) {
175			unregister_netdevice(priv->dev);
176			ipoib_dev_cleanup(priv->dev);
177			list_del(&priv->list);
178			dev = priv->dev;
179			break;
180		}
181	}
182	mutex_unlock(&ppriv->vlan_mutex);
183	rtnl_unlock();
184
185	if (dev) {
186		free_netdev(dev);
187		return 0;
188	}
189
190	return -ENODEV;
191}