datapath/linux/compat/gre.c

   1 /*
   2  * Copyright (c) 2007-2013 Nicira, Inc.
   3  *
   4  * This program is free software; you can redistribute it and/or
   5  * modify it under the terms of version 2 of the GNU General Public
   6  * License as published by the Free Software Foundation.
   7  *
   8  * This program is distributed in the hope that it will be useful, but
   9  * WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  11  * General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program; if not, write to the Free Software
  15  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  16  * 02110-1301, USA
  17  */
  18
  19 #include <linux/kconfig.h>
  20 #if IS_ENABLED(CONFIG_NET_IPGRE_DEMUX)
  21
  22 #include <linux/module.h>
  23 #include <linux/if.h>
  24 #include <linux/if_tunnel.h>
  25 #include <linux/icmp.h>
  26 #include <linux/in.h>
  27 #include <linux/ip.h>
  28 #include <linux/kernel.h>
  29 #include <linux/kmod.h>
  30 #include <linux/netdevice.h>
  31 #include <linux/skbuff.h>
  32 #include <linux/spinlock.h>
  33
  34 #include <net/gre.h>
  35 #include <net/icmp.h>
  36 #include <net/protocol.h>
  37 #include <net/route.h>
  38 #include <net/xfrm.h>
  39
  40 #include "gso.h"
  41
  42 static void gre_csum_fix(struct sk_buff *skb)
  43 {
  44         struct gre_base_hdr *greh;
  45         __be32 *options;
  46         int gre_offset = skb_transport_offset(skb);
  47
  48         greh = (struct gre_base_hdr *)skb_transport_header(skb);
  49         options = ((__be32 *)greh + 1);
  50
  51         *options = 0;
  52         *(__sum16 *)options = csum_fold(skb_checksum(skb, gre_offset,
  53                                                      skb->len - gre_offset, 0));
  54 }
  55
  56 struct sk_buff *gre_handle_offloads(struct sk_buff *skb, bool gre_csum)
  57 {
  58         int err;
  59
  60         skb_reset_inner_headers(skb);
  61
  62         if (skb_is_gso(skb)) {
  63                 if (gre_csum)
  64                         OVS_GSO_CB(skb)->fix_segment = gre_csum_fix;
  65         } else {
  66                 if (skb->ip_summed == CHECKSUM_PARTIAL && gre_csum) {
  67                         err = skb_checksum_help(skb);
  68                         if (err)
  69                                 goto error;
  70
  71                 } else if (skb->ip_summed != CHECKSUM_PARTIAL)
  72                         skb->ip_summed = CHECKSUM_NONE;
  73         }
  74         return skb;
  75 error:
  76         kfree_skb(skb);
  77         return ERR_PTR(err);
  78 }
  79
  80 static bool is_gre_gso(struct sk_buff *skb)
  81 {
  82         return skb_is_gso(skb);
  83 }
  84
  85 void gre_build_header(struct sk_buff *skb, const struct tnl_ptk_info *tpi,
  86                       int hdr_len)
  87 {
  88         struct gre_base_hdr *greh;
  89
  90         __skb_push(skb, hdr_len);
  91
  92         greh = (struct gre_base_hdr *)skb->data;
  93         greh->flags = tnl_flags_to_gre_flags(tpi->flags);
  94         greh->protocol = tpi->proto;
  95
  96         if (tpi->flags & (TUNNEL_KEY | TUNNEL_CSUM | TUNNEL_SEQ)) {
  97                 __be32 *ptr = (__be32 *)(((u8 *)greh) + hdr_len - 4);
  98
  99                 if (tpi->flags & TUNNEL_SEQ) {
 100                         *ptr = tpi->seq;
 101                         ptr--;
 102                 }
 103                 if (tpi->flags & TUNNEL_KEY) {
 104                         *ptr = tpi->key;
 105                         ptr--;
 106                 }
 107                 if (tpi->flags & TUNNEL_CSUM && !is_gre_gso(skb)) {
 108                         *ptr = 0;
 109                         *(__sum16 *)ptr = csum_fold(skb_checksum(skb, 0,
 110                                                 skb->len, 0));
 111                 }
 112         }
 113 }
 114
 115 #if LINUX_VERSION_CODE < KERNEL_VERSION(3,11,0)
 116
 117 static __sum16 check_checksum(struct sk_buff *skb)
 118 {
 119         __sum16 csum = 0;
 120
 121         switch (skb->ip_summed) {
 122         case CHECKSUM_COMPLETE:
 123                 csum = csum_fold(skb->csum);
 124
 125                 if (!csum)
 126                         break;
 127                 /* Fall through. */
 128
 129         case CHECKSUM_NONE:
 130                 skb->csum = 0;
 131                 csum = __skb_checksum_complete(skb);
 132                 skb->ip_summed = CHECKSUM_COMPLETE;
 133                 break;
 134         }
 135
 136         return csum;
 137 }
 138
 139 static int parse_gre_header(struct sk_buff *skb, struct tnl_ptk_info *tpi,
 140                             bool *csum_err)
 141 {
 142         unsigned int ip_hlen = ip_hdrlen(skb);
 143         struct gre_base_hdr *greh;
 144         __be32 *options;
 145         int hdr_len;
 146
 147         if (unlikely(!pskb_may_pull(skb, sizeof(struct gre_base_hdr))))
 148                 return -EINVAL;
 149
 150         greh = (struct gre_base_hdr *)(skb_network_header(skb) + ip_hlen);
 151         if (unlikely(greh->flags & (GRE_VERSION | GRE_ROUTING)))
 152                 return -EINVAL;
 153
 154         tpi->flags = gre_flags_to_tnl_flags(greh->flags);
 155         hdr_len = ip_gre_calc_hlen(tpi->flags);
 156
 157         if (!pskb_may_pull(skb, hdr_len))
 158                 return -EINVAL;
 159
 160         greh = (struct gre_base_hdr *)(skb_network_header(skb) + ip_hlen);
 161         tpi->proto = greh->protocol;
 162
 163         options = (__be32 *)(greh + 1);
 164         if (greh->flags & GRE_CSUM) {
 165                 if (check_checksum(skb)) {
 166                         *csum_err = true;
 167                         return -EINVAL;
 168                 }
 169                 options++;
 170         }
 171
 172         if (greh->flags & GRE_KEY) {
 173                 tpi->key = *options;
 174                 options++;
 175         } else
 176                 tpi->key = 0;
 177
 178         if (unlikely(greh->flags & GRE_SEQ)) {
 179                 tpi->seq = *options;
 180                 options++;
 181         } else
 182                 tpi->seq = 0;
 183
 184         /* WCCP version 1 and 2 protocol decoding.
 185          * - Change protocol to IP
 186          * - When dealing with WCCPv2, Skip extra 4 bytes in GRE header
 187          */
 188         if (greh->flags == 0 && tpi->proto == htons(ETH_P_WCCP)) {
 189                 tpi->proto = htons(ETH_P_IP);
 190                 if ((*(u8 *)options & 0xF0) != 0x40) {
 191                         hdr_len += 4;
 192                         if (!pskb_may_pull(skb, hdr_len))
 193                                 return -EINVAL;
 194                 }
 195         }
 196
 197         return iptunnel_pull_header(skb, hdr_len, tpi->proto);
 198 }
 199
 200 static struct gre_cisco_protocol __rcu *gre_cisco_proto;
 201
 202 static int gre_cisco_rcv(struct sk_buff *skb)
 203 {
 204         struct tnl_ptk_info tpi;
 205         bool csum_err = false;
 206         struct gre_cisco_protocol *proto;
 207
 208         rcu_read_lock();
 209         proto = rcu_dereference(gre_cisco_proto);
 210         if (!proto)
 211                 goto drop;
 212
 213         if (parse_gre_header(skb, &tpi, &csum_err) < 0)
 214                 goto drop;
 215         proto->handler(skb, &tpi);
 216         rcu_read_unlock();
 217         return 0;
 218
 219 drop:
 220         rcu_read_unlock();
 221         kfree_skb(skb);
 222         return 0;
 223 }
 224
 225 static const struct gre_protocol ipgre_protocol = {
 226         .handler        =       gre_cisco_rcv,
 227 };
 228
 229 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)
 230 static const struct gre_protocol __rcu *gre_proto[GREPROTO_MAX] __read_mostly;
 231
 232 int gre_add_protocol(const struct gre_protocol *proto, u8 version)
 233 {
 234         if (version >= GREPROTO_MAX)
 235                 return -EINVAL;
 236
 237         return (cmpxchg((const struct gre_protocol **)&gre_proto[version], NULL, proto) == NULL) ?
 238                 0 : -EBUSY;
 239 }
 240
 241 int gre_del_protocol(const struct gre_protocol *proto, u8 version)
 242 {
 243         int ret;
 244
 245         if (version >= GREPROTO_MAX)
 246                 return -EINVAL;
 247
 248         ret = (cmpxchg((const struct gre_protocol **)&gre_proto[version], proto, NULL) == proto) ?
 249                 0 : -EBUSY;
 250
 251         if (ret)
 252                 return ret;
 253
 254         synchronize_net();
 255         return 0;
 256 }
 257
 258 static int gre_rcv(struct sk_buff *skb)
 259 {
 260         const struct gre_protocol *proto;
 261         u8 ver;
 262         int ret;
 263
 264         if (!pskb_may_pull(skb, 12))
 265                 goto drop;
 266
 267         ver = skb->data[1] & 0x7f;
 268         if (ver >= GREPROTO_MAX)
 269                 goto drop;
 270
 271         rcu_read_lock();
 272         proto = rcu_dereference(gre_proto[ver]);
 273         if (!proto || !proto->handler)
 274                 goto drop_unlock;
 275         ret = proto->handler(skb);
 276         rcu_read_unlock();
 277         return ret;
 278
 279 drop_unlock:
 280         rcu_read_unlock();
 281 drop:
 282         kfree_skb(skb);
 283         return NET_RX_DROP;
 284 }
 285
 286 static const struct net_protocol net_gre_protocol = {
 287         .handler     = gre_rcv,
 288 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,32)
 289         .netns_ok    = 1,
 290 #endif
 291 };
 292 #endif
 293
 294 static int gre_compat_init(void)
 295 {
 296         int err;
 297
 298 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)
 299         if (inet_add_protocol(&net_gre_protocol, IPPROTO_GRE) < 0) {
 300                 pr_err("%s: cannot register gre protocol handler\n", __func__);
 301                 return -EAGAIN;
 302         }
 303 #endif
 304         err = gre_add_protocol(&ipgre_protocol, GREPROTO_CISCO);
 305         if (err) {
 306                 pr_warn("%s: cannot register gre_cisco protocol handler\n", __func__);
 307
 308 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)
 309                 inet_del_protocol(&net_gre_protocol, IPPROTO_GRE);
 310 #endif
 311         }
 312
 313         return err;
 314 }
 315
 316 static int gre_compat_exit(void)
 317 {
 318         int ret;
 319
 320         ret = gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO);
 321         if (ret)
 322                 return ret;
 323
 324 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)
 325         ret = inet_del_protocol(&net_gre_protocol, IPPROTO_GRE);
 326         if (ret)
 327                 return ret;
 328 #endif
 329         return 0;
 330 }
 331
 332 int gre_cisco_register(struct gre_cisco_protocol *newp)
 333 {
 334         int err;
 335
 336         err = gre_compat_init();
 337         if (err)
 338                 return err;
 339
 340         return (cmpxchg((struct gre_cisco_protocol **)&gre_cisco_proto, NULL, newp) == NULL) ?
 341                 0 : -EBUSY;
 342 }
 343
 344 int gre_cisco_unregister(struct gre_cisco_protocol *proto)
 345 {
 346         int ret;
 347
 348         ret = (cmpxchg((struct gre_cisco_protocol **)&gre_cisco_proto, proto, NULL) == proto) ?
 349                 0 : -EINVAL;
 350
 351         if (ret)
 352                 return ret;
 353
 354         synchronize_net();
 355         ret = gre_compat_exit();
 356         return ret;
 357 }
 358
 359 #endif /* 3.11 */
 360
 361 #endif /* CONFIG_NET_IPGRE_DEMUX */