1 /* GTP according to GSM TS 09.60 / 3GPP TS 29.060
3 * (C) 2012-2014 by sysmocom - s.f.m.c. GmbH
4 * (C) 2016 by Pablo Neira Ayuso <pablo@netfilter.org>
6 * Author: Harald Welte <hwelte@sysmocom.de>
7 * Pablo Neira Ayuso <pablo@netfilter.org>
8 * Andreas Schultz <aschultz@travelping.com>
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * as published by the Free Software Foundation; either version
13 * 2 of the License, or (at your option) any later version.
16 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
18 #include <linux/module.h>
19 #include <linux/skbuff.h>
20 #include <linux/udp.h>
21 #include <linux/rculist.h>
22 #include <linux/jhash.h>
23 #include <linux/if_tunnel.h>
24 #include <linux/net.h>
25 #include <linux/file.h>
26 #include <linux/gtp.h>
28 #include <net/net_namespace.h>
29 #include <net/protocol.h>
32 #include <net/udp_tunnel.h>
35 #include <net/genetlink.h>
36 #include <net/netns/generic.h>
39 /* An active session for the subscriber. */
41 struct hlist_node hlist_tid
;
42 struct hlist_node hlist_addr
;
58 struct in_addr ms_addr_ip4
;
59 struct in_addr peer_addr_ip4
;
62 struct net_device
*dev
;
65 struct rcu_head rcu_head
;
68 /* One instance of the GTP device. */
70 struct list_head list
;
75 struct net_device
*dev
;
78 unsigned int hash_size
;
79 struct hlist_head
*tid_hash
;
80 struct hlist_head
*addr_hash
;
83 static unsigned int gtp_net_id __read_mostly
;
86 struct list_head gtp_dev_list
;
89 static u32 gtp_h_initval
;
91 static void pdp_context_delete(struct pdp_ctx
*pctx
);
93 static inline u32
gtp0_hashfn(u64 tid
)
95 u32
*tid32
= (u32
*) &tid
;
96 return jhash_2words(tid32
[0], tid32
[1], gtp_h_initval
);
99 static inline u32
gtp1u_hashfn(u32 tid
)
101 return jhash_1word(tid
, gtp_h_initval
);
104 static inline u32
ipv4_hashfn(__be32 ip
)
106 return jhash_1word((__force u32
)ip
, gtp_h_initval
);
109 /* Resolve a PDP context structure based on the 64bit TID. */
110 static struct pdp_ctx
*gtp0_pdp_find(struct gtp_dev
*gtp
, u64 tid
)
112 struct hlist_head
*head
;
115 head
= >p
->tid_hash
[gtp0_hashfn(tid
) % gtp
->hash_size
];
117 hlist_for_each_entry_rcu(pdp
, head
, hlist_tid
) {
118 if (pdp
->gtp_version
== GTP_V0
&&
119 pdp
->u
.v0
.tid
== tid
)
125 /* Resolve a PDP context structure based on the 32bit TEI. */
126 static struct pdp_ctx
*gtp1_pdp_find(struct gtp_dev
*gtp
, u32 tid
)
128 struct hlist_head
*head
;
131 head
= >p
->tid_hash
[gtp1u_hashfn(tid
) % gtp
->hash_size
];
133 hlist_for_each_entry_rcu(pdp
, head
, hlist_tid
) {
134 if (pdp
->gtp_version
== GTP_V1
&&
135 pdp
->u
.v1
.i_tei
== tid
)
141 /* Resolve a PDP context based on IPv4 address of MS. */
142 static struct pdp_ctx
*ipv4_pdp_find(struct gtp_dev
*gtp
, __be32 ms_addr
)
144 struct hlist_head
*head
;
147 head
= >p
->addr_hash
[ipv4_hashfn(ms_addr
) % gtp
->hash_size
];
149 hlist_for_each_entry_rcu(pdp
, head
, hlist_addr
) {
150 if (pdp
->af
== AF_INET
&&
151 pdp
->ms_addr_ip4
.s_addr
== ms_addr
)
158 static bool gtp_check_ms_ipv4(struct sk_buff
*skb
, struct pdp_ctx
*pctx
,
159 unsigned int hdrlen
, unsigned int role
)
163 if (!pskb_may_pull(skb
, hdrlen
+ sizeof(struct iphdr
)))
166 iph
= (struct iphdr
*)(skb
->data
+ hdrlen
);
168 if (role
== GTP_ROLE_SGSN
)
169 return iph
->daddr
== pctx
->ms_addr_ip4
.s_addr
;
171 return iph
->saddr
== pctx
->ms_addr_ip4
.s_addr
;
174 /* Check if the inner IP address in this packet is assigned to any
175 * existing mobile subscriber.
177 static bool gtp_check_ms(struct sk_buff
*skb
, struct pdp_ctx
*pctx
,
178 unsigned int hdrlen
, unsigned int role
)
180 switch (ntohs(skb
->protocol
)) {
182 return gtp_check_ms_ipv4(skb
, pctx
, hdrlen
, role
);
187 static int gtp_rx(struct pdp_ctx
*pctx
, struct sk_buff
*skb
,
188 unsigned int hdrlen
, unsigned int role
)
190 struct pcpu_sw_netstats
*stats
;
192 if (!gtp_check_ms(skb
, pctx
, hdrlen
, role
)) {
193 netdev_dbg(pctx
->dev
, "No PDP ctx for this MS\n");
197 /* Get rid of the GTP + UDP headers. */
198 if (iptunnel_pull_header(skb
, hdrlen
, skb
->protocol
,
199 !net_eq(sock_net(pctx
->sk
), dev_net(pctx
->dev
))))
202 netdev_dbg(pctx
->dev
, "forwarding packet from GGSN to uplink\n");
204 /* Now that the UDP and the GTP header have been removed, set up the
205 * new network header. This is required by the upper layer to
206 * calculate the transport header.
208 skb_reset_network_header(skb
);
210 skb
->dev
= pctx
->dev
;
212 stats
= this_cpu_ptr(pctx
->dev
->tstats
);
213 u64_stats_update_begin(&stats
->syncp
);
215 stats
->rx_bytes
+= skb
->len
;
216 u64_stats_update_end(&stats
->syncp
);
222 /* 1 means pass up to the stack, -1 means drop and 0 means decapsulated. */
223 static int gtp0_udp_encap_recv(struct gtp_dev
*gtp
, struct sk_buff
*skb
)
225 unsigned int hdrlen
= sizeof(struct udphdr
) +
226 sizeof(struct gtp0_header
);
227 struct gtp0_header
*gtp0
;
228 struct pdp_ctx
*pctx
;
230 if (!pskb_may_pull(skb
, hdrlen
))
233 gtp0
= (struct gtp0_header
*)(skb
->data
+ sizeof(struct udphdr
));
235 if ((gtp0
->flags
>> 5) != GTP_V0
)
238 if (gtp0
->type
!= GTP_TPDU
)
241 pctx
= gtp0_pdp_find(gtp
, be64_to_cpu(gtp0
->tid
));
243 netdev_dbg(gtp
->dev
, "No PDP ctx to decap skb=%p\n", skb
);
247 return gtp_rx(pctx
, skb
, hdrlen
, gtp
->role
);
250 static int gtp1u_udp_encap_recv(struct gtp_dev
*gtp
, struct sk_buff
*skb
)
252 unsigned int hdrlen
= sizeof(struct udphdr
) +
253 sizeof(struct gtp1_header
);
254 struct gtp1_header
*gtp1
;
255 struct pdp_ctx
*pctx
;
257 if (!pskb_may_pull(skb
, hdrlen
))
260 gtp1
= (struct gtp1_header
*)(skb
->data
+ sizeof(struct udphdr
));
262 if ((gtp1
->flags
>> 5) != GTP_V1
)
265 if (gtp1
->type
!= GTP_TPDU
)
268 /* From 29.060: "This field shall be present if and only if any one or
269 * more of the S, PN and E flags are set.".
271 * If any of the bit is set, then the remaining ones also have to be
274 if (gtp1
->flags
& GTP1_F_MASK
)
277 /* Make sure the header is larger enough, including extensions. */
278 if (!pskb_may_pull(skb
, hdrlen
))
281 gtp1
= (struct gtp1_header
*)(skb
->data
+ sizeof(struct udphdr
));
283 pctx
= gtp1_pdp_find(gtp
, ntohl(gtp1
->tid
));
285 netdev_dbg(gtp
->dev
, "No PDP ctx to decap skb=%p\n", skb
);
289 return gtp_rx(pctx
, skb
, hdrlen
, gtp
->role
);
292 static void __gtp_encap_destroy(struct sock
*sk
)
297 gtp
= sk
->sk_user_data
;
303 udp_sk(sk
)->encap_type
= 0;
304 rcu_assign_sk_user_data(sk
, NULL
);
310 static void gtp_encap_destroy(struct sock
*sk
)
313 __gtp_encap_destroy(sk
);
317 static void gtp_encap_disable_sock(struct sock
*sk
)
322 __gtp_encap_destroy(sk
);
325 static void gtp_encap_disable(struct gtp_dev
*gtp
)
327 gtp_encap_disable_sock(gtp
->sk0
);
328 gtp_encap_disable_sock(gtp
->sk1u
);
331 /* UDP encapsulation receive handler. See net/ipv4/udp.c.
332 * Return codes: 0: success, <0: error, >0: pass up to userspace UDP socket.
334 static int gtp_encap_recv(struct sock
*sk
, struct sk_buff
*skb
)
339 gtp
= rcu_dereference_sk_user_data(sk
);
343 netdev_dbg(gtp
->dev
, "encap_recv sk=%p\n", sk
);
345 switch (udp_sk(sk
)->encap_type
) {
347 netdev_dbg(gtp
->dev
, "received GTP0 packet\n");
348 ret
= gtp0_udp_encap_recv(gtp
, skb
);
350 case UDP_ENCAP_GTP1U
:
351 netdev_dbg(gtp
->dev
, "received GTP1U packet\n");
352 ret
= gtp1u_udp_encap_recv(gtp
, skb
);
355 ret
= -1; /* Shouldn't happen. */
360 netdev_dbg(gtp
->dev
, "pass up to the process\n");
365 netdev_dbg(gtp
->dev
, "GTP packet has been dropped\n");
374 static int gtp_dev_init(struct net_device
*dev
)
376 struct gtp_dev
*gtp
= netdev_priv(dev
);
380 dev
->tstats
= netdev_alloc_pcpu_stats(struct pcpu_sw_netstats
);
387 static void gtp_dev_uninit(struct net_device
*dev
)
389 struct gtp_dev
*gtp
= netdev_priv(dev
);
391 gtp_encap_disable(gtp
);
392 free_percpu(dev
->tstats
);
395 static struct rtable
*ip4_route_output_gtp(struct flowi4
*fl4
,
396 const struct sock
*sk
,
399 memset(fl4
, 0, sizeof(*fl4
));
400 fl4
->flowi4_oif
= sk
->sk_bound_dev_if
;
402 fl4
->saddr
= inet_sk(sk
)->inet_saddr
;
403 fl4
->flowi4_tos
= RT_CONN_FLAGS(sk
);
404 fl4
->flowi4_proto
= sk
->sk_protocol
;
406 return ip_route_output_key(sock_net(sk
), fl4
);
409 static inline void gtp0_push_header(struct sk_buff
*skb
, struct pdp_ctx
*pctx
)
411 int payload_len
= skb
->len
;
412 struct gtp0_header
*gtp0
;
414 gtp0
= skb_push(skb
, sizeof(*gtp0
));
416 gtp0
->flags
= 0x1e; /* v0, GTP-non-prime. */
417 gtp0
->type
= GTP_TPDU
;
418 gtp0
->length
= htons(payload_len
);
419 gtp0
->seq
= htons((atomic_inc_return(&pctx
->tx_seq
) - 1) % 0xffff);
420 gtp0
->flow
= htons(pctx
->u
.v0
.flow
);
422 gtp0
->spare
[0] = gtp0
->spare
[1] = gtp0
->spare
[2] = 0xff;
423 gtp0
->tid
= cpu_to_be64(pctx
->u
.v0
.tid
);
426 static inline void gtp1_push_header(struct sk_buff
*skb
, struct pdp_ctx
*pctx
)
428 int payload_len
= skb
->len
;
429 struct gtp1_header
*gtp1
;
431 gtp1
= skb_push(skb
, sizeof(*gtp1
));
433 /* Bits 8 7 6 5 4 3 2 1
434 * +--+--+--+--+--+--+--+--+
435 * |version |PT| 0| E| S|PN|
436 * +--+--+--+--+--+--+--+--+
439 gtp1
->flags
= 0x30; /* v1, GTP-non-prime. */
440 gtp1
->type
= GTP_TPDU
;
441 gtp1
->length
= htons(payload_len
);
442 gtp1
->tid
= htonl(pctx
->u
.v1
.o_tei
);
444 /* TODO: Suppport for extension header, sequence number and N-PDU.
445 * Update the length field if any of them is available.
454 struct pdp_ctx
*pctx
;
455 struct net_device
*dev
;
459 static void gtp_push_header(struct sk_buff
*skb
, struct gtp_pktinfo
*pktinfo
)
461 switch (pktinfo
->pctx
->gtp_version
) {
463 pktinfo
->gtph_port
= htons(GTP0_PORT
);
464 gtp0_push_header(skb
, pktinfo
->pctx
);
467 pktinfo
->gtph_port
= htons(GTP1U_PORT
);
468 gtp1_push_header(skb
, pktinfo
->pctx
);
473 static inline void gtp_set_pktinfo_ipv4(struct gtp_pktinfo
*pktinfo
,
474 struct sock
*sk
, struct iphdr
*iph
,
475 struct pdp_ctx
*pctx
, struct rtable
*rt
,
477 struct net_device
*dev
)
481 pktinfo
->pctx
= pctx
;
487 static int gtp_build_skb_ip4(struct sk_buff
*skb
, struct net_device
*dev
,
488 struct gtp_pktinfo
*pktinfo
)
490 struct gtp_dev
*gtp
= netdev_priv(dev
);
491 struct pdp_ctx
*pctx
;
498 /* Read the IP destination address and resolve the PDP context.
499 * Prepend PDP header with TEI/TID from PDP ctx.
502 if (gtp
->role
== GTP_ROLE_SGSN
)
503 pctx
= ipv4_pdp_find(gtp
, iph
->saddr
);
505 pctx
= ipv4_pdp_find(gtp
, iph
->daddr
);
508 netdev_dbg(dev
, "no PDP ctx found for %pI4, skip\n",
512 netdev_dbg(dev
, "found PDP context %p\n", pctx
);
514 rt
= ip4_route_output_gtp(&fl4
, pctx
->sk
, pctx
->peer_addr_ip4
.s_addr
);
516 netdev_dbg(dev
, "no route to SSGN %pI4\n",
517 &pctx
->peer_addr_ip4
.s_addr
);
518 dev
->stats
.tx_carrier_errors
++;
522 if (rt
->dst
.dev
== dev
) {
523 netdev_dbg(dev
, "circular route to SSGN %pI4\n",
524 &pctx
->peer_addr_ip4
.s_addr
);
525 dev
->stats
.collisions
++;
531 /* This is similar to tnl_update_pmtu(). */
534 mtu
= dst_mtu(&rt
->dst
) - dev
->hard_header_len
-
535 sizeof(struct iphdr
) - sizeof(struct udphdr
);
536 switch (pctx
->gtp_version
) {
538 mtu
-= sizeof(struct gtp0_header
);
541 mtu
-= sizeof(struct gtp1_header
);
545 mtu
= dst_mtu(&rt
->dst
);
548 rt
->dst
.ops
->update_pmtu(&rt
->dst
, NULL
, skb
, mtu
);
550 if (!skb_is_gso(skb
) && (iph
->frag_off
& htons(IP_DF
)) &&
551 mtu
< ntohs(iph
->tot_len
)) {
552 netdev_dbg(dev
, "packet too big, fragmentation needed\n");
553 memset(IPCB(skb
), 0, sizeof(*IPCB(skb
)));
554 icmp_send(skb
, ICMP_DEST_UNREACH
, ICMP_FRAG_NEEDED
,
559 gtp_set_pktinfo_ipv4(pktinfo
, pctx
->sk
, iph
, pctx
, rt
, &fl4
, dev
);
560 gtp_push_header(skb
, pktinfo
);
569 static netdev_tx_t
gtp_dev_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
571 unsigned int proto
= ntohs(skb
->protocol
);
572 struct gtp_pktinfo pktinfo
;
575 /* Ensure there is sufficient headroom. */
576 if (skb_cow_head(skb
, dev
->needed_headroom
))
579 skb_reset_inner_headers(skb
);
581 /* PDP context lookups in gtp_build_skb_*() need rcu read-side lock. */
585 err
= gtp_build_skb_ip4(skb
, dev
, &pktinfo
);
598 netdev_dbg(pktinfo
.dev
, "gtp -> IP src: %pI4 dst: %pI4\n",
599 &pktinfo
.iph
->saddr
, &pktinfo
.iph
->daddr
);
600 udp_tunnel_xmit_skb(pktinfo
.rt
, pktinfo
.sk
, skb
,
601 pktinfo
.fl4
.saddr
, pktinfo
.fl4
.daddr
,
603 ip4_dst_hoplimit(&pktinfo
.rt
->dst
),
605 pktinfo
.gtph_port
, pktinfo
.gtph_port
,
612 dev
->stats
.tx_errors
++;
617 static const struct net_device_ops gtp_netdev_ops
= {
618 .ndo_init
= gtp_dev_init
,
619 .ndo_uninit
= gtp_dev_uninit
,
620 .ndo_start_xmit
= gtp_dev_xmit
,
621 .ndo_get_stats64
= ip_tunnel_get_stats64
,
624 static void gtp_link_setup(struct net_device
*dev
)
626 dev
->netdev_ops
= >p_netdev_ops
;
627 dev
->needs_free_netdev
= true;
629 dev
->hard_header_len
= 0;
632 /* Zero header length. */
633 dev
->type
= ARPHRD_NONE
;
634 dev
->flags
= IFF_POINTOPOINT
| IFF_NOARP
| IFF_MULTICAST
;
636 dev
->priv_flags
|= IFF_NO_QUEUE
;
637 dev
->features
|= NETIF_F_LLTX
;
640 /* Assume largest header, ie. GTPv0. */
641 dev
->needed_headroom
= LL_MAX_HEADER
+
642 sizeof(struct iphdr
) +
643 sizeof(struct udphdr
) +
644 sizeof(struct gtp0_header
);
647 static int gtp_hashtable_new(struct gtp_dev
*gtp
, int hsize
);
648 static void gtp_hashtable_free(struct gtp_dev
*gtp
);
649 static int gtp_encap_enable(struct gtp_dev
*gtp
, struct nlattr
*data
[]);
651 static int gtp_newlink(struct net
*src_net
, struct net_device
*dev
,
652 struct nlattr
*tb
[], struct nlattr
*data
[],
653 struct netlink_ext_ack
*extack
)
659 if (!data
[IFLA_GTP_FD0
] && !data
[IFLA_GTP_FD1
])
662 gtp
= netdev_priv(dev
);
664 err
= gtp_encap_enable(gtp
, data
);
668 if (!data
[IFLA_GTP_PDP_HASHSIZE
])
671 hashsize
= nla_get_u32(data
[IFLA_GTP_PDP_HASHSIZE
]);
673 err
= gtp_hashtable_new(gtp
, hashsize
);
677 err
= register_netdevice(dev
);
679 netdev_dbg(dev
, "failed to register new netdev %d\n", err
);
683 gn
= net_generic(dev_net(dev
), gtp_net_id
);
684 list_add_rcu(>p
->list
, &gn
->gtp_dev_list
);
686 netdev_dbg(dev
, "registered new GTP interface\n");
691 gtp_hashtable_free(gtp
);
693 gtp_encap_disable(gtp
);
697 static void gtp_dellink(struct net_device
*dev
, struct list_head
*head
)
699 struct gtp_dev
*gtp
= netdev_priv(dev
);
701 gtp_encap_disable(gtp
);
702 gtp_hashtable_free(gtp
);
703 list_del_rcu(>p
->list
);
704 unregister_netdevice_queue(dev
, head
);
707 static const struct nla_policy gtp_policy
[IFLA_GTP_MAX
+ 1] = {
708 [IFLA_GTP_FD0
] = { .type
= NLA_U32
},
709 [IFLA_GTP_FD1
] = { .type
= NLA_U32
},
710 [IFLA_GTP_PDP_HASHSIZE
] = { .type
= NLA_U32
},
711 [IFLA_GTP_ROLE
] = { .type
= NLA_U32
},
714 static int gtp_validate(struct nlattr
*tb
[], struct nlattr
*data
[],
715 struct netlink_ext_ack
*extack
)
723 static size_t gtp_get_size(const struct net_device
*dev
)
725 return nla_total_size(sizeof(__u32
)); /* IFLA_GTP_PDP_HASHSIZE */
728 static int gtp_fill_info(struct sk_buff
*skb
, const struct net_device
*dev
)
730 struct gtp_dev
*gtp
= netdev_priv(dev
);
732 if (nla_put_u32(skb
, IFLA_GTP_PDP_HASHSIZE
, gtp
->hash_size
))
733 goto nla_put_failure
;
741 static struct rtnl_link_ops gtp_link_ops __read_mostly
= {
743 .maxtype
= IFLA_GTP_MAX
,
744 .policy
= gtp_policy
,
745 .priv_size
= sizeof(struct gtp_dev
),
746 .setup
= gtp_link_setup
,
747 .validate
= gtp_validate
,
748 .newlink
= gtp_newlink
,
749 .dellink
= gtp_dellink
,
750 .get_size
= gtp_get_size
,
751 .fill_info
= gtp_fill_info
,
754 static int gtp_hashtable_new(struct gtp_dev
*gtp
, int hsize
)
758 gtp
->addr_hash
= kmalloc(sizeof(struct hlist_head
) * hsize
, GFP_KERNEL
);
759 if (gtp
->addr_hash
== NULL
)
762 gtp
->tid_hash
= kmalloc(sizeof(struct hlist_head
) * hsize
, GFP_KERNEL
);
763 if (gtp
->tid_hash
== NULL
)
766 gtp
->hash_size
= hsize
;
768 for (i
= 0; i
< hsize
; i
++) {
769 INIT_HLIST_HEAD(>p
->addr_hash
[i
]);
770 INIT_HLIST_HEAD(>p
->tid_hash
[i
]);
774 kfree(gtp
->addr_hash
);
778 static void gtp_hashtable_free(struct gtp_dev
*gtp
)
780 struct pdp_ctx
*pctx
;
783 for (i
= 0; i
< gtp
->hash_size
; i
++)
784 hlist_for_each_entry_rcu(pctx
, >p
->tid_hash
[i
], hlist_tid
)
785 pdp_context_delete(pctx
);
788 kfree(gtp
->addr_hash
);
789 kfree(gtp
->tid_hash
);
792 static struct sock
*gtp_encap_enable_socket(int fd
, int type
,
795 struct udp_tunnel_sock_cfg tuncfg
= {NULL
};
800 pr_debug("enable gtp on %d, %d\n", fd
, type
);
802 sock
= sockfd_lookup(fd
, &err
);
804 pr_debug("gtp socket fd=%d not found\n", fd
);
808 if (sock
->sk
->sk_protocol
!= IPPROTO_UDP
) {
809 pr_debug("socket fd=%d not UDP\n", fd
);
810 sk
= ERR_PTR(-EINVAL
);
815 if (sock
->sk
->sk_user_data
) {
816 sk
= ERR_PTR(-EBUSY
);
823 tuncfg
.sk_user_data
= gtp
;
824 tuncfg
.encap_type
= type
;
825 tuncfg
.encap_rcv
= gtp_encap_recv
;
826 tuncfg
.encap_destroy
= gtp_encap_destroy
;
828 setup_udp_tunnel_sock(sock_net(sock
->sk
), sock
, &tuncfg
);
831 release_sock(sock
->sk
);
836 static int gtp_encap_enable(struct gtp_dev
*gtp
, struct nlattr
*data
[])
838 struct sock
*sk1u
= NULL
;
839 struct sock
*sk0
= NULL
;
840 unsigned int role
= GTP_ROLE_GGSN
;
842 if (data
[IFLA_GTP_FD0
]) {
843 u32 fd0
= nla_get_u32(data
[IFLA_GTP_FD0
]);
845 sk0
= gtp_encap_enable_socket(fd0
, UDP_ENCAP_GTP0
, gtp
);
850 if (data
[IFLA_GTP_FD1
]) {
851 u32 fd1
= nla_get_u32(data
[IFLA_GTP_FD1
]);
853 sk1u
= gtp_encap_enable_socket(fd1
, UDP_ENCAP_GTP1U
, gtp
);
856 gtp_encap_disable_sock(sk0
);
857 return PTR_ERR(sk1u
);
861 if (data
[IFLA_GTP_ROLE
]) {
862 role
= nla_get_u32(data
[IFLA_GTP_ROLE
]);
863 if (role
> GTP_ROLE_SGSN
) {
865 gtp_encap_disable_sock(sk0
);
867 gtp_encap_disable_sock(sk1u
);
879 static struct gtp_dev
*gtp_find_dev(struct net
*src_net
, struct nlattr
*nla
[])
881 struct gtp_dev
*gtp
= NULL
;
882 struct net_device
*dev
;
885 /* Examine the link attributes and figure out which network namespace
886 * we are talking about.
888 if (nla
[GTPA_NET_NS_FD
])
889 net
= get_net_ns_by_fd(nla_get_u32(nla
[GTPA_NET_NS_FD
]));
891 net
= get_net(src_net
);
896 /* Check if there's an existing gtpX device to configure */
897 dev
= dev_get_by_index_rcu(net
, nla_get_u32(nla
[GTPA_LINK
]));
898 if (dev
&& dev
->netdev_ops
== >p_netdev_ops
)
899 gtp
= netdev_priv(dev
);
905 static void ipv4_pdp_fill(struct pdp_ctx
*pctx
, struct genl_info
*info
)
907 pctx
->gtp_version
= nla_get_u32(info
->attrs
[GTPA_VERSION
]);
909 pctx
->peer_addr_ip4
.s_addr
=
910 nla_get_be32(info
->attrs
[GTPA_PEER_ADDRESS
]);
911 pctx
->ms_addr_ip4
.s_addr
=
912 nla_get_be32(info
->attrs
[GTPA_MS_ADDRESS
]);
914 switch (pctx
->gtp_version
) {
916 /* According to TS 09.60, sections 7.5.1 and 7.5.2, the flow
917 * label needs to be the same for uplink and downlink packets,
918 * so let's annotate this.
920 pctx
->u
.v0
.tid
= nla_get_u64(info
->attrs
[GTPA_TID
]);
921 pctx
->u
.v0
.flow
= nla_get_u16(info
->attrs
[GTPA_FLOW
]);
924 pctx
->u
.v1
.i_tei
= nla_get_u32(info
->attrs
[GTPA_I_TEI
]);
925 pctx
->u
.v1
.o_tei
= nla_get_u32(info
->attrs
[GTPA_O_TEI
]);
932 static int ipv4_pdp_add(struct gtp_dev
*gtp
, struct sock
*sk
,
933 struct genl_info
*info
)
935 struct net_device
*dev
= gtp
->dev
;
936 u32 hash_ms
, hash_tid
= 0;
937 struct pdp_ctx
*pctx
;
941 ms_addr
= nla_get_be32(info
->attrs
[GTPA_MS_ADDRESS
]);
942 hash_ms
= ipv4_hashfn(ms_addr
) % gtp
->hash_size
;
944 hlist_for_each_entry_rcu(pctx
, >p
->addr_hash
[hash_ms
], hlist_addr
) {
945 if (pctx
->ms_addr_ip4
.s_addr
== ms_addr
) {
952 if (info
->nlhdr
->nlmsg_flags
& NLM_F_EXCL
)
954 if (info
->nlhdr
->nlmsg_flags
& NLM_F_REPLACE
)
957 ipv4_pdp_fill(pctx
, info
);
959 if (pctx
->gtp_version
== GTP_V0
)
960 netdev_dbg(dev
, "GTPv0-U: update tunnel id = %llx (pdp %p)\n",
961 pctx
->u
.v0
.tid
, pctx
);
962 else if (pctx
->gtp_version
== GTP_V1
)
963 netdev_dbg(dev
, "GTPv1-U: update tunnel id = %x/%x (pdp %p)\n",
964 pctx
->u
.v1
.i_tei
, pctx
->u
.v1
.o_tei
, pctx
);
970 pctx
= kmalloc(sizeof(*pctx
), GFP_ATOMIC
);
976 pctx
->dev
= gtp
->dev
;
977 ipv4_pdp_fill(pctx
, info
);
978 atomic_set(&pctx
->tx_seq
, 0);
980 switch (pctx
->gtp_version
) {
982 /* TS 09.60: "The flow label identifies unambiguously a GTP
983 * flow.". We use the tid for this instead, I cannot find a
984 * situation in which this doesn't unambiguosly identify the
987 hash_tid
= gtp0_hashfn(pctx
->u
.v0
.tid
) % gtp
->hash_size
;
990 hash_tid
= gtp1u_hashfn(pctx
->u
.v1
.i_tei
) % gtp
->hash_size
;
994 hlist_add_head_rcu(&pctx
->hlist_addr
, >p
->addr_hash
[hash_ms
]);
995 hlist_add_head_rcu(&pctx
->hlist_tid
, >p
->tid_hash
[hash_tid
]);
997 switch (pctx
->gtp_version
) {
999 netdev_dbg(dev
, "GTPv0-U: new PDP ctx id=%llx ssgn=%pI4 ms=%pI4 (pdp=%p)\n",
1000 pctx
->u
.v0
.tid
, &pctx
->peer_addr_ip4
,
1001 &pctx
->ms_addr_ip4
, pctx
);
1004 netdev_dbg(dev
, "GTPv1-U: new PDP ctx id=%x/%x ssgn=%pI4 ms=%pI4 (pdp=%p)\n",
1005 pctx
->u
.v1
.i_tei
, pctx
->u
.v1
.o_tei
,
1006 &pctx
->peer_addr_ip4
, &pctx
->ms_addr_ip4
, pctx
);
1013 static void pdp_context_free(struct rcu_head
*head
)
1015 struct pdp_ctx
*pctx
= container_of(head
, struct pdp_ctx
, rcu_head
);
1021 static void pdp_context_delete(struct pdp_ctx
*pctx
)
1023 hlist_del_rcu(&pctx
->hlist_tid
);
1024 hlist_del_rcu(&pctx
->hlist_addr
);
1025 call_rcu(&pctx
->rcu_head
, pdp_context_free
);
1028 static int gtp_genl_new_pdp(struct sk_buff
*skb
, struct genl_info
*info
)
1030 unsigned int version
;
1031 struct gtp_dev
*gtp
;
1035 if (!info
->attrs
[GTPA_VERSION
] ||
1036 !info
->attrs
[GTPA_LINK
] ||
1037 !info
->attrs
[GTPA_PEER_ADDRESS
] ||
1038 !info
->attrs
[GTPA_MS_ADDRESS
])
1041 version
= nla_get_u32(info
->attrs
[GTPA_VERSION
]);
1045 if (!info
->attrs
[GTPA_TID
] ||
1046 !info
->attrs
[GTPA_FLOW
])
1050 if (!info
->attrs
[GTPA_I_TEI
] ||
1051 !info
->attrs
[GTPA_O_TEI
])
1062 gtp
= gtp_find_dev(sock_net(skb
->sk
), info
->attrs
);
1068 if (version
== GTP_V0
)
1070 else if (version
== GTP_V1
)
1080 err
= ipv4_pdp_add(gtp
, sk
, info
);
1088 static struct pdp_ctx
*gtp_find_pdp_by_link(struct net
*net
,
1089 struct nlattr
*nla
[])
1091 struct gtp_dev
*gtp
;
1093 gtp
= gtp_find_dev(net
, nla
);
1095 return ERR_PTR(-ENODEV
);
1097 if (nla
[GTPA_MS_ADDRESS
]) {
1098 __be32 ip
= nla_get_be32(nla
[GTPA_MS_ADDRESS
]);
1100 return ipv4_pdp_find(gtp
, ip
);
1101 } else if (nla
[GTPA_VERSION
]) {
1102 u32 gtp_version
= nla_get_u32(nla
[GTPA_VERSION
]);
1104 if (gtp_version
== GTP_V0
&& nla
[GTPA_TID
])
1105 return gtp0_pdp_find(gtp
, nla_get_u64(nla
[GTPA_TID
]));
1106 else if (gtp_version
== GTP_V1
&& nla
[GTPA_I_TEI
])
1107 return gtp1_pdp_find(gtp
, nla_get_u32(nla
[GTPA_I_TEI
]));
1110 return ERR_PTR(-EINVAL
);
1113 static struct pdp_ctx
*gtp_find_pdp(struct net
*net
, struct nlattr
*nla
[])
1115 struct pdp_ctx
*pctx
;
1118 pctx
= gtp_find_pdp_by_link(net
, nla
);
1120 pctx
= ERR_PTR(-EINVAL
);
1123 pctx
= ERR_PTR(-ENOENT
);
1128 static int gtp_genl_del_pdp(struct sk_buff
*skb
, struct genl_info
*info
)
1130 struct pdp_ctx
*pctx
;
1133 if (!info
->attrs
[GTPA_VERSION
])
1138 pctx
= gtp_find_pdp(sock_net(skb
->sk
), info
->attrs
);
1140 err
= PTR_ERR(pctx
);
1144 if (pctx
->gtp_version
== GTP_V0
)
1145 netdev_dbg(pctx
->dev
, "GTPv0-U: deleting tunnel id = %llx (pdp %p)\n",
1146 pctx
->u
.v0
.tid
, pctx
);
1147 else if (pctx
->gtp_version
== GTP_V1
)
1148 netdev_dbg(pctx
->dev
, "GTPv1-U: deleting tunnel id = %x/%x (pdp %p)\n",
1149 pctx
->u
.v1
.i_tei
, pctx
->u
.v1
.o_tei
, pctx
);
1151 pdp_context_delete(pctx
);
1158 static struct genl_family gtp_genl_family
;
1160 static int gtp_genl_fill_info(struct sk_buff
*skb
, u32 snd_portid
, u32 snd_seq
,
1161 u32 type
, struct pdp_ctx
*pctx
)
1165 genlh
= genlmsg_put(skb
, snd_portid
, snd_seq
, >p_genl_family
, 0,
1170 if (nla_put_u32(skb
, GTPA_VERSION
, pctx
->gtp_version
) ||
1171 nla_put_be32(skb
, GTPA_PEER_ADDRESS
, pctx
->peer_addr_ip4
.s_addr
) ||
1172 nla_put_be32(skb
, GTPA_MS_ADDRESS
, pctx
->ms_addr_ip4
.s_addr
))
1173 goto nla_put_failure
;
1175 switch (pctx
->gtp_version
) {
1177 if (nla_put_u64_64bit(skb
, GTPA_TID
, pctx
->u
.v0
.tid
, GTPA_PAD
) ||
1178 nla_put_u16(skb
, GTPA_FLOW
, pctx
->u
.v0
.flow
))
1179 goto nla_put_failure
;
1182 if (nla_put_u32(skb
, GTPA_I_TEI
, pctx
->u
.v1
.i_tei
) ||
1183 nla_put_u32(skb
, GTPA_O_TEI
, pctx
->u
.v1
.o_tei
))
1184 goto nla_put_failure
;
1187 genlmsg_end(skb
, genlh
);
1192 genlmsg_cancel(skb
, genlh
);
1196 static int gtp_genl_get_pdp(struct sk_buff
*skb
, struct genl_info
*info
)
1198 struct pdp_ctx
*pctx
= NULL
;
1199 struct sk_buff
*skb2
;
1202 if (!info
->attrs
[GTPA_VERSION
])
1207 pctx
= gtp_find_pdp(sock_net(skb
->sk
), info
->attrs
);
1209 err
= PTR_ERR(pctx
);
1213 skb2
= genlmsg_new(NLMSG_GOODSIZE
, GFP_ATOMIC
);
1219 err
= gtp_genl_fill_info(skb2
, NETLINK_CB(skb
).portid
,
1220 info
->snd_seq
, info
->nlhdr
->nlmsg_type
, pctx
);
1222 goto err_unlock_free
;
1225 return genlmsg_unicast(genl_info_net(info
), skb2
, info
->snd_portid
);
1234 static int gtp_genl_dump_pdp(struct sk_buff
*skb
,
1235 struct netlink_callback
*cb
)
1237 struct gtp_dev
*last_gtp
= (struct gtp_dev
*)cb
->args
[2], *gtp
;
1238 struct net
*net
= sock_net(skb
->sk
);
1239 struct gtp_net
*gn
= net_generic(net
, gtp_net_id
);
1240 unsigned long tid
= cb
->args
[1];
1241 int i
, k
= cb
->args
[0], ret
;
1242 struct pdp_ctx
*pctx
;
1247 list_for_each_entry_rcu(gtp
, &gn
->gtp_dev_list
, list
) {
1248 if (last_gtp
&& last_gtp
!= gtp
)
1253 for (i
= k
; i
< gtp
->hash_size
; i
++) {
1254 hlist_for_each_entry_rcu(pctx
, >p
->tid_hash
[i
], hlist_tid
) {
1255 if (tid
&& tid
!= pctx
->u
.tid
)
1260 ret
= gtp_genl_fill_info(skb
,
1261 NETLINK_CB(cb
->skb
).portid
,
1263 cb
->nlh
->nlmsg_type
, pctx
);
1266 cb
->args
[1] = pctx
->u
.tid
;
1267 cb
->args
[2] = (unsigned long)gtp
;
1278 static struct nla_policy gtp_genl_policy
[GTPA_MAX
+ 1] = {
1279 [GTPA_LINK
] = { .type
= NLA_U32
, },
1280 [GTPA_VERSION
] = { .type
= NLA_U32
, },
1281 [GTPA_TID
] = { .type
= NLA_U64
, },
1282 [GTPA_PEER_ADDRESS
] = { .type
= NLA_U32
, },
1283 [GTPA_MS_ADDRESS
] = { .type
= NLA_U32
, },
1284 [GTPA_FLOW
] = { .type
= NLA_U16
, },
1285 [GTPA_NET_NS_FD
] = { .type
= NLA_U32
, },
1286 [GTPA_I_TEI
] = { .type
= NLA_U32
, },
1287 [GTPA_O_TEI
] = { .type
= NLA_U32
, },
1290 static const struct genl_ops gtp_genl_ops
[] = {
1292 .cmd
= GTP_CMD_NEWPDP
,
1293 .doit
= gtp_genl_new_pdp
,
1294 .policy
= gtp_genl_policy
,
1295 .flags
= GENL_ADMIN_PERM
,
1298 .cmd
= GTP_CMD_DELPDP
,
1299 .doit
= gtp_genl_del_pdp
,
1300 .policy
= gtp_genl_policy
,
1301 .flags
= GENL_ADMIN_PERM
,
1304 .cmd
= GTP_CMD_GETPDP
,
1305 .doit
= gtp_genl_get_pdp
,
1306 .dumpit
= gtp_genl_dump_pdp
,
1307 .policy
= gtp_genl_policy
,
1308 .flags
= GENL_ADMIN_PERM
,
1312 static struct genl_family gtp_genl_family __ro_after_init
= {
1316 .maxattr
= GTPA_MAX
,
1318 .module
= THIS_MODULE
,
1319 .ops
= gtp_genl_ops
,
1320 .n_ops
= ARRAY_SIZE(gtp_genl_ops
),
1323 static int __net_init
gtp_net_init(struct net
*net
)
1325 struct gtp_net
*gn
= net_generic(net
, gtp_net_id
);
1327 INIT_LIST_HEAD(&gn
->gtp_dev_list
);
1331 static void __net_exit
gtp_net_exit(struct net
*net
)
1333 struct gtp_net
*gn
= net_generic(net
, gtp_net_id
);
1334 struct gtp_dev
*gtp
;
1338 list_for_each_entry(gtp
, &gn
->gtp_dev_list
, list
)
1339 gtp_dellink(gtp
->dev
, &list
);
1341 unregister_netdevice_many(&list
);
1345 static struct pernet_operations gtp_net_ops
= {
1346 .init
= gtp_net_init
,
1347 .exit
= gtp_net_exit
,
1349 .size
= sizeof(struct gtp_net
),
1352 static int __init
gtp_init(void)
1356 get_random_bytes(>p_h_initval
, sizeof(gtp_h_initval
));
1358 err
= rtnl_link_register(>p_link_ops
);
1362 err
= genl_register_family(>p_genl_family
);
1364 goto unreg_rtnl_link
;
1366 err
= register_pernet_subsys(>p_net_ops
);
1368 goto unreg_genl_family
;
1370 pr_info("GTP module loaded (pdp ctx size %zd bytes)\n",
1371 sizeof(struct pdp_ctx
));
1375 genl_unregister_family(>p_genl_family
);
1377 rtnl_link_unregister(>p_link_ops
);
1379 pr_err("error loading GTP module loaded\n");
1382 late_initcall(gtp_init
);
1384 static void __exit
gtp_fini(void)
1386 genl_unregister_family(>p_genl_family
);
1387 rtnl_link_unregister(>p_link_ops
);
1388 unregister_pernet_subsys(>p_net_ops
);
1390 pr_info("GTP module unloaded\n");
1392 module_exit(gtp_fini
);
1394 MODULE_LICENSE("GPL");
1395 MODULE_AUTHOR("Harald Welte <hwelte@sysmocom.de>");
1396 MODULE_DESCRIPTION("Interface driver for GTP encapsulated traffic");
1397 MODULE_ALIAS_RTNL_LINK("gtp");
1398 MODULE_ALIAS_GENL_FAMILY("gtp");