]>
Commit | Line | Data |
---|---|---|
8024e028 TH |
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> | |
c29a70d2 PS |
7 | #include <net/dst_metadata.h> |
8 | #include <net/net_namespace.h> | |
8024e028 TH |
9 | #include <net/udp.h> |
10 | #include <net/udp_tunnel.h> | |
8024e028 | 11 | |
fd384412 AZ |
12 | int udp_sock_create4(struct net *net, struct udp_port_cfg *cfg, |
13 | struct socket **sockp) | |
8024e028 | 14 | { |
6a93cc90 | 15 | int err; |
8024e028 | 16 | struct socket *sock = NULL; |
fd384412 | 17 | struct sockaddr_in udp_addr; |
8024e028 | 18 | |
26abe143 | 19 | err = sock_create_kern(net, AF_INET, SOCK_DGRAM, 0, &sock); |
fd384412 AZ |
20 | if (err < 0) |
21 | goto error; | |
8024e028 | 22 | |
fd384412 AZ |
23 | udp_addr.sin_family = AF_INET; |
24 | udp_addr.sin_addr = cfg->local_ip; | |
25 | udp_addr.sin_port = cfg->local_udp_port; | |
26 | err = kernel_bind(sock, (struct sockaddr *)&udp_addr, | |
27 | sizeof(udp_addr)); | |
28 | if (err < 0) | |
29 | goto error; | |
8024e028 | 30 | |
fd384412 | 31 | if (cfg->peer_udp_port) { |
8024e028 | 32 | udp_addr.sin_family = AF_INET; |
fd384412 AZ |
33 | udp_addr.sin_addr = cfg->peer_ip; |
34 | udp_addr.sin_port = cfg->peer_udp_port; | |
35 | err = kernel_connect(sock, (struct sockaddr *)&udp_addr, | |
36 | sizeof(udp_addr), 0); | |
8024e028 TH |
37 | if (err < 0) |
38 | goto error; | |
8024e028 TH |
39 | } |
40 | ||
fd384412 | 41 | sock->sk->sk_no_check_tx = !cfg->use_udp_checksums; |
8024e028 TH |
42 | |
43 | *sockp = sock; | |
8024e028 TH |
44 | return 0; |
45 | ||
46 | error: | |
47 | if (sock) { | |
48 | kernel_sock_shutdown(sock, SHUT_RDWR); | |
26abe143 | 49 | sock_release(sock); |
8024e028 TH |
50 | } |
51 | *sockp = NULL; | |
52 | return err; | |
53 | } | |
fd384412 | 54 | EXPORT_SYMBOL(udp_sock_create4); |
8024e028 | 55 | |
6a93cc90 AZ |
56 | void setup_udp_tunnel_sock(struct net *net, struct socket *sock, |
57 | struct udp_tunnel_sock_cfg *cfg) | |
58 | { | |
59 | struct sock *sk = sock->sk; | |
60 | ||
61 | /* Disable multicast loopback */ | |
62 | inet_sk(sk)->mc_loop = 0; | |
63 | ||
64 | /* Enable CHECKSUM_UNNECESSARY to CHECKSUM_COMPLETE conversion */ | |
224d019c | 65 | inet_inc_convert_csum(sk); |
6a93cc90 AZ |
66 | |
67 | rcu_assign_sk_user_data(sk, cfg->sk_user_data); | |
68 | ||
69 | udp_sk(sk)->encap_type = cfg->encap_type; | |
70 | udp_sk(sk)->encap_rcv = cfg->encap_rcv; | |
71 | udp_sk(sk)->encap_destroy = cfg->encap_destroy; | |
72 | ||
73 | udp_tunnel_encap_enable(sock); | |
74 | } | |
75 | EXPORT_SYMBOL_GPL(setup_udp_tunnel_sock); | |
76 | ||
039f5062 PS |
77 | void udp_tunnel_xmit_skb(struct rtable *rt, struct sock *sk, struct sk_buff *skb, |
78 | __be32 src, __be32 dst, __u8 tos, __u8 ttl, | |
79 | __be16 df, __be16 src_port, __be16 dst_port, | |
80 | bool xnet, bool nocheck) | |
6a93cc90 AZ |
81 | { |
82 | struct udphdr *uh; | |
83 | ||
84 | __skb_push(skb, sizeof(*uh)); | |
85 | skb_reset_transport_header(skb); | |
86 | uh = udp_hdr(skb); | |
87 | ||
88 | uh->dest = dst_port; | |
89 | uh->source = src_port; | |
90 | uh->len = htons(skb->len); | |
91 | ||
d998f8ef | 92 | udp_set_csum(nocheck, skb, src, dst, skb->len); |
6a93cc90 | 93 | |
039f5062 | 94 | iptunnel_xmit(sk, rt, skb, src, dst, IPPROTO_UDP, tos, ttl, df, xnet); |
6a93cc90 AZ |
95 | } |
96 | EXPORT_SYMBOL_GPL(udp_tunnel_xmit_skb); | |
97 | ||
98 | void udp_tunnel_sock_release(struct socket *sock) | |
99 | { | |
100 | rcu_assign_sk_user_data(sock->sk, NULL); | |
101 | kernel_sock_shutdown(sock, SHUT_RDWR); | |
26abe143 | 102 | sock_release(sock); |
6a93cc90 AZ |
103 | } |
104 | EXPORT_SYMBOL_GPL(udp_tunnel_sock_release); | |
105 | ||
c29a70d2 PS |
106 | struct metadata_dst *udp_tun_rx_dst(struct sk_buff *skb, unsigned short family, |
107 | __be16 flags, __be64 tunnel_id, int md_size) | |
108 | { | |
109 | struct metadata_dst *tun_dst; | |
110 | struct ip_tunnel_info *info; | |
111 | ||
112 | if (family == AF_INET) | |
113 | tun_dst = ip_tun_rx_dst(skb, flags, tunnel_id, md_size); | |
114 | else | |
115 | tun_dst = ipv6_tun_rx_dst(skb, flags, tunnel_id, md_size); | |
116 | if (!tun_dst) | |
117 | return NULL; | |
118 | ||
119 | info = &tun_dst->u.tun_info; | |
120 | info->key.tp_src = udp_hdr(skb)->source; | |
121 | info->key.tp_dst = udp_hdr(skb)->dest; | |
122 | if (udp_hdr(skb)->check) | |
123 | info->key.tun_flags |= TUNNEL_CSUM; | |
124 | return tun_dst; | |
125 | } | |
126 | EXPORT_SYMBOL_GPL(udp_tun_rx_dst); | |
127 | ||
8024e028 | 128 | MODULE_LICENSE("GPL"); |