datapath/vport-patch.c

   1 /*
   2  * Copyright (c) 2010 Nicira Networks.
   3  * Distributed under the terms of the GNU GPL version 2.
   4  *
   5  * Significant portions of this file may be copied from parts of the Linux
   6  * kernel, by Linus Torvalds and others.
   7  */
   8
   9 #include <linux/dcache.h>
  10 #include <linux/kernel.h>
  11 #include <linux/list.h>
  12 #include <linux/rtnetlink.h>
  13
  14 #include "datapath.h"
  15 #include "vport.h"
  16 #include "vport-generic.h"
  17
  18 struct device_config {
  19         struct rcu_head rcu;
  20
  21         unsigned char eth_addr[ETH_ALEN];
  22         unsigned int mtu;
  23 };
  24
  25 struct patch_vport {
  26         struct rcu_head rcu;
  27
  28         char name[IFNAMSIZ];
  29
  30         /* Protected by RTNL lock. */
  31         char peer_name[IFNAMSIZ];
  32         struct hlist_node hash_node;
  33
  34         struct vport __rcu *peer;
  35         struct device_config __rcu *devconf;
  36 };
  37
  38 /* Protected by RTNL lock. */
  39 static struct hlist_head *peer_table;
  40 #define PEER_HASH_BUCKETS 256
  41
  42 static void update_peers(const char *name, struct vport *);
  43
  44 static inline struct patch_vport *patch_vport_priv(const struct vport *vport)
  45 {
  46         return vport_priv(vport);
  47 }
  48
  49 /* RCU callback. */
  50 static void free_config(struct rcu_head *rcu)
  51 {
  52         struct device_config *c = container_of(rcu, struct device_config, rcu);
  53         kfree(c);
  54 }
  55
  56 static void assign_config_rcu(struct vport *vport,
  57                               struct device_config *new_config)
  58 {
  59         struct patch_vport *patch_vport = patch_vport_priv(vport);
  60         struct device_config *old_config;
  61
  62         old_config = rtnl_dereference(patch_vport->devconf);
  63         rcu_assign_pointer(patch_vport->devconf, new_config);
  64         call_rcu(&old_config->rcu, free_config);
  65 }
  66
  67 static struct hlist_head *hash_bucket(const char *name)
  68 {
  69         unsigned int hash = full_name_hash(name, strlen(name));
  70         return &peer_table[hash & (PEER_HASH_BUCKETS - 1)];
  71 }
  72
  73 static int patch_init(void)
  74 {
  75         peer_table = kzalloc(PEER_HASH_BUCKETS * sizeof(struct hlist_head),
  76                             GFP_KERNEL);
  77         if (!peer_table)
  78                 return -ENOMEM;
  79
  80         return 0;
  81 }
  82
  83 static void patch_exit(void)
  84 {
  85         kfree(peer_table);
  86 }
  87
  88 static int set_config(struct vport *vport, const void *config)
  89 {
  90         struct patch_vport *patch_vport = patch_vport_priv(vport);
  91         char peer_name[IFNAMSIZ];
  92
  93         strlcpy(peer_name, config, IFNAMSIZ);
  94
  95         if (!strcmp(patch_vport->name, peer_name))
  96                 return -EINVAL;
  97
  98         strcpy(patch_vport->peer_name, peer_name);
  99
 100         return 0;
 101 }
 102
 103 static struct vport *patch_create(const struct vport_parms *parms)
 104 {
 105         struct vport *vport;
 106         struct patch_vport *patch_vport;
 107         int err;
 108
 109         vport = vport_alloc(sizeof(struct patch_vport), &patch_vport_ops, parms);
 110         if (IS_ERR(vport)) {
 111                 err = PTR_ERR(vport);
 112                 goto error;
 113         }
 114
 115         patch_vport = patch_vport_priv(vport);
 116
 117         strcpy(patch_vport->name, parms->name);
 118
 119         err = set_config(vport, parms->config);
 120         if (err)
 121                 goto error_free_vport;
 122
 123         patch_vport->devconf = kmalloc(sizeof(struct device_config), GFP_KERNEL);
 124         if (!patch_vport->devconf) {
 125                 err = -ENOMEM;
 126                 goto error_free_vport;
 127         }
 128
 129         vport_gen_rand_ether_addr(patch_vport->devconf->eth_addr);
 130
 131         /* Make the default MTU fairly large so that it doesn't become the
 132          * bottleneck on systems using jumbo frames. */
 133         patch_vport->devconf->mtu = 65535;
 134
 135         hlist_add_head(&patch_vport->hash_node, hash_bucket(patch_vport->peer_name));
 136
 137         rcu_assign_pointer(patch_vport->peer, vport_locate(patch_vport->peer_name));
 138         update_peers(patch_vport->name, vport);
 139
 140         return vport;
 141
 142 error_free_vport:
 143         vport_free(vport);
 144 error:
 145         return ERR_PTR(err);
 146 }
 147
 148 static int patch_modify(struct vport *vport, struct odp_port *port)
 149 {
 150         int err = set_config(vport, port->config);
 151         if (!err) {
 152                 struct patch_vport *patch_vport = patch_vport_priv(vport);
 153
 154                 hlist_del(&patch_vport->hash_node);
 155                 rcu_assign_pointer(patch_vport->peer, vport_locate(patch_vport->peer_name));
 156                 hlist_add_head(&patch_vport->hash_node, hash_bucket(patch_vport->peer_name));
 157         }
 158         return err;
 159 }
 160
 161 static void free_port_rcu(struct rcu_head *rcu)
 162 {
 163         struct patch_vport *patch_vport = container_of(rcu,
 164                                                       struct patch_vport, rcu);
 165
 166         kfree(patch_vport->devconf);
 167         vport_free(vport_from_priv(patch_vport));
 168 }
 169
 170 static int patch_destroy(struct vport *vport)
 171 {
 172         struct patch_vport *patch_vport = patch_vport_priv(vport);
 173
 174         update_peers(patch_vport->name, NULL);
 175         hlist_del(&patch_vport->hash_node);
 176         call_rcu(&patch_vport->rcu, free_port_rcu);
 177
 178         return 0;
 179 }
 180
 181 static void update_peers(const char *name, struct vport *vport)
 182 {
 183         struct hlist_head *bucket = hash_bucket(name);
 184         struct patch_vport *peer_vport;
 185         struct hlist_node *node;
 186
 187         hlist_for_each_entry(peer_vport, node, bucket, hash_node)
 188                 if (!strcmp(peer_vport->peer_name, name))
 189                         rcu_assign_pointer(peer_vport->peer, vport);
 190 }
 191
 192 static int patch_set_mtu(struct vport *vport, int mtu)
 193 {
 194         struct patch_vport *patch_vport = patch_vport_priv(vport);
 195         struct device_config *devconf;
 196
 197         devconf = kmemdup(patch_vport->devconf, sizeof(struct device_config), GFP_KERNEL);
 198         if (!devconf)
 199                 return -ENOMEM;
 200
 201         devconf->mtu = mtu;
 202         assign_config_rcu(vport, devconf);
 203
 204         return 0;
 205 }
 206
 207 static int patch_set_addr(struct vport *vport, const unsigned char *addr)
 208 {
 209         struct patch_vport *patch_vport = patch_vport_priv(vport);
 210         struct device_config *devconf;
 211
 212         devconf = kmemdup(patch_vport->devconf, sizeof(struct device_config), GFP_KERNEL);
 213         if (!devconf)
 214                 return -ENOMEM;
 215
 216         memcpy(devconf->eth_addr, addr, ETH_ALEN);
 217         assign_config_rcu(vport, devconf);
 218
 219         return 0;
 220 }
 221
 222
 223 static const char *patch_get_name(const struct vport *vport)
 224 {
 225         const struct patch_vport *patch_vport = patch_vport_priv(vport);
 226         return patch_vport->name;
 227 }
 228
 229 static const unsigned char *patch_get_addr(const struct vport *vport)
 230 {
 231         const struct patch_vport *patch_vport = patch_vport_priv(vport);
 232         return rcu_dereference_rtnl(patch_vport->devconf)->eth_addr;
 233 }
 234
 235 static int patch_get_mtu(const struct vport *vport)
 236 {
 237         const struct patch_vport *patch_vport = patch_vport_priv(vport);
 238         return rcu_dereference_rtnl(patch_vport->devconf)->mtu;
 239 }
 240
 241 static int patch_send(struct vport *vport, struct sk_buff *skb)
 242 {
 243         struct patch_vport *patch_vport = patch_vport_priv(vport);
 244         struct vport *peer = rcu_dereference(patch_vport->peer);
 245         int skb_len = skb->len;
 246
 247         if (!peer) {
 248                 kfree_skb(skb);
 249                 vport_record_error(vport, VPORT_E_TX_DROPPED);
 250
 251                 return 0;
 252         }
 253
 254         vport_receive(peer, skb);
 255         return skb_len;
 256 }
 257
 258 const struct vport_ops patch_vport_ops = {
 259         .type           = "patch",
 260         .flags          = VPORT_F_GEN_STATS,
 261         .init           = patch_init,
 262         .exit           = patch_exit,
 263         .create         = patch_create,
 264         .modify         = patch_modify,
 265         .destroy        = patch_destroy,
 266         .set_mtu        = patch_set_mtu,
 267         .set_addr       = patch_set_addr,
 268         .get_name       = patch_get_name,
 269         .get_addr       = patch_get_addr,
 270         .get_dev_flags  = vport_gen_get_dev_flags,
 271         .is_running     = vport_gen_is_running,
 272         .get_operstate  = vport_gen_get_operstate,
 273         .get_mtu        = patch_get_mtu,
 274         .send           = patch_send,
 275 };