11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * Copyright (c) 2004 Topspin Communications.  All rights reserved.
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  * This software is available to you under a choice of one of two
51da177e4SLinus Torvalds  * licenses.  You may choose to be licensed under the terms of the GNU
61da177e4SLinus Torvalds  * General Public License (GPL) Version 2, available from the file
71da177e4SLinus Torvalds  * COPYING in the main directory of this source tree, or the
81da177e4SLinus Torvalds  * OpenIB.org BSD license below:
91da177e4SLinus Torvalds  *
101da177e4SLinus Torvalds  *     Redistribution and use in source and binary forms, with or
111da177e4SLinus Torvalds  *     without modification, are permitted provided that the following
121da177e4SLinus Torvalds  *     conditions are met:
131da177e4SLinus Torvalds  *
141da177e4SLinus Torvalds  *      - Redistributions of source code must retain the above
151da177e4SLinus Torvalds  *        copyright notice, this list of conditions and the following
161da177e4SLinus Torvalds  *        disclaimer.
171da177e4SLinus Torvalds  *
181da177e4SLinus Torvalds  *      - Redistributions in binary form must reproduce the above
191da177e4SLinus Torvalds  *        copyright notice, this list of conditions and the following
201da177e4SLinus Torvalds  *        disclaimer in the documentation and/or other materials
211da177e4SLinus Torvalds  *        provided with the distribution.
221da177e4SLinus Torvalds  *
231da177e4SLinus Torvalds  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
241da177e4SLinus Torvalds  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
251da177e4SLinus Torvalds  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
261da177e4SLinus Torvalds  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
271da177e4SLinus Torvalds  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
281da177e4SLinus Torvalds  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
291da177e4SLinus Torvalds  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
301da177e4SLinus Torvalds  * SOFTWARE.
311da177e4SLinus Torvalds  *
321da177e4SLinus Torvalds  * $Id: ipoib_vlan.c 1349 2004-12-16 21:09:43Z roland $
331da177e4SLinus Torvalds  */
341da177e4SLinus Torvalds 
351da177e4SLinus Torvalds #include <linux/module.h>
361da177e4SLinus Torvalds 
371da177e4SLinus Torvalds #include <linux/init.h>
381da177e4SLinus Torvalds #include <linux/slab.h>
391da177e4SLinus Torvalds #include <linux/seq_file.h>
401da177e4SLinus Torvalds 
411da177e4SLinus Torvalds #include <asm/uaccess.h>
421da177e4SLinus Torvalds 
431da177e4SLinus Torvalds #include "ipoib.h"
441da177e4SLinus Torvalds 
4543cb76d9SGreg Kroah-Hartman static ssize_t show_parent(struct device *d, struct device_attribute *attr,
4643cb76d9SGreg Kroah-Hartman 			   char *buf)
471da177e4SLinus Torvalds {
4843cb76d9SGreg Kroah-Hartman 	struct net_device *dev = to_net_dev(d);
491da177e4SLinus Torvalds 	struct ipoib_dev_priv *priv = netdev_priv(dev);
501da177e4SLinus Torvalds 
511da177e4SLinus Torvalds 	return sprintf(buf, "%s\n", priv->parent->name);
521da177e4SLinus Torvalds }
5343cb76d9SGreg Kroah-Hartman static DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
541da177e4SLinus Torvalds 
551da177e4SLinus Torvalds int ipoib_vlan_add(struct net_device *pdev, unsigned short pkey)
561da177e4SLinus Torvalds {
571da177e4SLinus Torvalds 	struct ipoib_dev_priv *ppriv, *priv;
581da177e4SLinus Torvalds 	char intf_name[IFNAMSIZ];
591da177e4SLinus Torvalds 	int result;
601da177e4SLinus Torvalds 
611da177e4SLinus Torvalds 	if (!capable(CAP_NET_ADMIN))
621da177e4SLinus Torvalds 		return -EPERM;
631da177e4SLinus Torvalds 
641da177e4SLinus Torvalds 	ppriv = netdev_priv(pdev);
651da177e4SLinus Torvalds 
6695ed644fSIngo Molnar 	mutex_lock(&ppriv->vlan_mutex);
671da177e4SLinus Torvalds 
681da177e4SLinus Torvalds 	/*
691da177e4SLinus Torvalds 	 * First ensure this isn't a duplicate. We check the parent device and
701da177e4SLinus Torvalds 	 * then all of the child interfaces to make sure the Pkey doesn't match.
711da177e4SLinus Torvalds 	 */
721da177e4SLinus Torvalds 	if (ppriv->pkey == pkey) {
731da177e4SLinus Torvalds 		result = -ENOTUNIQ;
741da177e4SLinus Torvalds 		goto err;
751da177e4SLinus Torvalds 	}
761da177e4SLinus Torvalds 
771da177e4SLinus Torvalds 	list_for_each_entry(priv, &ppriv->child_intfs, list) {
781da177e4SLinus Torvalds 		if (priv->pkey == pkey) {
791da177e4SLinus Torvalds 			result = -ENOTUNIQ;
801da177e4SLinus Torvalds 			goto err;
811da177e4SLinus Torvalds 		}
821da177e4SLinus Torvalds 	}
831da177e4SLinus Torvalds 
841da177e4SLinus Torvalds 	snprintf(intf_name, sizeof intf_name, "%s.%04x",
851da177e4SLinus Torvalds 		 ppriv->dev->name, pkey);
861da177e4SLinus Torvalds 	priv = ipoib_intf_alloc(intf_name);
871da177e4SLinus Torvalds 	if (!priv) {
881da177e4SLinus Torvalds 		result = -ENOMEM;
891da177e4SLinus Torvalds 		goto err;
901da177e4SLinus Torvalds 	}
911da177e4SLinus Torvalds 
92bc7b3a36SShirley Ma 	priv->max_ib_mtu = ppriv->max_ib_mtu;
931da177e4SLinus Torvalds 	set_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags);
941da177e4SLinus Torvalds 
951da177e4SLinus Torvalds 	priv->pkey = pkey;
961da177e4SLinus Torvalds 
971da177e4SLinus Torvalds 	memcpy(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
981da177e4SLinus Torvalds 	priv->dev->broadcast[8] = pkey >> 8;
991da177e4SLinus Torvalds 	priv->dev->broadcast[9] = pkey & 0xff;
1001da177e4SLinus Torvalds 
1011da177e4SLinus Torvalds 	result = ipoib_dev_init(priv->dev, ppriv->ca, ppriv->port);
1021da177e4SLinus Torvalds 	if (result < 0) {
1031da177e4SLinus Torvalds 		ipoib_warn(ppriv, "failed to initialize subinterface: "
1041da177e4SLinus Torvalds 			   "device %s, port %d",
1051da177e4SLinus Torvalds 			   ppriv->ca->name, ppriv->port);
1061da177e4SLinus Torvalds 		goto device_init_failed;
1071da177e4SLinus Torvalds 	}
1081da177e4SLinus Torvalds 
1091da177e4SLinus Torvalds 	result = register_netdev(priv->dev);
1101da177e4SLinus Torvalds 	if (result) {
1111da177e4SLinus Torvalds 		ipoib_warn(priv, "failed to initialize; error %i", result);
1121da177e4SLinus Torvalds 		goto register_failed;
1131da177e4SLinus Torvalds 	}
1141da177e4SLinus Torvalds 
1151da177e4SLinus Torvalds 	priv->parent = ppriv->dev;
1161da177e4SLinus Torvalds 
1171732b0efSRoland Dreier 	ipoib_create_debug_files(priv->dev);
1181da177e4SLinus Torvalds 
119839fcabaSMichael S. Tsirkin 	if (ipoib_cm_add_mode_attr(priv->dev))
120839fcabaSMichael S. Tsirkin 		goto sysfs_failed;
1211da177e4SLinus Torvalds 	if (ipoib_add_pkey_attr(priv->dev))
1221da177e4SLinus Torvalds 		goto sysfs_failed;
123335a64a5SOr Gerlitz 	if (ipoib_add_umcast_attr(priv->dev))
124335a64a5SOr Gerlitz 		goto sysfs_failed;
1251da177e4SLinus Torvalds 
12643cb76d9SGreg Kroah-Hartman 	if (device_create_file(&priv->dev->dev, &dev_attr_parent))
1271da177e4SLinus Torvalds 		goto sysfs_failed;
1281da177e4SLinus Torvalds 
1291da177e4SLinus Torvalds 	list_add_tail(&priv->list, &ppriv->child_intfs);
1301da177e4SLinus Torvalds 
13195ed644fSIngo Molnar 	mutex_unlock(&ppriv->vlan_mutex);
1321da177e4SLinus Torvalds 
1331da177e4SLinus Torvalds 	return 0;
1341da177e4SLinus Torvalds 
1351da177e4SLinus Torvalds sysfs_failed:
1361732b0efSRoland Dreier 	ipoib_delete_debug_files(priv->dev);
1371da177e4SLinus Torvalds 	unregister_netdev(priv->dev);
1381da177e4SLinus Torvalds 
1391da177e4SLinus Torvalds register_failed:
1401da177e4SLinus Torvalds 	ipoib_dev_cleanup(priv->dev);
1411da177e4SLinus Torvalds 
1421da177e4SLinus Torvalds device_init_failed:
1431da177e4SLinus Torvalds 	free_netdev(priv->dev);
1441da177e4SLinus Torvalds 
1451da177e4SLinus Torvalds err:
14695ed644fSIngo Molnar 	mutex_unlock(&ppriv->vlan_mutex);
1471da177e4SLinus Torvalds 	return result;
1481da177e4SLinus Torvalds }
1491da177e4SLinus Torvalds 
1501da177e4SLinus Torvalds int ipoib_vlan_delete(struct net_device *pdev, unsigned short pkey)
1511da177e4SLinus Torvalds {
1521da177e4SLinus Torvalds 	struct ipoib_dev_priv *ppriv, *priv, *tpriv;
1531da177e4SLinus Torvalds 	int ret = -ENOENT;
1541da177e4SLinus Torvalds 
1551da177e4SLinus Torvalds 	if (!capable(CAP_NET_ADMIN))
1561da177e4SLinus Torvalds 		return -EPERM;
1571da177e4SLinus Torvalds 
1581da177e4SLinus Torvalds 	ppriv = netdev_priv(pdev);
1591da177e4SLinus Torvalds 
16095ed644fSIngo Molnar 	mutex_lock(&ppriv->vlan_mutex);
1611da177e4SLinus Torvalds 	list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
1621da177e4SLinus Torvalds 		if (priv->pkey == pkey) {
1631da177e4SLinus Torvalds 			unregister_netdev(priv->dev);
1641da177e4SLinus Torvalds 			ipoib_dev_cleanup(priv->dev);
1651da177e4SLinus Torvalds 			list_del(&priv->list);
1665941d079SRoland Dreier 			free_netdev(priv->dev);
1671da177e4SLinus Torvalds 
1681da177e4SLinus Torvalds 			ret = 0;
1691da177e4SLinus Torvalds 			break;
1701da177e4SLinus Torvalds 		}
1711da177e4SLinus Torvalds 	}
17295ed644fSIngo Molnar 	mutex_unlock(&ppriv->vlan_mutex);
1731da177e4SLinus Torvalds 
1741da177e4SLinus Torvalds 	return ret;
1751da177e4SLinus Torvalds }
176