Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 1 | /* Copyright (C) 2003-2011 Jozsef Kadlecsik <kadlec@blackhole.kfki.hu> |
| 2 | * |
| 3 | * This program is free software; you can redistribute it and/or modify |
| 4 | * it under the terms of the GNU General Public License version 2 as |
| 5 | * published by the Free Software Foundation. |
| 6 | */ |
| 7 | |
| 8 | /* Get Layer-4 data from the packets */ |
| 9 | |
| 10 | #include <linux/ip.h> |
| 11 | #include <linux/skbuff.h> |
| 12 | #include <linux/icmp.h> |
| 13 | #include <linux/icmpv6.h> |
Jozsef Kadlecsik | 91eb7c0 | 2011-04-13 13:51:38 +0200 | [diff] [blame] | 14 | #include <linux/sctp.h> |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 15 | #include <linux/netfilter_ipv6/ip6_tables.h> |
| 16 | #include <net/ip.h> |
Patrick McHardy | 724bab4 | 2011-02-02 23:50:01 +0100 | [diff] [blame] | 17 | #include <net/ipv6.h> |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 18 | |
| 19 | #include <linux/netfilter/ipset/ip_set_getport.h> |
Paul Gortmaker | bc3b2d7 | 2011-07-15 11:47:34 -0400 | [diff] [blame] | 20 | #include <linux/export.h> |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 21 | |
| 22 | /* We must handle non-linear skbs */ |
| 23 | static bool |
| 24 | get_port(const struct sk_buff *skb, int protocol, unsigned int protooff, |
| 25 | bool src, __be16 *port, u8 *proto) |
| 26 | { |
| 27 | switch (protocol) { |
| 28 | case IPPROTO_TCP: { |
| 29 | struct tcphdr _tcph; |
| 30 | const struct tcphdr *th; |
| 31 | |
| 32 | th = skb_header_pointer(skb, protooff, sizeof(_tcph), &_tcph); |
Jozsef Kadlecsik | ca0f6a5 | 2015-06-13 19:45:33 +0200 | [diff] [blame] | 33 | if (!th) |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 34 | /* No choice either */ |
| 35 | return false; |
| 36 | |
| 37 | *port = src ? th->source : th->dest; |
| 38 | break; |
| 39 | } |
Jozsef Kadlecsik | 91eb7c0 | 2011-04-13 13:51:38 +0200 | [diff] [blame] | 40 | case IPPROTO_SCTP: { |
| 41 | sctp_sctphdr_t _sh; |
| 42 | const sctp_sctphdr_t *sh; |
| 43 | |
| 44 | sh = skb_header_pointer(skb, protooff, sizeof(_sh), &_sh); |
Jozsef Kadlecsik | ca0f6a5 | 2015-06-13 19:45:33 +0200 | [diff] [blame] | 45 | if (!sh) |
Jozsef Kadlecsik | 91eb7c0 | 2011-04-13 13:51:38 +0200 | [diff] [blame] | 46 | /* No choice either */ |
| 47 | return false; |
| 48 | |
| 49 | *port = src ? sh->source : sh->dest; |
| 50 | break; |
| 51 | } |
| 52 | case IPPROTO_UDP: |
| 53 | case IPPROTO_UDPLITE: { |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 54 | struct udphdr _udph; |
| 55 | const struct udphdr *uh; |
| 56 | |
| 57 | uh = skb_header_pointer(skb, protooff, sizeof(_udph), &_udph); |
Jozsef Kadlecsik | ca0f6a5 | 2015-06-13 19:45:33 +0200 | [diff] [blame] | 58 | if (!uh) |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 59 | /* No choice either */ |
| 60 | return false; |
| 61 | |
| 62 | *port = src ? uh->source : uh->dest; |
| 63 | break; |
| 64 | } |
| 65 | case IPPROTO_ICMP: { |
| 66 | struct icmphdr _ich; |
| 67 | const struct icmphdr *ic; |
| 68 | |
| 69 | ic = skb_header_pointer(skb, protooff, sizeof(_ich), &_ich); |
Jozsef Kadlecsik | ca0f6a5 | 2015-06-13 19:45:33 +0200 | [diff] [blame] | 70 | if (!ic) |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 71 | return false; |
| 72 | |
| 73 | *port = (__force __be16)htons((ic->type << 8) | ic->code); |
| 74 | break; |
| 75 | } |
| 76 | case IPPROTO_ICMPV6: { |
| 77 | struct icmp6hdr _ich; |
| 78 | const struct icmp6hdr *ic; |
| 79 | |
| 80 | ic = skb_header_pointer(skb, protooff, sizeof(_ich), &_ich); |
Jozsef Kadlecsik | ca0f6a5 | 2015-06-13 19:45:33 +0200 | [diff] [blame] | 81 | if (!ic) |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 82 | return false; |
| 83 | |
| 84 | *port = (__force __be16) |
| 85 | htons((ic->icmp6_type << 8) | ic->icmp6_code); |
| 86 | break; |
| 87 | } |
| 88 | default: |
| 89 | break; |
| 90 | } |
| 91 | *proto = protocol; |
| 92 | |
| 93 | return true; |
| 94 | } |
| 95 | |
| 96 | bool |
| 97 | ip_set_get_ip4_port(const struct sk_buff *skb, bool src, |
| 98 | __be16 *port, u8 *proto) |
| 99 | { |
| 100 | const struct iphdr *iph = ip_hdr(skb); |
Alexander Drozdov | 3e4e8d1 | 2015-05-02 19:28:01 +0200 | [diff] [blame] | 101 | unsigned int protooff = skb_network_offset(skb) + ip_hdrlen(skb); |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 102 | int protocol = iph->protocol; |
| 103 | |
| 104 | /* See comments at tcp_match in ip_tables.c */ |
Anders K. Pedersen | 60b0fe3 | 2013-05-03 23:15:48 +0200 | [diff] [blame] | 105 | if (protocol <= 0) |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 106 | return false; |
| 107 | |
Anders K. Pedersen | 60b0fe3 | 2013-05-03 23:15:48 +0200 | [diff] [blame] | 108 | if (ntohs(iph->frag_off) & IP_OFFSET) |
| 109 | switch (protocol) { |
| 110 | case IPPROTO_TCP: |
| 111 | case IPPROTO_SCTP: |
| 112 | case IPPROTO_UDP: |
| 113 | case IPPROTO_UDPLITE: |
| 114 | case IPPROTO_ICMP: |
| 115 | /* Port info not available for fragment offset > 0 */ |
| 116 | return false; |
| 117 | default: |
| 118 | /* Other protocols doesn't have ports, |
Jozsef Kadlecsik | ca0f6a5 | 2015-06-13 19:45:33 +0200 | [diff] [blame] | 119 | * so we can match fragments. |
| 120 | */ |
Anders K. Pedersen | 60b0fe3 | 2013-05-03 23:15:48 +0200 | [diff] [blame] | 121 | *proto = protocol; |
| 122 | return true; |
| 123 | } |
| 124 | |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 125 | return get_port(skb, protocol, protooff, src, port, proto); |
| 126 | } |
| 127 | EXPORT_SYMBOL_GPL(ip_set_get_ip4_port); |
| 128 | |
Igor Maravić | c0cd115 | 2011-12-12 02:58:24 +0000 | [diff] [blame] | 129 | #if IS_ENABLED(CONFIG_IP6_NF_IPTABLES) |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 130 | bool |
| 131 | ip_set_get_ip6_port(const struct sk_buff *skb, bool src, |
| 132 | __be16 *port, u8 *proto) |
| 133 | { |
Patrick McHardy | 724bab4 | 2011-02-02 23:50:01 +0100 | [diff] [blame] | 134 | int protoff; |
| 135 | u8 nexthdr; |
Jozsef Kadlecsik | 55524c2 | 2013-09-16 20:00:08 +0200 | [diff] [blame] | 136 | __be16 frag_off = 0; |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 137 | |
Patrick McHardy | 724bab4 | 2011-02-02 23:50:01 +0100 | [diff] [blame] | 138 | nexthdr = ipv6_hdr(skb)->nexthdr; |
Alexander Drozdov | 3e4e8d1 | 2015-05-02 19:28:01 +0200 | [diff] [blame] | 139 | protoff = ipv6_skip_exthdr(skb, |
| 140 | skb_network_offset(skb) + |
| 141 | sizeof(struct ipv6hdr), &nexthdr, |
Jesse Gross | 75f2811 | 2011-11-30 17:05:51 -0800 | [diff] [blame] | 142 | &frag_off); |
Jozsef Kadlecsik | 55524c2 | 2013-09-16 20:00:08 +0200 | [diff] [blame] | 143 | if (protoff < 0 || (frag_off & htons(~0x7)) != 0) |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 144 | return false; |
| 145 | |
Patrick McHardy | 724bab4 | 2011-02-02 23:50:01 +0100 | [diff] [blame] | 146 | return get_port(skb, nexthdr, protoff, src, port, proto); |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 147 | } |
| 148 | EXPORT_SYMBOL_GPL(ip_set_get_ip6_port); |
Patrick McHardy | 724bab4 | 2011-02-02 23:50:01 +0100 | [diff] [blame] | 149 | #endif |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 150 | |
| 151 | bool |
| 152 | ip_set_get_ip_port(const struct sk_buff *skb, u8 pf, bool src, __be16 *port) |
| 153 | { |
| 154 | bool ret; |
| 155 | u8 proto; |
| 156 | |
| 157 | switch (pf) { |
Jan Engelhardt | c15f1c8 | 2012-02-14 00:24:10 +0100 | [diff] [blame] | 158 | case NFPROTO_IPV4: |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 159 | ret = ip_set_get_ip4_port(skb, src, port, &proto); |
Patrick McHardy | 316ed38 | 2011-02-02 09:31:37 +0100 | [diff] [blame] | 160 | break; |
Jan Engelhardt | c15f1c8 | 2012-02-14 00:24:10 +0100 | [diff] [blame] | 161 | case NFPROTO_IPV6: |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 162 | ret = ip_set_get_ip6_port(skb, src, port, &proto); |
Patrick McHardy | 316ed38 | 2011-02-02 09:31:37 +0100 | [diff] [blame] | 163 | break; |
Jozsef Kadlecsik | a7b4f98 | 2011-02-01 15:28:35 +0100 | [diff] [blame] | 164 | default: |
| 165 | return false; |
| 166 | } |
| 167 | if (!ret) |
| 168 | return ret; |
| 169 | switch (proto) { |
| 170 | case IPPROTO_TCP: |
| 171 | case IPPROTO_UDP: |
| 172 | return true; |
| 173 | default: |
| 174 | return false; |
| 175 | } |
| 176 | } |
| 177 | EXPORT_SYMBOL_GPL(ip_set_get_ip_port); |