package/network/config/qos-scripts/files/usr/lib/qos/generate.sh

   1 #!/bin/sh
   2 [ -e /lib/functions.sh ] && . /lib/functions.sh || . ./functions.sh
   3 [ -x /sbin/modprobe ] && {
   4         insmod="modprobe"
   5 } || {
   6         insmod="insmod"
   7 }
   8 rmmod="rmmod"
   9
  10 add_insmod() {
  11         eval "export isset=\${insmod_$1}"
  12         case "$isset" in
  13                 1) ;;
  14                 *) {
  15                         [ "$2" ] && append INSMOD "$rmmod $1 >&- 2>&-" "$N"
  16                         append INSMOD "$insmod $* >&- 2>&-" "$N"; export insmod_$1=1
  17                 };;
  18         esac
  19 }
  20
  21 [ -e /etc/config/network ] && {
  22         # only try to parse network config on openwrt
  23
  24         . /lib/functions/network.sh
  25
  26         find_ifname() {
  27                 local ifname
  28                 if network_get_device ifname "$1"; then
  29                         echo "$ifname"
  30                 else
  31                         echo "Device for interface $1 not found." >&2
  32                         exit 1
  33                 fi
  34         }
  35 } || {
  36         find_ifname() {
  37                 echo "Interface not found." >&2
  38                 exit 1
  39         }
  40 }
  41
  42 parse_matching_rule() {
  43         local var="$1"
  44         local section="$2"
  45         local options="$3"
  46         local prefix="$4"
  47         local suffix="$5"
  48         local proto="$6"
  49         local mport=""
  50         local ports=""
  51
  52         append "$var" "$prefix" "$N"
  53         for option in $options; do
  54                 case "$option" in
  55                         proto) config_get value "$section" proto; proto="${proto:-$value}";;
  56                 esac
  57         done
  58         config_get type "$section" TYPE
  59         case "$type" in
  60                 classify) unset pkt; append "$var" "-m mark --mark 0/0x0f";;
  61                 default) pkt=1; append "$var" "-m mark --mark 0/0xf0";;
  62                 reclassify) pkt=1;;
  63         esac
  64         append "$var" "${proto:+-p $proto}"
  65         for option in $options; do
  66                 config_get value "$section" "$option"
  67
  68                 case "$pkt:$option" in
  69                         *:srchost)
  70                                 append "$var" "-s $value"
  71                         ;;
  72                         *:dsthost)
  73                                 append "$var" "-d $value"
  74                         ;;
  75                         *:ports|*:srcports|*:dstports)
  76                                 value="$(echo "$value" | sed -e 's,-,:,g')"
  77                                 lproto=${lproto:-tcp}
  78                                 case "$proto" in
  79                                         ""|tcp|udp) append "$var" "-m ${proto:-tcp -p tcp} -m multiport";;
  80                                         *) unset "$var"; return 0;;
  81                                 esac
  82                                 case "$option" in
  83                                         ports)
  84                                                 config_set "$section" srcports ""
  85                                                 config_set "$section" dstports ""
  86                                                 config_set "$section" portrange ""
  87                                                 append "$var" "--ports $value"
  88                                         ;;
  89                                         srcports)
  90                                                 config_set "$section" ports ""
  91                                                 config_set "$section" dstports ""
  92                                                 config_set "$section" portrange ""
  93                                                 append "$var" "--sports $value"
  94                                         ;;
  95                                         dstports)
  96                                                 config_set "$section" ports ""
  97                                                 config_set "$section" srcports ""
  98                                                 config_set "$section" portrange ""
  99                                                 append "$var" "--dports $value"
 100                                         ;;
 101                                 esac
 102                                 ports=1
 103                         ;;
 104                         *:portrange)
 105                                 config_set "$section" ports ""
 106                                 config_set "$section" srcports ""
 107                                 config_set "$section" dstports ""
 108                                 value="$(echo "$value" | sed -e 's,-,:,g')"
 109                                 case "$proto" in
 110                                         ""|tcp|udp) append "$var" "-m ${proto:-tcp -p tcp} --sport $value --dport $value";;
 111                                         *) unset "$var"; return 0;;
 112                                 esac
 113                                 ports=1
 114                         ;;
 115                         *:connbytes)
 116                                 value="$(echo "$value" | sed -e 's,-,:,g')"
 117                                 add_insmod xt_connbytes
 118                                 append "$var" "-m connbytes --connbytes $value --connbytes-dir both --connbytes-mode bytes"
 119                         ;;
 120                         *:comment)
 121                                 add_insmod xt_comment
 122                                 append "$var" "-m comment --comment '$value'"
 123                         ;;
 124                         *:tos)
 125                                 add_insmod xt_dscp
 126                                 case "$value" in
 127                                         !*) append "$var" "-m tos ! --tos $value";;
 128                                         *) append "$var" "-m tos --tos $value"
 129                                 esac
 130                         ;;
 131                         *:dscp)
 132                                 add_insmod xt_dscp
 133                                 dscp_option="--dscp"
 134                                 [ -z "${value%%[EBCA]*}" ] && dscp_option="--dscp-class"
 135                                 case "$value" in
 136                                         !*) append "$var" "-m dscp ! $dscp_option $value";;
 137                                         *) append "$var" "-m dscp $dscp_option $value"
 138                                 esac
 139                         ;;
 140                         *:direction)
 141                                 value="$(echo "$value" | sed -e 's,-,:,g')"
 142                                 if [ "$value" = "out" ]; then
 143                                         append "$var" "-o $device"
 144                                 elif [ "$value" = "in" ]; then
 145                                         append "$var" "-i $device"
 146                                 fi
 147                         ;;
 148                         *:srciface)
 149                                 append "$var" "-i $value"
 150                         ;;
 151                         1:pktsize)
 152                                 value="$(echo "$value" | sed -e 's,-,:,g')"
 153                                 add_insmod xt_length
 154                                 append "$var" "-m length --length $value"
 155                         ;;
 156                         1:limit)
 157                                 add_insmod xt_limit
 158                                 append "$var" "-m limit --limit $value"
 159                         ;;
 160                         1:tcpflags)
 161                                 case "$proto" in
 162                                         tcp) append "$var" "-m tcp --tcp-flags ALL $value";;
 163                                         *) unset $var; return 0;;
 164                                 esac
 165                         ;;
 166                         1:mark)
 167                                 config_get class "${value##!}" classnr
 168                                 [ -z "$class" ] && continue;
 169                                 case "$value" in
 170                                         !*) append "$var" "-m mark ! --mark $class/0x0f";;
 171                                         *) append "$var" "-m mark --mark $class/0x0f";;
 172                                 esac
 173                         ;;
 174                         1:TOS)
 175                                 add_insmod xt_DSCP
 176                                 config_get TOS "$rule" 'TOS'
 177                                 suffix="-j TOS --set-tos "${TOS:-"Normal-Service"}
 178                         ;;
 179                         1:DSCP)
 180                                 add_insmod xt_DSCP
 181                                 config_get DSCP "$rule" 'DSCP'
 182                                 [ -z "${DSCP%%[EBCA]*}" ] && set_value="--set-dscp-class $DSCP" \
 183                                 || set_value="--set-dscp $DSCP"
 184                                 suffix="-j DSCP $set_value"
 185                         ;;
 186                 esac
 187         done
 188         append "$var" "$suffix"
 189         case "$ports:$proto" in
 190                 1:)     parse_matching_rule "$var" "$section" "$options" "$prefix" "$suffix" "udp";;
 191         esac
 192 }
 193
 194 config_cb() {
 195         option_cb() {
 196                 return 0
 197         }
 198         case "$1" in
 199                 interface)
 200                         config_set "$2" "classgroup" "Default"
 201                         config_set "$2" "upload" "128"
 202                 ;;
 203                 classify|default|reclassify)
 204                         option_cb() {
 205                                 append "CONFIG_${CONFIG_SECTION}_options" "$1"
 206                         }
 207                 ;;
 208         esac
 209 }
 210
 211 qos_parse_config() {
 212         config_get TYPE "$1" TYPE
 213         case "$TYPE" in
 214                 interface)
 215                         config_get_bool enabled "$1" enabled 1
 216                         [ 1 -eq "$enabled" ] && {
 217                                 config_get classgroup "$1" classgroup
 218                                 config_set "$1" ifbdev "$C"
 219                                 C=$(($C+1))
 220                                 append INTERFACES "$1"
 221                                 config_set "$classgroup" enabled 1
 222                                 config_get device "$1" device
 223                                 [ -z "$device" ] && {
 224                                         device="$(find_ifname $1)"
 225                                         [ -z "$device" ] && exit 1
 226                                         config_set "$1" device "$device"
 227                                 }
 228                         }
 229                 ;;
 230                 classgroup) append CG "$1";;
 231                 classify|default|reclassify)
 232                         case "$TYPE" in
 233                                 classify) var="ctrules";;
 234                                 *) var="rules";;
 235                         esac
 236                         append "$var" "$1"
 237                 ;;
 238         esac
 239 }
 240
 241 enum_classes() {
 242         local c="0"
 243         config_get classes "$1" classes
 244         config_get default "$1" default
 245         for class in $classes; do
 246                 c="$(($c + 1))"
 247                 config_set "${class}" classnr $c
 248                 case "$class" in
 249                         $default) class_default=$c;;
 250                 esac
 251         done
 252         class_default="${class_default:-$c}"
 253 }
 254
 255 cls_var() {
 256         local varname="$1"
 257         local class="$2"
 258         local name="$3"
 259         local type="$4"
 260         local default="$5"
 261         local tmp tmp1 tmp2
 262         config_get tmp1 "$class" "$name"
 263         config_get tmp2 "${class}_${type}" "$name"
 264         tmp="${tmp2:-$tmp1}"
 265         tmp="${tmp:-$tmp2}"
 266         export ${varname}="${tmp:-$default}"
 267 }
 268
 269 tcrules() {
 270         _dir=/usr/lib/qos
 271         [ -e $_dir/tcrules.awk ] || _dir=.
 272         echo "$cstr" | awk \
 273                 -v device="$dev" \
 274                 -v linespeed="$rate" \
 275                 -v direction="$dir" \
 276                 -f $_dir/tcrules.awk
 277 }
 278
 279 start_interface() {
 280         local iface="$1"
 281         local num_ifb="$2"
 282         config_get device "$iface" device
 283         config_get_bool enabled "$iface" enabled 1
 284         [ -z "$device" -o 1 -ne "$enabled" ] && {
 285                 return 1
 286         }
 287         config_get upload "$iface" upload
 288         config_get_bool halfduplex "$iface" halfduplex
 289         config_get download "$iface" download
 290         config_get classgroup "$iface" classgroup
 291         config_get_bool overhead "$iface" overhead 0
 292
 293         download="${download:-${halfduplex:+$upload}}"
 294         enum_classes "$classgroup"
 295         for dir in ${halfduplex:-up} ${download:+down}; do
 296                 case "$dir" in
 297                         up)
 298                                 [ "$overhead" = 1 ] && upload=$(($upload * 98 / 100 - (15 * 128 / $upload)))
 299                                 dev="$device"
 300                                 rate="$upload"
 301                                 dl_mode=""
 302                                 prefix="cls"
 303                         ;;
 304                         down)
 305                                 [ "$(ls -d /proc/sys/net/ipv4/conf/ifb* 2>&- | wc -l)" -ne "$num_ifb" ] && add_insmod ifb numifbs="$num_ifb"
 306                                 config_get ifbdev "$iface" ifbdev
 307                                 [ "$overhead" = 1 ] && download=$(($download * 98 / 100 - (80 * 1024 / $download)))
 308                                 dev="ifb$ifbdev"
 309                                 rate="$download"
 310                                 dl_mode=1
 311                                 prefix="d_cls"
 312                         ;;
 313                         *) continue;;
 314                 esac
 315                 cstr=
 316                 for class in $classes; do
 317                         cls_var pktsize "$class" packetsize $dir 1500
 318                         cls_var pktdelay "$class" packetdelay $dir 0
 319                         cls_var maxrate "$class" limitrate $dir 100
 320                         cls_var prio "$class" priority $dir 1
 321                         cls_var avgrate "$class" avgrate $dir 0
 322                         cls_var qdisc "$class" qdisc $dir ""
 323                         cls_var filter "$class" filter $dir ""
 324                         config_get classnr "$class" classnr
 325                         append cstr "$classnr:$prio:$avgrate:$pktsize:$pktdelay:$maxrate:$qdisc:$filter" "$N"
 326                 done
 327                 append ${prefix}q "$(tcrules)" "$N"
 328                 export dev_${dir}="ip link add ${dev} type ifb >&- 2>&-
 329 ip link set $dev up >&- 2>&-
 330 tc qdisc del dev $dev root >&- 2>&-
 331 tc qdisc add dev $dev root handle 1: hfsc default ${class_default}0
 332 tc class add dev $dev parent 1: classid 1:1 hfsc sc rate ${rate}kbit ul rate ${rate}kbit"
 333         done
 334         [ -n "$download" ] && {
 335                 add_insmod cls_u32
 336                 add_insmod em_u32
 337                 add_insmod act_connmark
 338                 add_insmod act_mirred
 339                 add_insmod sch_ingress
 340         }
 341         if [ -n "$halfduplex" ]; then
 342                 export dev_up="tc qdisc del dev $device root >&- 2>&-
 343 tc qdisc add dev $device root handle 1: hfsc
 344 tc filter add dev $device parent 1: prio 10 u32 match u32 0 0 flowid 1:1 action mirred egress redirect dev ifb$ifbdev"
 345         elif [ -n "$download" ]; then
 346                 append dev_${dir} "tc qdisc del dev $device ingress >&- 2>&-
 347 tc qdisc add dev $device ingress
 348 tc filter add dev $device parent ffff: prio 1 u32 match u32 0 0 flowid 1:1 action connmark action mirred egress redirect dev ifb$ifbdev" "$N"
 349         fi
 350         add_insmod cls_fw
 351         add_insmod sch_hfsc
 352
 353         cat <<EOF
 354 ${INSMOD:+$INSMOD$N}${dev_up:+$dev_up
 355 $clsq
 356 }${ifbdev:+$dev_down
 357 $d_clsq
 358 $d_clsl
 359 $d_clsf
 360 }
 361 EOF
 362         unset INSMOD clsq clsf clsl d_clsq d_clsl d_clsf dev_up dev_down
 363 }
 364
 365 start_interfaces() {
 366         local C="$1"
 367         for iface in $INTERFACES; do
 368                 start_interface "$iface" "$C"
 369         done
 370 }
 371
 372 add_rules() {
 373         local var="$1"
 374         local rules="$2"
 375         local prefix="$3"
 376
 377         for rule in $rules; do
 378                 unset iptrule
 379                 config_get target "$rule" target
 380                 config_get target "$target" classnr
 381                 config_get options "$rule" options
 382
 383                 ## If we want to override the TOS field, let's clear the DSCP field first.
 384                 [ ! -z "$(echo $options | grep 'TOS')" ] && {
 385                         s_options=${options%%TOS}
 386                         add_insmod xt_DSCP
 387                         parse_matching_rule iptrule "$rule" "$s_options" "$prefix" "-j DSCP --set-dscp 0"
 388                         append "$var" "$iptrule" "$N"
 389                         unset iptrule
 390                 }
 391
 392                 target=$(($target | ($target << 4)))
 393                 parse_matching_rule iptrule "$rule" "$options" "$prefix" "-j MARK --set-mark $target/0xff"
 394                 append "$var" "$iptrule" "$N"
 395         done
 396 }
 397
 398 start_cg() {
 399         local cg="$1"
 400         local iptrules
 401         local pktrules
 402         local sizerules
 403         enum_classes "$cg"
 404         for command in $iptables; do
 405                 add_rules iptrules "$ctrules" "$command -w -t mangle -A qos_${cg}_ct"
 406         done
 407         config_get classes "$cg" classes
 408         for class in $classes; do
 409                 config_get mark "$class" classnr
 410                 config_get maxsize "$class" maxsize
 411                 [ -z "$maxsize" -o -z "$mark" ] || {
 412                         add_insmod xt_length
 413                         for command in $iptables; do
 414                                 append pktrules "$command -w -t mangle -A qos_${cg} -m mark --mark $mark/0x0f -m length --length $maxsize: -j MARK --set-mark 0/0xff" "$N"
 415                         done
 416                 }
 417         done
 418         for command in $iptables; do
 419                 add_rules pktrules "$rules" "$command -w -t mangle -A qos_${cg}"
 420         done
 421         for iface in $INTERFACES; do
 422                 config_get classgroup "$iface" classgroup
 423                 config_get device "$iface" device
 424                 config_get ifbdev "$iface" ifbdev
 425                 config_get upload "$iface" upload
 426                 config_get download "$iface" download
 427                 config_get halfduplex "$iface" halfduplex
 428                 download="${download:-${halfduplex:+$upload}}"
 429                 for command in $iptables; do
 430                         append up "$command -w -t mangle -A OUTPUT -o $device -j qos_${cg}" "$N"
 431                         append up "$command -w -t mangle -A FORWARD -o $device -j qos_${cg}" "$N"
 432                 done
 433         done
 434         cat <<EOF
 435 $INSMOD
 436 EOF
 437
 438 for command in $iptables; do
 439         cat <<EOF
 440         $command -w -t mangle -N qos_${cg}
 441         $command -w -t mangle -N qos_${cg}_ct
 442 EOF
 443 done
 444 cat <<EOF
 445         ${iptrules:+${iptrules}${N}}
 446 EOF
 447 for command in $iptables; do
 448         cat <<EOF
 449         $command -w -t mangle -A qos_${cg}_ct -j CONNMARK --save-mark --mask 0xff
 450         $command -w -t mangle -A qos_${cg} -j CONNMARK --restore-mark --mask 0x0f
 451         $command -w -t mangle -A qos_${cg} -m mark --mark 0/0x0f -j qos_${cg}_ct
 452 EOF
 453 done
 454 cat <<EOF
 455 $pktrules
 456 EOF
 457 for command in $iptables; do
 458         cat <<EOF
 459         $command -w -t mangle -A qos_${cg} -j CONNMARK --save-mark --mask 0xff
 460 EOF
 461 done
 462 cat <<EOF
 463 $up$N${down:+${down}$N}
 464 EOF
 465         unset INSMOD
 466 }
 467
 468 start_firewall() {
 469         add_insmod xt_multiport
 470         add_insmod xt_connmark
 471         stop_firewall
 472         for group in $CG; do
 473                 start_cg $group
 474         done
 475 }
 476
 477 stop_firewall() {
 478         # Builds up a list of iptables commands to flush the qos_* chains,
 479         # remove rules referring to them, then delete them
 480
 481         # Print rules in the mangle table, like iptables-save
 482         for command in $iptables; do
 483                 $command -w -t mangle -S |
 484                         # Find rules for the qos_* chains
 485                         grep -E '(^-N qos_|-j qos_)' |
 486                         # Exclude rules in qos_* chains (inter-qos_* refs)
 487                         grep -v '^-A qos_' |
 488                         # Replace -N with -X and hold, with -F and print
 489                         # Replace -A with -D
 490                         # Print held lines at the end (note leading newline)
 491                         sed -e '/^-N/{s/^-N/-X/;H;s/^-X/-F/}' \
 492                                 -e 's/^-A/-D/' \
 493                                 -e '${p;g}' |
 494                         # Make into proper iptables calls
 495                         # Note: awkward in previous call due to hold space usage
 496                         sed -n -e "s/^./${command} -w -t mangle &/p"
 497         done
 498 }
 499
 500 C="0"
 501 INTERFACES=""
 502 [ -e ./qos.conf ] && {
 503         . ./qos.conf
 504         config_cb
 505 } || {
 506         config_load qos
 507         config_foreach qos_parse_config
 508 }
 509
 510 C="0"
 511 for iface in $INTERFACES; do
 512         export C="$(($C + 1))"
 513 done
 514
 515 [ -x /usr/sbin/ip6tables ] && {
 516         iptables="ip6tables iptables"
 517 } || {
 518         iptables="iptables"
 519 }
 520
 521 case "$1" in
 522         all)
 523                 start_interfaces "$C"
 524                 start_firewall
 525         ;;
 526         interface)
 527                 start_interface "$2" "$C"
 528         ;;
 529         interfaces)
 530                 start_interfaces
 531         ;;
 532         firewall)
 533                 case "$2" in
 534                         stop)
 535                                 stop_firewall
 536                         ;;
 537                         start|"")
 538                                 start_firewall
 539                         ;;
 540                 esac
 541         ;;
 542 esac