Branch data     Line data    Source code

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