1aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger/* 2aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * q_tbf.c TBF. 3aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * 4aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * This program is free software; you can redistribute it and/or 5aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * modify it under the terms of the GNU General Public License 6aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * as published by the Free Software Foundation; either version 7aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * 2 of the License, or (at your option) any later version. 8aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * 9aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru> 10aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * 11aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger */ 12aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 13aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <stdio.h> 14aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <stdlib.h> 15aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <unistd.h> 16aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <syslog.h> 17aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <fcntl.h> 18aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <sys/socket.h> 19aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <netinet/in.h> 20aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <arpa/inet.h> 21aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <string.h> 22aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 23aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include "utils.h" 24aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include "tc_util.h" 25aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 26aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstatic void explain(void) 27aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 28aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Usage: ... tbf limit BYTES burst BYTES[/BYTES] rate KBPS [ mtu BYTES[/BYTES] ]\n"); 292c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer fprintf(stderr, " [ peakrate KBPS ] [ latency TIME ] "); 30292f29b42c3444375b5ae7086484c99da7129d94Jesper Dangaard Brouer fprintf(stderr, "[ overhead BYTES ] [ linklayer TYPE ]\n"); 31aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 32aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 333bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijkstatic void explain1(const char *arg, const char *val) 34aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 353bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: illegal value for \"%s\": \"%s\"\n", arg, val); 36aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 37aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 38aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 39aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstatic int tbf_parse_opt(struct qdisc_util *qu, int argc, char **argv, struct nlmsghdr *n) 40aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 41aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger int ok=0; 42aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct tc_tbf_qopt opt; 43aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 rtab[256]; 44aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 ptab[256]; 45aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned buffer=0, mtu=0, mpu=0, latency=0; 46ae665a522bd46bea44c5ea84c89c8b1731954170Stephen Hemminger int Rcell_log=-1, Pcell_log = -1; 472c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer unsigned short overhead=0; 48292f29b42c3444375b5ae7086484c99da7129d94Jesper Dangaard Brouer unsigned int linklayer = LINKLAYER_ETHERNET; /* Assume ethernet */ 49aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct rtattr *tail; 50ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang __u64 rate64 = 0, prate64 = 0; 51aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 52aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memset(&opt, 0, sizeof(opt)); 53aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 54aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger while (argc > 0) { 55aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (matches(*argv, "limit") == 0) { 56aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 573bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk if (opt.limit) { 583bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: duplicate \"limit\" specification\n"); 593bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk return -1; 603bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk } 613bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk if (latency) { 623bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: specifying both \"latency\" and \"limit\" is not allowed\n"); 63aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 64aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 65aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_size(&opt.limit, *argv)) { 663bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1("limit", *argv); 67aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 68aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 69aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ok++; 70aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "latency") == 0) { 71aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 723bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk if (latency) { 733bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: duplicate \"latency\" specification\n"); 743bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk return -1; 753bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk } 763bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk if (opt.limit) { 773bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: specifying both \"limit\" and \"/latency\" is not allowed\n"); 78aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 79aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 808f34caafbdbc8f87d228d577872591e138caadb1Patrick McHardy if (get_time(&latency, *argv)) { 813bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1("latency", *argv); 82aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 83aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 84aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ok++; 85aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "burst") == 0 || 86aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(*argv, "buffer") == 0 || 87aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(*argv, "maxburst") == 0) { 883bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk const char *parm_name = *argv; 89aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 90aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (buffer) { 913bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: duplicate \"buffer/burst/maxburst\" specification\n"); 92aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 93aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 94aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_size_and_cell(&buffer, &Rcell_log, *argv) < 0) { 953bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1(parm_name, *argv); 96aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 97aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 98aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ok++; 99aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (strcmp(*argv, "mtu") == 0 || 100aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(*argv, "minburst") == 0) { 1013bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk const char *parm_name = *argv; 102aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 103aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (mtu) { 1043bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: duplicate \"mtu/minburst\" specification\n"); 105aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 106aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 107aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_size_and_cell(&mtu, &Pcell_log, *argv) < 0) { 1083bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1(parm_name, *argv); 109aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 110aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 111aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ok++; 112aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (strcmp(*argv, "mpu") == 0) { 113aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 114aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (mpu) { 1153bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: duplicate \"mpu\" specification\n"); 116aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 117aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 118aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_size(&mpu, *argv)) { 1193bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1("mpu", *argv); 120aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 121aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 122aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ok++; 123aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (strcmp(*argv, "rate") == 0) { 124aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 125ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (rate64) { 1263bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: duplicate \"rate\" specification\n"); 127aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 128aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 129ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (get_rate64(&rate64, *argv)) { 1303bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1("rate", *argv); 131aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 132aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 133aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ok++; 134aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "peakrate") == 0) { 135aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 136ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (prate64) { 1373bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: duplicate \"peakrate\" specification\n"); 138aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 139aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 140ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (get_rate64(&prate64, *argv)) { 1413bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1("peakrate", *argv); 142aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 143aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 144aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ok++; 1452c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer } else if (matches(*argv, "overhead") == 0) { 1462c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer NEXT_ARG(); 1472c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer if (overhead) { 1483bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: duplicate \"overhead\" specification\n"); 1492c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer return -1; 1502c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer } 1512c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer if (get_u16(&overhead, *argv, 10)) { 1523bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1("overhead", *argv); return -1; 1532c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer } 154292f29b42c3444375b5ae7086484c99da7129d94Jesper Dangaard Brouer } else if (matches(*argv, "linklayer") == 0) { 155292f29b42c3444375b5ae7086484c99da7129d94Jesper Dangaard Brouer NEXT_ARG(); 156292f29b42c3444375b5ae7086484c99da7129d94Jesper Dangaard Brouer if (get_linklayer(&linklayer, *argv)) { 1573bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain1("linklayer", *argv); return -1; 158292f29b42c3444375b5ae7086484c99da7129d94Jesper Dangaard Brouer } 159aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (strcmp(*argv, "help") == 0) { 160aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger explain(); 161aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 162aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else { 1633bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: unknown parameter \"%s\"\n", *argv); 164aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger explain(); 165aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 166aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 167aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger argc--; argv++; 168aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 169aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1703bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk int verdict = 0; 171aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1723bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk /* Be nice to the user: try to emit all error messages in 1733bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk * one go rather than reveal one more problem when a 1743bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk * previous one has been fixed. 1753bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk */ 176ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (rate64 == 0) { 1773bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: the \"rate\" parameter is mandatory.\n"); 1783bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk verdict = -1; 1793bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk } 1803bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk if (!buffer) { 1813bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: the \"burst\" parameter is mandatory.\n"); 1823bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk verdict = -1; 183aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 184ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (prate64) { 185aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!mtu) { 1863bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: when \"peakrate\" is specified, \"mtu\" must also be specified.\n"); 1873bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk verdict = -1; 188aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 189aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 190aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 191aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (opt.limit == 0 && latency == 0) { 1923bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: either \"limit\" or \"latency\" is required.\n"); 1933bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk verdict = -1; 194aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 195aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1963bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk if (verdict != 0) { 1973bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk explain(); 1983bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk return verdict; 1993bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk } 2003bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk 201ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang opt.rate.rate = (rate64 >= (1ULL << 32)) ? ~0U : rate64; 202ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang opt.peakrate.rate = (prate64 >= (1ULL << 32)) ? ~0U : prate64; 203ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang 204aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (opt.limit == 0) { 205ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang double lim = rate64*(double)latency/TIME_UNITS_PER_SEC + buffer; 206ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (prate64) { 207ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang double lim2 = prate64*(double)latency/TIME_UNITS_PER_SEC + mtu; 208aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (lim2 < lim) 209aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger lim = lim2; 210aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 211aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger opt.limit = lim; 212aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 213aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 2142c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer opt.rate.mpu = mpu; 2152c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer opt.rate.overhead = overhead; 216292f29b42c3444375b5ae7086484c99da7129d94Jesper Dangaard Brouer if (tc_calc_rtable(&opt.rate, rtab, Rcell_log, mtu, linklayer) < 0) { 2173bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: failed to calculate rate table.\n"); 218aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 219aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 220aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger opt.buffer = tc_calc_xmittime(opt.rate.rate, buffer); 221d5f46f9cc3856af532e852ef29fd7ddfd141faf0Jesper Dangaard Brouer 222aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (opt.peakrate.rate) { 2232c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer opt.peakrate.mpu = mpu; 2242c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer opt.peakrate.overhead = overhead; 225292f29b42c3444375b5ae7086484c99da7129d94Jesper Dangaard Brouer if (tc_calc_rtable(&opt.peakrate, ptab, Pcell_log, mtu, linklayer) < 0) { 2263bed7bb7e73894b949e4fd875f1712f4cf8b4655Kees van Reeuwijk fprintf(stderr, "tbf: failed to calculate peak rate table.\n"); 227aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 228aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 229aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger opt.mtu = tc_calc_xmittime(opt.peakrate.rate, mtu); 230aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 231aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 232228569c3ff79468f4c7580fd88b0d6a34ebdc311n); tail = NLMSG_TAIL(n); 233aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 1024, TCA_OPTIONS, NULL, 0); 234aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 2024, TCA_TBF_PARMS, &opt, sizeof(opt)); 235a01de0a336d96b74810f0e544a40983012aaee81Yang Yingliang addattr_l(n, 2124, TCA_TBF_BURST, &buffer, sizeof(buffer)); 236ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (rate64 >= (1ULL << 32)) 237ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang addattr_l(n, 2124, TCA_TBF_RATE64, &rate64, sizeof(rate64)); 238aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 3024, TCA_TBF_RTAB, rtab, 1024); 239ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (opt.peakrate.rate) { 240ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (prate64 >= (1ULL << 32)) 241ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang addattr_l(n, 3124, TCA_TBF_PRATE64, &prate64, sizeof(prate64)); 242a01de0a336d96b74810f0e544a40983012aaee81Yang Yingliang addattr_l(n, 3224, TCA_TBF_PBURST, &mtu, sizeof(mtu)); 243aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_TBF_PTAB, ptab, 1024); 244ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang } 245228569c3ff79468f4c7580fd88b0d6a34ebdc311void *) NLMSG_TAIL(n) - (void *) tail; tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail; 246aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 247aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 248aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 249aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstatic int tbf_print_opt(struct qdisc_util *qu, FILE *f, struct rtattr *opt) 250aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 251ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang struct rtattr *tb[TCA_TBF_MAX+1]; 252aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct tc_tbf_qopt *qopt; 2533e92ff522ac2d634b21a3cd9c4d1de278532f0adJesper Dangaard Brouer unsigned int linklayer; 254aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger double buffer, mtu; 255aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger double latency; 256ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang __u64 rate64 = 0, prate64 = 0; 257aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger SPRINT_BUF(b1); 258aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger SPRINT_BUF(b2); 2593e92ff522ac2d634b21a3cd9c4d1de278532f0adJesper Dangaard Brouer SPRINT_BUF(b3); 260aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 261aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (opt == NULL) 262aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 263aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 264ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang parse_rtattr_nested(tb, TCA_TBF_MAX, opt); 265aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 266aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_TBF_PARMS] == NULL) 267aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 268aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 269aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger qopt = RTA_DATA(tb[TCA_TBF_PARMS]); 270aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (RTA_PAYLOAD(tb[TCA_TBF_PARMS]) < sizeof(*qopt)) 271aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 272ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang rate64 = qopt->rate.rate; 273ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (tb[TCA_TBF_RATE64] && 274ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang RTA_PAYLOAD(tb[TCA_TBF_RATE64]) >= sizeof(rate64)) 275ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang rate64 = rta_getattr_u64(tb[TCA_TBF_RATE64]); 276ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang fprintf(f, "rate %s ", sprint_rate(rate64, b1)); 277ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang buffer = tc_calc_xmitsize(rate64, qopt->buffer); 278aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (show_details) { 279aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "burst %s/%u mpu %s ", sprint_size(buffer, b1), 280aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1<<qopt->rate.cell_log, sprint_size(qopt->rate.mpu, b2)); 281aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else { 282aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "burst %s ", sprint_size(buffer, b1)); 283aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 284aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (show_raw) 285aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "[%08x] ", qopt->buffer); 286ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang prate64 = qopt->peakrate.rate; 287ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (tb[TCA_TBF_PRATE64] && 288ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang RTA_PAYLOAD(tb[TCA_TBF_PRATE64]) >= sizeof(prate64)) 289ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang prate64 = rta_getattr_u64(tb[TCA_TBF_PRATE64]); 290ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (prate64) { 291ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang fprintf(f, "peakrate %s ", sprint_rate(prate64, b1)); 292aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (qopt->mtu || qopt->peakrate.mpu) { 293ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang mtu = tc_calc_xmitsize(prate64, qopt->mtu); 294aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (show_details) { 295aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "mtu %s/%u mpu %s ", sprint_size(mtu, b1), 296aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1<<qopt->peakrate.cell_log, sprint_size(qopt->peakrate.mpu, b2)); 297aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else { 298aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "minburst %s ", sprint_size(mtu, b1)); 299aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 300aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (show_raw) 301aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "[%08x] ", qopt->mtu); 302aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 303aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 304aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 305ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang latency = TIME_UNITS_PER_SEC*(qopt->limit/(double)rate64) - tc_core_tick2time(qopt->buffer); 306ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang if (prate64) { 307ddc6243e9aafa54ed120e5868e6c0f9b27475fecYang Yingliang double lat2 = TIME_UNITS_PER_SEC*(qopt->limit/(double)prate64) - tc_core_tick2time(qopt->mtu); 308aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (lat2 > latency) 309aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger latency = lat2; 310aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 3113ff10e82c135ba1b7ddd22ea15dda5ae0c2e78c1Sergey V. Lobanov if (latency >= 0.0) 3123ff10e82c135ba1b7ddd22ea15dda5ae0c2e78c1Sergey V. Lobanov fprintf(f, "lat %s ", sprint_time(latency, b1)); 3133ff10e82c135ba1b7ddd22ea15dda5ae0c2e78c1Sergey V. Lobanov if (show_raw || latency < 0.0) 3143ff10e82c135ba1b7ddd22ea15dda5ae0c2e78c1Sergey V. Lobanov fprintf(f, "limit %s ", sprint_size(qopt->limit, b1)); 315aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 3162c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer if (qopt->rate.overhead) { 3172c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer fprintf(f, "overhead %d", qopt->rate.overhead); 3182c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer } 3193e92ff522ac2d634b21a3cd9c4d1de278532f0adJesper Dangaard Brouer linklayer = (qopt->rate.linklayer & TC_LINKLAYER_MASK); 3203e92ff522ac2d634b21a3cd9c4d1de278532f0adJesper Dangaard Brouer if (linklayer > TC_LINKLAYER_ETHERNET || show_details) 3213e92ff522ac2d634b21a3cd9c4d1de278532f0adJesper Dangaard Brouer fprintf(f, "linklayer %s ", sprint_linklayer(linklayer, b3)); 3222c42579f9c15bdd9d0fdd5e6571c382bfa31399aJesper Dangaard Brouer 323aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 324aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 325aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 32695812b56a5a66e7e9a21744cfe8bc0bb9791ea98net[shemminger]!kaberstruct qdisc_util tbf_qdisc_util = { 327f2f99e2eefdbd9cb6a750b19a7b3036db351b983osdl.net!shemminger .id = "tbf", 328f2f99e2eefdbd9cb6a750b19a7b3036db351b983osdl.net!shemminger .parse_qopt = tbf_parse_opt, 329f2f99e2eefdbd9cb6a750b19a7b3036db351b983osdl.net!shemminger .print_qopt = tbf_print_opt, 330aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger}; 331