1 #include <linux/module.h>
2 #include <linux/errno.h>
3 #include <linux/socket.h>
4 #include <linux/udp.h>
5 #include <linux/types.h>
6 #include <linux/kernel.h>
7 #include <linux/in6.h>
8 #include <net/udp.h>
9 #include <net/udp_tunnel.h>
10 #include <net/net_namespace.h>
11 #include <net/netns/generic.h>
12 #include <net/ip6_tunnel.h>
13 #include <net/ip6_checksum.h>
14
udp_sock_create6(struct net * net,struct udp_port_cfg * cfg,struct socket ** sockp)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
22 err = sock_create_kern(net, AF_INET6, SOCK_DGRAM, 0, &sock);
23 if (err < 0)
24 goto error;
25
26 if (cfg->ipv6_v6only) {
27 int val = 1;
28
29 err = kernel_setsockopt(sock, IPPROTO_IPV6, IPV6_V6ONLY,
30 (char *) &val, sizeof(val));
31 if (err < 0)
32 goto error;
33 }
34
35 udp6_addr.sin6_family = AF_INET6;
36 memcpy(&udp6_addr.sin6_addr, &cfg->local_ip6,
37 sizeof(udp6_addr.sin6_addr));
38 udp6_addr.sin6_port = cfg->local_udp_port;
39 err = kernel_bind(sock, (struct sockaddr *)&udp6_addr,
40 sizeof(udp6_addr));
41 if (err < 0)
42 goto error;
43
44 if (cfg->peer_udp_port) {
45 memset(&udp6_addr, 0, sizeof(udp6_addr));
46 udp6_addr.sin6_family = AF_INET6;
47 memcpy(&udp6_addr.sin6_addr, &cfg->peer_ip6,
48 sizeof(udp6_addr.sin6_addr));
49 udp6_addr.sin6_port = cfg->peer_udp_port;
50 err = kernel_connect(sock,
51 (struct sockaddr *)&udp6_addr,
52 sizeof(udp6_addr), 0);
53 }
54 if (err < 0)
55 goto error;
56
57 udp_set_no_check6_tx(sock->sk, !cfg->use_udp6_tx_checksums);
58 udp_set_no_check6_rx(sock->sk, !cfg->use_udp6_rx_checksums);
59
60 *sockp = sock;
61 return 0;
62
63 error:
64 if (sock) {
65 kernel_sock_shutdown(sock, SHUT_RDWR);
66 sock_release(sock);
67 }
68 *sockp = NULL;
69 return err;
70 }
71 EXPORT_SYMBOL_GPL(udp_sock_create6);
72
udp_tunnel6_xmit_skb(struct dst_entry * dst,struct sock * sk,struct sk_buff * skb,struct net_device * dev,struct in6_addr * saddr,struct in6_addr * daddr,__u8 prio,__u8 ttl,__be16 src_port,__be16 dst_port,bool nocheck)73 int udp_tunnel6_xmit_skb(struct dst_entry *dst, struct sock *sk,
74 struct sk_buff *skb,
75 struct net_device *dev, struct in6_addr *saddr,
76 struct in6_addr *daddr,
77 __u8 prio, __u8 ttl, __be16 src_port,
78 __be16 dst_port, bool nocheck)
79 {
80 struct udphdr *uh;
81 struct ipv6hdr *ip6h;
82
83 __skb_push(skb, sizeof(*uh));
84 skb_reset_transport_header(skb);
85 uh = udp_hdr(skb);
86
87 uh->dest = dst_port;
88 uh->source = src_port;
89
90 uh->len = htons(skb->len);
91
92 memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt));
93 IPCB(skb)->flags &= ~(IPSKB_XFRM_TUNNEL_SIZE | IPSKB_XFRM_TRANSFORMED
94 | IPSKB_REROUTED);
95 skb_dst_set(skb, dst);
96
97 udp6_set_csum(nocheck, skb, saddr, daddr, skb->len);
98
99 __skb_push(skb, sizeof(*ip6h));
100 skb_reset_network_header(skb);
101 ip6h = ipv6_hdr(skb);
102 ip6_flow_hdr(ip6h, prio, htonl(0));
103 ip6h->payload_len = htons(skb->len);
104 ip6h->nexthdr = IPPROTO_UDP;
105 ip6h->hop_limit = ttl;
106 ip6h->daddr = *daddr;
107 ip6h->saddr = *saddr;
108
109 ip6tunnel_xmit(sk, skb, dev);
110 return 0;
111 }
112 EXPORT_SYMBOL_GPL(udp_tunnel6_xmit_skb);
113
114 MODULE_LICENSE("GPL");
115