ip6_udp_tunnel.c 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. #include <linux/module.h>
  3. #include <linux/errno.h>
  4. #include <linux/socket.h>
  5. #include <linux/udp.h>
  6. #include <linux/types.h>
  7. #include <linux/kernel.h>
  8. #include <linux/in6.h>
  9. #include <net/udp.h>
  10. #include <net/udp_tunnel.h>
  11. #include <net/net_namespace.h>
  12. #include <net/netns/generic.h>
  13. #include <net/ip6_tunnel.h>
  14. #include <net/ip6_checksum.h>
  15. int udp_sock_create6(struct net *net, struct udp_port_cfg *cfg,
  16. struct socket **sockp)
  17. {
  18. struct sockaddr_in6 udp6_addr = {};
  19. int err;
  20. struct socket *sock = NULL;
  21. err = sock_create_kern(net, AF_INET6, SOCK_DGRAM, 0, &sock);
  22. if (err < 0)
  23. goto error;
  24. if (cfg->ipv6_v6only) {
  25. err = ip6_sock_set_v6only(sock->sk);
  26. if (err < 0)
  27. goto error;
  28. }
  29. if (cfg->bind_ifindex) {
  30. err = sock_bindtoindex(sock->sk, cfg->bind_ifindex, true);
  31. if (err < 0)
  32. goto error;
  33. }
  34. udp6_addr.sin6_family = AF_INET6;
  35. memcpy(&udp6_addr.sin6_addr, &cfg->local_ip6,
  36. sizeof(udp6_addr.sin6_addr));
  37. udp6_addr.sin6_port = cfg->local_udp_port;
  38. err = kernel_bind(sock, (struct sockaddr *)&udp6_addr,
  39. sizeof(udp6_addr));
  40. if (err < 0)
  41. goto error;
  42. if (cfg->peer_udp_port) {
  43. memset(&udp6_addr, 0, sizeof(udp6_addr));
  44. udp6_addr.sin6_family = AF_INET6;
  45. memcpy(&udp6_addr.sin6_addr, &cfg->peer_ip6,
  46. sizeof(udp6_addr.sin6_addr));
  47. udp6_addr.sin6_port = cfg->peer_udp_port;
  48. err = kernel_connect(sock,
  49. (struct sockaddr *)&udp6_addr,
  50. sizeof(udp6_addr), 0);
  51. }
  52. if (err < 0)
  53. goto error;
  54. udp_set_no_check6_tx(sock->sk, !cfg->use_udp6_tx_checksums);
  55. udp_set_no_check6_rx(sock->sk, !cfg->use_udp6_rx_checksums);
  56. *sockp = sock;
  57. return 0;
  58. error:
  59. if (sock) {
  60. kernel_sock_shutdown(sock, SHUT_RDWR);
  61. sock_release(sock);
  62. }
  63. *sockp = NULL;
  64. return err;
  65. }
  66. EXPORT_SYMBOL_GPL(udp_sock_create6);
  67. int udp_tunnel6_xmit_skb(struct dst_entry *dst, struct sock *sk,
  68. struct sk_buff *skb,
  69. struct net_device *dev, struct in6_addr *saddr,
  70. struct in6_addr *daddr,
  71. __u8 prio, __u8 ttl, __be32 label,
  72. __be16 src_port, __be16 dst_port, bool nocheck)
  73. {
  74. struct udphdr *uh;
  75. struct ipv6hdr *ip6h;
  76. __skb_push(skb, sizeof(*uh));
  77. skb_reset_transport_header(skb);
  78. uh = udp_hdr(skb);
  79. uh->dest = dst_port;
  80. uh->source = src_port;
  81. uh->len = htons(skb->len);
  82. skb_dst_set(skb, dst);
  83. udp6_set_csum(nocheck, skb, saddr, daddr, skb->len);
  84. __skb_push(skb, sizeof(*ip6h));
  85. skb_reset_network_header(skb);
  86. ip6h = ipv6_hdr(skb);
  87. ip6_flow_hdr(ip6h, prio, label);
  88. ip6h->payload_len = htons(skb->len);
  89. ip6h->nexthdr = IPPROTO_UDP;
  90. ip6h->hop_limit = ttl;
  91. ip6h->daddr = *daddr;
  92. ip6h->saddr = *saddr;
  93. ip6tunnel_xmit(sk, skb, dev);
  94. return 0;
  95. }
  96. EXPORT_SYMBOL_GPL(udp_tunnel6_xmit_skb);
  97. MODULE_LICENSE("GPL");