#!/bin/sh

# Link and QoS classes 
################################################################################
# Modification History;
#
# 2007/05/30 Pranab Bohra
# Q01617220 - Changed the "limit" value for individual pfifo queues from 5 to 105.
#
#################################################################################

TC=/sbin/tc
EXIT_CODE=0

#Link speed we receive as parameter for this script is expected in Kilo bits / second!
#Convert all kbits values into bytes per second
DEV=$1

LINK_SPEED=$(( (($2*1000)/8) ))

# Configure each queue based on its average frame size (mtu value in HTB)
PARENT_MTU=256
PREMIUM_MTU=256
NETWORK_MTU=512
PLATINUM_MTU=512
GOLD_MTU=512
SILVER_MTU=512
BRONZE_MTU=512
STANDARD_MTU=512

# Here we have to check if the egress device is a wan interface. 
# If the case, then we must adjust the layer2 frame header length.
# In BCM, the wanx network devices use an "ethernet" header at the
# IP networking level (which is 14 bytes long not counting the FCS).
# In reality, a normal wan network device would use a 6-byte long
# Q.922 header with FCS to carry IP PDUs. The adjustment is based
# on the average frame size per queue. The parent queue will also
# need to be adjusted based on the sum of adjustments of each queue.
#
# Here are the adjustments per average frame size:
#   Formula:  adjustment = (8/frame size) where
#             14-6=8 (eth hdr - fcs - Q.922 hdr with fcs)
#
#   Size:  64   Adjustment: 1.125 [x * 1125/1000]
#   Size: 256   Adjustment: 1.031 [x * 1031/1000]
#   Size: 512   Adjustment: 1.015 [x * 1015/1000]
#
#   However, by experimenting with traffic generators, 
#   queue #1 gets better results if we use 2.6% increase
#   in bandwidth when the average frame size is 256. 
#   Queues #2 to #7 get better results if there is no 
#   adjustment in bandwidth. 
#
# There is another adjustment that needs to be implemented
# for the voice traffic queue #1. The lowest average frame
# size value that can be programmed is 256. However, the 
# target value is 64 bytes long frames on average. To 
# compensate for this difference, we need to increase the
# rate and ceil values by a linear factor.
#
# Similarly, there are adjustments required on the non-WAN interfaces.
#
# However, by experimenting with a traffic generator, 
# it was found that theoritical queue adjustments did not 
# necessarily matched the practical ones. The exact values
# are defined in the constants below.

RATE_INCREASE=0
TMP_RATE=0
TMP_CEIL=0
WAN_HEADER_ADJ_64=112
WAN_HEADER_ADJ_256=31
WAN_HEADER_ADJ_512=7
WAN_HEADER_ADJ_DIVIDER=1000
OTHER_HEADER_ADJ_64=-60
OTHER_HEADER_ADJ_256=-15
OTHER_HEADER_ADJ_512=-15
OTHER_HEADER_ADJ_DIVIDER=1000

if [ "$1" = "wan1" ] || [ "$1" = "wan2" ]
then
   # Adjustements are required to rates and ceil values.

   RATE_TMP=$(( (${3}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${4}*$LINK_SPEED)/100 ))
   PREMIUM_RATE=$(( $RATE_TMP+($WAN_HEADER_ADJ_64*($RATE_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   PREMIUM_CEIL=$(( $CEIL_TMP+($WAN_HEADER_ADJ_64*($CEIL_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($PREMIUM_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${5}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${6}*$LINK_SPEED)/100 ))
   NETWORK_RATE=$(( $RATE_TMP+($WAN_HEADER_ADJ_512*($RATE_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   NETWORK_CEIL=$(( $CEIL_TMP+($WAN_HEADER_ADJ_512*($CEIL_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($NETWORK_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${7}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${8}*$LINK_SPEED)/100 ))
   PLATINUM_RATE=$(( $RATE_TMP+($WAN_HEADER_ADJ_512*($RATE_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   PLATINUM_CEIL=$(( $CEIL_TMP+($WAN_HEADER_ADJ_512*($CEIL_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($PLATINUM_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${9}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${10}*$LINK_SPEED)/100 ))
   GOLD_RATE=$(( $RATE_TMP+($WAN_HEADER_ADJ_512*($RATE_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   GOLD_CEIL=$(( $CEIL_TMP+($WAN_HEADER_ADJ_512*($CEIL_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($GOLD_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${11}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${12}*$LINK_SPEED)/100 ))
   SILVER_RATE=$(( $RATE_TMP+($WAN_HEADER_ADJ_512*($RATE_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   SILVER_CEIL=$(( $CEIL_TMP+($WAN_HEADER_ADJ_512*($CEIL_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($SILVER_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${13}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${14}*$LINK_SPEED)/100 ))
   BRONZE_RATE=$(( $RATE_TMP+($WAN_HEADER_ADJ_512*($RATE_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   BRONZE_CEIL=$(( $CEIL_TMP+($WAN_HEADER_ADJ_512*($CEIL_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($BRONZE_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${15}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${16}*$LINK_SPEED)/100 ))
   STANDARD_RATE=$(( $RATE_TMP+($WAN_HEADER_ADJ_512*($RATE_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   STANDARD_CEIL=$(( $CEIL_TMP+($WAN_HEADER_ADJ_512*($CEIL_TMP)/$WAN_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($STANDARD_RATE-$RATE_TMP)+$RATE_INCREASE ))
else
   # Adjustements are required to rates and ceil values.

   RATE_TMP=$(( (${3}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${4}*$LINK_SPEED)/100 ))
   PREMIUM_RATE=$(( $RATE_TMP+($OTHER_HEADER_ADJ_256*($RATE_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   PREMIUM_CEIL=$(( $CEIL_TMP+($OTHER_HEADER_ADJ_256*($CEIL_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($PREMIUM_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${5}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${6}*$LINK_SPEED)/100 ))
   NETWORK_RATE=$(( $RATE_TMP+($OTHER_HEADER_ADJ_512*($RATE_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   NETWORK_CEIL=$(( $CEIL_TMP+($OTHER_HEADER_ADJ_512*($CEIL_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($NETWORK_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${7}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${8}*$LINK_SPEED)/100 ))
   PLATINUM_RATE=$(( $RATE_TMP+($OTHER_HEADER_ADJ_512*($RATE_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   PLATINUM_CEIL=$(( $CEIL_TMP+($OTHER_HEADER_ADJ_512*($CEIL_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($PLATINUM_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${9}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${10}*$LINK_SPEED)/100 ))
   GOLD_RATE=$(( $RATE_TMP+($OTHER_HEADER_ADJ_512*($RATE_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   GOLD_CEIL=$(( $CEIL_TMP+($OTHER_HEADER_ADJ_512*($CEIL_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($GOLD_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${11}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${12}*$LINK_SPEED)/100 ))
   SILVER_RATE=$(( $RATE_TMP+($OTHER_HEADER_ADJ_512*($RATE_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   SILVER_CEIL=$(( $CEIL_TMP+($OTHER_HEADER_ADJ_512*($CEIL_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($SILVER_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${13}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${14}*$LINK_SPEED)/100 ))
   BRONZE_RATE=$(( $RATE_TMP+($OTHER_HEADER_ADJ_512*($RATE_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   BRONZE_CEIL=$(( $CEIL_TMP+($OTHER_HEADER_ADJ_512*($CEIL_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($BRONZE_RATE-$RATE_TMP)+$RATE_INCREASE ))

   RATE_TMP=$(( (${15}*$LINK_SPEED)/100 ))
   CEIL_TMP=$(( (${16}*$LINK_SPEED)/100 ))
   STANDARD_RATE=$(( $RATE_TMP+($OTHER_HEADER_ADJ_512*($RATE_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   STANDARD_CEIL=$(( $CEIL_TMP+($OTHER_HEADER_ADJ_512*($CEIL_TMP)/$OTHER_HEADER_ADJ_DIVIDER) ))
   RATE_INCREASE=$(( ($STANDARD_RATE-$RATE_TMP)+$RATE_INCREASE ))
fi

HTB_QUEUES_RATE=$(( ($LINK_SPEED+RATE_INCREASE) ))

# Configure the TOS values per network class
PREMIUM_TOS_1=0xB8
PREMIUM_TOS_2=0xA0
NETWORK_TOS_1=0xC0
NETWORK_TOS_2=0xE0
PLATINUM_TOS_1=0x80
PLATINUM_TOS_2=0x88
PLATINUM_TOS_3=0x90
PLATINUM_TOS_4=0x98
GOLD_TOS_1=0x60
GOLD_TOS_2=0x68
GOLD_TOS_3=0x70
GOLD_TOS_4=0x78
SILVER_TOS_1=0x40
SILVER_TOS_2=0x48
SILVER_TOS_3=0x50
SILVER_TOS_4=0x58
BRONZE_TOS_1=0x20
BRONZE_TOS_2=0x28
BRONZE_TOS_3=0x30
BRONZE_TOS_4=0x38
STANDARD_TOS=0x00

HTB_QUEUES_RATE=${HTB_QUEUES_RATE}bps

PREMIUM_RATE=${PREMIUM_RATE}bps
NETWORK_RATE=${NETWORK_RATE}bps
PLATINUM_RATE=${PLATINUM_RATE}bps
GOLD_RATE=${GOLD_RATE}bps
SILVER_RATE=${SILVER_RATE}bps
BRONZE_RATE=${BRONZE_RATE}bps
STANDARD_RATE=${STANDARD_RATE}bps

PREMIUM_CEIL=${PREMIUM_CEIL}bps
NETWORK_CEIL=${NETWORK_CEIL}bps
PLATINUM_CEIL=${PLATINUM_CEIL}bps
GOLD_CEIL=${GOLD_CEIL}bps
SILVER_CEIL=${SILVER_CEIL}bps
BRONZE_CEIL=${BRONZE_CEIL}bps
STANDARD_CEIL=${STANDARD_CEIL}bps 

LINK_SPEED=${LINK_SPEED}bps

DROP_RATE=4bps
DROP_CEIL=4bps
DROP_MTU=256

#End computation


# Adjust the parameters in case all traffic must be dropped on a given queue.
# Also set the rate or ceil values to the lowest possible value in case
# they are set to "0".
if [ "$PREMIUM_RATE" = "0bps" ]
then
  PREMIUM_RATE=${DROP_RATE}
  PREMIUM_MTU=${DROP_MTU}
  if  [ "$PREMIUM_CEIL" = "0bps" ]
  then   
    PREMIUM_CEIL=${DROP_CEIL}
  fi
fi
if [ "$NETWORK_RATE" = "0bps" ]
then
  NETWORK_RATE=${DROP_RATE}
  NETWORK_MTU=${DROP_MTU}
  if  [ "$NETWORK_CEIL" = "0bps" ]
  then   
    NETWORK_CEIL=${DROP_CEIL}
  fi
fi
if [ "$PLATINUM_RATE" = "0bps" ]
then
  PLATINUM_RATE=${DROP_RATE}
  PLATINUM_MTU=${DROP_MTU}
  if  [ "$PLATINUM_CEIL" = "0bps" ]
  then   
    PLATINUM_CEIL=${DROP_CEIL}
  fi
fi
if [ "$GOLD_RATE" = "0bps" ]
then
  GOLD_RATE=${DROP_RATE}
  GOLD_MTU=${DROP_MTU}
  if  [ "$GOLD_CEIL" = "0bps" ]
  then   
    GOLD_CEIL=${DROP_CEIL}
  fi
fi
if [ "$SILVER_RATE" = "0bps" ]
then
  SILVER_RATE=${DROP_RATE}
  SILVER_MTU=${DROP_MTU}
  if  [ "$SILVER_CEIL" = "0bps" ]
  then   
    SILVER_CEIL=${DROP_CEIL}
  fi
fi
if [ "$BRONZE_RATE" = "0bps" ]
then
  BRONZE_RATE=${DROP_RATE}
  BRONZE_MTU=${DROP_MTU}
  if  [ "$BRONZE_CEIL" = "0bps" ]
  then   
    BRONZE_CEIL=${DROP_CEIL}
  fi
fi
if [ "$STANDARD_RATE" = "0bps" ]
then
  STANDARD_RATE=${DROP_RATE}
  STANDARD_MTU=${DROP_MTU}
  if  [ "$STANDARD_CEIL" = "0bps" ]
  then   
    STANDARD_CEIL=${DROP_CEIL}
  fi
fi

#Free pevious QoS Settings
$TC qdisc del  dev $DEV root handle 1: htb default 16 2> /dev/null

#Attach HTB to ethX
$TC qdisc add dev $DEV root handle 1: htb default 16 ; EXIT_CODE=$(($EXIT_CODE+$?))


$TC class add dev $DEV parent 1: classid 1:1 htb rate $HTB_QUEUES_RATE ceil $HTB_QUEUES_RATE mtu $PARENT_MTU; EXIT_CODE=$(($EXIT_CODE+$?))


#Create the other 7 classes :PREMIUM,NETWORK,PLATINUM ....
$TC class add dev $DEV parent 1:1 classid 1:10 htb rate $PREMIUM_RATE ceil $PREMIUM_CEIL mtu $PREMIUM_MTU  prio 0 ; EXIT_CODE=$(($EXIT_CODE+$?))
$TC class add dev $DEV parent 1:1 classid 1:11 htb rate $NETWORK_RATE ceil $NETWORK_CEIL mtu $NETWORK_MTU  prio 1 ; EXIT_CODE=$(($EXIT_CODE+$?))
$TC class add dev $DEV parent 1:1 classid 1:12 htb rate $PLATINUM_RATE ceil $PLATINUM_CEIL mtu $PLATINUM_MTU prio 1 ; EXIT_CODE=$(($EXIT_CODE+$?))
$TC class add dev $DEV parent 1:1 classid 1:13 htb rate $GOLD_RATE  ceil $GOLD_CEIL      mtu $GOLD_MTU  prio 1 ; EXIT_CODE=$(($EXIT_CODE+$?))
$TC class add dev $DEV parent 1:1 classid 1:14 htb rate $SILVER_RATE ceil $SILVER_CEIL   mtu $SILVER_MTU  prio 1 ; EXIT_CODE=$(($EXIT_CODE+$?))
$TC class add dev $DEV parent 1:1 classid 1:15 htb rate $BRONZE_RATE  ceil $BRONZE_CEIL  mtu $BRONZE_MTU  prio 1 ; EXIT_CODE=$(($EXIT_CODE+$?))
$TC class add dev $DEV parent 1:1 classid 1:16 htb rate $STANDARD_RATE ceil $STANDARD_CEIL mtu $STANDARD_MTU prio 1 ; EXIT_CODE=$(($EXIT_CODE+$?))

#Attach queuing disciplines to the leaf classes
$TC qdisc add dev $DEV parent 1:10 handle 20: pfifo limit 105; EXIT_CODE=$(($EXIT_CODE+$?))
$TC qdisc add dev $DEV parent 1:11 handle 30: pfifo limit 105; EXIT_CODE=$(($EXIT_CODE+$?))
$TC qdisc add dev $DEV parent 1:12 handle 40: pfifo limit 105; EXIT_CODE=$(($EXIT_CODE+$?))
$TC qdisc add dev $DEV parent 1:13 handle 50: pfifo limit 105; EXIT_CODE=$(($EXIT_CODE+$?))
$TC qdisc add dev $DEV parent 1:14 handle 60: pfifo limit 105; EXIT_CODE=$(($EXIT_CODE+$?))
$TC qdisc add dev $DEV parent 1:15 handle 70: pfifo limit 105; EXIT_CODE=$(($EXIT_CODE+$?))
$TC qdisc add dev $DEV parent 1:16 handle 80: pfifo limit 105; EXIT_CODE=$(($EXIT_CODE+$?))

#Attach filters to the leaf classes
$TC filter add dev $DEV parent 1:0 prio 1 protocol ip u32 match ip tos $PREMIUM_TOS_1  0xff flowid 1:10; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 2 protocol ip u32 match ip tos $PREMIUM_TOS_2  0xff flowid 1:10; EXIT_CODE=$(($EXIT_CODE+$?))

$TC filter add dev $DEV parent 1:0 prio 3 protocol ip u32 match ip tos $NETWORK_TOS_1  0xff flowid 1:11; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 4 protocol ip u32 match ip tos $NETWORK_TOS_2  0xff flowid 1:11; EXIT_CODE=$(($EXIT_CODE+$?))

$TC filter add dev $DEV parent 1:0 prio 5 protocol ip u32 match ip tos $PLATINUM_TOS_1   0xff flowid 1:12; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 6 protocol ip u32 match ip tos $PLATINUM_TOS_2   0xff flowid 1:12; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 7 protocol ip u32 match ip tos $PLATINUM_TOS_3   0xff flowid 1:12; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 8 protocol ip u32 match ip tos $PLATINUM_TOS_4   0xff flowid 1:12; EXIT_CODE=$(($EXIT_CODE+$?))

$TC filter add dev $DEV parent 1:0 prio 9   protocol ip u32 match ip tos $GOLD_TOS_1       0xff flowid 1:13; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 10  protocol ip u32 match ip tos $GOLD_TOS_2       0xff flowid 1:13; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 11  protocol ip u32 match ip tos $GOLD_TOS_3       0xff flowid 1:13; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 12  protocol ip u32 match ip tos $GOLD_TOS_4       0xff flowid 1:13; EXIT_CODE=$(($EXIT_CODE+$?))


$TC filter add dev $DEV parent 1:0 prio 13  protocol ip u32 match ip tos $SILVER_TOS_1     0xff flowid 1:14; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 14  protocol ip u32 match ip tos $SILVER_TOS_2     0xff flowid 1:14; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 15  protocol ip u32 match ip tos $SILVER_TOS_3     0xff flowid 1:14; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 16  protocol ip u32 match ip tos $SILVER_TOS_4     0xff flowid 1:14; EXIT_CODE=$(($EXIT_CODE+$?))


$TC filter add dev $DEV parent 1:0 prio 17 protocol ip u32 match ip tos $BRONZE_TOS_1     0xff flowid 1:15; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 18 protocol ip u32 match ip tos $BRONZE_TOS_2     0xff flowid 1:15; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 19 protocol ip u32 match ip tos $BRONZE_TOS_3     0xff flowid 1:15; EXIT_CODE=$(($EXIT_CODE+$?))
$TC filter add dev $DEV parent 1:0 prio 20 protocol ip u32 match ip tos $BRONZE_TOS_4     0xff flowid 1:15; EXIT_CODE=$(($EXIT_CODE+$?))

#No filter for default class
#$TC filter add dev $DEV protocol ip parent 1:0 prio 9 u32 match ip tos $STANDARD_TOS    0xff flowid 1:16

exit $EXIT_CODE
