xfrm6_input.c 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146
  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. {
  23. XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip6 = NULL;
  24. XFRM_SPI_SKB_CB(skb)->family = AF_INET6;
  25. XFRM_SPI_SKB_CB(skb)->daddroff = offsetof(struct ipv6hdr, daddr);
  26. return xfrm_input(skb, nexthdr, spi, 0);
  27. }
  28. EXPORT_SYMBOL(xfrm6_rcv_spi);
  29. int xfrm6_transport_finish(struct sk_buff *skb, int async)
  30. {
  31. skb_network_header(skb)[IP6CB(skb)->nhoff] =
  32. XFRM_MODE_SKB_CB(skb)->protocol;
  33. #ifndef CONFIG_NETFILTER
  34. if (!async)
  35. return 1;
  36. #endif
  37. ipv6_hdr(skb)->payload_len = htons(skb->len);
  38. __skb_push(skb, skb->data - skb_network_header(skb));
  39. NF_HOOK(NFPROTO_IPV6, NF_INET_PRE_ROUTING,
  40. dev_net(skb->dev), NULL, skb, skb->dev, NULL,
  41. ip6_rcv_finish);
  42. return -1;
  43. }
  44. int xfrm6_rcv(struct sk_buff *skb)
  45. {
  46. return xfrm6_rcv_spi(skb, skb_network_header(skb)[IP6CB(skb)->nhoff],
  47. 0);
  48. }
  49. EXPORT_SYMBOL(xfrm6_rcv);
  50. int xfrm6_input_addr(struct sk_buff *skb, xfrm_address_t *daddr,
  51. xfrm_address_t *saddr, u8 proto)
  52. {
  53. struct net *net = dev_net(skb->dev);
  54. struct xfrm_state *x = NULL;
  55. int i = 0;
  56. /* Allocate new secpath or COW existing one. */
  57. if (!skb->sp || atomic_read(&skb->sp->refcnt) != 1) {
  58. struct sec_path *sp;
  59. sp = secpath_dup(skb->sp);
  60. if (!sp) {
  61. XFRM_INC_STATS(net, LINUX_MIB_XFRMINERROR);
  62. goto drop;
  63. }
  64. if (skb->sp)
  65. secpath_put(skb->sp);
  66. skb->sp = sp;
  67. }
  68. if (1 + skb->sp->len == XFRM_MAX_DEPTH) {
  69. XFRM_INC_STATS(net, LINUX_MIB_XFRMINBUFFERERROR);
  70. goto drop;
  71. }
  72. for (i = 0; i < 3; i++) {
  73. xfrm_address_t *dst, *src;
  74. switch (i) {
  75. case 0:
  76. dst = daddr;
  77. src = saddr;
  78. break;
  79. case 1:
  80. /* lookup state with wild-card source address */
  81. dst = daddr;
  82. src = (xfrm_address_t *)&in6addr_any;
  83. break;
  84. default:
  85. /* lookup state with wild-card addresses */
  86. dst = (xfrm_address_t *)&in6addr_any;
  87. src = (xfrm_address_t *)&in6addr_any;
  88. break;
  89. }
  90. x = xfrm_state_lookup_byaddr(net, skb->mark, dst, src, proto, AF_INET6);
  91. if (!x)
  92. continue;
  93. spin_lock(&x->lock);
  94. if ((!i || (x->props.flags & XFRM_STATE_WILDRECV)) &&
  95. likely(x->km.state == XFRM_STATE_VALID) &&
  96. !xfrm_state_check_expire(x)) {
  97. spin_unlock(&x->lock);
  98. if (x->type->input(x, skb) > 0) {
  99. /* found a valid state */
  100. break;
  101. }
  102. } else
  103. spin_unlock(&x->lock);
  104. xfrm_state_put(x);
  105. x = NULL;
  106. }
  107. if (!x) {
  108. XFRM_INC_STATS(net, LINUX_MIB_XFRMINNOSTATES);
  109. xfrm_audit_state_notfound_simple(skb, AF_INET6);
  110. goto drop;
  111. }
  112. skb->sp->xvec[skb->sp->len++] = x;
  113. spin_lock(&x->lock);
  114. x->curlft.bytes += skb->len;
  115. x->curlft.packets++;
  116. spin_unlock(&x->lock);
  117. return 1;
  118. drop:
  119. return -1;
  120. }
  121. EXPORT_SYMBOL(xfrm6_input_addr);