5 * YOSHIFUJI Hideaki @USAGI
6 * Split up af-specific portion
7 * Derek Atkins <derek@ihtfp.com>
8 * Add Encapsulation support
12 #include <linux/string.h>
13 #include <net/inet_ecn.h>
17 int xfrm4_rcv(struct sk_buff *skb)
19 return xfrm4_rcv_encap(skb, 0);
22 static inline void ipip_ecn_decapsulate(struct sk_buff *skb)
24 struct iphdr *outer_iph = skb->nh.iph;
25 struct iphdr *inner_iph = skb->h.ipiph;
27 if (INET_ECN_is_ce(outer_iph->tos))
28 IP_ECN_set_ce(inner_iph);
31 static int xfrm4_parse_spi(struct sk_buff *skb, u8 nexthdr, u32 *spi, u32 *seq)
35 if (!pskb_may_pull(skb, sizeof(struct iphdr)))
37 *spi = skb->nh.iph->saddr;
42 return xfrm_parse_spi(skb, nexthdr, spi, seq);
45 int xfrm4_rcv_encap(struct sk_buff *skb, __u16 encap_type)
49 struct sec_decap_state xfrm_vec[XFRM_MAX_DEPTH];
54 if ((err = xfrm4_parse_spi(skb, skb->nh.iph->protocol, &spi, &seq)) != 0)
58 struct iphdr *iph = skb->nh.iph;
60 if (xfrm_nr == XFRM_MAX_DEPTH)
63 x = xfrm_state_lookup((xfrm_address_t *)&iph->daddr, spi, iph->protocol, AF_INET);
68 if (unlikely(x->km.state != XFRM_STATE_VALID))
71 if (x->props.replay_window && xfrm_replay_check(x, seq))
74 if (xfrm_state_check_expire(x))
77 xfrm_vec[xfrm_nr].decap.decap_type = encap_type;
78 if (x->type->input(x, &(xfrm_vec[xfrm_nr].decap), skb))
81 /* only the first xfrm gets the encap type */
84 if (x->props.replay_window)
85 xfrm_replay_advance(x, seq);
87 x->curlft.bytes += skb->len;
90 spin_unlock(&x->lock);
92 xfrm_vec[xfrm_nr++].xvec = x;
97 if (iph->protocol != IPPROTO_IPIP)
99 if (!pskb_may_pull(skb, sizeof(struct iphdr)))
101 if (skb_cloned(skb) &&
102 pskb_expand_head(skb, 0, 0, GFP_ATOMIC))
104 if (x->props.flags & XFRM_STATE_DECAP_DSCP)
105 ipv4_copy_dscp(iph, skb->h.ipiph);
106 if (!(x->props.flags & XFRM_STATE_NOECN))
107 ipip_ecn_decapsulate(skb);
108 skb->mac.raw = memmove(skb->data - skb->mac_len,
109 skb->mac.raw, skb->mac_len);
110 skb->nh.raw = skb->data;
111 memset(&(IPCB(skb)->opt), 0, sizeof(struct ip_options));
116 if ((err = xfrm_parse_spi(skb, skb->nh.iph->protocol, &spi, &seq)) < 0)
120 /* Allocate new secpath or COW existing one. */
122 if (!skb->sp || atomic_read(&skb->sp->refcnt) != 1) {
124 sp = secpath_dup(skb->sp);
128 secpath_put(skb->sp);
131 if (xfrm_nr + skb->sp->len > XFRM_MAX_DEPTH)
134 memcpy(skb->sp->x+skb->sp->len, xfrm_vec, xfrm_nr*sizeof(struct sec_decap_state));
135 skb->sp->len += xfrm_nr;
138 if (!(skb->dev->flags&IFF_LOOPBACK)) {
139 dst_release(skb->dst);
145 return -skb->nh.iph->protocol;
149 spin_unlock(&x->lock);
152 while (--xfrm_nr >= 0)
153 xfrm_state_put(xfrm_vec[xfrm_nr].xvec);