drivers/infiniband/ulp/ipoib/ipoib_vlan.c

   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
  42 static 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 }
  50 static DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
  51
  52 int __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         set_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags);
  62
  63         result = ipoib_set_dev_features(priv, ppriv->ca);
  64         if (result)
  65                 goto err;
  66
  67         priv->pkey = pkey;
  68
  69         memcpy(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
  70         priv->dev->broadcast[8] = pkey >> 8;
  71         priv->dev->broadcast[9] = pkey & 0xff;
  72
  73         result = ipoib_dev_init(priv->dev, ppriv->ca, ppriv->port);
  74         if (result < 0) {
  75                 ipoib_warn(ppriv, "failed to initialize subinterface: "
  76                            "device %s, port %d",
  77                            ppriv->ca->name, ppriv->port);
  78                 goto err;
  79         }
  80
  81         result = register_netdevice(priv->dev);
  82         if (result) {
  83                 ipoib_warn(priv, "failed to initialize; error %i", result);
  84                 goto register_failed;
  85         }
  86
  87         priv->parent = ppriv->dev;
  88
  89         ipoib_create_debug_files(priv->dev);
  90
  91         /* RTNL childs don't need proprietary sysfs entries */
  92         if (type == IPOIB_LEGACY_CHILD) {
  93                 if (ipoib_cm_add_mode_attr(priv->dev))
  94                         goto sysfs_failed;
  95                 if (ipoib_add_pkey_attr(priv->dev))
  96                         goto sysfs_failed;
  97                 if (ipoib_add_umcast_attr(priv->dev))
  98                         goto sysfs_failed;
  99
 100                 if (device_create_file(&priv->dev->dev, &dev_attr_parent))
 101                         goto sysfs_failed;
 102         }
 103
 104         priv->child_type  = type;
 105         list_add_tail(&priv->list, &ppriv->child_intfs);
 106
 107         return 0;
 108
 109 sysfs_failed:
 110         result = -ENOMEM;
 111         ipoib_delete_debug_files(priv->dev);
 112         unregister_netdevice(priv->dev);
 113
 114 register_failed:
 115         ipoib_dev_cleanup(priv->dev);
 116
 117 err:
 118         return result;
 119 }
 120
 121 int ipoib_vlan_add(struct net_device *pdev, unsigned short pkey)
 122 {
 123         struct ipoib_dev_priv *ppriv, *priv;
 124         char intf_name[IFNAMSIZ];
 125         struct ipoib_dev_priv *tpriv;
 126         int result;
 127
 128         if (!capable(CAP_NET_ADMIN))
 129                 return -EPERM;
 130
 131         ppriv = netdev_priv(pdev);
 132
 133         snprintf(intf_name, sizeof intf_name, "%s.%04x",
 134                  ppriv->dev->name, pkey);
 135         priv = ipoib_intf_alloc(intf_name);
 136         if (!priv)
 137                 return -ENOMEM;
 138
 139         if (!rtnl_trylock())
 140                 return restart_syscall();
 141
 142         down_write(&ppriv->vlan_rwsem);
 143
 144         /*
 145          * First ensure this isn't a duplicate. We check the parent device and
 146          * then all of the legacy child interfaces to make sure the Pkey
 147          * doesn't match.
 148          */
 149         if (ppriv->pkey == pkey) {
 150                 result = -ENOTUNIQ;
 151                 goto out;
 152         }
 153
 154         list_for_each_entry(tpriv, &ppriv->child_intfs, list) {
 155                 if (tpriv->pkey == pkey &&
 156                     tpriv->child_type == IPOIB_LEGACY_CHILD) {
 157                         result = -ENOTUNIQ;
 158                         goto out;
 159                 }
 160         }
 161
 162         result = __ipoib_vlan_add(ppriv, priv, pkey, IPOIB_LEGACY_CHILD);
 163
 164 out:
 165         up_write(&ppriv->vlan_rwsem);
 166
 167         if (result)
 168                 free_netdev(priv->dev);
 169
 170         rtnl_unlock();
 171
 172         return result;
 173 }
 174
 175 int ipoib_vlan_delete(struct net_device *pdev, unsigned short pkey)
 176 {
 177         struct ipoib_dev_priv *ppriv, *priv, *tpriv;
 178         struct net_device *dev = NULL;
 179
 180         if (!capable(CAP_NET_ADMIN))
 181                 return -EPERM;
 182
 183         ppriv = netdev_priv(pdev);
 184
 185         if (!rtnl_trylock())
 186                 return restart_syscall();
 187
 188         down_write(&ppriv->vlan_rwsem);
 189         list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
 190                 if (priv->pkey == pkey &&
 191                     priv->child_type == IPOIB_LEGACY_CHILD) {
 192                         unregister_netdevice(priv->dev);
 193                         list_del(&priv->list);
 194                         dev = priv->dev;
 195                         break;
 196                 }
 197         }
 198         up_write(&ppriv->vlan_rwsem);
 199
 200         rtnl_unlock();
 201
 202         if (dev) {
 203                 free_netdev(dev);
 204                 return 0;
 205         }
 206
 207         return -ENODEV;
 208 }