Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 1 | /* Shared library add-on to iptables for DSCP |
| 2 | * |
| 3 | * (C) 2002 by Harald Welte <laforge@gnumonks.org> |
| 4 | * |
| 5 | * This program is distributed under the terms of GNU GPL v2, 1991 |
| 6 | * |
| 7 | * libipt_dscp.c borrowed heavily from libipt_tos.c |
| 8 | * |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 9 | * --class support added by Iain Barnes |
| 10 | * |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 11 | * For a list of DSCP codepoints see |
| 12 | * http://www.iana.org/assignments/dscp-registry |
| 13 | * |
| 14 | */ |
| 15 | #include <stdio.h> |
| 16 | #include <string.h> |
| 17 | #include <stdlib.h> |
| 18 | #include <getopt.h> |
| 19 | |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 20 | #include <xtables.h> |
| 21 | #include <linux/netfilter/x_tables.h> |
| 22 | #include <linux/netfilter/xt_dscp.h> |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 23 | |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 24 | /* This is evil, but it's my code - HW*/ |
Jan Engelhardt | f82070f | 2008-01-20 13:14:00 +0000 | [diff] [blame] | 25 | #include "dscp_helper.c" |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 26 | |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 27 | static void dscp_help(void) |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 28 | { |
| 29 | printf( |
Jan Engelhardt | 8b7c64d | 2008-04-15 11:48:25 +0200 | [diff] [blame] | 30 | "dscp match options\n" |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 31 | "[!] --dscp value Match DSCP codepoint with numerical value\n" |
| 32 | " This value can be in decimal (ex: 32)\n" |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 33 | " or in hex (ex: 0x20)\n" |
Harald Welte | a49ded0 | 2002-08-07 09:55:37 +0000 | [diff] [blame] | 34 | "[!] --dscp-class name Match the DiffServ class. This value may\n" |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 35 | " be any of the BE,EF, AFxx or CSx classes\n" |
| 36 | "\n" |
Jan Engelhardt | 8b7c64d | 2008-04-15 11:48:25 +0200 | [diff] [blame] | 37 | " These two options are mutually exclusive !\n"); |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 38 | } |
| 39 | |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 40 | static const struct option dscp_opts[] = { |
Patrick McHardy | 500f483 | 2007-09-08 15:59:04 +0000 | [diff] [blame] | 41 | { "dscp", 1, NULL, 'F' }, |
| 42 | { "dscp-class", 1, NULL, 'G' }, |
Max Kellermann | 9ee386a | 2008-01-29 13:48:05 +0000 | [diff] [blame] | 43 | { .name = NULL } |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 44 | }; |
| 45 | |
| 46 | static void |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 47 | parse_dscp(const char *s, struct xt_dscp_info *dinfo) |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 48 | { |
| 49 | unsigned int dscp; |
| 50 | |
Jan Engelhardt | 5f2922c | 2009-01-27 18:43:01 +0100 | [diff] [blame] | 51 | if (!xtables_strtoui(s, NULL, &dscp, 0, UINT8_MAX)) |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 52 | exit_error(PARAMETER_PROBLEM, |
| 53 | "Invalid dscp `%s'\n", s); |
| 54 | |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 55 | if (dscp > XT_DSCP_MAX) |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 56 | exit_error(PARAMETER_PROBLEM, |
| 57 | "DSCP `%d` out of range\n", dscp); |
| 58 | |
Jan Engelhardt | 213e185 | 2009-01-27 17:24:34 +0100 | [diff] [blame] | 59 | dinfo->dscp = dscp; |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 60 | } |
| 61 | |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 62 | |
| 63 | static void |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 64 | parse_class(const char *s, struct xt_dscp_info *dinfo) |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 65 | { |
| 66 | unsigned int dscp = class_to_dscp(s); |
| 67 | |
| 68 | /* Assign the value */ |
Jan Engelhardt | 213e185 | 2009-01-27 17:24:34 +0100 | [diff] [blame] | 69 | dinfo->dscp = dscp; |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 70 | } |
| 71 | |
| 72 | |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 73 | static int |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 74 | dscp_parse(int c, char **argv, int invert, unsigned int *flags, |
| 75 | const void *entry, struct xt_entry_match **match) |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 76 | { |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 77 | struct xt_dscp_info *dinfo |
| 78 | = (struct xt_dscp_info *)(*match)->data; |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 79 | |
| 80 | switch (c) { |
| 81 | case 'F': |
| 82 | if (*flags) |
| 83 | exit_error(PARAMETER_PROBLEM, |
| 84 | "DSCP match: Only use --dscp ONCE!"); |
| 85 | check_inverse(optarg, &invert, &optind, 0); |
| 86 | parse_dscp(argv[optind-1], dinfo); |
| 87 | if (invert) |
| 88 | dinfo->invert = 1; |
| 89 | *flags = 1; |
| 90 | break; |
| 91 | |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 92 | case 'G': |
| 93 | if (*flags) |
| 94 | exit_error(PARAMETER_PROBLEM, |
Harald Welte | a49ded0 | 2002-08-07 09:55:37 +0000 | [diff] [blame] | 95 | "DSCP match: Only use --dscp-class ONCE!"); |
Iain Barnes | 0ddae8f | 2002-06-21 17:35:55 +0000 | [diff] [blame] | 96 | check_inverse(optarg, &invert, &optind, 0); |
| 97 | parse_class(argv[optind - 1], dinfo); |
| 98 | if (invert) |
| 99 | dinfo->invert = 1; |
| 100 | *flags = 1; |
| 101 | break; |
| 102 | |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 103 | default: |
| 104 | return 0; |
| 105 | } |
| 106 | |
| 107 | return 1; |
| 108 | } |
| 109 | |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 110 | static void dscp_check(unsigned int flags) |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 111 | { |
| 112 | if (!flags) |
| 113 | exit_error(PARAMETER_PROBLEM, |
| 114 | "DSCP match: Parameter --dscp is required"); |
| 115 | } |
| 116 | |
| 117 | static void |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 118 | dscp_print(const void *ip, const struct xt_entry_match *match, int numeric) |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 119 | { |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 120 | const struct xt_dscp_info *dinfo = |
| 121 | (const struct xt_dscp_info *)match->data; |
Jan Engelhardt | cea9f71 | 2008-12-09 15:06:20 +0100 | [diff] [blame] | 122 | printf("DSCP match %s0x%02x", dinfo->invert ? "!" : "", dinfo->dscp); |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 123 | } |
| 124 | |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 125 | static void dscp_save(const void *ip, const struct xt_entry_match *match) |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 126 | { |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 127 | const struct xt_dscp_info *dinfo = |
| 128 | (const struct xt_dscp_info *)match->data; |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 129 | |
Jan Engelhardt | cea9f71 | 2008-12-09 15:06:20 +0100 | [diff] [blame] | 130 | printf("%s--dscp 0x%02x ", dinfo->invert ? "! " : "", dinfo->dscp); |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 131 | } |
| 132 | |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 133 | static struct xtables_match dscp_match = { |
Jan Engelhardt | 03d9948 | 2008-11-18 12:27:54 +0100 | [diff] [blame] | 134 | .family = NFPROTO_IPV4, |
Pablo Neira | 8caee8b | 2004-12-28 13:11:59 +0000 | [diff] [blame] | 135 | .name = "dscp", |
Jan Engelhardt | 8b7c64d | 2008-04-15 11:48:25 +0200 | [diff] [blame] | 136 | .version = XTABLES_VERSION, |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 137 | .size = XT_ALIGN(sizeof(struct xt_dscp_info)), |
| 138 | .userspacesize = XT_ALIGN(sizeof(struct xt_dscp_info)), |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 139 | .help = dscp_help, |
| 140 | .parse = dscp_parse, |
| 141 | .final_check = dscp_check, |
| 142 | .print = dscp_print, |
| 143 | .save = dscp_save, |
| 144 | .extra_opts = dscp_opts, |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 145 | }; |
| 146 | |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 147 | static struct xtables_match dscp_match6 = { |
Jan Engelhardt | 03d9948 | 2008-11-18 12:27:54 +0100 | [diff] [blame] | 148 | .family = NFPROTO_IPV6, |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 149 | .name = "dscp", |
Jan Engelhardt | 8b7c64d | 2008-04-15 11:48:25 +0200 | [diff] [blame] | 150 | .version = XTABLES_VERSION, |
Yasuyuki KOZAKAI | 18e0608 | 2007-07-24 07:17:23 +0000 | [diff] [blame] | 151 | .size = XT_ALIGN(sizeof(struct xt_dscp_info)), |
| 152 | .userspacesize = XT_ALIGN(sizeof(struct xt_dscp_info)), |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 153 | .help = dscp_help, |
| 154 | .parse = dscp_parse, |
| 155 | .final_check = dscp_check, |
| 156 | .print = dscp_print, |
| 157 | .save = dscp_save, |
| 158 | .extra_opts = dscp_opts, |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 159 | }; |
| 160 | |
| 161 | void _init(void) |
| 162 | { |
Jan Engelhardt | 181dead | 2007-10-04 16:27:07 +0000 | [diff] [blame] | 163 | xtables_register_match(&dscp_match); |
| 164 | xtables_register_match(&dscp_match6); |
Harald Welte | 487d1d3 | 2002-03-14 12:22:06 +0000 | [diff] [blame] | 165 | } |