1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
|
# **** License ****
# This program is free software; you can redistribute it and/or modify
# it under the terms of the GNU General Public License version 2 as
# published by the Free Software Foundation.
#
# This program is distributed in the hope that it will be useful, but
# WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
# General Public License for more details.
#
# This code was originally developed by Vyatta, Inc.
# Portions created by Vyatta are Copyright (C) 2008 Vyatta, Inc.
# All Rights Reserved.
# **** End License ****
package Vyatta::Qos::Match;
require Vyatta::Config;
use Vyatta::Qos::Util qw(getIfIndex getDsfield getProtocol);
use strict;
use warnings;
sub getPort {
my ( $str, $proto ) = @_;
return unless defined($str);
if ( $str =~ /^([0-9]+)|(0x[0-9a-fA-F]+)$/ ) {
die "$str is not a valid port number\n"
if ( $str <= 0 || $str > 65535 );
return $str;
}
$proto = "tcp" unless $proto;
my $port = getservbyname( $str, $proto );
die "$str unknown $proto port name\n" unless $port;
return $port;
}
sub new {
my ( $that, $config ) = @_;
my $self = {};
my $class = ref($that) || $that;
my $lastaf;
bless $self, $class;
# special case for match all
unless ($config) {
$self->{'ether'} = { protocol => 'all' };
return $self;
}
foreach my $af (qw(ip ipv6 ether)) {
next unless $config->exists($af);
my %fields;
if ( $af eq 'ether' ) {
$fields{protocol} = $config->returnValue("ether protocol");
$fields{src} = $config->returnValue("ether source");
$fields{dst} = $config->returnValue("ether destination");
} else {
$fields{dsfield} = getDsfield( $config->returnValue("$af dscp") );
my $ipprot = $config->returnValue("$af protocol");
$fields{protocol} = getProtocol($ipprot);
$fields{src} = $config->returnValue("$af source address");
$fields{dst} = $config->returnValue("$af destination address");
my $port = $config->returnValue("$af source port");
$fields{sport} = getPort( $port, $ipprot ) if $port;
$port = $config->returnValue("$af destination port");
$fields{dport} = getPort( $port, $ipprot ) if $port;
}
$self->{$af} = \%fields;
die "Can not match on both $af and $lastaf protocol in same match\n"
if $lastaf;
$lastaf = $af;
}
my $vif = $config->returnValue("vif");
$self->{_vif} = $vif;
my $iif = $config->returnValue("interface");
$self->{_indev} = getIfIndex($iif);
my $fwmark = $config->returnValue("mark");
$self->{_fwmark} = $fwmark;
if ($lastaf) {
die "Can not combine protocol and vlan tag match\n"
if ($vif);
die "Can not combine protocol and interface match\n"
if ($iif);
}
return $self;
}
sub filter {
my ( $self, $dev, $parent, $classid, $prio, $dsmark, $police ) = @_;
# empty match
return unless %{$self};
# Special case for when dsmarking is used with ds matching
# original dscp is saved in tc_index
if ($dsmark) {
foreach my $ipver (qw(ip ipv6)) {
my $ip = $self->{$ipver};
next unless $ip && $$ip{dsfield};
printf "filter add dev %s parent %x: protocol %s prio %d",
$dev, $parent, $ipver, $prio;
printf " handle %s tcindex classid %x:%x\n",
$$ip{dsfield}, $parent, $classid;
$prio += 1;
}
return;
}
my $fwmark = $self->{_fwmark};
foreach my $proto (qw(ip ipv6 ether)) {
my $p = $self->{$proto};
next unless $p;
printf "filter add dev %s parent %x: prio %d", $dev, $parent, $prio;
if ( $proto eq 'ether' ) {
my $type = $$p{protocol};
$type = 'all' unless $type;
print " protocol $type u32";
if ( defined( $$p{src} ) || defined( $$p{dst} ) ) {
print " match ether src $$p{src}" if $$p{src};
print " match ether dst $$p{dst}" if $$p{dst};
} else {
print " match u32 0 0";
}
} else {
print " protocol all u32";
# workaround inconsistent usage in tc u32 match
my $sel = $proto;
if ( $proto eq 'ipv6' ) {
$sel = 'ip6';
printf " match u16 0x%x 0x0ff0 at 0", hex( $$p{dsfield} ) << 4,
if $$p{dsfield};
} else {
print " match $sel dsfield $$p{dsfield} 0xff" if $$p{dsfield};
}
print " match $sel protocol $$p{protocol} 0xff" if $$p{protocol};
print " match $sel src $$p{src}" if $$p{src};
print " match $sel sport $$p{sport} 0xffff" if $$p{sport};
print " match $sel dst $$p{dst}" if $$p{dst};
print " match $sel dport $$p{dport} 0xffff" if $$p{dport};
}
print " match mark $fwmark 0xff" if $fwmark;
print " $police" if $police;
printf " flowid %x:%x\n", $parent, $classid;
return;
}
my $indev = $self->{_indev};
my $vif = $self->{_vif};
if ( defined($vif) || defined($indev) ) {
printf "filter add dev %s parent %x: prio %d", $dev, $parent, $prio;
print " protocol all basic";
print " match meta\(rt_iif eq $indev\)" if $indev;
print " match meta\(vlan mask 0xfff eq $vif\)" if $vif;
print " match meta\(fwmark eq $fwmark\)" if $fwmark;
print " $police" if $police;
printf " flowid %x:%x\n", $parent, $classid;
}
elsif ($fwmark) {
printf "filter add dev %s parent %x: prio %d", $dev, $parent, $prio;
printf " protocol all handle %d fw", $fwmark;
print " $police" if $police;
printf " flowid %x:%x\n", $parent, $classid;
}
}
1;
|
