1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /* GTP according to GSM TS 09.60 / 3GPP TS 29.060
4 * (C) 2012-2014 by sysmocom - s.f.m.c. GmbH
5 * (C) 2016 by Pablo Neira Ayuso <pablo@netfilter.org>
7 * Author: Harald Welte <hwelte@sysmocom.de>
8 * Pablo Neira Ayuso <pablo@netfilter.org>
9 * Andreas Schultz <aschultz@travelping.com>
12 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
14 #include <linux/module.h>
15 #include <linux/skbuff.h>
16 #include <linux/udp.h>
17 #include <linux/rculist.h>
18 #include <linux/jhash.h>
19 #include <linux/if_tunnel.h>
20 #include <linux/net.h>
21 #include <linux/file.h>
22 #include <linux/gtp.h>
24 #include <net/net_namespace.h>
25 #include <net/protocol.h>
28 #include <net/udp_tunnel.h>
31 #include <net/genetlink.h>
32 #include <net/netns/generic.h>
35 /* An active session for the subscriber. */
37 struct hlist_node hlist_tid
;
38 struct hlist_node hlist_addr
;
53 struct in_addr ms_addr_ip4
;
54 struct in_addr peer_addr_ip4
;
57 struct net_device
*dev
;
60 struct rcu_head rcu_head
;
63 /* One instance of the GTP device. */
65 struct list_head list
;
70 struct net_device
*dev
;
73 unsigned int hash_size
;
74 struct hlist_head
*tid_hash
;
75 struct hlist_head
*addr_hash
;
78 static unsigned int gtp_net_id __read_mostly
;
81 struct list_head gtp_dev_list
;
84 static u32 gtp_h_initval
;
86 static void pdp_context_delete(struct pdp_ctx
*pctx
);
88 static inline u32
gtp0_hashfn(u64 tid
)
90 u32
*tid32
= (u32
*) &tid
;
91 return jhash_2words(tid32
[0], tid32
[1], gtp_h_initval
);
94 static inline u32
gtp1u_hashfn(u32 tid
)
96 return jhash_1word(tid
, gtp_h_initval
);
99 static inline u32
ipv4_hashfn(__be32 ip
)
101 return jhash_1word((__force u32
)ip
, gtp_h_initval
);
104 /* Resolve a PDP context structure based on the 64bit TID. */
105 static struct pdp_ctx
*gtp0_pdp_find(struct gtp_dev
*gtp
, u64 tid
)
107 struct hlist_head
*head
;
110 head
= >p
->tid_hash
[gtp0_hashfn(tid
) % gtp
->hash_size
];
112 hlist_for_each_entry_rcu(pdp
, head
, hlist_tid
) {
113 if (pdp
->gtp_version
== GTP_V0
&&
114 pdp
->u
.v0
.tid
== tid
)
120 /* Resolve a PDP context structure based on the 32bit TEI. */
121 static struct pdp_ctx
*gtp1_pdp_find(struct gtp_dev
*gtp
, u32 tid
)
123 struct hlist_head
*head
;
126 head
= >p
->tid_hash
[gtp1u_hashfn(tid
) % gtp
->hash_size
];
128 hlist_for_each_entry_rcu(pdp
, head
, hlist_tid
) {
129 if (pdp
->gtp_version
== GTP_V1
&&
130 pdp
->u
.v1
.i_tei
== tid
)
136 /* Resolve a PDP context based on IPv4 address of MS. */
137 static struct pdp_ctx
*ipv4_pdp_find(struct gtp_dev
*gtp
, __be32 ms_addr
)
139 struct hlist_head
*head
;
142 head
= >p
->addr_hash
[ipv4_hashfn(ms_addr
) % gtp
->hash_size
];
144 hlist_for_each_entry_rcu(pdp
, head
, hlist_addr
) {
145 if (pdp
->af
== AF_INET
&&
146 pdp
->ms_addr_ip4
.s_addr
== ms_addr
)
153 static bool gtp_check_ms_ipv4(struct sk_buff
*skb
, struct pdp_ctx
*pctx
,
154 unsigned int hdrlen
, unsigned int role
)
158 if (!pskb_may_pull(skb
, hdrlen
+ sizeof(struct iphdr
)))
161 iph
= (struct iphdr
*)(skb
->data
+ hdrlen
);
163 if (role
== GTP_ROLE_SGSN
)
164 return iph
->daddr
== pctx
->ms_addr_ip4
.s_addr
;
166 return iph
->saddr
== pctx
->ms_addr_ip4
.s_addr
;
169 /* Check if the inner IP address in this packet is assigned to any
170 * existing mobile subscriber.
172 static bool gtp_check_ms(struct sk_buff
*skb
, struct pdp_ctx
*pctx
,
173 unsigned int hdrlen
, unsigned int role
)
175 switch (ntohs(skb
->protocol
)) {
177 return gtp_check_ms_ipv4(skb
, pctx
, hdrlen
, role
);
182 static int gtp_rx(struct pdp_ctx
*pctx
, struct sk_buff
*skb
,
183 unsigned int hdrlen
, unsigned int role
)
185 if (!gtp_check_ms(skb
, pctx
, hdrlen
, role
)) {
186 netdev_dbg(pctx
->dev
, "No PDP ctx for this MS\n");
190 /* Get rid of the GTP + UDP headers. */
191 if (iptunnel_pull_header(skb
, hdrlen
, skb
->protocol
,
192 !net_eq(sock_net(pctx
->sk
), dev_net(pctx
->dev
))))
195 netdev_dbg(pctx
->dev
, "forwarding packet from GGSN to uplink\n");
197 /* Now that the UDP and the GTP header have been removed, set up the
198 * new network header. This is required by the upper layer to
199 * calculate the transport header.
201 skb_reset_network_header(skb
);
203 skb
->dev
= pctx
->dev
;
205 dev_sw_netstats_rx_add(pctx
->dev
, skb
->len
);
211 /* 1 means pass up to the stack, -1 means drop and 0 means decapsulated. */
212 static int gtp0_udp_encap_recv(struct gtp_dev
*gtp
, struct sk_buff
*skb
)
214 unsigned int hdrlen
= sizeof(struct udphdr
) +
215 sizeof(struct gtp0_header
);
216 struct gtp0_header
*gtp0
;
217 struct pdp_ctx
*pctx
;
219 if (!pskb_may_pull(skb
, hdrlen
))
222 gtp0
= (struct gtp0_header
*)(skb
->data
+ sizeof(struct udphdr
));
224 if ((gtp0
->flags
>> 5) != GTP_V0
)
227 if (gtp0
->type
!= GTP_TPDU
)
230 pctx
= gtp0_pdp_find(gtp
, be64_to_cpu(gtp0
->tid
));
232 netdev_dbg(gtp
->dev
, "No PDP ctx to decap skb=%p\n", skb
);
236 return gtp_rx(pctx
, skb
, hdrlen
, gtp
->role
);
239 static int gtp1u_udp_encap_recv(struct gtp_dev
*gtp
, struct sk_buff
*skb
)
241 unsigned int hdrlen
= sizeof(struct udphdr
) +
242 sizeof(struct gtp1_header
);
243 struct gtp1_header
*gtp1
;
244 struct pdp_ctx
*pctx
;
246 if (!pskb_may_pull(skb
, hdrlen
))
249 gtp1
= (struct gtp1_header
*)(skb
->data
+ sizeof(struct udphdr
));
251 if ((gtp1
->flags
>> 5) != GTP_V1
)
254 if (gtp1
->type
!= GTP_TPDU
)
257 /* From 29.060: "This field shall be present if and only if any one or
258 * more of the S, PN and E flags are set.".
260 * If any of the bit is set, then the remaining ones also have to be
263 if (gtp1
->flags
& GTP1_F_MASK
)
266 /* Make sure the header is larger enough, including extensions. */
267 if (!pskb_may_pull(skb
, hdrlen
))
270 gtp1
= (struct gtp1_header
*)(skb
->data
+ sizeof(struct udphdr
));
272 pctx
= gtp1_pdp_find(gtp
, ntohl(gtp1
->tid
));
274 netdev_dbg(gtp
->dev
, "No PDP ctx to decap skb=%p\n", skb
);
278 return gtp_rx(pctx
, skb
, hdrlen
, gtp
->role
);
281 static void __gtp_encap_destroy(struct sock
*sk
)
286 gtp
= sk
->sk_user_data
;
292 udp_sk(sk
)->encap_type
= 0;
293 rcu_assign_sk_user_data(sk
, NULL
);
299 static void gtp_encap_destroy(struct sock
*sk
)
302 __gtp_encap_destroy(sk
);
306 static void gtp_encap_disable_sock(struct sock
*sk
)
311 __gtp_encap_destroy(sk
);
314 static void gtp_encap_disable(struct gtp_dev
*gtp
)
316 gtp_encap_disable_sock(gtp
->sk0
);
317 gtp_encap_disable_sock(gtp
->sk1u
);
320 /* UDP encapsulation receive handler. See net/ipv4/udp.c.
321 * Return codes: 0: success, <0: error, >0: pass up to userspace UDP socket.
323 static int gtp_encap_recv(struct sock
*sk
, struct sk_buff
*skb
)
328 gtp
= rcu_dereference_sk_user_data(sk
);
332 netdev_dbg(gtp
->dev
, "encap_recv sk=%p\n", sk
);
334 switch (udp_sk(sk
)->encap_type
) {
336 netdev_dbg(gtp
->dev
, "received GTP0 packet\n");
337 ret
= gtp0_udp_encap_recv(gtp
, skb
);
339 case UDP_ENCAP_GTP1U
:
340 netdev_dbg(gtp
->dev
, "received GTP1U packet\n");
341 ret
= gtp1u_udp_encap_recv(gtp
, skb
);
344 ret
= -1; /* Shouldn't happen. */
349 netdev_dbg(gtp
->dev
, "pass up to the process\n");
354 netdev_dbg(gtp
->dev
, "GTP packet has been dropped\n");
363 static int gtp_dev_init(struct net_device
*dev
)
365 struct gtp_dev
*gtp
= netdev_priv(dev
);
369 dev
->tstats
= netdev_alloc_pcpu_stats(struct pcpu_sw_netstats
);
376 static void gtp_dev_uninit(struct net_device
*dev
)
378 struct gtp_dev
*gtp
= netdev_priv(dev
);
380 gtp_encap_disable(gtp
);
381 free_percpu(dev
->tstats
);
384 static struct rtable
*ip4_route_output_gtp(struct flowi4
*fl4
,
385 const struct sock
*sk
,
388 memset(fl4
, 0, sizeof(*fl4
));
389 fl4
->flowi4_oif
= sk
->sk_bound_dev_if
;
391 fl4
->saddr
= inet_sk(sk
)->inet_saddr
;
392 fl4
->flowi4_tos
= RT_CONN_FLAGS(sk
);
393 fl4
->flowi4_proto
= sk
->sk_protocol
;
395 return ip_route_output_key(sock_net(sk
), fl4
);
398 static inline void gtp0_push_header(struct sk_buff
*skb
, struct pdp_ctx
*pctx
)
400 int payload_len
= skb
->len
;
401 struct gtp0_header
*gtp0
;
403 gtp0
= skb_push(skb
, sizeof(*gtp0
));
405 gtp0
->flags
= 0x1e; /* v0, GTP-non-prime. */
406 gtp0
->type
= GTP_TPDU
;
407 gtp0
->length
= htons(payload_len
);
408 gtp0
->seq
= htons((atomic_inc_return(&pctx
->tx_seq
) - 1) % 0xffff);
409 gtp0
->flow
= htons(pctx
->u
.v0
.flow
);
411 gtp0
->spare
[0] = gtp0
->spare
[1] = gtp0
->spare
[2] = 0xff;
412 gtp0
->tid
= cpu_to_be64(pctx
->u
.v0
.tid
);
415 static inline void gtp1_push_header(struct sk_buff
*skb
, struct pdp_ctx
*pctx
)
417 int payload_len
= skb
->len
;
418 struct gtp1_header
*gtp1
;
420 gtp1
= skb_push(skb
, sizeof(*gtp1
));
422 /* Bits 8 7 6 5 4 3 2 1
423 * +--+--+--+--+--+--+--+--+
424 * |version |PT| 0| E| S|PN|
425 * +--+--+--+--+--+--+--+--+
428 gtp1
->flags
= 0x30; /* v1, GTP-non-prime. */
429 gtp1
->type
= GTP_TPDU
;
430 gtp1
->length
= htons(payload_len
);
431 gtp1
->tid
= htonl(pctx
->u
.v1
.o_tei
);
433 /* TODO: Suppport for extension header, sequence number and N-PDU.
434 * Update the length field if any of them is available.
443 struct pdp_ctx
*pctx
;
444 struct net_device
*dev
;
448 static void gtp_push_header(struct sk_buff
*skb
, struct gtp_pktinfo
*pktinfo
)
450 switch (pktinfo
->pctx
->gtp_version
) {
452 pktinfo
->gtph_port
= htons(GTP0_PORT
);
453 gtp0_push_header(skb
, pktinfo
->pctx
);
456 pktinfo
->gtph_port
= htons(GTP1U_PORT
);
457 gtp1_push_header(skb
, pktinfo
->pctx
);
462 static inline void gtp_set_pktinfo_ipv4(struct gtp_pktinfo
*pktinfo
,
463 struct sock
*sk
, struct iphdr
*iph
,
464 struct pdp_ctx
*pctx
, struct rtable
*rt
,
466 struct net_device
*dev
)
470 pktinfo
->pctx
= pctx
;
476 static int gtp_build_skb_ip4(struct sk_buff
*skb
, struct net_device
*dev
,
477 struct gtp_pktinfo
*pktinfo
)
479 struct gtp_dev
*gtp
= netdev_priv(dev
);
480 struct pdp_ctx
*pctx
;
487 /* Read the IP destination address and resolve the PDP context.
488 * Prepend PDP header with TEI/TID from PDP ctx.
491 if (gtp
->role
== GTP_ROLE_SGSN
)
492 pctx
= ipv4_pdp_find(gtp
, iph
->saddr
);
494 pctx
= ipv4_pdp_find(gtp
, iph
->daddr
);
497 netdev_dbg(dev
, "no PDP ctx found for %pI4, skip\n",
501 netdev_dbg(dev
, "found PDP context %p\n", pctx
);
503 rt
= ip4_route_output_gtp(&fl4
, pctx
->sk
, pctx
->peer_addr_ip4
.s_addr
);
505 netdev_dbg(dev
, "no route to SSGN %pI4\n",
506 &pctx
->peer_addr_ip4
.s_addr
);
507 dev
->stats
.tx_carrier_errors
++;
511 if (rt
->dst
.dev
== dev
) {
512 netdev_dbg(dev
, "circular route to SSGN %pI4\n",
513 &pctx
->peer_addr_ip4
.s_addr
);
514 dev
->stats
.collisions
++;
520 /* This is similar to tnl_update_pmtu(). */
523 mtu
= dst_mtu(&rt
->dst
) - dev
->hard_header_len
-
524 sizeof(struct iphdr
) - sizeof(struct udphdr
);
525 switch (pctx
->gtp_version
) {
527 mtu
-= sizeof(struct gtp0_header
);
530 mtu
-= sizeof(struct gtp1_header
);
534 mtu
= dst_mtu(&rt
->dst
);
537 rt
->dst
.ops
->update_pmtu(&rt
->dst
, NULL
, skb
, mtu
, false);
539 if (!skb_is_gso(skb
) && (iph
->frag_off
& htons(IP_DF
)) &&
540 mtu
< ntohs(iph
->tot_len
)) {
541 netdev_dbg(dev
, "packet too big, fragmentation needed\n");
542 icmp_ndo_send(skb
, ICMP_DEST_UNREACH
, ICMP_FRAG_NEEDED
,
547 gtp_set_pktinfo_ipv4(pktinfo
, pctx
->sk
, iph
, pctx
, rt
, &fl4
, dev
);
548 gtp_push_header(skb
, pktinfo
);
557 static netdev_tx_t
gtp_dev_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
559 unsigned int proto
= ntohs(skb
->protocol
);
560 struct gtp_pktinfo pktinfo
;
563 /* Ensure there is sufficient headroom. */
564 if (skb_cow_head(skb
, dev
->needed_headroom
))
567 skb_reset_inner_headers(skb
);
569 /* PDP context lookups in gtp_build_skb_*() need rcu read-side lock. */
573 err
= gtp_build_skb_ip4(skb
, dev
, &pktinfo
);
586 netdev_dbg(pktinfo
.dev
, "gtp -> IP src: %pI4 dst: %pI4\n",
587 &pktinfo
.iph
->saddr
, &pktinfo
.iph
->daddr
);
588 udp_tunnel_xmit_skb(pktinfo
.rt
, pktinfo
.sk
, skb
,
589 pktinfo
.fl4
.saddr
, pktinfo
.fl4
.daddr
,
591 ip4_dst_hoplimit(&pktinfo
.rt
->dst
),
593 pktinfo
.gtph_port
, pktinfo
.gtph_port
,
600 dev
->stats
.tx_errors
++;
605 static const struct net_device_ops gtp_netdev_ops
= {
606 .ndo_init
= gtp_dev_init
,
607 .ndo_uninit
= gtp_dev_uninit
,
608 .ndo_start_xmit
= gtp_dev_xmit
,
609 .ndo_get_stats64
= dev_get_tstats64
,
612 static void gtp_link_setup(struct net_device
*dev
)
614 dev
->netdev_ops
= >p_netdev_ops
;
615 dev
->needs_free_netdev
= true;
617 dev
->hard_header_len
= 0;
620 /* Zero header length. */
621 dev
->type
= ARPHRD_NONE
;
622 dev
->flags
= IFF_POINTOPOINT
| IFF_NOARP
| IFF_MULTICAST
;
624 dev
->priv_flags
|= IFF_NO_QUEUE
;
625 dev
->features
|= NETIF_F_LLTX
;
628 /* Assume largest header, ie. GTPv0. */
629 dev
->needed_headroom
= LL_MAX_HEADER
+
630 sizeof(struct iphdr
) +
631 sizeof(struct udphdr
) +
632 sizeof(struct gtp0_header
);
635 static int gtp_hashtable_new(struct gtp_dev
*gtp
, int hsize
);
636 static int gtp_encap_enable(struct gtp_dev
*gtp
, struct nlattr
*data
[]);
638 static void gtp_destructor(struct net_device
*dev
)
640 struct gtp_dev
*gtp
= netdev_priv(dev
);
642 kfree(gtp
->addr_hash
);
643 kfree(gtp
->tid_hash
);
646 static int gtp_newlink(struct net
*src_net
, struct net_device
*dev
,
647 struct nlattr
*tb
[], struct nlattr
*data
[],
648 struct netlink_ext_ack
*extack
)
654 if (!data
[IFLA_GTP_FD0
] && !data
[IFLA_GTP_FD1
])
657 gtp
= netdev_priv(dev
);
659 if (!data
[IFLA_GTP_PDP_HASHSIZE
]) {
662 hashsize
= nla_get_u32(data
[IFLA_GTP_PDP_HASHSIZE
]);
667 err
= gtp_hashtable_new(gtp
, hashsize
);
671 err
= gtp_encap_enable(gtp
, data
);
675 err
= register_netdevice(dev
);
677 netdev_dbg(dev
, "failed to register new netdev %d\n", err
);
681 gn
= net_generic(dev_net(dev
), gtp_net_id
);
682 list_add_rcu(>p
->list
, &gn
->gtp_dev_list
);
683 dev
->priv_destructor
= gtp_destructor
;
685 netdev_dbg(dev
, "registered new GTP interface\n");
690 gtp_encap_disable(gtp
);
692 kfree(gtp
->addr_hash
);
693 kfree(gtp
->tid_hash
);
697 static void gtp_dellink(struct net_device
*dev
, struct list_head
*head
)
699 struct gtp_dev
*gtp
= netdev_priv(dev
);
700 struct pdp_ctx
*pctx
;
703 for (i
= 0; i
< gtp
->hash_size
; i
++)
704 hlist_for_each_entry_rcu(pctx
, >p
->tid_hash
[i
], hlist_tid
)
705 pdp_context_delete(pctx
);
707 list_del_rcu(>p
->list
);
708 unregister_netdevice_queue(dev
, head
);
711 static const struct nla_policy gtp_policy
[IFLA_GTP_MAX
+ 1] = {
712 [IFLA_GTP_FD0
] = { .type
= NLA_U32
},
713 [IFLA_GTP_FD1
] = { .type
= NLA_U32
},
714 [IFLA_GTP_PDP_HASHSIZE
] = { .type
= NLA_U32
},
715 [IFLA_GTP_ROLE
] = { .type
= NLA_U32
},
718 static int gtp_validate(struct nlattr
*tb
[], struct nlattr
*data
[],
719 struct netlink_ext_ack
*extack
)
727 static size_t gtp_get_size(const struct net_device
*dev
)
729 return nla_total_size(sizeof(__u32
)); /* IFLA_GTP_PDP_HASHSIZE */
732 static int gtp_fill_info(struct sk_buff
*skb
, const struct net_device
*dev
)
734 struct gtp_dev
*gtp
= netdev_priv(dev
);
736 if (nla_put_u32(skb
, IFLA_GTP_PDP_HASHSIZE
, gtp
->hash_size
))
737 goto nla_put_failure
;
745 static struct rtnl_link_ops gtp_link_ops __read_mostly
= {
747 .maxtype
= IFLA_GTP_MAX
,
748 .policy
= gtp_policy
,
749 .priv_size
= sizeof(struct gtp_dev
),
750 .setup
= gtp_link_setup
,
751 .validate
= gtp_validate
,
752 .newlink
= gtp_newlink
,
753 .dellink
= gtp_dellink
,
754 .get_size
= gtp_get_size
,
755 .fill_info
= gtp_fill_info
,
758 static int gtp_hashtable_new(struct gtp_dev
*gtp
, int hsize
)
762 gtp
->addr_hash
= kmalloc_array(hsize
, sizeof(struct hlist_head
),
763 GFP_KERNEL
| __GFP_NOWARN
);
764 if (gtp
->addr_hash
== NULL
)
767 gtp
->tid_hash
= kmalloc_array(hsize
, sizeof(struct hlist_head
),
768 GFP_KERNEL
| __GFP_NOWARN
);
769 if (gtp
->tid_hash
== NULL
)
772 gtp
->hash_size
= hsize
;
774 for (i
= 0; i
< hsize
; i
++) {
775 INIT_HLIST_HEAD(>p
->addr_hash
[i
]);
776 INIT_HLIST_HEAD(>p
->tid_hash
[i
]);
780 kfree(gtp
->addr_hash
);
784 static struct sock
*gtp_encap_enable_socket(int fd
, int type
,
787 struct udp_tunnel_sock_cfg tuncfg
= {NULL
};
792 pr_debug("enable gtp on %d, %d\n", fd
, type
);
794 sock
= sockfd_lookup(fd
, &err
);
796 pr_debug("gtp socket fd=%d not found\n", fd
);
801 if (sk
->sk_protocol
!= IPPROTO_UDP
||
802 sk
->sk_type
!= SOCK_DGRAM
||
803 (sk
->sk_family
!= AF_INET
&& sk
->sk_family
!= AF_INET6
)) {
804 pr_debug("socket fd=%d not UDP\n", fd
);
805 sk
= ERR_PTR(-EINVAL
);
810 if (sk
->sk_user_data
) {
811 sk
= ERR_PTR(-EBUSY
);
817 tuncfg
.sk_user_data
= gtp
;
818 tuncfg
.encap_type
= type
;
819 tuncfg
.encap_rcv
= gtp_encap_recv
;
820 tuncfg
.encap_destroy
= gtp_encap_destroy
;
822 setup_udp_tunnel_sock(sock_net(sock
->sk
), sock
, &tuncfg
);
825 release_sock(sock
->sk
);
831 static int gtp_encap_enable(struct gtp_dev
*gtp
, struct nlattr
*data
[])
833 struct sock
*sk1u
= NULL
;
834 struct sock
*sk0
= NULL
;
835 unsigned int role
= GTP_ROLE_GGSN
;
837 if (data
[IFLA_GTP_FD0
]) {
838 u32 fd0
= nla_get_u32(data
[IFLA_GTP_FD0
]);
840 sk0
= gtp_encap_enable_socket(fd0
, UDP_ENCAP_GTP0
, gtp
);
845 if (data
[IFLA_GTP_FD1
]) {
846 u32 fd1
= nla_get_u32(data
[IFLA_GTP_FD1
]);
848 sk1u
= gtp_encap_enable_socket(fd1
, UDP_ENCAP_GTP1U
, gtp
);
850 gtp_encap_disable_sock(sk0
);
851 return PTR_ERR(sk1u
);
855 if (data
[IFLA_GTP_ROLE
]) {
856 role
= nla_get_u32(data
[IFLA_GTP_ROLE
]);
857 if (role
> GTP_ROLE_SGSN
) {
858 gtp_encap_disable_sock(sk0
);
859 gtp_encap_disable_sock(sk1u
);
871 static struct gtp_dev
*gtp_find_dev(struct net
*src_net
, struct nlattr
*nla
[])
873 struct gtp_dev
*gtp
= NULL
;
874 struct net_device
*dev
;
877 /* Examine the link attributes and figure out which network namespace
878 * we are talking about.
880 if (nla
[GTPA_NET_NS_FD
])
881 net
= get_net_ns_by_fd(nla_get_u32(nla
[GTPA_NET_NS_FD
]));
883 net
= get_net(src_net
);
888 /* Check if there's an existing gtpX device to configure */
889 dev
= dev_get_by_index_rcu(net
, nla_get_u32(nla
[GTPA_LINK
]));
890 if (dev
&& dev
->netdev_ops
== >p_netdev_ops
)
891 gtp
= netdev_priv(dev
);
897 static void ipv4_pdp_fill(struct pdp_ctx
*pctx
, struct genl_info
*info
)
899 pctx
->gtp_version
= nla_get_u32(info
->attrs
[GTPA_VERSION
]);
901 pctx
->peer_addr_ip4
.s_addr
=
902 nla_get_be32(info
->attrs
[GTPA_PEER_ADDRESS
]);
903 pctx
->ms_addr_ip4
.s_addr
=
904 nla_get_be32(info
->attrs
[GTPA_MS_ADDRESS
]);
906 switch (pctx
->gtp_version
) {
908 /* According to TS 09.60, sections 7.5.1 and 7.5.2, the flow
909 * label needs to be the same for uplink and downlink packets,
910 * so let's annotate this.
912 pctx
->u
.v0
.tid
= nla_get_u64(info
->attrs
[GTPA_TID
]);
913 pctx
->u
.v0
.flow
= nla_get_u16(info
->attrs
[GTPA_FLOW
]);
916 pctx
->u
.v1
.i_tei
= nla_get_u32(info
->attrs
[GTPA_I_TEI
]);
917 pctx
->u
.v1
.o_tei
= nla_get_u32(info
->attrs
[GTPA_O_TEI
]);
924 static struct pdp_ctx
*gtp_pdp_add(struct gtp_dev
*gtp
, struct sock
*sk
,
925 struct genl_info
*info
)
927 struct pdp_ctx
*pctx
, *pctx_tid
= NULL
;
928 struct net_device
*dev
= gtp
->dev
;
929 u32 hash_ms
, hash_tid
= 0;
930 unsigned int version
;
934 ms_addr
= nla_get_be32(info
->attrs
[GTPA_MS_ADDRESS
]);
935 hash_ms
= ipv4_hashfn(ms_addr
) % gtp
->hash_size
;
936 version
= nla_get_u32(info
->attrs
[GTPA_VERSION
]);
938 pctx
= ipv4_pdp_find(gtp
, ms_addr
);
941 if (version
== GTP_V0
)
942 pctx_tid
= gtp0_pdp_find(gtp
,
943 nla_get_u64(info
->attrs
[GTPA_TID
]));
944 else if (version
== GTP_V1
)
945 pctx_tid
= gtp1_pdp_find(gtp
,
946 nla_get_u32(info
->attrs
[GTPA_I_TEI
]));
951 if (info
->nlhdr
->nlmsg_flags
& NLM_F_EXCL
)
952 return ERR_PTR(-EEXIST
);
953 if (info
->nlhdr
->nlmsg_flags
& NLM_F_REPLACE
)
954 return ERR_PTR(-EOPNOTSUPP
);
956 if (pctx
&& pctx_tid
)
957 return ERR_PTR(-EEXIST
);
961 ipv4_pdp_fill(pctx
, info
);
963 if (pctx
->gtp_version
== GTP_V0
)
964 netdev_dbg(dev
, "GTPv0-U: update tunnel id = %llx (pdp %p)\n",
965 pctx
->u
.v0
.tid
, pctx
);
966 else if (pctx
->gtp_version
== GTP_V1
)
967 netdev_dbg(dev
, "GTPv1-U: update tunnel id = %x/%x (pdp %p)\n",
968 pctx
->u
.v1
.i_tei
, pctx
->u
.v1
.o_tei
, pctx
);
974 pctx
= kmalloc(sizeof(*pctx
), GFP_ATOMIC
);
976 return ERR_PTR(-ENOMEM
);
980 pctx
->dev
= gtp
->dev
;
981 ipv4_pdp_fill(pctx
, info
);
982 atomic_set(&pctx
->tx_seq
, 0);
984 switch (pctx
->gtp_version
) {
986 /* TS 09.60: "The flow label identifies unambiguously a GTP
987 * flow.". We use the tid for this instead, I cannot find a
988 * situation in which this doesn't unambiguosly identify the
991 hash_tid
= gtp0_hashfn(pctx
->u
.v0
.tid
) % gtp
->hash_size
;
994 hash_tid
= gtp1u_hashfn(pctx
->u
.v1
.i_tei
) % gtp
->hash_size
;
998 hlist_add_head_rcu(&pctx
->hlist_addr
, >p
->addr_hash
[hash_ms
]);
999 hlist_add_head_rcu(&pctx
->hlist_tid
, >p
->tid_hash
[hash_tid
]);
1001 switch (pctx
->gtp_version
) {
1003 netdev_dbg(dev
, "GTPv0-U: new PDP ctx id=%llx ssgn=%pI4 ms=%pI4 (pdp=%p)\n",
1004 pctx
->u
.v0
.tid
, &pctx
->peer_addr_ip4
,
1005 &pctx
->ms_addr_ip4
, pctx
);
1008 netdev_dbg(dev
, "GTPv1-U: new PDP ctx id=%x/%x ssgn=%pI4 ms=%pI4 (pdp=%p)\n",
1009 pctx
->u
.v1
.i_tei
, pctx
->u
.v1
.o_tei
,
1010 &pctx
->peer_addr_ip4
, &pctx
->ms_addr_ip4
, pctx
);
1017 static void pdp_context_free(struct rcu_head
*head
)
1019 struct pdp_ctx
*pctx
= container_of(head
, struct pdp_ctx
, rcu_head
);
1025 static void pdp_context_delete(struct pdp_ctx
*pctx
)
1027 hlist_del_rcu(&pctx
->hlist_tid
);
1028 hlist_del_rcu(&pctx
->hlist_addr
);
1029 call_rcu(&pctx
->rcu_head
, pdp_context_free
);
1032 static int gtp_tunnel_notify(struct pdp_ctx
*pctx
, u8 cmd
, gfp_t allocation
);
1034 static int gtp_genl_new_pdp(struct sk_buff
*skb
, struct genl_info
*info
)
1036 unsigned int version
;
1037 struct pdp_ctx
*pctx
;
1038 struct gtp_dev
*gtp
;
1042 if (!info
->attrs
[GTPA_VERSION
] ||
1043 !info
->attrs
[GTPA_LINK
] ||
1044 !info
->attrs
[GTPA_PEER_ADDRESS
] ||
1045 !info
->attrs
[GTPA_MS_ADDRESS
])
1048 version
= nla_get_u32(info
->attrs
[GTPA_VERSION
]);
1052 if (!info
->attrs
[GTPA_TID
] ||
1053 !info
->attrs
[GTPA_FLOW
])
1057 if (!info
->attrs
[GTPA_I_TEI
] ||
1058 !info
->attrs
[GTPA_O_TEI
])
1068 gtp
= gtp_find_dev(sock_net(skb
->sk
), info
->attrs
);
1074 if (version
== GTP_V0
)
1076 else if (version
== GTP_V1
)
1086 pctx
= gtp_pdp_add(gtp
, sk
, info
);
1088 err
= PTR_ERR(pctx
);
1090 gtp_tunnel_notify(pctx
, GTP_CMD_NEWPDP
, GFP_KERNEL
);
1099 static struct pdp_ctx
*gtp_find_pdp_by_link(struct net
*net
,
1100 struct nlattr
*nla
[])
1102 struct gtp_dev
*gtp
;
1104 gtp
= gtp_find_dev(net
, nla
);
1106 return ERR_PTR(-ENODEV
);
1108 if (nla
[GTPA_MS_ADDRESS
]) {
1109 __be32 ip
= nla_get_be32(nla
[GTPA_MS_ADDRESS
]);
1111 return ipv4_pdp_find(gtp
, ip
);
1112 } else if (nla
[GTPA_VERSION
]) {
1113 u32 gtp_version
= nla_get_u32(nla
[GTPA_VERSION
]);
1115 if (gtp_version
== GTP_V0
&& nla
[GTPA_TID
])
1116 return gtp0_pdp_find(gtp
, nla_get_u64(nla
[GTPA_TID
]));
1117 else if (gtp_version
== GTP_V1
&& nla
[GTPA_I_TEI
])
1118 return gtp1_pdp_find(gtp
, nla_get_u32(nla
[GTPA_I_TEI
]));
1121 return ERR_PTR(-EINVAL
);
1124 static struct pdp_ctx
*gtp_find_pdp(struct net
*net
, struct nlattr
*nla
[])
1126 struct pdp_ctx
*pctx
;
1129 pctx
= gtp_find_pdp_by_link(net
, nla
);
1131 pctx
= ERR_PTR(-EINVAL
);
1134 pctx
= ERR_PTR(-ENOENT
);
1139 static int gtp_genl_del_pdp(struct sk_buff
*skb
, struct genl_info
*info
)
1141 struct pdp_ctx
*pctx
;
1144 if (!info
->attrs
[GTPA_VERSION
])
1149 pctx
= gtp_find_pdp(sock_net(skb
->sk
), info
->attrs
);
1151 err
= PTR_ERR(pctx
);
1155 if (pctx
->gtp_version
== GTP_V0
)
1156 netdev_dbg(pctx
->dev
, "GTPv0-U: deleting tunnel id = %llx (pdp %p)\n",
1157 pctx
->u
.v0
.tid
, pctx
);
1158 else if (pctx
->gtp_version
== GTP_V1
)
1159 netdev_dbg(pctx
->dev
, "GTPv1-U: deleting tunnel id = %x/%x (pdp %p)\n",
1160 pctx
->u
.v1
.i_tei
, pctx
->u
.v1
.o_tei
, pctx
);
1162 gtp_tunnel_notify(pctx
, GTP_CMD_DELPDP
, GFP_ATOMIC
);
1163 pdp_context_delete(pctx
);
1170 static struct genl_family gtp_genl_family
;
1172 enum gtp_multicast_groups
{
1176 static const struct genl_multicast_group gtp_genl_mcgrps
[] = {
1177 [GTP_GENL_MCGRP
] = { .name
= GTP_GENL_MCGRP_NAME
},
1180 static int gtp_genl_fill_info(struct sk_buff
*skb
, u32 snd_portid
, u32 snd_seq
,
1181 int flags
, u32 type
, struct pdp_ctx
*pctx
)
1185 genlh
= genlmsg_put(skb
, snd_portid
, snd_seq
, >p_genl_family
, flags
,
1190 if (nla_put_u32(skb
, GTPA_VERSION
, pctx
->gtp_version
) ||
1191 nla_put_u32(skb
, GTPA_LINK
, pctx
->dev
->ifindex
) ||
1192 nla_put_be32(skb
, GTPA_PEER_ADDRESS
, pctx
->peer_addr_ip4
.s_addr
) ||
1193 nla_put_be32(skb
, GTPA_MS_ADDRESS
, pctx
->ms_addr_ip4
.s_addr
))
1194 goto nla_put_failure
;
1196 switch (pctx
->gtp_version
) {
1198 if (nla_put_u64_64bit(skb
, GTPA_TID
, pctx
->u
.v0
.tid
, GTPA_PAD
) ||
1199 nla_put_u16(skb
, GTPA_FLOW
, pctx
->u
.v0
.flow
))
1200 goto nla_put_failure
;
1203 if (nla_put_u32(skb
, GTPA_I_TEI
, pctx
->u
.v1
.i_tei
) ||
1204 nla_put_u32(skb
, GTPA_O_TEI
, pctx
->u
.v1
.o_tei
))
1205 goto nla_put_failure
;
1208 genlmsg_end(skb
, genlh
);
1213 genlmsg_cancel(skb
, genlh
);
1217 static int gtp_tunnel_notify(struct pdp_ctx
*pctx
, u8 cmd
, gfp_t allocation
)
1219 struct sk_buff
*msg
;
1222 msg
= nlmsg_new(NLMSG_DEFAULT_SIZE
, allocation
);
1226 ret
= gtp_genl_fill_info(msg
, 0, 0, 0, cmd
, pctx
);
1232 ret
= genlmsg_multicast_netns(>p_genl_family
, dev_net(pctx
->dev
), msg
,
1233 0, GTP_GENL_MCGRP
, GFP_ATOMIC
);
1237 static int gtp_genl_get_pdp(struct sk_buff
*skb
, struct genl_info
*info
)
1239 struct pdp_ctx
*pctx
= NULL
;
1240 struct sk_buff
*skb2
;
1243 if (!info
->attrs
[GTPA_VERSION
])
1248 pctx
= gtp_find_pdp(sock_net(skb
->sk
), info
->attrs
);
1250 err
= PTR_ERR(pctx
);
1254 skb2
= genlmsg_new(NLMSG_GOODSIZE
, GFP_ATOMIC
);
1260 err
= gtp_genl_fill_info(skb2
, NETLINK_CB(skb
).portid
, info
->snd_seq
,
1261 0, info
->nlhdr
->nlmsg_type
, pctx
);
1263 goto err_unlock_free
;
1266 return genlmsg_unicast(genl_info_net(info
), skb2
, info
->snd_portid
);
1275 static int gtp_genl_dump_pdp(struct sk_buff
*skb
,
1276 struct netlink_callback
*cb
)
1278 struct gtp_dev
*last_gtp
= (struct gtp_dev
*)cb
->args
[2], *gtp
;
1279 int i
, j
, bucket
= cb
->args
[0], skip
= cb
->args
[1];
1280 struct net
*net
= sock_net(skb
->sk
);
1281 struct pdp_ctx
*pctx
;
1284 gn
= net_generic(net
, gtp_net_id
);
1290 list_for_each_entry_rcu(gtp
, &gn
->gtp_dev_list
, list
) {
1291 if (last_gtp
&& last_gtp
!= gtp
)
1296 for (i
= bucket
; i
< gtp
->hash_size
; i
++) {
1298 hlist_for_each_entry_rcu(pctx
, >p
->tid_hash
[i
],
1301 gtp_genl_fill_info(skb
,
1302 NETLINK_CB(cb
->skb
).portid
,
1305 cb
->nlh
->nlmsg_type
, pctx
)) {
1308 cb
->args
[2] = (unsigned long)gtp
;
1323 static const struct nla_policy gtp_genl_policy
[GTPA_MAX
+ 1] = {
1324 [GTPA_LINK
] = { .type
= NLA_U32
, },
1325 [GTPA_VERSION
] = { .type
= NLA_U32
, },
1326 [GTPA_TID
] = { .type
= NLA_U64
, },
1327 [GTPA_PEER_ADDRESS
] = { .type
= NLA_U32
, },
1328 [GTPA_MS_ADDRESS
] = { .type
= NLA_U32
, },
1329 [GTPA_FLOW
] = { .type
= NLA_U16
, },
1330 [GTPA_NET_NS_FD
] = { .type
= NLA_U32
, },
1331 [GTPA_I_TEI
] = { .type
= NLA_U32
, },
1332 [GTPA_O_TEI
] = { .type
= NLA_U32
, },
1335 static const struct genl_small_ops gtp_genl_ops
[] = {
1337 .cmd
= GTP_CMD_NEWPDP
,
1338 .validate
= GENL_DONT_VALIDATE_STRICT
| GENL_DONT_VALIDATE_DUMP
,
1339 .doit
= gtp_genl_new_pdp
,
1340 .flags
= GENL_ADMIN_PERM
,
1343 .cmd
= GTP_CMD_DELPDP
,
1344 .validate
= GENL_DONT_VALIDATE_STRICT
| GENL_DONT_VALIDATE_DUMP
,
1345 .doit
= gtp_genl_del_pdp
,
1346 .flags
= GENL_ADMIN_PERM
,
1349 .cmd
= GTP_CMD_GETPDP
,
1350 .validate
= GENL_DONT_VALIDATE_STRICT
| GENL_DONT_VALIDATE_DUMP
,
1351 .doit
= gtp_genl_get_pdp
,
1352 .dumpit
= gtp_genl_dump_pdp
,
1353 .flags
= GENL_ADMIN_PERM
,
1357 static struct genl_family gtp_genl_family __ro_after_init
= {
1361 .maxattr
= GTPA_MAX
,
1362 .policy
= gtp_genl_policy
,
1364 .module
= THIS_MODULE
,
1365 .small_ops
= gtp_genl_ops
,
1366 .n_small_ops
= ARRAY_SIZE(gtp_genl_ops
),
1367 .mcgrps
= gtp_genl_mcgrps
,
1368 .n_mcgrps
= ARRAY_SIZE(gtp_genl_mcgrps
),
1371 static int __net_init
gtp_net_init(struct net
*net
)
1373 struct gtp_net
*gn
= net_generic(net
, gtp_net_id
);
1375 INIT_LIST_HEAD(&gn
->gtp_dev_list
);
1379 static void __net_exit
gtp_net_exit(struct net
*net
)
1381 struct gtp_net
*gn
= net_generic(net
, gtp_net_id
);
1382 struct gtp_dev
*gtp
;
1386 list_for_each_entry(gtp
, &gn
->gtp_dev_list
, list
)
1387 gtp_dellink(gtp
->dev
, &list
);
1389 unregister_netdevice_many(&list
);
1393 static struct pernet_operations gtp_net_ops
= {
1394 .init
= gtp_net_init
,
1395 .exit
= gtp_net_exit
,
1397 .size
= sizeof(struct gtp_net
),
1400 static int __init
gtp_init(void)
1404 get_random_bytes(>p_h_initval
, sizeof(gtp_h_initval
));
1406 err
= rtnl_link_register(>p_link_ops
);
1410 err
= genl_register_family(>p_genl_family
);
1412 goto unreg_rtnl_link
;
1414 err
= register_pernet_subsys(>p_net_ops
);
1416 goto unreg_genl_family
;
1418 pr_info("GTP module loaded (pdp ctx size %zd bytes)\n",
1419 sizeof(struct pdp_ctx
));
1423 genl_unregister_family(>p_genl_family
);
1425 rtnl_link_unregister(>p_link_ops
);
1427 pr_err("error loading GTP module loaded\n");
1430 late_initcall(gtp_init
);
1432 static void __exit
gtp_fini(void)
1434 genl_unregister_family(>p_genl_family
);
1435 rtnl_link_unregister(>p_link_ops
);
1436 unregister_pernet_subsys(>p_net_ops
);
1438 pr_info("GTP module unloaded\n");
1440 module_exit(gtp_fini
);
1442 MODULE_LICENSE("GPL");
1443 MODULE_AUTHOR("Harald Welte <hwelte@sysmocom.de>");
1444 MODULE_DESCRIPTION("Interface driver for GTP encapsulated traffic");
1445 MODULE_ALIAS_RTNL_LINK("gtp");
1446 MODULE_ALIAS_GENL_FAMILY("gtp");