Merge tag 'mfd-next-5.2' of git://git.kernel.org/pub/scm/linux/kernel/git/lee/mfd
[linux-2.6-microblaze.git] / net / ipv4 / xfrm4_output.c
1 /*
2  * xfrm4_output.c - Common IPsec encapsulation code for IPv4.
3  * Copyright (c) 2004 Herbert Xu <herbert@gondor.apana.org.au>
4  *
5  * This program is free software; you can redistribute it and/or
6  * modify it under the terms of the GNU General Public License
7  * as published by the Free Software Foundation; either version
8  * 2 of the License, or (at your option) any later version.
9  */
10
11 #include <linux/if_ether.h>
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/skbuff.h>
15 #include <linux/netfilter_ipv4.h>
16 #include <net/dst.h>
17 #include <net/ip.h>
18 #include <net/xfrm.h>
19 #include <net/icmp.h>
20
21 static int xfrm4_tunnel_check_size(struct sk_buff *skb)
22 {
23         int mtu, ret = 0;
24
25         if (IPCB(skb)->flags & IPSKB_XFRM_TUNNEL_SIZE)
26                 goto out;
27
28         if (!(ip_hdr(skb)->frag_off & htons(IP_DF)) || skb->ignore_df)
29                 goto out;
30
31         mtu = dst_mtu(skb_dst(skb));
32         if ((!skb_is_gso(skb) && skb->len > mtu) ||
33             (skb_is_gso(skb) &&
34              !skb_gso_validate_network_len(skb, ip_skb_dst_mtu(skb->sk, skb)))) {
35                 skb->protocol = htons(ETH_P_IP);
36
37                 if (skb->sk)
38                         xfrm_local_error(skb, mtu);
39                 else
40                         icmp_send(skb, ICMP_DEST_UNREACH,
41                                   ICMP_FRAG_NEEDED, htonl(mtu));
42                 ret = -EMSGSIZE;
43         }
44 out:
45         return ret;
46 }
47
48 int xfrm4_extract_output(struct xfrm_state *x, struct sk_buff *skb)
49 {
50         int err;
51
52         err = xfrm4_tunnel_check_size(skb);
53         if (err)
54                 return err;
55
56         XFRM_MODE_SKB_CB(skb)->protocol = ip_hdr(skb)->protocol;
57
58         return xfrm4_extract_header(skb);
59 }
60
61 int xfrm4_output_finish(struct sock *sk, struct sk_buff *skb)
62 {
63         memset(IPCB(skb), 0, sizeof(*IPCB(skb)));
64
65 #ifdef CONFIG_NETFILTER
66         IPCB(skb)->flags |= IPSKB_XFRM_TRANSFORMED;
67 #endif
68
69         return xfrm_output(sk, skb);
70 }
71
72 static int __xfrm4_output(struct net *net, struct sock *sk, struct sk_buff *skb)
73 {
74         struct xfrm_state *x = skb_dst(skb)->xfrm;
75         const struct xfrm_state_afinfo *afinfo;
76         int ret = -EAFNOSUPPORT;
77
78 #ifdef CONFIG_NETFILTER
79         if (!x) {
80                 IPCB(skb)->flags |= IPSKB_REROUTED;
81                 return dst_output(net, sk, skb);
82         }
83 #endif
84
85         rcu_read_lock();
86         afinfo = xfrm_state_afinfo_get_rcu(x->outer_mode.family);
87         if (likely(afinfo))
88                 ret = afinfo->output_finish(sk, skb);
89         else
90                 kfree_skb(skb);
91         rcu_read_unlock();
92
93         return ret;
94 }
95
96 int xfrm4_output(struct net *net, struct sock *sk, struct sk_buff *skb)
97 {
98         return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING,
99                             net, sk, skb, NULL, skb_dst(skb)->dev,
100                             __xfrm4_output,
101                             !(IPCB(skb)->flags & IPSKB_REROUTED));
102 }
103
104 void xfrm4_local_error(struct sk_buff *skb, u32 mtu)
105 {
106         struct iphdr *hdr;
107
108         hdr = skb->encapsulation ? inner_ip_hdr(skb) : ip_hdr(skb);
109         ip_local_error(skb->sk, EMSGSIZE, hdr->daddr,
110                        inet_sk(skb->sk)->inet_dport, mtu);
111 }