xfrm6_input.c 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150
  1. /*
  2. * xfrm6_input.c: based on net/ipv4/xfrm4_input.c
  3. *
  4. * Authors:
  5. * Mitsuru KANDA @USAGI
  6. * Kazunori MIYAZAWA @USAGI
  7. * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
  8. * YOSHIFUJI Hideaki @USAGI
  9. * IPv6 support
  10. */
  11. #include <linux/module.h>
  12. #include <linux/string.h>
  13. #include <linux/netfilter.h>
  14. #include <linux/netfilter_ipv6.h>
  15. #include <net/ipv6.h>
  16. #include <net/xfrm.h>
  17. int xfrm6_extract_input(struct xfrm_state *x, struct sk_buff *skb)
  18. {
  19. return xfrm6_extract_header(skb);
  20. }
  21. int xfrm6_rcv_spi(struct sk_buff *skb, int nexthdr, __be32 spi,
  22. struct ip6_tnl *t)
  23. {
  24. XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip6 = t;
  25. XFRM_SPI_SKB_CB(skb)->family = AF_INET6;
  26. XFRM_SPI_SKB_CB(skb)->daddroff = offsetof(struct ipv6hdr, daddr);
  27. return xfrm_input(skb, nexthdr, spi, 0);
  28. }
  29. EXPORT_SYMBOL(xfrm6_rcv_spi);
  30. int xfrm6_transport_finish(struct sk_buff *skb, int async)
  31. {
  32. struct xfrm_offload *xo = xfrm_offload(skb);
  33. skb_network_header(skb)[IP6CB(skb)->nhoff] =
  34. XFRM_MODE_SKB_CB(skb)->protocol;
  35. #ifndef CONFIG_NETFILTER
  36. if (!async)
  37. return 1;
  38. #endif
  39. __skb_push(skb, skb->data - skb_network_header(skb));
  40. ipv6_hdr(skb)->payload_len = htons(skb->len - sizeof(struct ipv6hdr));
  41. if (xo && (xo->flags & XFRM_GRO)) {
  42. skb_mac_header_rebuild(skb);
  43. return -1;
  44. }
  45. NF_HOOK(NFPROTO_IPV6, NF_INET_PRE_ROUTING,
  46. dev_net(skb->dev), NULL, skb, skb->dev, NULL,
  47. ip6_rcv_finish);
  48. return -1;
  49. }
  50. int xfrm6_rcv_tnl(struct sk_buff *skb, struct ip6_tnl *t)
  51. {
  52. return xfrm6_rcv_spi(skb, skb_network_header(skb)[IP6CB(skb)->nhoff],
  53. 0, t);
  54. }
  55. EXPORT_SYMBOL(xfrm6_rcv_tnl);
  56. int xfrm6_rcv(struct sk_buff *skb)
  57. {
  58. return xfrm6_rcv_tnl(skb, NULL);
  59. }
  60. EXPORT_SYMBOL(xfrm6_rcv);
  61. int xfrm6_input_addr(struct sk_buff *skb, xfrm_address_t *daddr,
  62. xfrm_address_t *saddr, u8 proto)
  63. {
  64. struct net *net = dev_net(skb->dev);
  65. struct xfrm_state *x = NULL;
  66. int i = 0;
  67. if (secpath_set(skb)) {
  68. XFRM_INC_STATS(net, LINUX_MIB_XFRMINERROR);
  69. goto drop;
  70. }
  71. if (1 + skb->sp->len == XFRM_MAX_DEPTH) {
  72. XFRM_INC_STATS(net, LINUX_MIB_XFRMINBUFFERERROR);
  73. goto drop;
  74. }
  75. for (i = 0; i < 3; i++) {
  76. xfrm_address_t *dst, *src;
  77. switch (i) {
  78. case 0:
  79. dst = daddr;
  80. src = saddr;
  81. break;
  82. case 1:
  83. /* lookup state with wild-card source address */
  84. dst = daddr;
  85. src = (xfrm_address_t *)&in6addr_any;
  86. break;
  87. default:
  88. /* lookup state with wild-card addresses */
  89. dst = (xfrm_address_t *)&in6addr_any;
  90. src = (xfrm_address_t *)&in6addr_any;
  91. break;
  92. }
  93. x = xfrm_state_lookup_byaddr(net, skb->mark, dst, src, proto, AF_INET6);
  94. if (!x)
  95. continue;
  96. spin_lock(&x->lock);
  97. if ((!i || (x->props.flags & XFRM_STATE_WILDRECV)) &&
  98. likely(x->km.state == XFRM_STATE_VALID) &&
  99. !xfrm_state_check_expire(x)) {
  100. spin_unlock(&x->lock);
  101. if (x->type->input(x, skb) > 0) {
  102. /* found a valid state */
  103. break;
  104. }
  105. } else
  106. spin_unlock(&x->lock);
  107. xfrm_state_put(x);
  108. x = NULL;
  109. }
  110. if (!x) {
  111. XFRM_INC_STATS(net, LINUX_MIB_XFRMINNOSTATES);
  112. xfrm_audit_state_notfound_simple(skb, AF_INET6);
  113. goto drop;
  114. }
  115. skb->sp->xvec[skb->sp->len++] = x;
  116. spin_lock(&x->lock);
  117. x->curlft.bytes += skb->len;
  118. x->curlft.packets++;
  119. spin_unlock(&x->lock);
  120. return 1;
  121. drop:
  122. return -1;
  123. }
  124. EXPORT_SYMBOL(xfrm6_input_addr);