openwrt/package/qos-scripts/files/usr/lib/qos.sh

   1 #!/bin/sh
   2 . /etc/functions.sh
   3
   4 insmod="insmod"
   5 [ -f /sbin/modprobe ] && insmod="modprobe"
   6
   7 add_insmod() {
   8         eval "export isset=\${insmod_$1}"
   9         case "$isset" in
  10                 1) ;;
  11                 *) append INSMOD "$insmod $* >&- 2>&-" "$N"; export insmod_$1=1;;
  12         esac
  13 }
  14
  15 parse_matching_rule() {
  16         local var="$1"
  17         local section="$2"
  18         local options="$3"
  19         local prefix="$4"
  20         local suffix="$5"
  21         local proto="$6"
  22         local mport=""
  23         local ports=""
  24
  25         append "$var" "$prefix" "$N"
  26         for option in $options; do
  27                 case "$option" in
  28                         proto) config_get value "$section" proto; proto="${proto:-$value}";;
  29                 esac
  30         done
  31         config_get type "$section" TYPE
  32         case "$type" in
  33                 classify) unset pkt; append "$var" "-m mark --mark 0";;
  34                 default) pkt=1; append "$var" "-m mark --mark 0";;
  35                 reclassify) pkt=1;;
  36         esac
  37         append "$var" "${proto:+-p $proto}"
  38         for option in $options; do
  39                 config_get value "$section" "$option"
  40
  41                 case "$pkt:$option" in
  42                         *:srchost)
  43                                 append "$var" "-s $value"
  44                         ;;
  45                         *:dsthost)
  46                                 append "$var" "-d $value"
  47                         ;;
  48                         *:ipp2p)
  49                                 add_insmod ipt_ipp2p
  50                                 append "$var" "-m ipp2p"
  51                                 case "$value" in
  52                                         all) append "$var" "--edk --dc --kazaa --gnu --bit";;
  53                                         *) append "$var" "--$value";;
  54                                 esac
  55                         ;;
  56                         *:layer7)
  57                                 add_insmod ipt_layer7
  58                                 append "$var" "-m layer7 --l7proto $value${pkt:+ --l7pkt}"
  59                         ;;
  60                         *:ports|*:srcports|*:dstports)
  61                                 value="$(echo "$value" | sed -e 's,-,:,g')"
  62                                 lproto=${lproto:-tcp}
  63                                 case "$proto" in
  64                                         ""|tcp|udp) append "$var" "-m ${proto:-tcp -p tcp} -m multiport";;
  65                                         *) unset "$var"; return 0;;
  66                                 esac
  67                                 case "$option" in
  68                                         ports)
  69                                                 config_set "$section" srcports ""
  70                                                 config_set "$section" dstports ""
  71                                                 config_set "$section" portrange ""
  72                                                 append "$var" "--ports $value"
  73                                         ;;
  74                                         srcports)
  75                                                 config_set "$section" ports ""
  76                                                 config_set "$section" dstports ""
  77                                                 config_set "$section" portrange ""
  78                                                 append "$var" "--sports $value"
  79                                         ;;
  80                                         dstports)
  81                                                 config_set "$section" ports ""
  82                                                 config_set "$section" srcports ""
  83                                                 config_set "$section" portrange ""
  84                                                 append "$var" "--dports $value"
  85                                         ;;
  86                                 esac
  87                                 ports=1
  88                         ;;
  89                         *:portrange)
  90                                 config_set "$section" ports ""
  91                                 config_set "$section" srcports ""
  92                                 config_set "$section" dstports ""
  93                                 value="$(echo "$value" | sed -e 's,-,:,g')"
  94                                 case "$proto" in
  95                                         ""|tcp|udp) append "$var" "-m ${proto:-tcp -p tcp} --sport $value --dport $value";;
  96                                         *) unset "$var"; return 0;;
  97                                 esac
  98                                 ports=1
  99                         ;;
 100                         1:pktsize)
 101                                 value="$(echo "$value" | sed -e 's,-,:,g')"
 102                                 add_insmod ipt_length
 103                                 append "$var" "-m length --length $value"
 104                         ;;
 105                         1:limit)
 106                                 add_insmod ipt_limit
 107                                 append "$var" "-m limit --limit $value"
 108                         ;;
 109                         1:tcpflags)
 110                                 case "$proto" in
 111                                         tcp) append "$var" "-m tcp --tcp-flags ALL $value";;
 112                                         *) unset $var; return 0;;
 113                                 esac
 114                         ;;
 115                         1:mark)
 116                                 config_get class "${value##!}" classnr
 117                                 [ -z "$class" ] && continue;
 118                                 case "$value" in
 119                                         !*) append "$var" "-m mark ! --mark $class";;
 120                                         *) append "$var" "-m mark --mark $class";;
 121                                 esac
 122                 esac
 123         done
 124         append "$var" "$suffix"
 125         case "$ports:$proto" in
 126                 1:)     parse_matching_rule "$var" "$section" "$options" "$prefix" "$suffix" "udp";;
 127         esac
 128 }
 129
 130 config_cb() {
 131         option_cb() {
 132                 return 0
 133         }
 134
 135         # Section start
 136         case "$1" in
 137                 interface)
 138                         config_set "$1" "classgroup" "Default"
 139                         config_set "$1" "upload" "128"
 140                         config_set "$1" "download" "1024"
 141                 ;;
 142                 classify|default|reclassify)
 143                         option_cb() {
 144                                 append options "$1"
 145                         }
 146                 ;;
 147         esac
 148
 149     # Section end
 150         config_get TYPE "$CONFIG_SECTION" TYPE
 151         case "$TYPE" in
 152                 interface)
 153                         config_get enabled "$CONFIG_SECTION" enabled
 154                         config_get download "$CONFIG_SECTION" download
 155                         config_get classgroup "$CONFIG_SECTION" classgroup
 156                         config_set "$CONFIG_SECTION" imqdev "$C"
 157                         [ -z "$enabled" -o "$(($enabled))" -eq 0 ] || {
 158                                 C=$(($C+1))
 159                                 INTERFACES="$INTERFACES $CONFIG_SECTION"
 160                                 config_set "$classgroup" enabled 1
 161                         }
 162                         config_get device "$CONFIG_SECTION" device
 163                         [ -z "$device" ] && device="$(nvram get ${CONFIG_SECTION}_ifname)"
 164                         config_set "$CONFIG_SECTION" device "${device:-eth0}"
 165                 ;;
 166                 classgroup) append CG "$CONFIG_SECTION";;
 167                 classify|default|reclassify)
 168                         case "$TYPE" in
 169                                 classify) var="ctrules";;
 170                                 *) var="rules";;
 171                         esac
 172                         config_get target "$CONFIG_SECTION" target
 173                         config_set "$CONFIG_SECTION" options "$options"
 174                         append "$var" "$CONFIG_SECTION"
 175                         unset options
 176                 ;;
 177         esac
 178 }
 179
 180 class_main_qdisc() {
 181         local device="$1"
 182         awk -f - <<EOF
 183 BEGIN {
 184         limit = int("$maxrate")
 185         m2 = int("$m2")
 186         dmax = int("$dmax")
 187         umax = int("$umax")
 188         share = int("$share")
 189
 190         if (!(m2 > 0)) {
 191                 dmax = 500
 192                 umax = 1500
 193                 m2 = 10
 194                 rt = 0
 195         } else {
 196                 rt = 1
 197         }
 198
 199         cdata = ""
 200         pdmax = int (dmax + (umax * 8 / limit))
 201         if (rt == 1) {
 202                 if (share > 0) cdata = " rt"
 203                 else cdata = " ls"
 204                 if ((umax > 0) && (dmax > 0)) {
 205                         cdata = cdata " umax " umax "b dmax " pdmax "ms"
 206                 }
 207                 cdata = cdata " rate " m2 "kbit"
 208         }
 209         if (share > 0) {
 210                 if ((m2 > 0) && (umax > 0) && (dmax > 0)) {
 211                         cdata = cdata " ls umax " umax "b dmax " pdmax "ms rate " share "kbit"
 212                 } else {
 213                         cdata = cdata " ls m1 " share "kbit d 500ms m2 " share "kbit"
 214                 }
 215         }
 216
 217         print "tc class add dev $device parent 1:1 classid 1:${classnr}0 hfsc" cdata " ul rate " limit "kbit"
 218 }
 219 EOF
 220 }
 221
 222 class_leaf_qdisc() {
 223         local device="$1"
 224         awk -f - <<EOF
 225
 226 function qlen(rate, m2, umax, dmax,    qb, qr, qt, ql) {
 227         qlen_min = 5 # minimum queue length
 228         qlen_base = 1.7 # base value - queueing time in seconds
 229         qlen_avgr = 0.7 # avgrate modifier
 230         qlen_dmax = 0.0 # dmax modifier
 231
 232         # bits in a packet
 233         qb = 1500
 234         if ((m2 > 0) && (umax > 0)) qb -= int((1500 - umax) * qlen_pkt)
 235         qb *= 8
 236
 237         # rate in bits/s
 238         qr = rate
 239         qr -= int((rate - m2) * qlen_avgr)
 240         qr *= 1024
 241
 242         # queue time
 243         qt = qlen_base + qlen_dmax * (dmax / 1000)
 244
 245         # queue length
 246         ql = int(qr * qt / qb)
 247         if (ql < qlen_min) ql = qlen_min
 248
 249         return ql
 250 }
 251
 252 BEGIN {
 253         sfq_dthresh     = 25 # use sfq for download if pktdelay set to this or lower
 254
 255         limit = int("$maxrate")
 256         m2 = int("$m2")
 257         dmax = int("$dmax")
 258         umax = int("$umax")
 259
 260         if (!(m2 > 0)) {
 261                 dmax = 500
 262                 umax = 1500
 263                 m2 = 10
 264         }
 265
 266         cqlen = ${dl_mode:+2 * }qlen(limit, m2, umax, dmax)
 267
 268         printf "tc qdisc add dev $device parent 1:${classnr}0 handle ${classnr}00: "
 269         if (("$dir" != "down") || ((dmax > 0) && (dmax <= sfq_dthresh))) {
 270                 print "sfq perturb 10 limit " cqlen
 271         } else {
 272                 avpkt = 1200
 273                 min = int(limit * 1024 / 8 * 0.1)
 274                 dqb = cqlen * 1500
 275                 max = int(min + (dqb - min) * 0.25)
 276                 burst = int((2 * min + max) / (3 * avpkt))
 277
 278                 print "red min " min " max " max " burst " burst " avpkt " avpkt " limit " dqb " probability 0.04 ecn"
 279         }
 280 }
 281 EOF
 282 }
 283
 284 enum_classes() {
 285         local c="0"
 286         config_get classes "$1" classes
 287         config_get default "$1" default
 288         for class in $classes; do
 289                 c="$(($c + 1))"
 290                 config_set "${class}" classnr $c
 291                 case "$class" in
 292                         $default) class_default=$c;;
 293                 esac
 294         done
 295         class_default="${class_default:-$c}"
 296 }
 297
 298 cls_var() {
 299         local varname="$1"
 300         local class="$2"
 301         local name="$3"
 302         local type="$4"
 303         local default="$5"
 304         local tmp tmp1 tmp2
 305         config_get tmp1 "$class" "$name"
 306         config_get tmp2 "${class}_${type}" "$name"
 307         tmp="${tmp2:-$tmp1}"
 308         tmp="${tmp:-$tmp2}"
 309         export ${varname}="${tmp:-$default}"
 310 }
 311
 312 start_interface() {
 313         local iface="$1"
 314         local num_imq="$2"
 315         config_get device "$iface" device
 316         config_get enabled "$iface" enabled
 317         [ -z "$device" -o -z "$enabled" ] && exit
 318         config_get upload "$iface" upload
 319         config_get halfduplex "$iface" halfduplex
 320         config_get download "$iface" download
 321         config_get classgroup "$iface" classgroup
 322
 323         download="${download:-${halfduplex:+$upload}}"
 324         enum_classes "$classgroup"
 325         for dir in up${halfduplex} ${download:+down}; do
 326                 case "$dir" in
 327                         up)
 328                                 upload=$(($upload * 98 / 100 - 10))
 329                                 dev="$device"
 330                                 rate="$upload"
 331                                 dl_mode=""
 332                                 prefix="cls"
 333                         ;;
 334                         down)
 335                                 add_insmod imq numdevs="$num_imq"
 336                                 config_get imqdev "$iface" imqdev
 337                                 download=$(($download * 96 / 100 - 64))
 338                                 dev="imq$imqdev"
 339                                 rate="$download"
 340                                 dl_mode=1
 341                                 prefix="d_cls"
 342                         ;;
 343                         *) continue;;
 344                 esac
 345                 for class in $classes; do
 346                         cls_var umax "$class" packetsize $dir 1500
 347                         cls_var dmax "$class" packetdelay $dir 500
 348
 349                         cls_var maxrate "$class" limitrate $dir 100
 350                         cls_var share "$class" linksharing $dir 0
 351                         cls_var m2 "$class" avgrate $dir 0
 352                         maxrate=$(($maxrate * $rate / 100))
 353                         share=$(($share * $rate / 100))
 354                         m2=$(($m2 * $rate / 100))
 355
 356                         config_get classnr "$class" classnr
 357                         append ${prefix}q "$(class_main_qdisc "$dev" "$iface")" "$N"
 358                         append ${prefix}l "$(class_leaf_qdisc "$dev" "$iface")" "$N"
 359                         append ${prefix}f "tc filter add dev $dev parent 1: prio $classnr protocol ip handle $classnr fw flowid 1:${classnr}0" "$N"
 360                 done
 361                 export dev_${dir}="ifconfig $dev up txqueuelen 5 >&- 2>&-
 362 tc qdisc del dev $dev root >&- 2>&-
 363 tc qdisc add dev $dev root handle 1: hfsc default ${class_default}0
 364 tc class add dev $dev parent 1: classid 1:1 hfsc sc rate ${rate}kbit ul rate ${rate}kbit"
 365         done
 366         add_insmod cls_fw
 367         add_insmod sch_hfsc
 368         add_insmod sch_sfq
 369         add_insmod sch_red
 370         cat <<EOF
 371 ${INSMOD:+$INSMOD$N}${dev_up:+$dev_up
 372 $clsq
 373 $clsl
 374 $clsf
 375 }${imqdev:+$dev_down
 376 $d_clsq
 377 $d_clsl
 378 $d_clsf
 379 }
 380 EOF
 381         unset INSMOD clsq clsf clsl d_clsq d_clsl d_clsf dev_up dev_down
 382 }
 383
 384 start_interfaces() {
 385         local C="$1"
 386         for iface in $INTERFACES; do
 387                 start_interface "$iface" "$C"
 388         done
 389 }
 390
 391 add_rules() {
 392         local var="$1"
 393         local rules="$2"
 394         local prefix="$3"
 395
 396         for rule in $rules; do
 397                 unset iptrule
 398                 config_get target "$rule" target
 399                 config_get target "$target" classnr
 400                 config_get options "$rule" options
 401                 parse_matching_rule iptrule "$rule" "$options" "$prefix" "-j MARK --set-mark $target"
 402                 append "$var" "$iptrule" "$N"
 403         done
 404 }
 405
 406 start_cg() {
 407         local cg="$1"
 408         local iptrules
 409         local pktrules
 410         local sizerules
 411         local download
 412         enum_classes "$cg"
 413         add_rules iptrules "$ctrules" "iptables -t mangle -A ${cg}_ct"
 414         config_get classes "$cg" classes
 415         for class in $classes; do
 416                 config_get mark "$class" classnr
 417                 config_get maxsize "$class" maxsize
 418                 [ -z "$maxsize" -o -z "$mark" ] || {
 419                         add_insmod ipt_length
 420                         append pktrules "iptables -t mangle -A ${cg} -m mark --mark $mark -m length --length $maxsize: -j MARK --set-mark 0" "$N"
 421                 }
 422         done
 423         add_rules pktrules "$rules" "iptables -t mangle -A ${cg}"
 424         for iface in $INTERFACES; do
 425                 config_get classgroup "$iface" classgroup
 426                 config_get device "$iface" device
 427                 config_get imqdev "$iface" imqdev
 428                 config_get dl "$iface" download
 429                 config_get halfduplex "$iface" halfduplex
 430                 add_insmod ipt_IMQ
 431                 append up "iptables -t mangle -A OUTPUT -o $device -j ${cg}" "$N"
 432                 append up "iptables -t mangle -A FORWARD -o $device -j ${cg}" "$N"
 433                 [ -z "$dl" ] || {
 434                         [ -z "$halfduplex" ] || {
 435                                 append down "iptables -t mangle -A POSTROUTING -o $device -j IMQ --todev $imqdev" "$N"
 436                         }
 437                         append down "iptables -t mangle -A PREROUTING -i $device -j ${cg}" "$N"
 438                         append down "iptables -t mangle -A PREROUTING -i $device -j IMQ --todev $imqdev" "$N"
 439                 }
 440         done
 441         cat <<EOF
 442 $INSMOD
 443 iptables -t mangle -N ${cg} >&- 2>&-
 444 iptables -t mangle -N ${cg}_ct >&- 2>&-
 445 ${iptrules:+${iptrules}${N}iptables -t mangle -A ${cg}_ct -j CONNMARK --save-mark}
 446 iptables -t mangle -A ${cg} -j CONNMARK --restore-mark
 447 iptables -t mangle -A ${cg} -m mark --mark 0 -j ${cg}_ct
 448 $pktrules
 449 $up$N${down:+${down}$N}
 450 EOF
 451         unset INSMOD
 452 }
 453
 454 start_firewall() {
 455         add_insmod ipt_multiport
 456         add_insmod ipt_CONNMARK
 457         cat <<EOF
 458 iptables -t mangle -F
 459 iptables -t mangle -X
 460 EOF
 461         for group in $CG; do
 462                 start_cg $group
 463         done
 464 }
 465
 466 C="0"
 467 INTERFACES=""
 468 config_load qos
 469
 470 C="0"
 471 for iface in $INTERFACES; do
 472         export C="$(($C + 1))"
 473 done
 474
 475 case "$1" in
 476         all)
 477                 start_interfaces "$C"
 478                 start_firewall
 479         ;;
 480         interface)
 481                 start_interface "$2" "$C"
 482         ;;
 483         interfaces)
 484                 start_interfaces
 485         ;;
 486         firewall)
 487                 start_firewall
 488         ;;
 489 esac