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  * $Id: ipoib_vlan.c 1349 2004-12-16 21:09:43Z roland $
  33  */
  34
  35 #include <linux/version.h>
  36 #include <linux/module.h>
  37
  38 #include <linux/init.h>
  39 #include <linux/slab.h>
  40 #include <linux/seq_file.h>
  41
  42 #include <asm/uaccess.h>
  43
  44 #include "ipoib.h"
  45
  46 static ssize_t show_parent(struct class_device *class_dev, char *buf)
  47 {
  48         struct net_device *dev =
  49                 container_of(class_dev, struct net_device, class_dev);
  50         struct ipoib_dev_priv *priv = netdev_priv(dev);
  51
  52         return sprintf(buf, "%s\n", priv->parent->name);
  53 }
  54 static CLASS_DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
  55
  56 int ipoib_vlan_add(struct net_device *pdev, unsigned short pkey)
  57 {
  58         struct ipoib_dev_priv *ppriv, *priv;
  59         char intf_name[IFNAMSIZ];
  60         int result;
  61
  62         if (!capable(CAP_NET_ADMIN))
  63                 return -EPERM;
  64
  65         ppriv = netdev_priv(pdev);
  66
  67         down(&ppriv->vlan_mutex);
  68
  69         /*
  70          * First ensure this isn't a duplicate. We check the parent device and
  71          * then all of the child interfaces to make sure the Pkey doesn't match.
  72          */
  73         if (ppriv->pkey == pkey) {
  74                 result = -ENOTUNIQ;
  75                 goto err;
  76         }
  77
  78         list_for_each_entry(priv, &ppriv->child_intfs, list) {
  79                 if (priv->pkey == pkey) {
  80                         result = -ENOTUNIQ;
  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         set_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags);
  94
  95         priv->pkey = pkey;
  96
  97         memcpy(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
  98         priv->dev->broadcast[8] = pkey >> 8;
  99         priv->dev->broadcast[9] = pkey & 0xff;
 100
 101         result = ipoib_dev_init(priv->dev, ppriv->ca, ppriv->port);
 102         if (result < 0) {
 103                 ipoib_warn(ppriv, "failed to initialize subinterface: "
 104                            "device %s, port %d",
 105                            ppriv->ca->name, ppriv->port);
 106                 goto device_init_failed;
 107         }
 108
 109         result = register_netdev(priv->dev);
 110         if (result) {
 111                 ipoib_warn(priv, "failed to initialize; error %i", result);
 112                 goto register_failed;
 113         }
 114
 115         priv->parent = ppriv->dev;
 116
 117         if (ipoib_create_debug_file(priv->dev))
 118                 goto debug_failed;
 119
 120         if (ipoib_add_pkey_attr(priv->dev))
 121                 goto sysfs_failed;
 122
 123         if (class_device_create_file(&priv->dev->class_dev,
 124                                      &class_device_attr_parent))
 125                 goto sysfs_failed;
 126
 127         list_add_tail(&priv->list, &ppriv->child_intfs);
 128
 129         up(&ppriv->vlan_mutex);
 130
 131         return 0;
 132
 133 sysfs_failed:
 134         ipoib_delete_debug_file(priv->dev);
 135
 136 debug_failed:
 137         unregister_netdev(priv->dev);
 138
 139 register_failed:
 140         ipoib_dev_cleanup(priv->dev);
 141
 142 device_init_failed:
 143         free_netdev(priv->dev);
 144
 145 err:
 146         up(&ppriv->vlan_mutex);
 147         return result;
 148 }
 149
 150 int ipoib_vlan_delete(struct net_device *pdev, unsigned short pkey)
 151 {
 152         struct ipoib_dev_priv *ppriv, *priv, *tpriv;
 153         int ret = -ENOENT;
 154
 155         if (!capable(CAP_NET_ADMIN))
 156                 return -EPERM;
 157
 158         ppriv = netdev_priv(pdev);
 159
 160         down(&ppriv->vlan_mutex);
 161         list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
 162                 if (priv->pkey == pkey) {
 163                         unregister_netdev(priv->dev);
 164                         ipoib_dev_cleanup(priv->dev);
 165
 166                         list_del(&priv->list);
 167
 168                         kfree(priv);
 169
 170                         ret = 0;
 171                         break;
 172                 }
 173         }
 174         up(&ppriv->vlan_mutex);
 175
 176         return ret;
 177 }