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