5 * Copyright (C) 2007-2012 Intel Corporation. All rights reserved.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
31 #include <sys/errno.h>
32 #include <sys/socket.h>
35 #include <linux/netfilter_ipv4/ip_tables.h>
41 * Some comments on how the iptables API works (some of them from the
42 * source code from iptables and the kernel):
44 * - valid_hooks: bit indicates valid IDs for hook_entry
45 * - hook_entry[ID] offset to the chain start
46 * - overflows should be end of entry chains, and uncodintional policy nodes.
47 * - policy entry: last entry in a chain
48 * - user chain: end of last builtin + policy entry
49 * - final entry must be error node
50 * - Underflows must be unconditional and use the STANDARD target with
52 * - IPT_SO_GET_INFO and IPT_SO_GET_ENTRIES are used to read a table
53 * - IPT_SO_GET_INFO: struct ipt_getinfo (note the lack of table content)
54 * - IPT_SO_GET_ENTRIES: struct ipt_get_entries (contains only parts of the
55 * table header/meta info. The table is appended after the header. The entries
56 * are of the type struct ipt_entry.
57 * - After the ipt_entry the matches are appended. After the matches
58 * the target is appended.
59 * - ipt_entry->target_offset = Size of ipt_entry + matches
60 * - ipt_entry->next_offset = Size of ipt_entry + matches + target
61 * - IPT_SO_SET_REPLACE is used to write a table (contains the complete
62 * - hook_entry and overflow mark the begining and the end of a chain, e.g
63 * entry hook: pre/in/fwd/out/post -1/0/352/504/-1
64 * underflow: pre/in/fwd/out/post -1/200/352/904/-1
65 * means that INPUT starts at offset 0 and ends at 200 (the start offset to
66 * the last element). FORWARD has one entry starting/ending at 352. The entry
67 * has a size of 152. 352 + 152 = 504 which is the start of the OUTPUT chain
68 * which then ends at 904. PREROUTING and POSTROUTING are invalid hooks in
70 * - 'iptables -t filter -A INPUT -m mark --mark 999 -j LOG'
71 * writing that table looks like this:
73 * filter valid_hooks 0x0000000e num_entries 5 size 856
74 * entry hook: pre/in/fwd/out/post -1/0/376/528/-1
75 * underflow: pre/in/fwd/out/post -1/224/376/528/-1
76 * entry 0x699d30 offset 0 size 224
77 * RULE match 0x699da0 target 0x699dd0
78 * match mark match 0x3e7
79 * target LOG flags 0 level 4
82 * entry 0x699e10 offset 224 size 152
83 * RULE match 0x699e80 target 0x699e80
87 * entry 0x699ea8 offset 376 size 152
88 * RULE match 0x699f18 target 0x699f18
92 * entry 0x699f40 offset 528 size 152
93 * RULE match 0x699fb0 target 0x699fb0
97 * entry 0x699fd8 offset 680 size 176
98 * USER CHAIN (ERROR) match 0x69a048 target 0x69a048
100 * Reading the filter table looks like this:
102 * filter valid_hooks 0x0000000e num_entries 5 size 856
103 * entry hook: pre/in/fwd/out/post -1/0/376/528/-1
104 * underflow: pre/in/fwd/out/post -1/224/376/528/-1
105 * entry 0x25fec28 offset 0 size 224
106 * CHAIN (INPUT) match 0x25fec98 target 0x25fecc8
107 * match mark match 0x3e7
108 * target LOG flags 0 level 4
109 * src 0.0.0.0/0.0.0.0
110 * dst 0.0.0.0/0.0.0.0
111 * entry 0x25fed08 offset 224 size 152
112 * RULE match 0x25fed78 target 0x25fed78
114 * src 0.0.0.0/0.0.0.0
115 * dst 0.0.0.0/0.0.0.0
116 * entry 0x25feda0 offset 376 size 152
117 * CHAIN (FORWARD) match 0x25fee10 target 0x25fee10
119 * src 0.0.0.0/0.0.0.0
120 * dst 0.0.0.0/0.0.0.0
121 * entry 0x25fee38 offset 528 size 152
122 * CHAIN (OUTPUT) match 0x25feea8 target 0x25feea8
124 * src 0.0.0.0/0.0.0.0
125 * dst 0.0.0.0/0.0.0.0
126 * entry 0x25feed0 offset 680 size 176
130 static const char *hooknames[] = {
131 [NF_IP_PRE_ROUTING] = "PREROUTING",
132 [NF_IP_LOCAL_IN] = "INPUT",
133 [NF_IP_FORWARD] = "FORWARD",
134 [NF_IP_LOCAL_OUT] = "OUTPUT",
135 [NF_IP_POST_ROUTING] = "POSTROUTING",
138 #define LABEL_ACCEPT "ACCEPT"
139 #define LABEL_DROP "DROP"
140 #define LABEL_QUEUE "QUEUE"
141 #define LABEL_RETURN "RETURN"
143 #define XT_OPTION_OFFSET_SCALE 256
145 #define MIN_ALIGN (__alignof__(struct ipt_entry))
147 #define ALIGN(s) (((s) + ((MIN_ALIGN)-1)) & ~((MIN_ALIGN)-1))
149 struct error_target {
150 struct xt_entry_target t;
151 char error[IPT_TABLE_MAXNAMELEN];
154 struct connman_iptables_entry {
158 struct ipt_entry *entry;
161 struct connman_iptables {
164 struct ipt_getinfo *info;
165 struct ipt_get_entries *blob_entries;
167 unsigned int num_entries;
168 unsigned int old_entries;
171 unsigned int underflow[NF_INET_NUMHOOKS];
172 unsigned int hook_entry[NF_INET_NUMHOOKS];
177 static GHashTable *table_hash = NULL;
179 typedef int (*iterate_entries_cb_t)(struct connman_iptables *table,
180 struct ipt_entry *entry, int builtin,
181 unsigned int hook, unsigned int offset,
184 static int iterate_entries(struct connman_iptables *table,
185 struct ipt_entry *entries,
186 unsigned int valid_hooks,
187 unsigned int *hook_entry,
188 size_t size, iterate_entries_cb_t cb,
193 struct ipt_entry *entry;
195 if (valid_hooks != 0)
196 h = __builtin_ffs(valid_hooks) - 1;
198 h = NF_INET_NUMHOOKS;
200 for (i = 0, entry = entries; i < size;
201 i += entry->next_offset) {
203 entry = (void *)entries + i;
206 * Find next valid hook which offset is higher
207 * or equal with the current offset.
209 if (h < NF_INET_NUMHOOKS) {
210 if (hook_entry[h] < i) {
211 valid_hooks ^= (1 << h);
213 if (valid_hooks != 0)
214 h = __builtin_ffs(valid_hooks) - 1;
216 h = NF_INET_NUMHOOKS;
219 if (hook_entry[h] == i)
223 err = cb(table, entry, builtin, h, i, user_data);
232 static unsigned long entry_to_offset(struct connman_iptables *table,
233 struct ipt_entry *entry)
235 return (void *)entry - (void *)table->blob_entries->entrytable;
238 static int target_to_verdict(const char *target_name)
240 if (!strcmp(target_name, LABEL_ACCEPT))
241 return -NF_ACCEPT - 1;
243 if (!strcmp(target_name, LABEL_DROP))
246 if (!strcmp(target_name, LABEL_QUEUE))
247 return -NF_QUEUE - 1;
249 if (!strcmp(target_name, LABEL_RETURN))
255 static gboolean is_builtin_target(const char *target_name)
257 if (!strcmp(target_name, LABEL_ACCEPT) ||
258 !strcmp(target_name, LABEL_DROP) ||
259 !strcmp(target_name, LABEL_QUEUE) ||
260 !strcmp(target_name, LABEL_RETURN))
266 static gboolean is_jump(struct connman_iptables_entry *e)
268 struct xt_entry_target *target;
270 target = ipt_get_target(e->entry);
272 if (!strcmp(target->u.user.name, IPT_STANDARD_TARGET)) {
273 struct xt_standard_target *t;
275 t = (struct xt_standard_target *)target;
277 switch (t->verdict) {
293 static gboolean is_chain(struct connman_iptables *table,
294 struct connman_iptables_entry *e)
296 struct ipt_entry *entry;
297 struct xt_entry_target *target;
303 target = ipt_get_target(entry);
304 if (!strcmp(target->u.user.name, IPT_ERROR_TARGET))
310 static GList *find_chain_head(struct connman_iptables *table,
311 const char *chain_name)
314 struct connman_iptables_entry *head;
315 struct ipt_entry *entry;
316 struct xt_entry_target *target;
319 for (list = table->entries; list; list = list->next) {
324 builtin = head->builtin;
325 if (builtin >= 0 && !strcmp(hooknames[builtin], chain_name))
328 /* User defined chain */
329 target = ipt_get_target(entry);
330 if (!strcmp(target->u.user.name, IPT_ERROR_TARGET) &&
331 !strcmp((char *)target->data, chain_name))
338 static GList *find_chain_tail(struct connman_iptables *table,
339 const char *chain_name)
341 struct connman_iptables_entry *tail;
342 GList *chain_head, *list;
344 chain_head = find_chain_head(table, chain_name);
345 if (chain_head == NULL)
348 /* Then we look for the next chain */
349 for (list = chain_head->next; list; list = list->next) {
352 if (is_chain(table, tail))
356 /* Nothing found, we return the table end */
357 return g_list_last(table->entries);
361 static void update_offsets(struct connman_iptables *table)
364 struct connman_iptables_entry *entry, *prev_entry;
366 for (list = table->entries; list; list = list->next) {
369 if (list == table->entries) {
376 prev_entry = prev->data;
378 entry->offset = prev_entry->offset +
379 prev_entry->entry->next_offset;
383 static void update_targets_reference(struct connman_iptables *table,
384 struct connman_iptables_entry *entry_before,
385 struct connman_iptables_entry *modified_entry,
386 gboolean is_removing)
388 struct connman_iptables_entry *tmp;
389 struct xt_standard_target *t;
393 offset = modified_entry->entry->next_offset;
395 for (list = table->entries; list; list = list->next) {
401 t = (struct xt_standard_target *)ipt_get_target(tmp->entry);
403 if (is_removing == TRUE) {
404 if (t->verdict >= entry_before->offset)
405 t->verdict -= offset;
407 if (t->verdict > entry_before->offset)
408 t->verdict += offset;
413 static int iptables_add_entry(struct connman_iptables *table,
414 struct ipt_entry *entry, GList *before,
417 struct connman_iptables_entry *e, *entry_before;
422 e = g_try_malloc0(sizeof(struct connman_iptables_entry));
427 e->builtin = builtin;
429 table->entries = g_list_insert_before(table->entries, before, e);
430 table->num_entries++;
431 table->size += entry->next_offset;
433 if (before == NULL) {
434 e->offset = table->size - entry->next_offset;
439 entry_before = before->data;
442 * We've just appended/insterted a new entry. All references
443 * should be bumped accordingly.
445 update_targets_reference(table, entry_before, e, FALSE);
447 update_offsets(table);
452 static int remove_table_entry(struct connman_iptables *table,
453 struct connman_iptables_entry *entry)
457 table->num_entries--;
458 table->size -= entry->entry->next_offset;
459 removed = entry->entry->next_offset;
461 g_free(entry->entry);
463 table->entries = g_list_remove(table->entries, entry);
468 static int iptables_flush_chain(struct connman_iptables *table,
471 GList *chain_head, *chain_tail, *list, *next;
472 struct connman_iptables_entry *entry;
473 int builtin, removed = 0;
475 chain_head = find_chain_head(table, name);
476 if (chain_head == NULL)
479 chain_tail = find_chain_tail(table, name);
480 if (chain_tail == NULL)
483 entry = chain_head->data;
484 builtin = entry->builtin;
489 list = chain_head->next;
491 if (list == chain_tail->prev)
494 while (list != chain_tail->prev) {
496 next = g_list_next(list);
498 removed += remove_table_entry(table, entry);
504 struct connman_iptables_entry *e;
508 entry->builtin = builtin;
510 table->underflow[builtin] -= removed;
512 for (list = chain_tail; list; list = list->next) {
515 builtin = e->builtin;
519 table->hook_entry[builtin] -= removed;
520 table->underflow[builtin] -= removed;
524 update_offsets(table);
529 static int iptables_add_chain(struct connman_iptables *table,
533 struct ipt_entry *entry_head;
534 struct ipt_entry *entry_return;
535 struct error_target *error;
536 struct ipt_standard_target *standard;
537 u_int16_t entry_head_size, entry_return_size;
539 last = g_list_last(table->entries);
542 * An empty chain is composed of:
543 * - A head entry, with no match and an error target.
544 * The error target data is the chain name.
545 * - A tail entry, with no match and a standard target.
546 * The standard target verdict is XT_RETURN (return to the
551 entry_head_size = sizeof(struct ipt_entry) +
552 sizeof(struct error_target);
553 entry_head = g_try_malloc0(entry_head_size);
554 if (entry_head == NULL)
557 memset(entry_head, 0, entry_head_size);
559 entry_head->target_offset = sizeof(struct ipt_entry);
560 entry_head->next_offset = entry_head_size;
562 error = (struct error_target *) entry_head->elems;
563 strcpy(error->t.u.user.name, IPT_ERROR_TARGET);
564 error->t.u.user.target_size = ALIGN(sizeof(struct error_target));
565 strcpy(error->error, name);
567 if (iptables_add_entry(table, entry_head, last, -1) < 0)
571 entry_return_size = sizeof(struct ipt_entry) +
572 sizeof(struct ipt_standard_target);
573 entry_return = g_try_malloc0(entry_return_size);
574 if (entry_return == NULL)
577 memset(entry_return, 0, entry_return_size);
579 entry_return->target_offset = sizeof(struct ipt_entry);
580 entry_return->next_offset = entry_return_size;
582 standard = (struct ipt_standard_target *) entry_return->elems;
583 standard->target.u.user.target_size =
584 ALIGN(sizeof(struct ipt_standard_target));
585 standard->verdict = XT_RETURN;
587 if (iptables_add_entry(table, entry_return, last, -1) < 0)
593 g_free(entry_return);
600 static int iptables_delete_chain(struct connman_iptables *table,
603 struct connman_iptables_entry *entry;
604 GList *chain_head, *chain_tail;
606 chain_head = find_chain_head(table, name);
607 if (chain_head == NULL)
610 entry = chain_head->data;
612 /* We cannot remove builtin chain */
613 if (entry->builtin >= 0)
616 chain_tail = find_chain_tail(table, name);
617 if (chain_tail == NULL)
620 /* Chain must be flushed */
621 if (chain_head->next != chain_tail->prev)
624 remove_table_entry(table, entry);
626 entry = chain_tail->prev->data;
627 remove_table_entry(table, entry);
629 update_offsets(table);
634 static struct ipt_entry *new_rule(struct ipt_ip *ip,
635 const char *target_name, struct xtables_target *xt_t,
636 struct xtables_rule_match *xt_rm)
638 struct xtables_rule_match *tmp_xt_rm;
639 struct ipt_entry *new_entry;
640 size_t match_size, target_size;
643 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL; tmp_xt_rm = tmp_xt_rm->next)
644 match_size += tmp_xt_rm->match->m->u.match_size;
647 target_size = ALIGN(xt_t->t->u.target_size);
649 target_size = ALIGN(sizeof(struct xt_standard_target));
651 new_entry = g_try_malloc0(sizeof(struct ipt_entry) + target_size +
653 if (new_entry == NULL)
656 memcpy(&new_entry->ip, ip, sizeof(struct ipt_ip));
658 new_entry->target_offset = sizeof(struct ipt_entry) + match_size;
659 new_entry->next_offset = sizeof(struct ipt_entry) + target_size +
663 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
664 tmp_xt_rm = tmp_xt_rm->next) {
665 memcpy(new_entry->elems + match_size, tmp_xt_rm->match->m,
666 tmp_xt_rm->match->m->u.match_size);
667 match_size += tmp_xt_rm->match->m->u.match_size;
671 struct xt_entry_target *entry_target;
673 entry_target = ipt_get_target(new_entry);
674 memcpy(entry_target, xt_t->t, target_size);
680 static void update_hooks(struct connman_iptables *table, GList *chain_head,
681 struct ipt_entry *entry)
684 struct connman_iptables_entry *head, *e;
687 if (chain_head == NULL)
690 head = chain_head->data;
692 builtin = head->builtin;
696 table->underflow[builtin] += entry->next_offset;
698 for (list = chain_head->next; list; list = list->next) {
701 builtin = e->builtin;
705 table->hook_entry[builtin] += entry->next_offset;
706 table->underflow[builtin] += entry->next_offset;
710 static struct ipt_entry *prepare_rule_inclusion(struct connman_iptables *table,
711 struct ipt_ip *ip, const char *chain_name,
712 const char *target_name,
713 struct xtables_target *xt_t,
714 int *builtin, struct xtables_rule_match *xt_rm)
716 GList *chain_tail, *chain_head;
717 struct ipt_entry *new_entry;
718 struct connman_iptables_entry *head;
720 chain_head = find_chain_head(table, chain_name);
721 if (chain_head == NULL)
724 chain_tail = find_chain_tail(table, chain_name);
725 if (chain_tail == NULL)
728 new_entry = new_rule(ip, target_name, xt_t, xt_rm);
729 if (new_entry == NULL)
732 update_hooks(table, chain_head, new_entry);
735 * If the chain is builtin, and does not have any rule,
736 * then the one that we're inserting is becoming the head
737 * and thus needs the builtin flag.
739 head = chain_head->data;
740 if (head->builtin < 0)
742 else if (chain_head == chain_tail->prev) {
743 *builtin = head->builtin;
750 static int iptables_append_rule(struct connman_iptables *table,
751 struct ipt_ip *ip, char *chain_name,
752 char *target_name, struct xtables_target *xt_t,
753 struct xtables_rule_match *xt_rm)
756 struct ipt_entry *new_entry;
757 int builtin = -1, ret;
761 chain_tail = find_chain_tail(table, chain_name);
762 if (chain_tail == NULL)
765 new_entry = prepare_rule_inclusion(table, ip, chain_name,
766 target_name, xt_t, &builtin, xt_rm);
767 if (new_entry == NULL)
770 ret = iptables_add_entry(table, new_entry, chain_tail->prev, builtin);
777 static int iptables_insert_rule(struct connman_iptables *table,
778 struct ipt_ip *ip, const char *chain_name,
779 const char *target_name,
780 struct xtables_target *xt_t,
781 struct xtables_rule_match *xt_rm)
783 struct ipt_entry *new_entry;
784 int builtin = -1, ret;
787 chain_head = find_chain_head(table, chain_name);
788 if (chain_head == NULL)
791 new_entry = prepare_rule_inclusion(table, ip, chain_name,
792 target_name, xt_t, &builtin, xt_rm);
793 if (new_entry == NULL)
797 chain_head = chain_head->next;
799 ret = iptables_add_entry(table, new_entry, chain_head, builtin);
806 static gboolean is_same_ipt_entry(struct ipt_entry *i_e1,
807 struct ipt_entry *i_e2)
809 if (memcmp(&i_e1->ip, &i_e2->ip, sizeof(struct ipt_ip)) != 0)
812 if (i_e1->target_offset != i_e2->target_offset)
815 if (i_e1->next_offset != i_e2->next_offset)
821 static gboolean is_same_target(struct xt_entry_target *xt_e_t1,
822 struct xt_entry_target *xt_e_t2)
824 if (xt_e_t1 == NULL || xt_e_t2 == NULL)
827 if (strcmp(xt_e_t1->u.user.name, IPT_STANDARD_TARGET) == 0) {
828 struct xt_standard_target *xt_s_t1;
829 struct xt_standard_target *xt_s_t2;
831 xt_s_t1 = (struct xt_standard_target *) xt_e_t1;
832 xt_s_t2 = (struct xt_standard_target *) xt_e_t2;
834 if (xt_s_t1->verdict != xt_s_t2->verdict)
837 if (xt_e_t1->u.target_size != xt_e_t2->u.target_size)
840 if (strcmp(xt_e_t1->u.user.name, xt_e_t2->u.user.name) != 0)
847 static gboolean is_same_match(struct xt_entry_match *xt_e_m1,
848 struct xt_entry_match *xt_e_m2)
850 if (xt_e_m1 == NULL || xt_e_m2 == NULL)
853 if (xt_e_m1->u.match_size != xt_e_m2->u.match_size)
856 if (xt_e_m1->u.user.revision != xt_e_m2->u.user.revision)
859 if (strcmp(xt_e_m1->u.user.name, xt_e_m2->u.user.name) != 0)
865 static GList *find_existing_rule(struct connman_iptables *table,
866 struct ipt_ip *ip, const char *chain_name,
867 const char *target_name,
868 struct xtables_target *xt_t,
869 struct xtables_match *xt_m,
870 struct xtables_rule_match *xt_rm)
872 GList *chain_tail, *chain_head, *list;
873 struct xt_entry_target *xt_e_t = NULL;
874 struct xt_entry_match *xt_e_m = NULL;
875 struct connman_iptables_entry *entry;
876 struct ipt_entry *entry_test;
879 chain_head = find_chain_head(table, chain_name);
880 if (chain_head == NULL)
883 chain_tail = find_chain_tail(table, chain_name);
884 if (chain_tail == NULL)
890 entry_test = new_rule(ip, target_name, xt_t, xt_rm);
891 if (entry_test == NULL)
895 xt_e_t = ipt_get_target(entry_test);
897 xt_e_m = (struct xt_entry_match *)entry_test->elems;
899 entry = chain_head->data;
900 builtin = entry->builtin;
905 list = chain_head->next;
907 for (; list != chain_tail->prev; list = list->next) {
908 struct connman_iptables_entry *tmp;
909 struct ipt_entry *tmp_e;
914 if (is_same_ipt_entry(entry_test, tmp_e) == FALSE)
918 struct xt_entry_target *tmp_xt_e_t;
920 tmp_xt_e_t = ipt_get_target(tmp_e);
922 if (!is_same_target(tmp_xt_e_t, xt_e_t))
927 struct xt_entry_match *tmp_xt_e_m;
929 tmp_xt_e_m = (struct xt_entry_match *)tmp_e->elems;
931 if (!is_same_match(tmp_xt_e_m, xt_e_m))
940 if (list != chain_tail->prev)
946 static int iptables_delete_rule(struct connman_iptables *table,
947 struct ipt_ip *ip, const char *chain_name,
948 const char *target_name,
949 struct xtables_target *xt_t,
950 struct xtables_match *xt_m,
951 struct xtables_rule_match *xt_rm)
953 struct connman_iptables_entry *entry;
954 GList *chain_tail, *list;
955 int builtin, removed;
959 chain_tail = find_chain_tail(table, chain_name);
960 if (chain_tail == NULL)
963 list = find_existing_rule(table, ip, chain_name, target_name,
972 builtin = entry->builtin;
974 /* We have deleted a rule,
975 * all references should be bumped accordingly */
976 if (list->next != NULL)
977 update_targets_reference(table, list->next->data,
980 removed += remove_table_entry(table, entry);
986 entry->builtin = builtin;
989 table->underflow[builtin] -= removed;
990 for (list = chain_tail; list; list = list->next) {
993 builtin = entry->builtin;
997 table->hook_entry[builtin] -= removed;
998 table->underflow[builtin] -= removed;
1002 update_offsets(table);
1007 static int iptables_compare_rule(struct connman_iptables *table,
1008 struct ipt_ip *ip, const char *chain_name,
1009 const char *target_name,
1010 struct xtables_target *xt_t,
1011 struct xtables_match *xt_m,
1012 struct xtables_rule_match *xt_rm)
1014 struct connman_iptables_entry *entry;
1017 found = find_existing_rule(table, ip, chain_name, target_name,
1022 entry = found->data;
1030 static int iptables_change_policy(struct connman_iptables *table,
1031 const char *chain_name, const char *policy)
1034 struct connman_iptables_entry *entry;
1035 struct xt_entry_target *target;
1036 struct xt_standard_target *t;
1039 verdict = target_to_verdict(policy);
1043 chain_head = find_chain_head(table, chain_name);
1044 if (chain_head == NULL)
1047 entry = chain_head->data;
1048 if (entry->builtin < 0)
1051 target = ipt_get_target(entry->entry);
1053 t = (struct xt_standard_target *)target;
1054 t->verdict = verdict;
1059 static struct ipt_replace *iptables_blob(struct connman_iptables *table)
1061 struct ipt_replace *r;
1063 struct connman_iptables_entry *e;
1064 unsigned char *entry_index;
1066 r = g_try_malloc0(sizeof(struct ipt_replace) + table->size);
1070 memset(r, 0, sizeof(*r) + table->size);
1072 r->counters = g_try_malloc0(sizeof(struct xt_counters)
1073 * table->old_entries);
1074 if (r->counters == NULL) {
1079 strcpy(r->name, table->info->name);
1080 r->num_entries = table->num_entries;
1081 r->size = table->size;
1083 r->num_counters = table->old_entries;
1084 r->valid_hooks = table->info->valid_hooks;
1086 memcpy(r->hook_entry, table->hook_entry, sizeof(table->hook_entry));
1087 memcpy(r->underflow, table->underflow, sizeof(table->underflow));
1089 entry_index = (unsigned char *)r->entries;
1090 for (list = table->entries; list; list = list->next) {
1093 memcpy(entry_index, e->entry, e->entry->next_offset);
1094 entry_index += e->entry->next_offset;
1100 static void dump_ip(struct ipt_entry *entry)
1102 struct ipt_ip *ip = &entry->ip;
1103 char ip_string[INET6_ADDRSTRLEN];
1104 char ip_mask[INET6_ADDRSTRLEN];
1106 if (strlen(ip->iniface))
1107 connman_info("\tin %s", ip->iniface);
1109 if (strlen(ip->outiface))
1110 connman_info("\tout %s", ip->outiface);
1112 if (inet_ntop(AF_INET, &ip->src, ip_string, INET6_ADDRSTRLEN) != NULL &&
1113 inet_ntop(AF_INET, &ip->smsk,
1114 ip_mask, INET6_ADDRSTRLEN) != NULL)
1115 connman_info("\tsrc %s/%s", ip_string, ip_mask);
1117 if (inet_ntop(AF_INET, &ip->dst, ip_string, INET6_ADDRSTRLEN) != NULL &&
1118 inet_ntop(AF_INET, &ip->dmsk,
1119 ip_mask, INET6_ADDRSTRLEN) != NULL)
1120 connman_info("\tdst %s/%s", ip_string, ip_mask);
1123 static void dump_target(struct ipt_entry *entry)
1126 struct xtables_target *xt_t;
1127 struct xt_entry_target *target;
1129 target = ipt_get_target(entry);
1131 if (!strcmp(target->u.user.name, IPT_STANDARD_TARGET)) {
1132 struct xt_standard_target *t;
1134 t = (struct xt_standard_target *)target;
1136 switch (t->verdict) {
1138 connman_info("\ttarget RETURN");
1141 case -NF_ACCEPT - 1:
1142 connman_info("\ttarget ACCEPT");
1146 connman_info("\ttarget DROP");
1150 connman_info("\ttarget QUEUE");
1154 connman_info("\ttarget STOP");
1158 connman_info("\tJUMP (0x%x)", t->verdict);
1162 xt_t = xtables_find_target(IPT_STANDARD_TARGET,
1163 XTF_LOAD_MUST_SUCCEED);
1165 if(xt_t->print != NULL)
1166 xt_t->print(NULL, target, 1);
1168 xt_t = xtables_find_target(target->u.user.name, XTF_TRY_LOAD);
1170 connman_info("\ttarget %s", target->u.user.name);
1174 if(xt_t->print != NULL) {
1175 connman_info("\ttarget ");
1176 xt_t->print(NULL, target, 1);
1181 static void dump_match(struct ipt_entry *entry)
1183 struct xtables_match *xt_m;
1184 struct xt_entry_match *match;
1186 if (entry->elems == (unsigned char *)entry + entry->target_offset)
1189 match = (struct xt_entry_match *) entry->elems;
1191 if (!strlen(match->u.user.name))
1194 xt_m = xtables_find_match(match->u.user.name, XTF_TRY_LOAD, NULL);
1198 if(xt_m->print != NULL) {
1199 connman_info("\tmatch ");
1200 xt_m->print(NULL, match, 1);
1206 connman_info("\tmatch %s", match->u.user.name);
1210 static int dump_entry(struct connman_iptables *table,
1211 struct ipt_entry *entry, int builtin,
1212 unsigned int hook, unsigned int offset,
1215 struct xt_entry_target *target;
1217 target = ipt_get_target(entry);
1219 if (entry_to_offset(table, entry) + entry->next_offset ==
1220 table->blob_entries->size) {
1221 connman_info("End of CHAIN 0x%x", offset);
1225 if (!strcmp(target->u.user.name, IPT_ERROR_TARGET)) {
1226 connman_info("USER CHAIN (%s) %p match %p target %p size %d",
1227 target->data, entry, entry->elems,
1228 (char *)entry + entry->target_offset,
1229 entry->next_offset);
1232 } else if (builtin >= 0) {
1233 connman_info("CHAIN (%s) %p match %p target %p size %d",
1234 hooknames[builtin], entry, entry->elems,
1235 (char *)entry + entry->target_offset,
1236 entry->next_offset);
1238 connman_info("RULE %p match %p target %p size %d", entry,
1240 (char *)entry + entry->target_offset,
1241 entry->next_offset);
1251 static void iptables_dump(struct connman_iptables *table)
1253 connman_info("%s valid_hooks=0x%08x, num_entries=%u, size=%u",
1255 table->info->valid_hooks, table->info->num_entries,
1258 iterate_entries(table, table->blob_entries->entrytable,
1259 table->info->valid_hooks,
1260 table->info->hook_entry,
1261 table->blob_entries->size,
1266 static int iptables_get_entries(struct connman_iptables *table)
1268 socklen_t entry_size;
1270 entry_size = sizeof(struct ipt_get_entries) + table->info->size;
1272 return getsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_GET_ENTRIES,
1273 table->blob_entries, &entry_size);
1276 static int iptables_replace(struct connman_iptables *table,
1277 struct ipt_replace *r)
1279 return setsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_SET_REPLACE, r,
1280 sizeof(*r) + r->size);
1283 static int add_entry(struct connman_iptables *table, struct ipt_entry *entry,
1284 int builtin, unsigned int hook, unsigned offset,
1287 struct ipt_entry *new_entry;
1289 new_entry = g_try_malloc0(entry->next_offset);
1290 if (new_entry == NULL)
1293 memcpy(new_entry, entry, entry->next_offset);
1295 return iptables_add_entry(table, new_entry, NULL, builtin);
1298 static void table_cleanup(struct connman_iptables *table)
1301 struct connman_iptables_entry *entry;
1306 if (table->ipt_sock >= 0)
1307 close(table->ipt_sock);
1309 for (list = table->entries; list; list = list->next) {
1312 g_free(entry->entry);
1316 g_list_free(table->entries);
1317 g_free(table->info);
1318 g_free(table->blob_entries);
1322 static struct connman_iptables *iptables_init(const char *table_name)
1324 struct connman_iptables *table = NULL;
1325 char *module = NULL;
1328 if (table_name == NULL)
1329 table_name = "filter";
1331 DBG("%s", table_name);
1333 if (xtables_insmod("ip_tables", NULL, TRUE) != 0)
1334 DBG("ip_tables module loading gives error but trying anyway");
1336 module = g_strconcat("iptable_", table_name, NULL);
1340 if (xtables_insmod(module, NULL, TRUE) != 0)
1341 DBG("%s module loading gives error but trying anyway", module);
1345 table = g_hash_table_lookup(table_hash, table_name);
1349 table = g_try_new0(struct connman_iptables, 1);
1353 table->info = g_try_new0(struct ipt_getinfo, 1);
1354 if (table->info == NULL)
1357 table->ipt_sock = socket(AF_INET, SOCK_RAW | SOCK_CLOEXEC, IPPROTO_RAW);
1358 if (table->ipt_sock < 0)
1361 s = sizeof(*table->info);
1362 strcpy(table->info->name, table_name);
1363 if (getsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_GET_INFO,
1364 table->info, &s) < 0) {
1365 connman_error("iptables support missing error %d (%s)", errno,
1370 table->blob_entries = g_try_malloc0(sizeof(struct ipt_get_entries) +
1372 if (table->blob_entries == NULL)
1375 strcpy(table->blob_entries->name, table_name);
1376 table->blob_entries->size = table->info->size;
1378 if (iptables_get_entries(table) < 0)
1381 table->num_entries = 0;
1382 table->old_entries = table->info->num_entries;
1385 memcpy(table->underflow, table->info->underflow,
1386 sizeof(table->info->underflow));
1387 memcpy(table->hook_entry, table->info->hook_entry,
1388 sizeof(table->info->hook_entry));
1390 iterate_entries(table, table->blob_entries->entrytable,
1391 table->info->valid_hooks, table->info->hook_entry,
1392 table->blob_entries->size, add_entry, NULL);
1394 g_hash_table_insert(table_hash, g_strdup(table_name), table);
1399 table_cleanup(table);
1404 static struct option iptables_opts[] = {
1405 {.name = "append", .has_arg = 1, .val = 'A'},
1406 {.name = "compare", .has_arg = 1, .val = 'C'},
1407 {.name = "delete", .has_arg = 1, .val = 'D'},
1408 {.name = "flush-chain", .has_arg = 1, .val = 'F'},
1409 {.name = "insert", .has_arg = 1, .val = 'I'},
1410 {.name = "list", .has_arg = 2, .val = 'L'},
1411 {.name = "new-chain", .has_arg = 1, .val = 'N'},
1412 {.name = "policy", .has_arg = 1, .val = 'P'},
1413 {.name = "delete-chain", .has_arg = 1, .val = 'X'},
1414 {.name = "destination", .has_arg = 1, .val = 'd'},
1415 {.name = "in-interface", .has_arg = 1, .val = 'i'},
1416 {.name = "jump", .has_arg = 1, .val = 'j'},
1417 {.name = "match", .has_arg = 1, .val = 'm'},
1418 {.name = "out-interface", .has_arg = 1, .val = 'o'},
1419 {.name = "source", .has_arg = 1, .val = 's'},
1420 {.name = "table", .has_arg = 1, .val = 't'},
1424 struct xtables_globals iptables_globals = {
1426 .opts = iptables_opts,
1427 .orig_opts = iptables_opts,
1430 static struct xtables_target *prepare_target(struct connman_iptables *table,
1431 const char *target_name)
1433 struct xtables_target *xt_t = NULL;
1434 gboolean is_builtin, is_user_defined;
1435 GList *chain_head = NULL;
1439 is_user_defined = FALSE;
1441 if (is_builtin_target(target_name))
1444 chain_head = find_chain_head(table, target_name);
1445 if (chain_head != NULL && chain_head->next != NULL)
1446 is_user_defined = TRUE;
1449 if (is_builtin || is_user_defined)
1450 xt_t = xtables_find_target(IPT_STANDARD_TARGET,
1451 XTF_LOAD_MUST_SUCCEED);
1453 xt_t = xtables_find_target(target_name, XTF_TRY_LOAD);
1458 target_size = ALIGN(sizeof(struct ipt_entry_target)) + xt_t->size;
1460 xt_t->t = g_try_malloc0(target_size);
1461 if (xt_t->t == NULL)
1464 xt_t->t->u.target_size = target_size;
1466 if (is_builtin || is_user_defined) {
1467 struct xt_standard_target *target;
1469 target = (struct xt_standard_target *)(xt_t->t);
1470 strcpy(target->target.u.user.name, IPT_STANDARD_TARGET);
1472 if (is_builtin == TRUE)
1473 target->verdict = target_to_verdict(target_name);
1474 else if (is_user_defined == TRUE) {
1475 struct connman_iptables_entry *target_rule;
1477 if (chain_head == NULL) {
1482 target_rule = chain_head->next->data;
1483 target->verdict = target_rule->offset;
1486 strcpy(xt_t->t->u.user.name, target_name);
1487 xt_t->t->u.user.revision = xt_t->revision;
1488 if (xt_t->init != NULL)
1489 xt_t->init(xt_t->t);
1492 #if XTABLES_VERSION_CODE > 5
1493 if (xt_t->x6_options != NULL)
1494 iptables_globals.opts =
1495 xtables_options_xfrm(
1496 iptables_globals.orig_opts,
1497 iptables_globals.opts,
1499 &xt_t->option_offset);
1502 iptables_globals.opts =
1503 xtables_merge_options(
1504 #if XTABLES_VERSION_CODE > 5
1505 iptables_globals.orig_opts,
1507 iptables_globals.opts,
1509 &xt_t->option_offset);
1511 if (iptables_globals.opts == NULL) {
1519 static struct xtables_match *prepare_matches(struct connman_iptables *table,
1520 struct xtables_rule_match **xt_rm,
1521 const char *match_name)
1523 struct xtables_match *xt_m;
1526 if (match_name == NULL)
1529 xt_m = xtables_find_match(match_name, XTF_LOAD_MUST_SUCCEED, xt_rm);
1530 match_size = ALIGN(sizeof(struct ipt_entry_match)) + xt_m->size;
1532 xt_m->m = g_try_malloc0(match_size);
1533 if (xt_m->m == NULL)
1536 xt_m->m->u.match_size = match_size;
1537 strcpy(xt_m->m->u.user.name, xt_m->name);
1538 xt_m->m->u.user.revision = xt_m->revision;
1540 if (xt_m->init != NULL)
1541 xt_m->init(xt_m->m);
1543 if (xt_m == xt_m->next)
1546 #if XTABLES_VERSION_CODE > 5
1547 if (xt_m->x6_options != NULL)
1548 iptables_globals.opts =
1549 xtables_options_xfrm(
1550 iptables_globals.orig_opts,
1551 iptables_globals.opts,
1553 &xt_m->option_offset);
1556 iptables_globals.opts =
1557 xtables_merge_options(
1558 #if XTABLES_VERSION_CODE > 5
1559 iptables_globals.orig_opts,
1561 iptables_globals.opts,
1563 &xt_m->option_offset);
1565 if (iptables_globals.opts == NULL) {
1574 static int parse_ip_and_mask(const char *str, struct in_addr *ip, struct in_addr *mask)
1577 uint32_t prefixlength;
1581 tokens = g_strsplit(str, "/", 2);
1585 if (!inet_pton(AF_INET, tokens[0], ip)) {
1590 if (tokens[1] != NULL) {
1591 prefixlength = strtol(tokens[1], NULL, 10);
1592 if (prefixlength > 31) {
1597 tmp = ~(0xffffffff >> prefixlength);
1602 mask->s_addr = htonl(tmp);
1603 ip->s_addr = ip->s_addr & mask->s_addr;
1611 static struct connman_iptables *pre_load_table(const char *table_name,
1612 struct connman_iptables *table)
1617 return iptables_init(table_name);
1620 static void clear_tables_flags(void)
1622 struct xtables_match *xt_m;
1623 struct xtables_target *xt_t;
1626 * Clear all flags because the flags are only valid
1629 for (xt_m = xtables_matches; xt_m != NULL; xt_m = xt_m->next)
1632 for (xt_t = xtables_targets; xt_t != NULL; xt_t = xt_t->next) {
1638 static int iptables_command(int argc, char *argv[])
1640 struct connman_iptables *table;
1641 struct xtables_rule_match *xt_rm, *tmp_xt_rm;
1642 struct xtables_match *xt_m, *xt_m_t;
1643 struct xtables_target *xt_t;
1645 char *table_name, *chain, *new_chain, *match_name, *target_name;
1646 char *flush_chain, *delete_chain, *policy;
1647 int c, ret, in_len, out_len;
1648 gboolean dump, invert, insert, delete, compare;
1658 chain = new_chain = match_name = target_name = NULL;
1659 flush_chain = delete_chain = policy = table_name = NULL;
1660 memset(&ip, 0, sizeof(struct ipt_ip));
1665 /* Default code for options parsing */
1668 clear_tables_flags();
1670 /* extension's options will generate false-positives errors */
1675 while ((c = getopt_long(argc, argv,
1676 "-A:C:D:F:I:L::N:P:X:d:j:i:m:o:s:t:",
1677 iptables_globals.opts, NULL)) != -1) {
1680 /* It is either -A, -C, -D or -I at once */
1688 /* It is either -A, -C, -D or -I at once */
1697 /* It is either -A, -C, -D or -I at once */
1706 flush_chain = optarg;
1710 /* It is either -A, -C, -D or -I at once */
1729 policy = argv[optind++];
1736 delete_chain = optarg;
1740 if (!parse_ip_and_mask(optarg, &ip.dst, &ip.dmsk))
1744 ip.invflags |= IPT_INV_DSTIP;
1749 in_len = strlen(optarg);
1751 if (in_len + 1 > IFNAMSIZ)
1754 strcpy(ip.iniface, optarg);
1755 memset(ip.iniface_mask, 0xff, in_len + 1);
1758 ip.invflags |= IPT_INV_VIA_IN;
1763 target_name = optarg;
1765 table = pre_load_table(table_name, table);
1769 xt_t = prepare_target(table, target_name);
1776 match_name = optarg;
1778 table = pre_load_table(table_name, table);
1782 xt_m = prepare_matches(table, &xt_rm, match_name);
1789 out_len = strlen(optarg);
1791 if (out_len + 1 > IFNAMSIZ)
1794 strcpy(ip.outiface, optarg);
1795 memset(ip.outiface_mask, 0xff, out_len + 1);
1798 ip.invflags |= IPT_INV_VIA_OUT;
1803 if (!parse_ip_and_mask(optarg, &ip.src, &ip.smsk))
1807 ip.invflags |= IPT_INV_SRCIP;
1812 table_name = optarg;
1814 table = pre_load_table(table_name, table);
1821 if (optarg[0] == '!' && optarg[1] == '\0') {
1827 connman_error("Invalid option");
1832 #if XTABLES_VERSION_CODE > 5
1833 if (xt_t != NULL && (xt_t->x6_parse != NULL ||
1834 xt_t->parse != NULL) &&
1835 (c >= (int) xt_t->option_offset &&
1836 c < (int) xt_t->option_offset +
1837 XT_OPTION_OFFSET_SCALE)) {
1838 xtables_option_tpcall(c, argv,
1839 invert, xt_t, NULL);
1844 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1845 tmp_xt_rm = tmp_xt_rm->next) {
1846 xt_m_t = tmp_xt_rm->match;
1848 if (tmp_xt_rm->completed ||
1849 (xt_m_t->x6_parse == NULL &&
1850 xt_m_t->parse == NULL))
1853 if (c < (int) xt_m_t->option_offset ||
1854 c >= (int) xt_m_t->option_offset
1855 + XT_OPTION_OFFSET_SCALE)
1858 xtables_option_mpcall(c, argv,
1859 invert, xt_m_t, NULL);
1864 if (xt_t == NULL || xt_t->parse == NULL ||
1865 !xt_t->parse(c - xt_t->option_offset,
1866 argv, invert, &xt_t->tflags, NULL, &xt_t->t)) {
1868 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1869 tmp_xt_rm = tmp_xt_rm->next) {
1870 xt_m_t = tmp_xt_rm->match;
1872 if (tmp_xt_rm->completed ||
1873 xt_m_t->parse == NULL)
1876 if (xt_m->parse(c - xt_m->option_offset,
1877 argv, invert, &xt_m->mflags,
1889 #if XTABLES_VERSION_CODE > 5
1890 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1891 tmp_xt_rm = tmp_xt_rm->next)
1892 xtables_option_mfcall(tmp_xt_rm->match);
1895 xtables_option_tfcall(xt_t);
1897 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1898 tmp_xt_rm = tmp_xt_rm->next)
1899 if (tmp_xt_rm->match->final_check != NULL)
1900 tmp_xt_rm->match->final_check(
1901 tmp_xt_rm->match->mflags);
1903 if (xt_t != NULL && xt_t->final_check != NULL)
1904 xt_t->final_check(xt_t->tflags);
1907 table = pre_load_table(table_name, table);
1911 /* Option parsing went fine, falling back to succes code */
1914 if (delete_chain != NULL) {
1915 printf("Delete chain %s\n", delete_chain);
1917 iptables_delete_chain(table, delete_chain);
1923 iptables_dump(table);
1929 DBG("Flush chain %s", flush_chain);
1931 iptables_flush_chain(table, flush_chain);
1936 if (chain && new_chain) {
1942 DBG("New chain %s", new_chain);
1944 ret = iptables_add_chain(table, new_chain);
1949 if (policy != NULL) {
1950 printf("Changing policy of %s to %s\n", chain, policy);
1952 iptables_change_policy(table, chain, policy);
1960 if (compare == TRUE) {
1961 ret = iptables_compare_rule(table, &ip, chain,
1962 target_name, xt_t, xt_m, xt_rm);
1966 if (delete == TRUE) {
1967 DBG("Deleting %s to %s (match %s)\n",
1968 target_name, chain, match_name);
1970 ret = iptables_delete_rule(table, &ip, chain,
1971 target_name, xt_t, xt_m, xt_rm);
1976 if (insert == TRUE) {
1977 DBG("Inserting %s to %s (match %s)",
1978 target_name, chain, match_name);
1980 ret = iptables_insert_rule(table, &ip, chain,
1981 target_name, xt_t, xt_rm);
1985 DBG("Adding %s to %s (match %s)",
1986 target_name, chain, match_name);
1988 ret = iptables_append_rule(table, &ip, chain,
1989 target_name, xt_t, xt_rm);
2005 int __connman_iptables_command(const char *format, ...)
2007 char **argv, **arguments, *command;
2014 va_start(args, format);
2016 command = g_strdup_vprintf(format, args);
2020 if (command == NULL)
2023 arguments = g_strsplit_set(command, " ", -1);
2025 for (argc = 0; arguments[argc]; argc++);
2028 DBG("command %s argc %d", command, argc);
2030 argv = g_try_malloc0(argc * sizeof(char *));
2033 g_strfreev(arguments);
2037 argv[0] = "iptables";
2038 for (i = 1; i < argc; i++)
2039 argv[i] = arguments[i - 1];
2041 ret = iptables_command(argc, argv);
2044 g_strfreev(arguments);
2051 int __connman_iptables_commit(const char *table_name)
2053 struct connman_iptables *table;
2054 struct ipt_replace *repl;
2057 DBG("%s", table_name);
2059 table = g_hash_table_lookup(table_hash, table_name);
2063 repl = iptables_blob(table);
2065 err = iptables_replace(table, repl);
2067 g_free(repl->counters);
2073 g_hash_table_remove(table_hash, table_name);
2078 static void remove_table(gpointer user_data)
2080 struct connman_iptables *table = user_data;
2082 table_cleanup(table);
2085 int __connman_iptables_init(void)
2089 table_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
2090 g_free, remove_table);
2092 xtables_init_all(&iptables_globals, NFPROTO_IPV4);
2098 void __connman_iptables_cleanup(void)
2102 g_hash_table_destroy(table_hash);
2104 xtables_free_opts(1);