Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / infiniband / ulp / ipoib / ipoib_vlan.c
diff --git a/kernel/drivers/infiniband/ulp/ipoib/ipoib_vlan.c b/kernel/drivers/infiniband/ulp/ipoib/ipoib_vlan.c
new file mode 100644 (file)
index 0000000..fca1a88
--- /dev/null
@@ -0,0 +1,207 @@
+/*
+ * Copyright (c) 2004 Topspin Communications.  All rights reserved.
+ *
+ * This software is available to you under a choice of one of two
+ * licenses.  You may choose to be licensed under the terms of the GNU
+ * General Public License (GPL) Version 2, available from the file
+ * COPYING in the main directory of this source tree, or the
+ * OpenIB.org BSD license below:
+ *
+ *     Redistribution and use in source and binary forms, with or
+ *     without modification, are permitted provided that the following
+ *     conditions are met:
+ *
+ *      - Redistributions of source code must retain the above
+ *        copyright notice, this list of conditions and the following
+ *        disclaimer.
+ *
+ *      - Redistributions in binary form must reproduce the above
+ *        copyright notice, this list of conditions and the following
+ *        disclaimer in the documentation and/or other materials
+ *        provided with the distribution.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+ * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
+ * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
+ * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
+ * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
+ * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
+ * SOFTWARE.
+ */
+
+#include <linux/module.h>
+
+#include <linux/init.h>
+#include <linux/seq_file.h>
+
+#include <asm/uaccess.h>
+
+#include "ipoib.h"
+
+static ssize_t show_parent(struct device *d, struct device_attribute *attr,
+                          char *buf)
+{
+       struct net_device *dev = to_net_dev(d);
+       struct ipoib_dev_priv *priv = netdev_priv(dev);
+
+       return sprintf(buf, "%s\n", priv->parent->name);
+}
+static DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
+
+int __ipoib_vlan_add(struct ipoib_dev_priv *ppriv, struct ipoib_dev_priv *priv,
+                    u16 pkey, int type)
+{
+       int result;
+
+       priv->max_ib_mtu = ppriv->max_ib_mtu;
+       /* MTU will be reset when mcast join happens */
+       priv->dev->mtu   = IPOIB_UD_MTU(priv->max_ib_mtu);
+       priv->mcast_mtu  = priv->admin_mtu = priv->dev->mtu;
+       priv->parent = ppriv->dev;
+       set_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags);
+
+       result = ipoib_set_dev_features(priv, ppriv->ca);
+       if (result)
+               goto err;
+
+       priv->pkey = pkey;
+
+       memcpy(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
+       priv->dev->broadcast[8] = pkey >> 8;
+       priv->dev->broadcast[9] = pkey & 0xff;
+
+       result = ipoib_dev_init(priv->dev, ppriv->ca, ppriv->port);
+       if (result < 0) {
+               ipoib_warn(ppriv, "failed to initialize subinterface: "
+                          "device %s, port %d",
+                          ppriv->ca->name, ppriv->port);
+               goto err;
+       }
+
+       result = register_netdevice(priv->dev);
+       if (result) {
+               ipoib_warn(priv, "failed to initialize; error %i", result);
+               goto register_failed;
+       }
+
+       ipoib_create_debug_files(priv->dev);
+
+       /* RTNL childs don't need proprietary sysfs entries */
+       if (type == IPOIB_LEGACY_CHILD) {
+               if (ipoib_cm_add_mode_attr(priv->dev))
+                       goto sysfs_failed;
+               if (ipoib_add_pkey_attr(priv->dev))
+                       goto sysfs_failed;
+               if (ipoib_add_umcast_attr(priv->dev))
+                       goto sysfs_failed;
+
+               if (device_create_file(&priv->dev->dev, &dev_attr_parent))
+                       goto sysfs_failed;
+       }
+
+       priv->child_type  = type;
+       list_add_tail(&priv->list, &ppriv->child_intfs);
+
+       return 0;
+
+sysfs_failed:
+       result = -ENOMEM;
+       ipoib_delete_debug_files(priv->dev);
+       unregister_netdevice(priv->dev);
+
+register_failed:
+       ipoib_dev_cleanup(priv->dev);
+
+err:
+       return result;
+}
+
+int ipoib_vlan_add(struct net_device *pdev, unsigned short pkey)
+{
+       struct ipoib_dev_priv *ppriv, *priv;
+       char intf_name[IFNAMSIZ];
+       struct ipoib_dev_priv *tpriv;
+       int result;
+
+       if (!capable(CAP_NET_ADMIN))
+               return -EPERM;
+
+       ppriv = netdev_priv(pdev);
+
+       snprintf(intf_name, sizeof intf_name, "%s.%04x",
+                ppriv->dev->name, pkey);
+       priv = ipoib_intf_alloc(intf_name);
+       if (!priv)
+               return -ENOMEM;
+
+       if (!rtnl_trylock())
+               return restart_syscall();
+
+       down_write(&ppriv->vlan_rwsem);
+
+       /*
+        * First ensure this isn't a duplicate. We check the parent device and
+        * then all of the legacy child interfaces to make sure the Pkey
+        * doesn't match.
+        */
+       if (ppriv->pkey == pkey) {
+               result = -ENOTUNIQ;
+               goto out;
+       }
+
+       list_for_each_entry(tpriv, &ppriv->child_intfs, list) {
+               if (tpriv->pkey == pkey &&
+                   tpriv->child_type == IPOIB_LEGACY_CHILD) {
+                       result = -ENOTUNIQ;
+                       goto out;
+               }
+       }
+
+       result = __ipoib_vlan_add(ppriv, priv, pkey, IPOIB_LEGACY_CHILD);
+
+out:
+       up_write(&ppriv->vlan_rwsem);
+
+       if (result)
+               free_netdev(priv->dev);
+
+       rtnl_unlock();
+
+       return result;
+}
+
+int ipoib_vlan_delete(struct net_device *pdev, unsigned short pkey)
+{
+       struct ipoib_dev_priv *ppriv, *priv, *tpriv;
+       struct net_device *dev = NULL;
+
+       if (!capable(CAP_NET_ADMIN))
+               return -EPERM;
+
+       ppriv = netdev_priv(pdev);
+
+       if (!rtnl_trylock())
+               return restart_syscall();
+
+       down_write(&ppriv->vlan_rwsem);
+       list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
+               if (priv->pkey == pkey &&
+                   priv->child_type == IPOIB_LEGACY_CHILD) {
+                       unregister_netdevice(priv->dev);
+                       list_del(&priv->list);
+                       dev = priv->dev;
+                       break;
+               }
+       }
+       up_write(&ppriv->vlan_rwsem);
+
+       rtnl_unlock();
+
+       if (dev) {
+               free_netdev(dev);
+               return 0;
+       }
+
+       return -ENODEV;
+}