[PATCH] IPoIB: fix static rate calculation
[linux-2.6] / 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 }