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 /* fn returns 0 to continue iteration */
146 #define _XT_ENTRY_ITERATE_CONTINUE(type, entries, size, n, fn, args...) \
153 for (__i = 0, __n = 0; __i < (size); \
154 __i += __entry->next_offset, __n++) { \
155 __entry = (void *)(entries) + __i; \
159 __ret = fn(__entry, ## args); \
166 /* fn returns 0 to continue iteration */
167 #define _XT_ENTRY_ITERATE(type, entries, size, fn, args...) \
168 _XT_ENTRY_ITERATE_CONTINUE(type, entries, size, 0, fn, args)
170 #define ENTRY_ITERATE(entries, size, fn, args...) \
171 _XT_ENTRY_ITERATE(struct ipt_entry, entries, size, fn, ## args)
173 #define MIN_ALIGN (__alignof__(struct ipt_entry))
175 #define ALIGN(s) (((s) + ((MIN_ALIGN)-1)) & ~((MIN_ALIGN)-1))
177 struct error_target {
178 struct xt_entry_target t;
179 char error[IPT_TABLE_MAXNAMELEN];
182 struct connman_iptables_entry {
186 struct ipt_entry *entry;
189 struct connman_iptables {
192 struct ipt_getinfo *info;
193 struct ipt_get_entries *blob_entries;
195 unsigned int num_entries;
196 unsigned int old_entries;
199 unsigned int underflow[NF_INET_NUMHOOKS];
200 unsigned int hook_entry[NF_INET_NUMHOOKS];
205 static GHashTable *table_hash = NULL;
207 static struct ipt_entry *get_entry(struct connman_iptables *table,
210 return (struct ipt_entry *)((char *)table->blob_entries->entrytable +
214 static int is_hook_entry(struct connman_iptables *table,
215 struct ipt_entry *entry)
219 for (i = 0; i < NF_INET_NUMHOOKS; i++) {
220 if ((table->info->valid_hooks & (1 << i))
221 && get_entry(table, table->info->hook_entry[i]) == entry)
228 static unsigned long entry_to_offset(struct connman_iptables *table,
229 struct ipt_entry *entry)
231 return (void *)entry - (void *)table->blob_entries->entrytable;
234 static int target_to_verdict(char *target_name)
236 if (!strcmp(target_name, LABEL_ACCEPT))
237 return -NF_ACCEPT - 1;
239 if (!strcmp(target_name, LABEL_DROP))
242 if (!strcmp(target_name, LABEL_QUEUE))
243 return -NF_QUEUE - 1;
245 if (!strcmp(target_name, LABEL_RETURN))
251 static gboolean is_builtin_target(char *target_name)
253 if (!strcmp(target_name, LABEL_ACCEPT) ||
254 !strcmp(target_name, LABEL_DROP) ||
255 !strcmp(target_name, LABEL_QUEUE) ||
256 !strcmp(target_name, LABEL_RETURN))
262 static gboolean is_jump(struct connman_iptables_entry *e)
264 struct xt_entry_target *target;
266 target = ipt_get_target(e->entry);
268 if (!strcmp(target->u.user.name, IPT_STANDARD_TARGET)) {
269 struct xt_standard_target *t;
271 t = (struct xt_standard_target *)target;
273 switch (t->verdict) {
289 static gboolean is_chain(struct connman_iptables *table,
290 struct connman_iptables_entry *e)
292 struct ipt_entry *entry;
293 struct xt_entry_target *target;
299 target = ipt_get_target(entry);
300 if (!strcmp(target->u.user.name, IPT_ERROR_TARGET))
306 static GList *find_chain_head(struct connman_iptables *table,
310 struct connman_iptables_entry *head;
311 struct ipt_entry *entry;
312 struct xt_entry_target *target;
315 for (list = table->entries; list; list = list->next) {
320 builtin = head->builtin;
321 if (builtin >= 0 && !strcmp(hooknames[builtin], chain_name))
324 /* User defined chain */
325 target = ipt_get_target(entry);
326 if (!strcmp(target->u.user.name, IPT_ERROR_TARGET) &&
327 !strcmp((char *)target->data, chain_name))
334 static GList *find_chain_tail(struct connman_iptables *table,
337 struct connman_iptables_entry *tail;
338 GList *chain_head, *list;
340 chain_head = find_chain_head(table, chain_name);
341 if (chain_head == NULL)
344 /* Then we look for the next chain */
345 for (list = chain_head->next; list; list = list->next) {
348 if (is_chain(table, tail))
352 /* Nothing found, we return the table end */
353 return g_list_last(table->entries);
357 static void update_offsets(struct connman_iptables *table)
360 struct connman_iptables_entry *entry, *prev_entry;
362 for (list = table->entries; list; list = list->next) {
365 if (list == table->entries) {
372 prev_entry = prev->data;
374 entry->offset = prev_entry->offset +
375 prev_entry->entry->next_offset;
379 static void update_targets_reference(struct connman_iptables *table,
380 struct connman_iptables_entry *entry_before,
381 struct connman_iptables_entry *modified_entry,
382 gboolean is_removing)
384 struct connman_iptables_entry *tmp;
385 struct xt_standard_target *t;
389 offset = modified_entry->entry->next_offset;
391 for (list = table->entries; list; list = list->next) {
397 t = (struct xt_standard_target *)ipt_get_target(tmp->entry);
399 if (is_removing == TRUE) {
400 if (t->verdict >= entry_before->offset)
401 t->verdict -= offset;
403 if (t->verdict > entry_before->offset)
404 t->verdict += offset;
409 static int iptables_add_entry(struct connman_iptables *table,
410 struct ipt_entry *entry, GList *before,
413 struct connman_iptables_entry *e, *entry_before;
418 e = g_try_malloc0(sizeof(struct connman_iptables_entry));
423 e->builtin = builtin;
425 table->entries = g_list_insert_before(table->entries, before, e);
426 table->num_entries++;
427 table->size += entry->next_offset;
429 if (before == NULL) {
430 e->offset = table->size - entry->next_offset;
435 entry_before = before->data;
438 * We've just appended/insterted a new entry. All references
439 * should be bumped accordingly.
441 update_targets_reference(table, entry_before, e, FALSE);
443 update_offsets(table);
448 static int remove_table_entry(struct connman_iptables *table,
449 struct connman_iptables_entry *entry)
453 table->num_entries--;
454 table->size -= entry->entry->next_offset;
455 removed = entry->entry->next_offset;
457 g_free(entry->entry);
459 table->entries = g_list_remove(table->entries, entry);
464 static int iptables_flush_chain(struct connman_iptables *table,
467 GList *chain_head, *chain_tail, *list, *next;
468 struct connman_iptables_entry *entry;
469 int builtin, removed = 0;
471 chain_head = find_chain_head(table, name);
472 if (chain_head == NULL)
475 chain_tail = find_chain_tail(table, name);
476 if (chain_tail == NULL)
479 entry = chain_head->data;
480 builtin = entry->builtin;
485 list = chain_head->next;
487 if (list == chain_tail->prev)
490 while (list != chain_tail->prev) {
492 next = g_list_next(list);
494 removed += remove_table_entry(table, entry);
500 struct connman_iptables_entry *e;
504 entry->builtin = builtin;
506 table->underflow[builtin] -= removed;
508 for (list = chain_tail; list; list = list->next) {
511 builtin = e->builtin;
515 table->hook_entry[builtin] -= removed;
516 table->underflow[builtin] -= removed;
520 update_offsets(table);
525 static int iptables_add_chain(struct connman_iptables *table,
529 struct ipt_entry *entry_head;
530 struct ipt_entry *entry_return;
531 struct error_target *error;
532 struct ipt_standard_target *standard;
533 u_int16_t entry_head_size, entry_return_size;
535 last = g_list_last(table->entries);
538 * An empty chain is composed of:
539 * - A head entry, with no match and an error target.
540 * The error target data is the chain name.
541 * - A tail entry, with no match and a standard target.
542 * The standard target verdict is XT_RETURN (return to the
547 entry_head_size = sizeof(struct ipt_entry) +
548 sizeof(struct error_target);
549 entry_head = g_try_malloc0(entry_head_size);
550 if (entry_head == NULL)
553 memset(entry_head, 0, entry_head_size);
555 entry_head->target_offset = sizeof(struct ipt_entry);
556 entry_head->next_offset = entry_head_size;
558 error = (struct error_target *) entry_head->elems;
559 strcpy(error->t.u.user.name, IPT_ERROR_TARGET);
560 error->t.u.user.target_size = ALIGN(sizeof(struct error_target));
561 strcpy(error->error, name);
563 if (iptables_add_entry(table, entry_head, last, -1) < 0)
567 entry_return_size = sizeof(struct ipt_entry) +
568 sizeof(struct ipt_standard_target);
569 entry_return = g_try_malloc0(entry_return_size);
570 if (entry_return == NULL)
573 memset(entry_return, 0, entry_return_size);
575 entry_return->target_offset = sizeof(struct ipt_entry);
576 entry_return->next_offset = entry_return_size;
578 standard = (struct ipt_standard_target *) entry_return->elems;
579 standard->target.u.user.target_size =
580 ALIGN(sizeof(struct ipt_standard_target));
581 standard->verdict = XT_RETURN;
583 if (iptables_add_entry(table, entry_return, last, -1) < 0)
589 g_free(entry_return);
596 static int iptables_delete_chain(struct connman_iptables *table, char *name)
598 struct connman_iptables_entry *entry;
599 GList *chain_head, *chain_tail;
601 chain_head = find_chain_head(table, name);
602 if (chain_head == NULL)
605 entry = chain_head->data;
607 /* We cannot remove builtin chain */
608 if (entry->builtin >= 0)
611 chain_tail = find_chain_tail(table, name);
612 if (chain_tail == NULL)
615 /* Chain must be flushed */
616 if (chain_head->next != chain_tail->prev)
619 remove_table_entry(table, entry);
621 entry = chain_tail->prev->data;
622 remove_table_entry(table, entry);
624 update_offsets(table);
629 static struct ipt_entry *new_rule(struct ipt_ip *ip,
630 char *target_name, struct xtables_target *xt_t,
631 struct xtables_rule_match *xt_rm)
633 struct xtables_rule_match *tmp_xt_rm;
634 struct ipt_entry *new_entry;
635 size_t match_size, target_size;
638 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL; tmp_xt_rm = tmp_xt_rm->next)
639 match_size += tmp_xt_rm->match->m->u.match_size;
642 target_size = ALIGN(xt_t->t->u.target_size);
644 target_size = ALIGN(sizeof(struct xt_standard_target));
646 new_entry = g_try_malloc0(sizeof(struct ipt_entry) + target_size +
648 if (new_entry == NULL)
651 memcpy(&new_entry->ip, ip, sizeof(struct ipt_ip));
653 new_entry->target_offset = sizeof(struct ipt_entry) + match_size;
654 new_entry->next_offset = sizeof(struct ipt_entry) + target_size +
658 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
659 tmp_xt_rm = tmp_xt_rm->next) {
660 memcpy(new_entry->elems + match_size, tmp_xt_rm->match->m,
661 tmp_xt_rm->match->m->u.match_size);
662 match_size += tmp_xt_rm->match->m->u.match_size;
666 struct xt_entry_target *entry_target;
668 entry_target = ipt_get_target(new_entry);
669 memcpy(entry_target, xt_t->t, target_size);
675 static void update_hooks(struct connman_iptables *table, GList *chain_head,
676 struct ipt_entry *entry)
679 struct connman_iptables_entry *head, *e;
682 if (chain_head == NULL)
685 head = chain_head->data;
687 builtin = head->builtin;
691 table->underflow[builtin] += entry->next_offset;
693 for (list = chain_head->next; list; list = list->next) {
696 builtin = e->builtin;
700 table->hook_entry[builtin] += entry->next_offset;
701 table->underflow[builtin] += entry->next_offset;
705 static struct ipt_entry *prepare_rule_inclusion(struct connman_iptables *table,
706 struct ipt_ip *ip, char *chain_name,
707 char *target_name, struct xtables_target *xt_t,
708 int *builtin, struct xtables_rule_match *xt_rm)
710 GList *chain_tail, *chain_head;
711 struct ipt_entry *new_entry;
712 struct connman_iptables_entry *head;
714 chain_head = find_chain_head(table, chain_name);
715 if (chain_head == NULL)
718 chain_tail = find_chain_tail(table, chain_name);
719 if (chain_tail == NULL)
722 new_entry = new_rule(ip, target_name, xt_t, xt_rm);
723 if (new_entry == NULL)
726 update_hooks(table, chain_head, new_entry);
729 * If the chain is builtin, and does not have any rule,
730 * then the one that we're inserting is becoming the head
731 * and thus needs the builtin flag.
733 head = chain_head->data;
734 if (head->builtin < 0)
736 else if (chain_head == chain_tail->prev) {
737 *builtin = head->builtin;
744 static int iptables_append_rule(struct connman_iptables *table,
745 struct ipt_ip *ip, char *chain_name,
746 char *target_name, struct xtables_target *xt_t,
747 struct xtables_rule_match *xt_rm)
750 struct ipt_entry *new_entry;
751 int builtin = -1, ret;
755 chain_tail = find_chain_tail(table, chain_name);
756 if (chain_tail == NULL)
759 new_entry = prepare_rule_inclusion(table, ip, chain_name,
760 target_name, xt_t, &builtin, xt_rm);
761 if (new_entry == NULL)
764 ret = iptables_add_entry(table, new_entry, chain_tail->prev, builtin);
771 static int iptables_insert_rule(struct connman_iptables *table,
772 struct ipt_ip *ip, char *chain_name,
773 char *target_name, struct xtables_target *xt_t,
774 struct xtables_rule_match *xt_rm)
776 struct ipt_entry *new_entry;
777 int builtin = -1, ret;
780 chain_head = find_chain_head(table, chain_name);
781 if (chain_head == NULL)
784 new_entry = prepare_rule_inclusion(table, ip, chain_name,
785 target_name, xt_t, &builtin, xt_rm);
786 if (new_entry == NULL)
790 chain_head = chain_head->next;
792 ret = iptables_add_entry(table, new_entry, chain_head, builtin);
799 static gboolean is_same_ipt_entry(struct ipt_entry *i_e1,
800 struct ipt_entry *i_e2)
802 if (memcmp(&i_e1->ip, &i_e2->ip, sizeof(struct ipt_ip)) != 0)
805 if (i_e1->target_offset != i_e2->target_offset)
808 if (i_e1->next_offset != i_e2->next_offset)
814 static gboolean is_same_target(struct xt_entry_target *xt_e_t1,
815 struct xt_entry_target *xt_e_t2)
817 if (xt_e_t1 == NULL || xt_e_t2 == NULL)
820 if (strcmp(xt_e_t1->u.user.name, IPT_STANDARD_TARGET) == 0) {
821 struct xt_standard_target *xt_s_t1;
822 struct xt_standard_target *xt_s_t2;
824 xt_s_t1 = (struct xt_standard_target *) xt_e_t1;
825 xt_s_t2 = (struct xt_standard_target *) xt_e_t2;
827 if (xt_s_t1->verdict != xt_s_t2->verdict)
830 if (xt_e_t1->u.target_size != xt_e_t2->u.target_size)
833 if (strcmp(xt_e_t1->u.user.name, xt_e_t2->u.user.name) != 0)
840 static gboolean is_same_match(struct xt_entry_match *xt_e_m1,
841 struct xt_entry_match *xt_e_m2)
843 if (xt_e_m1 == NULL || xt_e_m2 == NULL)
846 if (xt_e_m1->u.match_size != xt_e_m2->u.match_size)
849 if (xt_e_m1->u.user.revision != xt_e_m2->u.user.revision)
852 if (strcmp(xt_e_m1->u.user.name, xt_e_m2->u.user.name) != 0)
858 static GList *find_existing_rule(struct connman_iptables *table,
859 struct ipt_ip *ip, char *chain_name,
860 char *target_name, struct xtables_target *xt_t,
861 struct xtables_match *xt_m,
862 struct xtables_rule_match *xt_rm)
864 GList *chain_tail, *chain_head, *list;
865 struct xt_entry_target *xt_e_t = NULL;
866 struct xt_entry_match *xt_e_m = NULL;
867 struct connman_iptables_entry *entry;
868 struct ipt_entry *entry_test;
871 chain_head = find_chain_head(table, chain_name);
872 if (chain_head == NULL)
875 chain_tail = find_chain_tail(table, chain_name);
876 if (chain_tail == NULL)
882 entry_test = new_rule(ip, target_name, xt_t, xt_rm);
883 if (entry_test == NULL)
887 xt_e_t = ipt_get_target(entry_test);
889 xt_e_m = (struct xt_entry_match *)entry_test->elems;
891 entry = chain_head->data;
892 builtin = entry->builtin;
897 list = chain_head->next;
899 for (; list != chain_tail->prev; list = list->next) {
900 struct connman_iptables_entry *tmp;
901 struct ipt_entry *tmp_e;
906 if (is_same_ipt_entry(entry_test, tmp_e) == FALSE)
910 struct xt_entry_target *tmp_xt_e_t;
912 tmp_xt_e_t = ipt_get_target(tmp_e);
914 if (!is_same_target(tmp_xt_e_t, xt_e_t))
919 struct xt_entry_match *tmp_xt_e_m;
921 tmp_xt_e_m = (struct xt_entry_match *)tmp_e->elems;
923 if (!is_same_match(tmp_xt_e_m, xt_e_m))
932 if (list != chain_tail->prev)
938 static int iptables_delete_rule(struct connman_iptables *table,
939 struct ipt_ip *ip, char *chain_name,
940 char *target_name, struct xtables_target *xt_t,
941 struct xtables_match *xt_m,
942 struct xtables_rule_match *xt_rm)
944 struct connman_iptables_entry *entry;
945 GList *chain_tail, *list;
946 int builtin, removed;
950 chain_tail = find_chain_tail(table, chain_name);
951 if (chain_tail == NULL)
954 list = find_existing_rule(table, ip, chain_name, target_name,
963 builtin = entry->builtin;
965 /* We have deleted a rule,
966 * all references should be bumped accordingly */
967 if (list->next != NULL)
968 update_targets_reference(table, list->next->data,
971 removed += remove_table_entry(table, entry);
977 entry->builtin = builtin;
980 table->underflow[builtin] -= removed;
981 for (list = chain_tail; list; list = list->next) {
984 builtin = entry->builtin;
988 table->hook_entry[builtin] -= removed;
989 table->underflow[builtin] -= removed;
993 update_offsets(table);
998 static int iptables_compare_rule(struct connman_iptables *table,
999 struct ipt_ip *ip, char *chain_name,
1000 char *target_name, struct xtables_target *xt_t,
1001 struct xtables_match *xt_m,
1002 struct xtables_rule_match *xt_rm)
1004 struct connman_iptables_entry *entry;
1007 found = find_existing_rule(table, ip, chain_name, target_name,
1012 entry = found->data;
1020 static int iptables_change_policy(struct connman_iptables *table,
1021 char *chain_name, char *policy)
1024 struct connman_iptables_entry *entry;
1025 struct xt_entry_target *target;
1026 struct xt_standard_target *t;
1029 verdict = target_to_verdict(policy);
1033 chain_head = find_chain_head(table, chain_name);
1034 if (chain_head == NULL)
1037 entry = chain_head->data;
1038 if (entry->builtin < 0)
1041 target = ipt_get_target(entry->entry);
1043 t = (struct xt_standard_target *)target;
1044 t->verdict = verdict;
1049 static struct ipt_replace *iptables_blob(struct connman_iptables *table)
1051 struct ipt_replace *r;
1053 struct connman_iptables_entry *e;
1054 unsigned char *entry_index;
1056 r = g_try_malloc0(sizeof(struct ipt_replace) + table->size);
1060 memset(r, 0, sizeof(*r) + table->size);
1062 r->counters = g_try_malloc0(sizeof(struct xt_counters)
1063 * table->old_entries);
1064 if (r->counters == NULL) {
1069 strcpy(r->name, table->info->name);
1070 r->num_entries = table->num_entries;
1071 r->size = table->size;
1073 r->num_counters = table->old_entries;
1074 r->valid_hooks = table->info->valid_hooks;
1076 memcpy(r->hook_entry, table->hook_entry, sizeof(table->hook_entry));
1077 memcpy(r->underflow, table->underflow, sizeof(table->underflow));
1079 entry_index = (unsigned char *)r->entries;
1080 for (list = table->entries; list; list = list->next) {
1083 memcpy(entry_index, e->entry, e->entry->next_offset);
1084 entry_index += e->entry->next_offset;
1090 static void dump_ip(struct ipt_entry *entry)
1092 struct ipt_ip *ip = &entry->ip;
1093 char ip_string[INET6_ADDRSTRLEN];
1094 char ip_mask[INET6_ADDRSTRLEN];
1096 if (strlen(ip->iniface))
1097 connman_info("\tin %s", ip->iniface);
1099 if (strlen(ip->outiface))
1100 connman_info("\tout %s", ip->outiface);
1102 if (inet_ntop(AF_INET, &ip->src, ip_string, INET6_ADDRSTRLEN) != NULL &&
1103 inet_ntop(AF_INET, &ip->smsk,
1104 ip_mask, INET6_ADDRSTRLEN) != NULL)
1105 connman_info("\tsrc %s/%s", ip_string, ip_mask);
1107 if (inet_ntop(AF_INET, &ip->dst, ip_string, INET6_ADDRSTRLEN) != NULL &&
1108 inet_ntop(AF_INET, &ip->dmsk,
1109 ip_mask, INET6_ADDRSTRLEN) != NULL)
1110 connman_info("\tdst %s/%s", ip_string, ip_mask);
1113 static void dump_target(struct connman_iptables *table,
1114 struct ipt_entry *entry)
1117 struct xtables_target *xt_t;
1118 struct xt_entry_target *target;
1120 target = ipt_get_target(entry);
1122 if (!strcmp(target->u.user.name, IPT_STANDARD_TARGET)) {
1123 struct xt_standard_target *t;
1125 t = (struct xt_standard_target *)target;
1127 switch (t->verdict) {
1129 connman_info("\ttarget RETURN");
1132 case -NF_ACCEPT - 1:
1133 connman_info("\ttarget ACCEPT");
1137 connman_info("\ttarget DROP");
1141 connman_info("\ttarget QUEUE");
1145 connman_info("\ttarget STOP");
1149 connman_info("\tJUMP @%p (0x%x)",
1150 (char*)table->blob_entries->entrytable +
1151 t->verdict, t->verdict);
1155 xt_t = xtables_find_target(IPT_STANDARD_TARGET,
1156 XTF_LOAD_MUST_SUCCEED);
1158 if(xt_t->print != NULL)
1159 xt_t->print(NULL, target, 1);
1161 xt_t = xtables_find_target(target->u.user.name, XTF_TRY_LOAD);
1163 connman_info("\ttarget %s", target->u.user.name);
1167 if(xt_t->print != NULL) {
1168 connman_info("\ttarget ");
1169 xt_t->print(NULL, target, 1);
1174 static void dump_match(struct connman_iptables *table, struct ipt_entry *entry)
1176 struct xtables_match *xt_m;
1177 struct xt_entry_match *match;
1179 if (entry->elems == (unsigned char *)entry + entry->target_offset)
1182 match = (struct xt_entry_match *) entry->elems;
1184 if (!strlen(match->u.user.name))
1187 xt_m = xtables_find_match(match->u.user.name, XTF_TRY_LOAD, NULL);
1191 if(xt_m->print != NULL) {
1192 connman_info("\tmatch ");
1193 xt_m->print(NULL, match, 1);
1199 connman_info("\tmatch %s", match->u.user.name);
1203 static int dump_entry(struct ipt_entry *entry,
1204 struct connman_iptables *table)
1206 struct xt_entry_target *target;
1207 unsigned int offset;
1210 offset = (char *)entry - (char *)table->blob_entries->entrytable;
1211 target = ipt_get_target(entry);
1212 builtin = is_hook_entry(table, entry);
1214 if (entry_to_offset(table, entry) + entry->next_offset ==
1215 table->blob_entries->size) {
1216 connman_info("End of CHAIN 0x%x", offset);
1220 if (!strcmp(target->u.user.name, IPT_ERROR_TARGET)) {
1221 connman_info("USER CHAIN (%s) %p match %p target %p size %d",
1222 target->data, entry, entry->elems,
1223 (char *)entry + entry->target_offset,
1224 entry->next_offset);
1227 } else if (builtin >= 0) {
1228 connman_info("CHAIN (%s) %p match %p target %p size %d",
1229 hooknames[builtin], entry, entry->elems,
1230 (char *)entry + entry->target_offset,
1231 entry->next_offset);
1233 connman_info("RULE %p match %p target %p size %d", entry,
1235 (char *)entry + entry->target_offset,
1236 entry->next_offset);
1239 dump_match(table, entry);
1240 dump_target(table, entry);
1246 static void iptables_dump(struct connman_iptables *table)
1248 connman_info("%s valid_hooks=0x%08x, num_entries=%u, size=%u",
1250 table->info->valid_hooks, table->info->num_entries,
1253 ENTRY_ITERATE(table->blob_entries->entrytable,
1254 table->blob_entries->size,
1259 static int iptables_get_entries(struct connman_iptables *table)
1261 socklen_t entry_size;
1263 entry_size = sizeof(struct ipt_get_entries) + table->info->size;
1265 return getsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_GET_ENTRIES,
1266 table->blob_entries, &entry_size);
1269 static int iptables_replace(struct connman_iptables *table,
1270 struct ipt_replace *r)
1272 return setsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_SET_REPLACE, r,
1273 sizeof(*r) + r->size);
1276 static int add_entry(struct ipt_entry *entry, struct connman_iptables *table)
1278 struct ipt_entry *new_entry;
1281 new_entry = g_try_malloc0(entry->next_offset);
1282 if (new_entry == NULL)
1285 memcpy(new_entry, entry, entry->next_offset);
1287 builtin = is_hook_entry(table, entry);
1289 return iptables_add_entry(table, new_entry, NULL, builtin);
1292 static void table_cleanup(struct connman_iptables *table)
1295 struct connman_iptables_entry *entry;
1300 if (table->ipt_sock >= 0)
1301 close(table->ipt_sock);
1303 for (list = table->entries; list; list = list->next) {
1306 g_free(entry->entry);
1310 g_list_free(table->entries);
1311 g_free(table->info);
1312 g_free(table->blob_entries);
1316 static struct connman_iptables *iptables_init(char *table_name)
1318 struct connman_iptables *table = NULL;
1319 char *module = NULL;
1322 if (table_name == NULL)
1323 table_name = "filter";
1325 DBG("%s", table_name);
1327 if (xtables_insmod("ip_tables", NULL, TRUE) != 0)
1328 DBG("ip_tables module loading gives error but trying anyway");
1330 module = g_strconcat("iptable_", table_name, NULL);
1334 if (xtables_insmod(module, NULL, TRUE) != 0)
1335 DBG("%s module loading gives error but trying anyway", module);
1339 table = g_hash_table_lookup(table_hash, table_name);
1343 table = g_try_new0(struct connman_iptables, 1);
1347 table->info = g_try_new0(struct ipt_getinfo, 1);
1348 if (table->info == NULL)
1351 table->ipt_sock = socket(AF_INET, SOCK_RAW | SOCK_CLOEXEC, IPPROTO_RAW);
1352 if (table->ipt_sock < 0)
1355 s = sizeof(*table->info);
1356 strcpy(table->info->name, table_name);
1357 if (getsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_GET_INFO,
1358 table->info, &s) < 0) {
1359 connman_error("iptables support missing error %d (%s)", errno,
1364 table->blob_entries = g_try_malloc0(sizeof(struct ipt_get_entries) +
1366 if (table->blob_entries == NULL)
1369 strcpy(table->blob_entries->name, table_name);
1370 table->blob_entries->size = table->info->size;
1372 if (iptables_get_entries(table) < 0)
1375 table->num_entries = 0;
1376 table->old_entries = table->info->num_entries;
1379 memcpy(table->underflow, table->info->underflow,
1380 sizeof(table->info->underflow));
1381 memcpy(table->hook_entry, table->info->hook_entry,
1382 sizeof(table->info->hook_entry));
1384 ENTRY_ITERATE(table->blob_entries->entrytable,
1385 table->blob_entries->size,
1388 g_hash_table_insert(table_hash, g_strdup(table_name), table);
1393 table_cleanup(table);
1398 static struct option iptables_opts[] = {
1399 {.name = "append", .has_arg = 1, .val = 'A'},
1400 {.name = "compare", .has_arg = 1, .val = 'C'},
1401 {.name = "delete", .has_arg = 1, .val = 'D'},
1402 {.name = "flush-chain", .has_arg = 1, .val = 'F'},
1403 {.name = "insert", .has_arg = 1, .val = 'I'},
1404 {.name = "list", .has_arg = 2, .val = 'L'},
1405 {.name = "new-chain", .has_arg = 1, .val = 'N'},
1406 {.name = "policy", .has_arg = 1, .val = 'P'},
1407 {.name = "delete-chain", .has_arg = 1, .val = 'X'},
1408 {.name = "destination", .has_arg = 1, .val = 'd'},
1409 {.name = "in-interface", .has_arg = 1, .val = 'i'},
1410 {.name = "jump", .has_arg = 1, .val = 'j'},
1411 {.name = "match", .has_arg = 1, .val = 'm'},
1412 {.name = "out-interface", .has_arg = 1, .val = 'o'},
1413 {.name = "source", .has_arg = 1, .val = 's'},
1414 {.name = "table", .has_arg = 1, .val = 't'},
1418 struct xtables_globals iptables_globals = {
1420 .opts = iptables_opts,
1421 .orig_opts = iptables_opts,
1424 static struct xtables_target *prepare_target(struct connman_iptables *table,
1427 struct xtables_target *xt_t = NULL;
1428 gboolean is_builtin, is_user_defined;
1429 GList *chain_head = NULL;
1433 is_user_defined = FALSE;
1435 if (is_builtin_target(target_name))
1438 chain_head = find_chain_head(table, target_name);
1439 if (chain_head != NULL && chain_head->next != NULL)
1440 is_user_defined = TRUE;
1443 if (is_builtin || is_user_defined)
1444 xt_t = xtables_find_target(IPT_STANDARD_TARGET,
1445 XTF_LOAD_MUST_SUCCEED);
1447 xt_t = xtables_find_target(target_name, XTF_TRY_LOAD);
1452 target_size = ALIGN(sizeof(struct ipt_entry_target)) + xt_t->size;
1454 xt_t->t = g_try_malloc0(target_size);
1455 if (xt_t->t == NULL)
1458 xt_t->t->u.target_size = target_size;
1460 if (is_builtin || is_user_defined) {
1461 struct xt_standard_target *target;
1463 target = (struct xt_standard_target *)(xt_t->t);
1464 strcpy(target->target.u.user.name, IPT_STANDARD_TARGET);
1466 if (is_builtin == TRUE)
1467 target->verdict = target_to_verdict(target_name);
1468 else if (is_user_defined == TRUE) {
1469 struct connman_iptables_entry *target_rule;
1471 if (chain_head == NULL) {
1476 target_rule = chain_head->next->data;
1477 target->verdict = target_rule->offset;
1480 strcpy(xt_t->t->u.user.name, target_name);
1481 xt_t->t->u.user.revision = xt_t->revision;
1482 if (xt_t->init != NULL)
1483 xt_t->init(xt_t->t);
1486 #if XTABLES_VERSION_CODE > 5
1487 if (xt_t->x6_options != NULL)
1488 iptables_globals.opts =
1489 xtables_options_xfrm(
1490 iptables_globals.orig_opts,
1491 iptables_globals.opts,
1493 &xt_t->option_offset);
1496 iptables_globals.opts =
1497 xtables_merge_options(
1498 #if XTABLES_VERSION_CODE > 5
1499 iptables_globals.orig_opts,
1501 iptables_globals.opts,
1503 &xt_t->option_offset);
1505 if (iptables_globals.opts == NULL) {
1513 static struct xtables_match *prepare_matches(struct connman_iptables *table,
1514 struct xtables_rule_match **xt_rm, char *match_name)
1516 struct xtables_match *xt_m;
1519 if (match_name == NULL)
1522 xt_m = xtables_find_match(match_name, XTF_LOAD_MUST_SUCCEED, xt_rm);
1523 match_size = ALIGN(sizeof(struct ipt_entry_match)) + xt_m->size;
1525 xt_m->m = g_try_malloc0(match_size);
1526 if (xt_m->m == NULL)
1529 xt_m->m->u.match_size = match_size;
1530 strcpy(xt_m->m->u.user.name, xt_m->name);
1531 xt_m->m->u.user.revision = xt_m->revision;
1533 if (xt_m->init != NULL)
1534 xt_m->init(xt_m->m);
1536 if (xt_m == xt_m->next)
1539 #if XTABLES_VERSION_CODE > 5
1540 if (xt_m->x6_options != NULL)
1541 iptables_globals.opts =
1542 xtables_options_xfrm(
1543 iptables_globals.orig_opts,
1544 iptables_globals.opts,
1546 &xt_m->option_offset);
1549 iptables_globals.opts =
1550 xtables_merge_options(
1551 #if XTABLES_VERSION_CODE > 5
1552 iptables_globals.orig_opts,
1554 iptables_globals.opts,
1556 &xt_m->option_offset);
1558 if (iptables_globals.opts == NULL) {
1567 static int parse_ip_and_mask(const char *str, struct in_addr *ip, struct in_addr *mask)
1570 uint32_t prefixlength;
1574 tokens = g_strsplit(str, "/", 2);
1578 if (!inet_pton(AF_INET, tokens[0], ip)) {
1583 if (tokens[1] != NULL) {
1584 prefixlength = strtol(tokens[1], NULL, 10);
1585 if (prefixlength > 31) {
1590 tmp = ~(0xffffffff >> prefixlength);
1595 mask->s_addr = htonl(tmp);
1596 ip->s_addr = ip->s_addr & mask->s_addr;
1604 static struct connman_iptables *pre_load_table(char *table_name,
1605 struct connman_iptables *table)
1610 return iptables_init(table_name);
1613 static int iptables_command(int argc, char *argv[])
1615 struct connman_iptables *table;
1616 struct xtables_rule_match *xt_rm, *tmp_xt_rm;
1617 struct xtables_match *xt_m, *xt_m_t;
1618 struct xtables_target *xt_t;
1620 char *table_name, *chain, *new_chain, *match_name, *target_name;
1621 char *flush_chain, *delete_chain, *policy;
1622 int c, ret, in_len, out_len;
1623 gboolean dump, invert, insert, delete, compare;
1633 chain = new_chain = match_name = target_name = NULL;
1634 flush_chain = delete_chain = policy = table_name = NULL;
1635 memset(&ip, 0, sizeof(struct ipt_ip));
1640 /* Default code for options parsing */
1643 /* extension's options will generate false-positives errors */
1648 while ((c = getopt_long(argc, argv,
1649 "-A:C:D:F:I:L::N:P:X:d:j:i:m:o:s:t:",
1650 iptables_globals.opts, NULL)) != -1) {
1653 /* It is either -A, -C, -D or -I at once */
1661 /* It is either -A, -C, -D or -I at once */
1670 /* It is either -A, -C, -D or -I at once */
1679 flush_chain = optarg;
1683 /* It is either -A, -C, -D or -I at once */
1702 policy = argv[optind++];
1709 delete_chain = optarg;
1713 if (!parse_ip_and_mask(optarg, &ip.dst, &ip.dmsk))
1717 ip.invflags |= IPT_INV_DSTIP;
1722 in_len = strlen(optarg);
1724 if (in_len + 1 > IFNAMSIZ)
1727 strcpy(ip.iniface, optarg);
1728 memset(ip.iniface_mask, 0xff, in_len + 1);
1731 ip.invflags |= IPT_INV_VIA_IN;
1736 target_name = optarg;
1738 table = pre_load_table(table_name, table);
1742 xt_t = prepare_target(table, target_name);
1749 match_name = optarg;
1751 table = pre_load_table(table_name, table);
1755 xt_m = prepare_matches(table, &xt_rm, match_name);
1762 out_len = strlen(optarg);
1764 if (out_len + 1 > IFNAMSIZ)
1767 strcpy(ip.outiface, optarg);
1768 memset(ip.outiface_mask, 0xff, out_len + 1);
1771 ip.invflags |= IPT_INV_VIA_OUT;
1776 if (!parse_ip_and_mask(optarg, &ip.src, &ip.smsk))
1780 ip.invflags |= IPT_INV_SRCIP;
1785 table_name = optarg;
1787 table = pre_load_table(table_name, table);
1794 if (optarg[0] == '!' && optarg[1] == '\0') {
1800 connman_error("Invalid option");
1805 #if XTABLES_VERSION_CODE > 5
1806 if (xt_t != NULL && (xt_t->x6_parse != NULL ||
1807 xt_t->parse != NULL) &&
1808 (c >= (int) xt_t->option_offset &&
1809 c < (int) xt_t->option_offset +
1810 XT_OPTION_OFFSET_SCALE)) {
1811 xtables_option_tpcall(c, argv,
1812 invert, xt_t, NULL);
1817 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1818 tmp_xt_rm = tmp_xt_rm->next) {
1819 xt_m_t = tmp_xt_rm->match;
1821 if (tmp_xt_rm->completed ||
1822 (xt_m_t->x6_parse == NULL &&
1823 xt_m_t->parse == NULL))
1826 if (c < (int) xt_m_t->option_offset ||
1827 c >= (int) xt_m_t->option_offset
1828 + XT_OPTION_OFFSET_SCALE)
1831 xtables_option_mpcall(c, argv,
1832 invert, xt_m_t, NULL);
1837 if (xt_t == NULL || xt_t->parse == NULL ||
1838 !xt_t->parse(c - xt_t->option_offset,
1839 argv, invert, &xt_t->tflags, NULL, &xt_t->t)) {
1841 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1842 tmp_xt_rm = tmp_xt_rm->next) {
1843 xt_m_t = tmp_xt_rm->match;
1845 if (tmp_xt_rm->completed ||
1846 xt_m_t->parse == NULL)
1849 if (xt_m->parse(c - xt_m->option_offset,
1850 argv, invert, &xt_m->mflags,
1862 #if XTABLES_VERSION_CODE > 5
1863 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1864 tmp_xt_rm = tmp_xt_rm->next)
1865 xtables_option_mfcall(tmp_xt_rm->match);
1868 xtables_option_tfcall(xt_t);
1870 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1871 tmp_xt_rm = tmp_xt_rm->next)
1872 if (tmp_xt_rm->match->final_check != NULL)
1873 tmp_xt_rm->match->final_check(
1874 tmp_xt_rm->match->mflags);
1876 if (xt_t != NULL && xt_t->final_check != NULL)
1877 xt_t->final_check(xt_t->tflags);
1880 table = pre_load_table(table_name, table);
1884 /* Option parsing went fine, falling back to succes code */
1887 if (delete_chain != NULL) {
1888 printf("Delete chain %s\n", delete_chain);
1890 iptables_delete_chain(table, delete_chain);
1896 iptables_dump(table);
1902 DBG("Flush chain %s", flush_chain);
1904 iptables_flush_chain(table, flush_chain);
1909 if (chain && new_chain) {
1915 DBG("New chain %s", new_chain);
1917 ret = iptables_add_chain(table, new_chain);
1922 if (policy != NULL) {
1923 printf("Changing policy of %s to %s\n", chain, policy);
1925 iptables_change_policy(table, chain, policy);
1933 if (compare == TRUE) {
1934 ret = iptables_compare_rule(table, &ip, chain,
1935 target_name, xt_t, xt_m, xt_rm);
1939 if (delete == TRUE) {
1940 DBG("Deleting %s to %s (match %s)\n",
1941 target_name, chain, match_name);
1943 ret = iptables_delete_rule(table, &ip, chain,
1944 target_name, xt_t, xt_m, xt_rm);
1949 if (insert == TRUE) {
1950 DBG("Inserting %s to %s (match %s)",
1951 target_name, chain, match_name);
1953 ret = iptables_insert_rule(table, &ip, chain,
1954 target_name, xt_t, xt_rm);
1958 DBG("Adding %s to %s (match %s)",
1959 target_name, chain, match_name);
1961 ret = iptables_append_rule(table, &ip, chain,
1962 target_name, xt_t, xt_rm);
1978 int __connman_iptables_command(const char *format, ...)
1980 char **argv, **arguments, *command;
1987 va_start(args, format);
1989 command = g_strdup_vprintf(format, args);
1993 if (command == NULL)
1996 arguments = g_strsplit_set(command, " ", -1);
1998 for (argc = 0; arguments[argc]; argc++);
2001 DBG("command %s argc %d", command, argc);
2003 argv = g_try_malloc0(argc * sizeof(char *));
2006 g_strfreev(arguments);
2010 argv[0] = "iptables";
2011 for (i = 1; i < argc; i++)
2012 argv[i] = arguments[i - 1];
2014 ret = iptables_command(argc, argv);
2017 g_strfreev(arguments);
2024 int __connman_iptables_commit(const char *table_name)
2026 struct connman_iptables *table;
2027 struct ipt_replace *repl;
2030 DBG("%s", table_name);
2032 table = g_hash_table_lookup(table_hash, table_name);
2036 repl = iptables_blob(table);
2038 err = iptables_replace(table, repl);
2040 g_free(repl->counters);
2046 g_hash_table_remove(table_hash, table_name);
2051 static void remove_table(gpointer user_data)
2053 struct connman_iptables *table = user_data;
2055 table_cleanup(table);
2058 int __connman_iptables_init(void)
2062 table_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
2063 g_free, remove_table);
2065 xtables_init_all(&iptables_globals, NFPROTO_IPV4);
2071 void __connman_iptables_cleanup(void)
2075 g_hash_table_destroy(table_hash);
2077 xtables_free_opts(1);