projects / linux-block.git / blame
| Commit | Line | Data |
|---|---|---|
| 2874c5fd | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
| 0d89d203 SH |
2 | /* |
| 3 | * MPLS GSO Support | |
| 4 | * | |
| 5 | * Authors: Simon Horman (horms@verge.net.au) | |
| 6 | * | |
| 0d89d203 SH |
7 | * Based on: GSO portions of net/ipv4/gre.c |
| 8 | */ | |
| 9 | ||
| 10 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | |
| 11 | ||
| 12 | #include <linux/err.h> | |
| 13 | #include <linux/module.h> | |
| 14 | #include <linux/netdev_features.h> | |
| 15 | #include <linux/netdevice.h> | |
| 16 | #include <linux/skbuff.h> | |
| d348ede3 | 17 | #include <net/mpls.h> |
| 0d89d203 SH |
18 | |
| 19 | static struct sk_buff *mpls_gso_segment(struct sk_buff *skb, | |
| 20 | netdev_features_t features) | |
| 21 | { | |
| 22 | struct sk_buff *segs = ERR_PTR(-EINVAL); | |
| 48d2ab60 | 23 | u16 mac_offset = skb->mac_header; |
| 0d89d203 | 24 | netdev_features_t mpls_features; |
| 48d2ab60 | 25 | u16 mac_len = skb->mac_len; |
| 0d89d203 | 26 | __be16 mpls_protocol; |
| 48d2ab60 DA |
27 | unsigned int mpls_hlen; |
| 28 | ||
| 29 | skb_reset_network_header(skb); | |
| 30 | mpls_hlen = skb_inner_network_header(skb) - skb_network_header(skb); | |
| d348ede3 BN |
31 | if (unlikely(!mpls_hlen || mpls_hlen % MPLS_HLEN)) |
| 32 | goto out; | |
| 48d2ab60 DA |
33 | if (unlikely(!pskb_may_pull(skb, mpls_hlen))) |
| 34 | goto out; | |
| 0d89d203 | 35 | |
| 0d89d203 SH |
36 | /* Setup inner SKB. */ |
| 37 | mpls_protocol = skb->protocol; | |
| 38 | skb->protocol = skb->inner_protocol; | |
| 39 | ||
| 48d2ab60 DA |
40 | __skb_pull(skb, mpls_hlen); |
| 41 | ||
| 42 | skb->mac_len = 0; | |
| 43 | skb_reset_mac_header(skb); | |
| 0d89d203 SH |
44 | |
| 45 | /* Segment inner packet. */ | |
| 1e16aa3d | 46 | mpls_features = skb->dev->mpls_features & features; |
| 0d89d203 | 47 | segs = skb_mac_gso_segment(skb, mpls_features); |
| 48d2ab60 DA |
48 | if (IS_ERR_OR_NULL(segs)) { |
| 49 | skb_gso_error_unwind(skb, mpls_protocol, mpls_hlen, mac_offset, | |
| 50 | mac_len); | |
| 51 | goto out; | |
| 52 | } | |
| 53 | skb = segs; | |
| 54 | ||
| 55 | mpls_hlen += mac_len; | |
| 56 | do { | |
| 57 | skb->mac_len = mac_len; | |
| 58 | skb->protocol = mpls_protocol; | |
| 0d89d203 | 59 | |
| 48d2ab60 | 60 | skb_reset_inner_network_header(skb); |
| 0d89d203 | 61 | |
| 48d2ab60 | 62 | __skb_push(skb, mpls_hlen); |
| 0d89d203 | 63 | |
| 48d2ab60 DA |
64 | skb_reset_mac_header(skb); |
| 65 | skb_set_network_header(skb, mac_len); | |
| 66 | } while ((skb = skb->next)); | |
| 5c7cdf33 | 67 | |
| 48d2ab60 | 68 | out: |
| 0d89d203 SH |
69 | return segs; |
| 70 | } | |
| 71 | ||
| 207895fd | 72 | static struct packet_offload mpls_mc_offload __read_mostly = { |
| 0d89d203 | 73 | .type = cpu_to_be16(ETH_P_MPLS_MC), |
| bdef7de4 | 74 | .priority = 15, |
| 0d89d203 | 75 | .callbacks = { |
| 0d89d203 SH |
76 | .gso_segment = mpls_gso_segment, |
| 77 | }, | |
| 78 | }; | |
| 79 | ||
| 207895fd | 80 | static struct packet_offload mpls_uc_offload __read_mostly = { |
| 0d89d203 | 81 | .type = cpu_to_be16(ETH_P_MPLS_UC), |
| bdef7de4 | 82 | .priority = 15, |
| 0d89d203 | 83 | .callbacks = { |
| 0d89d203 SH |
84 | .gso_segment = mpls_gso_segment, |
| 85 | }, | |
| 86 | }; | |
| 87 | ||
| 88 | static int __init mpls_gso_init(void) | |
| 89 | { | |
| 90 | pr_info("MPLS GSO support\n"); | |
| 91 | ||
| 92 | dev_add_offload(&mpls_uc_offload); | |
| 93 | dev_add_offload(&mpls_mc_offload); | |
| 94 | ||
| 95 | return 0; | |
| 96 | } | |
| 97 | ||
| 98 | static void __exit mpls_gso_exit(void) | |
| 99 | { | |
| 100 | dev_remove_offload(&mpls_uc_offload); | |
| 101 | dev_remove_offload(&mpls_mc_offload); | |
| 102 | } | |
| 103 | ||
| 104 | module_init(mpls_gso_init); | |
| 105 | module_exit(mpls_gso_exit); | |
| 106 | ||
| 107 | MODULE_DESCRIPTION("MPLS GSO support"); | |
| 108 | MODULE_AUTHOR("Simon Horman (horms@verge.net.au)"); | |
| 109 | MODULE_LICENSE("GPL"); |