1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
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
42static 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}
50static DEVICE_ATTR(parent, S_IRUGO, show_parent, NULL);
51
52int ipoib_vlan_add(struct net_device *pdev, unsigned short pkey)
53{
54 struct ipoib_dev_priv *ppriv, *priv;
55 char intf_name[IFNAMSIZ];
56 int result;
57
58 if (!capable(CAP_NET_ADMIN))
59 return -EPERM;
60
61 ppriv = netdev_priv(pdev);
62
63 if (!rtnl_trylock())
64 return restart_syscall();
65 mutex_lock(&ppriv->vlan_mutex);
66
67
68
69
70
71 if (ppriv->pkey == pkey) {
72 result = -ENOTUNIQ;
73 priv = NULL;
74 goto err;
75 }
76
77 list_for_each_entry(priv, &ppriv->child_intfs, list) {
78 if (priv->pkey == pkey) {
79 result = -ENOTUNIQ;
80 priv = NULL;
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 priv->max_ib_mtu = ppriv->max_ib_mtu;
94
95 priv->dev->mtu = IPOIB_UD_MTU(priv->max_ib_mtu);
96 priv->mcast_mtu = priv->admin_mtu = priv->dev->mtu;
97 set_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags);
98
99 result = ipoib_set_dev_features(priv, ppriv->ca);
100 if (result)
101 goto err;
102
103 priv->pkey = pkey;
104
105 memcpy(priv->dev->dev_addr, ppriv->dev->dev_addr, INFINIBAND_ALEN);
106 priv->dev->broadcast[8] = pkey >> 8;
107 priv->dev->broadcast[9] = pkey & 0xff;
108
109 result = ipoib_dev_init(priv->dev, ppriv->ca, ppriv->port);
110 if (result < 0) {
111 ipoib_warn(ppriv, "failed to initialize subinterface: "
112 "device %s, port %d",
113 ppriv->ca->name, ppriv->port);
114 goto err;
115 }
116
117 result = register_netdevice(priv->dev);
118 if (result) {
119 ipoib_warn(priv, "failed to initialize; error %i", result);
120 goto register_failed;
121 }
122
123 priv->parent = ppriv->dev;
124
125 ipoib_create_debug_files(priv->dev);
126
127 if (ipoib_cm_add_mode_attr(priv->dev))
128 goto sysfs_failed;
129 if (ipoib_add_pkey_attr(priv->dev))
130 goto sysfs_failed;
131 if (ipoib_add_umcast_attr(priv->dev))
132 goto sysfs_failed;
133
134 if (device_create_file(&priv->dev->dev, &dev_attr_parent))
135 goto sysfs_failed;
136
137 list_add_tail(&priv->list, &ppriv->child_intfs);
138
139 mutex_unlock(&ppriv->vlan_mutex);
140 rtnl_unlock();
141
142 return 0;
143
144sysfs_failed:
145 ipoib_delete_debug_files(priv->dev);
146 unregister_netdevice(priv->dev);
147
148register_failed:
149 ipoib_dev_cleanup(priv->dev);
150
151err:
152 mutex_unlock(&ppriv->vlan_mutex);
153 rtnl_unlock();
154 if (priv)
155 free_netdev(priv->dev);
156
157 return result;
158}
159
160int ipoib_vlan_delete(struct net_device *pdev, unsigned short pkey)
161{
162 struct ipoib_dev_priv *ppriv, *priv, *tpriv;
163 struct net_device *dev = NULL;
164
165 if (!capable(CAP_NET_ADMIN))
166 return -EPERM;
167
168 ppriv = netdev_priv(pdev);
169
170 if (!rtnl_trylock())
171 return restart_syscall();
172 mutex_lock(&ppriv->vlan_mutex);
173 list_for_each_entry_safe(priv, tpriv, &ppriv->child_intfs, list) {
174 if (priv->pkey == pkey) {
175 unregister_netdevice(priv->dev);
176 ipoib_dev_cleanup(priv->dev);
177 list_del(&priv->list);
178 dev = priv->dev;
179 break;
180 }
181 }
182 mutex_unlock(&ppriv->vlan_mutex);
183 rtnl_unlock();
184
185 if (dev) {
186 free_netdev(dev);
187 return 0;
188 }
189
190 return -ENODEV;
191}
192