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 connman_iptables *table,
1124 struct ipt_entry *entry)
1127 struct xtables_target *xt_t;
1128 struct xt_entry_target *target;
1130 target = ipt_get_target(entry);
1132 if (!strcmp(target->u.user.name, IPT_STANDARD_TARGET)) {
1133 struct xt_standard_target *t;
1135 t = (struct xt_standard_target *)target;
1137 switch (t->verdict) {
1139 connman_info("\ttarget RETURN");
1142 case -NF_ACCEPT - 1:
1143 connman_info("\ttarget ACCEPT");
1147 connman_info("\ttarget DROP");
1151 connman_info("\ttarget QUEUE");
1155 connman_info("\ttarget STOP");
1159 connman_info("\tJUMP @%p (0x%x)",
1160 (char*)table->blob_entries->entrytable +
1161 t->verdict, t->verdict);
1165 xt_t = xtables_find_target(IPT_STANDARD_TARGET,
1166 XTF_LOAD_MUST_SUCCEED);
1168 if(xt_t->print != NULL)
1169 xt_t->print(NULL, target, 1);
1171 xt_t = xtables_find_target(target->u.user.name, XTF_TRY_LOAD);
1173 connman_info("\ttarget %s", target->u.user.name);
1177 if(xt_t->print != NULL) {
1178 connman_info("\ttarget ");
1179 xt_t->print(NULL, target, 1);
1184 static void dump_match(struct connman_iptables *table, struct ipt_entry *entry)
1186 struct xtables_match *xt_m;
1187 struct xt_entry_match *match;
1189 if (entry->elems == (unsigned char *)entry + entry->target_offset)
1192 match = (struct xt_entry_match *) entry->elems;
1194 if (!strlen(match->u.user.name))
1197 xt_m = xtables_find_match(match->u.user.name, XTF_TRY_LOAD, NULL);
1201 if(xt_m->print != NULL) {
1202 connman_info("\tmatch ");
1203 xt_m->print(NULL, match, 1);
1209 connman_info("\tmatch %s", match->u.user.name);
1213 static int dump_entry(struct connman_iptables *table,
1214 struct ipt_entry *entry, int builtin,
1215 unsigned int hook, unsigned int offset,
1218 struct xt_entry_target *target;
1220 target = ipt_get_target(entry);
1222 if (entry_to_offset(table, entry) + entry->next_offset ==
1223 table->blob_entries->size) {
1224 connman_info("End of CHAIN 0x%x", offset);
1228 if (!strcmp(target->u.user.name, IPT_ERROR_TARGET)) {
1229 connman_info("USER CHAIN (%s) %p match %p target %p size %d",
1230 target->data, entry, entry->elems,
1231 (char *)entry + entry->target_offset,
1232 entry->next_offset);
1235 } else if (builtin >= 0) {
1236 connman_info("CHAIN (%s) %p match %p target %p size %d",
1237 hooknames[builtin], entry, entry->elems,
1238 (char *)entry + entry->target_offset,
1239 entry->next_offset);
1241 connman_info("RULE %p match %p target %p size %d", entry,
1243 (char *)entry + entry->target_offset,
1244 entry->next_offset);
1247 dump_match(table, entry);
1248 dump_target(table, entry);
1254 static void iptables_dump(struct connman_iptables *table)
1256 connman_info("%s valid_hooks=0x%08x, num_entries=%u, size=%u",
1258 table->info->valid_hooks, table->info->num_entries,
1261 iterate_entries(table, table->blob_entries->entrytable,
1262 table->info->valid_hooks,
1263 table->info->hook_entry,
1264 table->blob_entries->size,
1269 static int iptables_get_entries(struct connman_iptables *table)
1271 socklen_t entry_size;
1273 entry_size = sizeof(struct ipt_get_entries) + table->info->size;
1275 return getsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_GET_ENTRIES,
1276 table->blob_entries, &entry_size);
1279 static int iptables_replace(struct connman_iptables *table,
1280 struct ipt_replace *r)
1282 return setsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_SET_REPLACE, r,
1283 sizeof(*r) + r->size);
1286 static int add_entry(struct connman_iptables *table, struct ipt_entry *entry,
1287 int builtin, unsigned int hook, unsigned offset,
1290 struct ipt_entry *new_entry;
1292 new_entry = g_try_malloc0(entry->next_offset);
1293 if (new_entry == NULL)
1296 memcpy(new_entry, entry, entry->next_offset);
1298 return iptables_add_entry(table, new_entry, NULL, builtin);
1301 static void table_cleanup(struct connman_iptables *table)
1304 struct connman_iptables_entry *entry;
1309 if (table->ipt_sock >= 0)
1310 close(table->ipt_sock);
1312 for (list = table->entries; list; list = list->next) {
1315 g_free(entry->entry);
1319 g_list_free(table->entries);
1320 g_free(table->info);
1321 g_free(table->blob_entries);
1325 static struct connman_iptables *iptables_init(const char *table_name)
1327 struct connman_iptables *table = NULL;
1328 char *module = NULL;
1331 if (table_name == NULL)
1332 table_name = "filter";
1334 DBG("%s", table_name);
1336 if (xtables_insmod("ip_tables", NULL, TRUE) != 0)
1337 DBG("ip_tables module loading gives error but trying anyway");
1339 module = g_strconcat("iptable_", table_name, NULL);
1343 if (xtables_insmod(module, NULL, TRUE) != 0)
1344 DBG("%s module loading gives error but trying anyway", module);
1348 table = g_hash_table_lookup(table_hash, table_name);
1352 table = g_try_new0(struct connman_iptables, 1);
1356 table->info = g_try_new0(struct ipt_getinfo, 1);
1357 if (table->info == NULL)
1360 table->ipt_sock = socket(AF_INET, SOCK_RAW | SOCK_CLOEXEC, IPPROTO_RAW);
1361 if (table->ipt_sock < 0)
1364 s = sizeof(*table->info);
1365 strcpy(table->info->name, table_name);
1366 if (getsockopt(table->ipt_sock, IPPROTO_IP, IPT_SO_GET_INFO,
1367 table->info, &s) < 0) {
1368 connman_error("iptables support missing error %d (%s)", errno,
1373 table->blob_entries = g_try_malloc0(sizeof(struct ipt_get_entries) +
1375 if (table->blob_entries == NULL)
1378 strcpy(table->blob_entries->name, table_name);
1379 table->blob_entries->size = table->info->size;
1381 if (iptables_get_entries(table) < 0)
1384 table->num_entries = 0;
1385 table->old_entries = table->info->num_entries;
1388 memcpy(table->underflow, table->info->underflow,
1389 sizeof(table->info->underflow));
1390 memcpy(table->hook_entry, table->info->hook_entry,
1391 sizeof(table->info->hook_entry));
1393 iterate_entries(table, table->blob_entries->entrytable,
1394 table->info->valid_hooks, table->info->hook_entry,
1395 table->blob_entries->size, add_entry, NULL);
1397 g_hash_table_insert(table_hash, g_strdup(table_name), table);
1402 table_cleanup(table);
1407 static struct option iptables_opts[] = {
1408 {.name = "append", .has_arg = 1, .val = 'A'},
1409 {.name = "compare", .has_arg = 1, .val = 'C'},
1410 {.name = "delete", .has_arg = 1, .val = 'D'},
1411 {.name = "flush-chain", .has_arg = 1, .val = 'F'},
1412 {.name = "insert", .has_arg = 1, .val = 'I'},
1413 {.name = "list", .has_arg = 2, .val = 'L'},
1414 {.name = "new-chain", .has_arg = 1, .val = 'N'},
1415 {.name = "policy", .has_arg = 1, .val = 'P'},
1416 {.name = "delete-chain", .has_arg = 1, .val = 'X'},
1417 {.name = "destination", .has_arg = 1, .val = 'd'},
1418 {.name = "in-interface", .has_arg = 1, .val = 'i'},
1419 {.name = "jump", .has_arg = 1, .val = 'j'},
1420 {.name = "match", .has_arg = 1, .val = 'm'},
1421 {.name = "out-interface", .has_arg = 1, .val = 'o'},
1422 {.name = "source", .has_arg = 1, .val = 's'},
1423 {.name = "table", .has_arg = 1, .val = 't'},
1427 struct xtables_globals iptables_globals = {
1429 .opts = iptables_opts,
1430 .orig_opts = iptables_opts,
1433 static struct xtables_target *prepare_target(struct connman_iptables *table,
1434 const char *target_name)
1436 struct xtables_target *xt_t = NULL;
1437 gboolean is_builtin, is_user_defined;
1438 GList *chain_head = NULL;
1442 is_user_defined = FALSE;
1444 if (is_builtin_target(target_name))
1447 chain_head = find_chain_head(table, target_name);
1448 if (chain_head != NULL && chain_head->next != NULL)
1449 is_user_defined = TRUE;
1452 if (is_builtin || is_user_defined)
1453 xt_t = xtables_find_target(IPT_STANDARD_TARGET,
1454 XTF_LOAD_MUST_SUCCEED);
1456 xt_t = xtables_find_target(target_name, XTF_TRY_LOAD);
1461 target_size = ALIGN(sizeof(struct ipt_entry_target)) + xt_t->size;
1463 xt_t->t = g_try_malloc0(target_size);
1464 if (xt_t->t == NULL)
1467 xt_t->t->u.target_size = target_size;
1469 if (is_builtin || is_user_defined) {
1470 struct xt_standard_target *target;
1472 target = (struct xt_standard_target *)(xt_t->t);
1473 strcpy(target->target.u.user.name, IPT_STANDARD_TARGET);
1475 if (is_builtin == TRUE)
1476 target->verdict = target_to_verdict(target_name);
1477 else if (is_user_defined == TRUE) {
1478 struct connman_iptables_entry *target_rule;
1480 if (chain_head == NULL) {
1485 target_rule = chain_head->next->data;
1486 target->verdict = target_rule->offset;
1489 strcpy(xt_t->t->u.user.name, target_name);
1490 xt_t->t->u.user.revision = xt_t->revision;
1491 if (xt_t->init != NULL)
1492 xt_t->init(xt_t->t);
1495 #if XTABLES_VERSION_CODE > 5
1496 if (xt_t->x6_options != NULL)
1497 iptables_globals.opts =
1498 xtables_options_xfrm(
1499 iptables_globals.orig_opts,
1500 iptables_globals.opts,
1502 &xt_t->option_offset);
1505 iptables_globals.opts =
1506 xtables_merge_options(
1507 #if XTABLES_VERSION_CODE > 5
1508 iptables_globals.orig_opts,
1510 iptables_globals.opts,
1512 &xt_t->option_offset);
1514 if (iptables_globals.opts == NULL) {
1522 static struct xtables_match *prepare_matches(struct connman_iptables *table,
1523 struct xtables_rule_match **xt_rm,
1524 const char *match_name)
1526 struct xtables_match *xt_m;
1529 if (match_name == NULL)
1532 xt_m = xtables_find_match(match_name, XTF_LOAD_MUST_SUCCEED, xt_rm);
1533 match_size = ALIGN(sizeof(struct ipt_entry_match)) + xt_m->size;
1535 xt_m->m = g_try_malloc0(match_size);
1536 if (xt_m->m == NULL)
1539 xt_m->m->u.match_size = match_size;
1540 strcpy(xt_m->m->u.user.name, xt_m->name);
1541 xt_m->m->u.user.revision = xt_m->revision;
1543 if (xt_m->init != NULL)
1544 xt_m->init(xt_m->m);
1546 if (xt_m == xt_m->next)
1549 #if XTABLES_VERSION_CODE > 5
1550 if (xt_m->x6_options != NULL)
1551 iptables_globals.opts =
1552 xtables_options_xfrm(
1553 iptables_globals.orig_opts,
1554 iptables_globals.opts,
1556 &xt_m->option_offset);
1559 iptables_globals.opts =
1560 xtables_merge_options(
1561 #if XTABLES_VERSION_CODE > 5
1562 iptables_globals.orig_opts,
1564 iptables_globals.opts,
1566 &xt_m->option_offset);
1568 if (iptables_globals.opts == NULL) {
1577 static int parse_ip_and_mask(const char *str, struct in_addr *ip, struct in_addr *mask)
1580 uint32_t prefixlength;
1584 tokens = g_strsplit(str, "/", 2);
1588 if (!inet_pton(AF_INET, tokens[0], ip)) {
1593 if (tokens[1] != NULL) {
1594 prefixlength = strtol(tokens[1], NULL, 10);
1595 if (prefixlength > 31) {
1600 tmp = ~(0xffffffff >> prefixlength);
1605 mask->s_addr = htonl(tmp);
1606 ip->s_addr = ip->s_addr & mask->s_addr;
1614 static struct connman_iptables *pre_load_table(const char *table_name,
1615 struct connman_iptables *table)
1620 return iptables_init(table_name);
1623 static void clear_tables_flags(void)
1625 struct xtables_match *xt_m;
1626 struct xtables_target *xt_t;
1629 * Clear all flags because the flags are only valid
1632 for (xt_m = xtables_matches; xt_m != NULL; xt_m = xt_m->next)
1635 for (xt_t = xtables_targets; xt_t != NULL; xt_t = xt_t->next) {
1641 static int iptables_command(int argc, char *argv[])
1643 struct connman_iptables *table;
1644 struct xtables_rule_match *xt_rm, *tmp_xt_rm;
1645 struct xtables_match *xt_m, *xt_m_t;
1646 struct xtables_target *xt_t;
1648 char *table_name, *chain, *new_chain, *match_name, *target_name;
1649 char *flush_chain, *delete_chain, *policy;
1650 int c, ret, in_len, out_len;
1651 gboolean dump, invert, insert, delete, compare;
1661 chain = new_chain = match_name = target_name = NULL;
1662 flush_chain = delete_chain = policy = table_name = NULL;
1663 memset(&ip, 0, sizeof(struct ipt_ip));
1668 /* Default code for options parsing */
1671 clear_tables_flags();
1673 /* extension's options will generate false-positives errors */
1678 while ((c = getopt_long(argc, argv,
1679 "-A:C:D:F:I:L::N:P:X:d:j:i:m:o:s:t:",
1680 iptables_globals.opts, NULL)) != -1) {
1683 /* It is either -A, -C, -D or -I at once */
1691 /* It is either -A, -C, -D or -I at once */
1700 /* It is either -A, -C, -D or -I at once */
1709 flush_chain = optarg;
1713 /* It is either -A, -C, -D or -I at once */
1732 policy = argv[optind++];
1739 delete_chain = optarg;
1743 if (!parse_ip_and_mask(optarg, &ip.dst, &ip.dmsk))
1747 ip.invflags |= IPT_INV_DSTIP;
1752 in_len = strlen(optarg);
1754 if (in_len + 1 > IFNAMSIZ)
1757 strcpy(ip.iniface, optarg);
1758 memset(ip.iniface_mask, 0xff, in_len + 1);
1761 ip.invflags |= IPT_INV_VIA_IN;
1766 target_name = optarg;
1768 table = pre_load_table(table_name, table);
1772 xt_t = prepare_target(table, target_name);
1779 match_name = optarg;
1781 table = pre_load_table(table_name, table);
1785 xt_m = prepare_matches(table, &xt_rm, match_name);
1792 out_len = strlen(optarg);
1794 if (out_len + 1 > IFNAMSIZ)
1797 strcpy(ip.outiface, optarg);
1798 memset(ip.outiface_mask, 0xff, out_len + 1);
1801 ip.invflags |= IPT_INV_VIA_OUT;
1806 if (!parse_ip_and_mask(optarg, &ip.src, &ip.smsk))
1810 ip.invflags |= IPT_INV_SRCIP;
1815 table_name = optarg;
1817 table = pre_load_table(table_name, table);
1824 if (optarg[0] == '!' && optarg[1] == '\0') {
1830 connman_error("Invalid option");
1835 #if XTABLES_VERSION_CODE > 5
1836 if (xt_t != NULL && (xt_t->x6_parse != NULL ||
1837 xt_t->parse != NULL) &&
1838 (c >= (int) xt_t->option_offset &&
1839 c < (int) xt_t->option_offset +
1840 XT_OPTION_OFFSET_SCALE)) {
1841 xtables_option_tpcall(c, argv,
1842 invert, xt_t, NULL);
1847 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1848 tmp_xt_rm = tmp_xt_rm->next) {
1849 xt_m_t = tmp_xt_rm->match;
1851 if (tmp_xt_rm->completed ||
1852 (xt_m_t->x6_parse == NULL &&
1853 xt_m_t->parse == NULL))
1856 if (c < (int) xt_m_t->option_offset ||
1857 c >= (int) xt_m_t->option_offset
1858 + XT_OPTION_OFFSET_SCALE)
1861 xtables_option_mpcall(c, argv,
1862 invert, xt_m_t, NULL);
1867 if (xt_t == NULL || xt_t->parse == NULL ||
1868 !xt_t->parse(c - xt_t->option_offset,
1869 argv, invert, &xt_t->tflags, NULL, &xt_t->t)) {
1871 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1872 tmp_xt_rm = tmp_xt_rm->next) {
1873 xt_m_t = tmp_xt_rm->match;
1875 if (tmp_xt_rm->completed ||
1876 xt_m_t->parse == NULL)
1879 if (xt_m->parse(c - xt_m->option_offset,
1880 argv, invert, &xt_m->mflags,
1892 #if XTABLES_VERSION_CODE > 5
1893 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1894 tmp_xt_rm = tmp_xt_rm->next)
1895 xtables_option_mfcall(tmp_xt_rm->match);
1898 xtables_option_tfcall(xt_t);
1900 for (tmp_xt_rm = xt_rm; tmp_xt_rm != NULL;
1901 tmp_xt_rm = tmp_xt_rm->next)
1902 if (tmp_xt_rm->match->final_check != NULL)
1903 tmp_xt_rm->match->final_check(
1904 tmp_xt_rm->match->mflags);
1906 if (xt_t != NULL && xt_t->final_check != NULL)
1907 xt_t->final_check(xt_t->tflags);
1910 table = pre_load_table(table_name, table);
1914 /* Option parsing went fine, falling back to succes code */
1917 if (delete_chain != NULL) {
1918 printf("Delete chain %s\n", delete_chain);
1920 iptables_delete_chain(table, delete_chain);
1926 iptables_dump(table);
1932 DBG("Flush chain %s", flush_chain);
1934 iptables_flush_chain(table, flush_chain);
1939 if (chain && new_chain) {
1945 DBG("New chain %s", new_chain);
1947 ret = iptables_add_chain(table, new_chain);
1952 if (policy != NULL) {
1953 printf("Changing policy of %s to %s\n", chain, policy);
1955 iptables_change_policy(table, chain, policy);
1963 if (compare == TRUE) {
1964 ret = iptables_compare_rule(table, &ip, chain,
1965 target_name, xt_t, xt_m, xt_rm);
1969 if (delete == TRUE) {
1970 DBG("Deleting %s to %s (match %s)\n",
1971 target_name, chain, match_name);
1973 ret = iptables_delete_rule(table, &ip, chain,
1974 target_name, xt_t, xt_m, xt_rm);
1979 if (insert == TRUE) {
1980 DBG("Inserting %s to %s (match %s)",
1981 target_name, chain, match_name);
1983 ret = iptables_insert_rule(table, &ip, chain,
1984 target_name, xt_t, xt_rm);
1988 DBG("Adding %s to %s (match %s)",
1989 target_name, chain, match_name);
1991 ret = iptables_append_rule(table, &ip, chain,
1992 target_name, xt_t, xt_rm);
2008 int __connman_iptables_command(const char *format, ...)
2010 char **argv, **arguments, *command;
2017 va_start(args, format);
2019 command = g_strdup_vprintf(format, args);
2023 if (command == NULL)
2026 arguments = g_strsplit_set(command, " ", -1);
2028 for (argc = 0; arguments[argc]; argc++);
2031 DBG("command %s argc %d", command, argc);
2033 argv = g_try_malloc0(argc * sizeof(char *));
2036 g_strfreev(arguments);
2040 argv[0] = "iptables";
2041 for (i = 1; i < argc; i++)
2042 argv[i] = arguments[i - 1];
2044 ret = iptables_command(argc, argv);
2047 g_strfreev(arguments);
2054 int __connman_iptables_commit(const char *table_name)
2056 struct connman_iptables *table;
2057 struct ipt_replace *repl;
2060 DBG("%s", table_name);
2062 table = g_hash_table_lookup(table_hash, table_name);
2066 repl = iptables_blob(table);
2068 err = iptables_replace(table, repl);
2070 g_free(repl->counters);
2076 g_hash_table_remove(table_hash, table_name);
2081 static void remove_table(gpointer user_data)
2083 struct connman_iptables *table = user_data;
2085 table_cleanup(table);
2088 int __connman_iptables_init(void)
2092 table_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
2093 g_free, remove_table);
2095 xtables_init_all(&iptables_globals, NFPROTO_IPV4);
2101 void __connman_iptables_cleanup(void)
2105 g_hash_table_destroy(table_hash);
2107 xtables_free_opts(1);