1187769Sluigi/* 2300779Struckman * Codel/FQ_Codel and PIE/FQ_PIE Code: 3300779Struckman * Copyright (C) 2016 Centre for Advanced Internet Architectures, 4300779Struckman * Swinburne University of Technology, Melbourne, Australia. 5300779Struckman * Portions of this code were made possible in part by a gift from 6300779Struckman * The Comcast Innovation Fund. 7300779Struckman * Implemented by Rasool Al-Saadi <ralsaadi@swin.edu.au> 8300779Struckman * 9204591Sluigi * Copyright (c) 2002-2003,2010 Luigi Rizzo 10187769Sluigi * 11187769Sluigi * Redistribution and use in source forms, with and without modification, 12187769Sluigi * are permitted provided that this entire comment appears intact. 13187769Sluigi * 14187769Sluigi * Redistribution in binary form may occur without any restrictions. 15187769Sluigi * Obviously, it would be nice if you gave credit where credit is due 16187769Sluigi * but requiring it would be too onerous. 17187769Sluigi * 18187769Sluigi * This software is provided ``AS IS'' without any warranties of any kind. 19187769Sluigi * 20187769Sluigi * $FreeBSD: stable/11/sbin/ipfw/dummynet.c 331194 2018-03-19 07:28:54Z eadler $ 21187769Sluigi * 22187769Sluigi * dummynet support 23187769Sluigi */ 24187769Sluigi 25300779Struckman#define NEW_AQM 26187769Sluigi#include <sys/types.h> 27187769Sluigi#include <sys/socket.h> 28187983Sluigi/* XXX there are several sysctl leftover here */ 29187769Sluigi#include <sys/sysctl.h> 30187769Sluigi 31187769Sluigi#include "ipfw2.h" 32187769Sluigi 33300779Struckman#ifdef NEW_AQM 34300779Struckman#include <stdint.h> 35300779Struckman#endif 36300779Struckman 37187769Sluigi#include <ctype.h> 38187769Sluigi#include <err.h> 39194930Soleg#include <errno.h> 40194930Soleg#include <libutil.h> 41187769Sluigi#include <netdb.h> 42187769Sluigi#include <stdio.h> 43187769Sluigi#include <stdlib.h> 44187769Sluigi#include <string.h> 45187769Sluigi#include <sysexits.h> 46187769Sluigi 47187769Sluigi#include <net/if.h> 48187769Sluigi#include <netinet/in.h> 49187769Sluigi#include <netinet/ip_fw.h> 50187769Sluigi#include <netinet/ip_dummynet.h> 51187983Sluigi#include <arpa/inet.h> /* inet_ntoa */ 52187769Sluigi 53204591Sluigi 54187769Sluigistatic struct _s_x dummynet_params[] = { 55187769Sluigi { "plr", TOK_PLR }, 56187769Sluigi { "noerror", TOK_NOERROR }, 57187769Sluigi { "buckets", TOK_BUCKETS }, 58187769Sluigi { "dst-ip", TOK_DSTIP }, 59187769Sluigi { "src-ip", TOK_SRCIP }, 60187769Sluigi { "dst-port", TOK_DSTPORT }, 61187769Sluigi { "src-port", TOK_SRCPORT }, 62187769Sluigi { "proto", TOK_PROTO }, 63187769Sluigi { "weight", TOK_WEIGHT }, 64204591Sluigi { "lmax", TOK_LMAX }, 65204591Sluigi { "maxlen", TOK_LMAX }, 66187769Sluigi { "all", TOK_ALL }, 67204591Sluigi { "mask", TOK_MASK }, /* alias for both */ 68204591Sluigi { "sched_mask", TOK_SCHED_MASK }, 69204591Sluigi { "flow_mask", TOK_FLOW_MASK }, 70187769Sluigi { "droptail", TOK_DROPTAIL }, 71266941Shiren { "ecn", TOK_ECN }, 72187769Sluigi { "red", TOK_RED }, 73187769Sluigi { "gred", TOK_GRED }, 74300779Struckman#ifdef NEW_AQM 75300779Struckman { "codel", TOK_CODEL}, /* Codel AQM */ 76300779Struckman { "fq_codel", TOK_FQ_CODEL}, /* FQ-Codel */ 77300779Struckman { "pie", TOK_PIE}, /* PIE AQM */ 78300779Struckman { "fq_pie", TOK_FQ_PIE}, /* FQ-PIE */ 79300779Struckman#endif 80187769Sluigi { "bw", TOK_BW }, 81187769Sluigi { "bandwidth", TOK_BW }, 82187769Sluigi { "delay", TOK_DELAY }, 83204591Sluigi { "link", TOK_LINK }, 84187769Sluigi { "pipe", TOK_PIPE }, 85187769Sluigi { "queue", TOK_QUEUE }, 86204591Sluigi { "flowset", TOK_FLOWSET }, 87204591Sluigi { "sched", TOK_SCHED }, 88204591Sluigi { "pri", TOK_PRI }, 89204591Sluigi { "priority", TOK_PRI }, 90204591Sluigi { "type", TOK_TYPE }, 91187769Sluigi { "flow-id", TOK_FLOWID}, 92187769Sluigi { "dst-ipv6", TOK_DSTIP6}, 93187769Sluigi { "dst-ip6", TOK_DSTIP6}, 94187769Sluigi { "src-ipv6", TOK_SRCIP6}, 95187769Sluigi { "src-ip6", TOK_SRCIP6}, 96204591Sluigi { "profile", TOK_PROFILE}, 97194930Soleg { "burst", TOK_BURST}, 98187769Sluigi { "dummynet-params", TOK_NULL }, 99187769Sluigi { NULL, 0 } /* terminator */ 100187769Sluigi}; 101187769Sluigi 102300779Struckman#ifdef NEW_AQM 103300779Struckman/* AQM/extra sched parameters tokens*/ 104300779Struckmanstatic struct _s_x aqm_params[] = { 105300779Struckman { "target", TOK_TARGET}, 106300779Struckman { "interval", TOK_INTERVAL}, 107300779Struckman { "limit", TOK_LIMIT}, 108300779Struckman { "flows", TOK_FLOWS}, 109300779Struckman { "quantum", TOK_QUANTUM}, 110300779Struckman { "ecn", TOK_ECN}, 111300779Struckman { "noecn", TOK_NO_ECN}, 112300779Struckman { "tupdate", TOK_TUPDATE}, 113300779Struckman { "max_burst", TOK_MAX_BURST}, 114300779Struckman { "max_ecnth", TOK_MAX_ECNTH}, 115300779Struckman { "alpha", TOK_ALPHA}, 116300779Struckman { "beta", TOK_BETA}, 117300779Struckman { "capdrop", TOK_CAPDROP}, 118300779Struckman { "nocapdrop", TOK_NO_CAPDROP}, 119300779Struckman { "onoff", TOK_ONOFF}, 120300779Struckman { "dre", TOK_DRE}, 121300779Struckman { "ts", TOK_TS}, 122300779Struckman { "derand", TOK_DERAND}, 123300779Struckman { "noderand", TOK_NO_DERAND}, 124300779Struckman { NULL, 0 } /* terminator */ 125300779Struckman}; 126300779Struckman#endif 127300779Struckman 128204591Sluigi#define O_NEXT(p, len) ((void *)((char *)p + len)) 129204591Sluigi 130204591Sluigistatic void 131204591Sluigioid_fill(struct dn_id *oid, int len, int type, uintptr_t id) 132204591Sluigi{ 133204591Sluigi oid->len = len; 134204591Sluigi oid->type = type; 135204591Sluigi oid->subtype = 0; 136204591Sluigi oid->id = id; 137204591Sluigi} 138204591Sluigi 139204591Sluigi/* make room in the buffer and move the pointer forward */ 140204591Sluigistatic void * 141204591Sluigio_next(struct dn_id **o, int len, int type) 142204591Sluigi{ 143204591Sluigi struct dn_id *ret = *o; 144204591Sluigi oid_fill(ret, len, type, 0); 145204591Sluigi *o = O_NEXT(*o, len); 146204591Sluigi return ret; 147204591Sluigi} 148204591Sluigi 149300779Struckman#ifdef NEW_AQM 150300779Struckman 151300779Struckman/* Codel flags */ 152300779Struckmanenum { 153300779Struckman CODEL_ECN_ENABLED = 1 154300779Struckman}; 155300779Struckman 156300779Struckman/* PIE flags, from PIE kernel module */ 157300779Struckmanenum { 158300779Struckman PIE_ECN_ENABLED = 1, 159300779Struckman PIE_CAPDROP_ENABLED = 2, 160300779Struckman PIE_ON_OFF_MODE_ENABLED = 4, 161300779Struckman PIE_DEPRATEEST_ENABLED = 8, 162300779Struckman PIE_DERAND_ENABLED = 16 163300779Struckman}; 164300779Struckman 165300779Struckman#define PIE_FIX_POINT_BITS 13 166300779Struckman#define PIE_SCALE (1L<<PIE_FIX_POINT_BITS) 167300779Struckman 168300779Struckman/* integer to time */ 169300779Struckmanvoid 170300779Struckmanus_to_time(int t,char *strt) 171300779Struckman{ 172300779Struckman if (t < 0) 173300779Struckman strt[0]='\0'; 174300779Struckman else if ( t==0 ) 175300779Struckman sprintf(strt,"%d", t); 176300779Struckman else if (t< 1000) 177300779Struckman sprintf(strt,"%dus", t); 178300779Struckman else if (t < 1000000) 179300779Struckman sprintf(strt,"%gms", (float) t / 1000); 180300779Struckman else 181300779Struckman sprintf(strt,"%gfs", (float) t / 1000000); 182300779Struckman} 183300779Struckman 184300779Struckman/* 185300779Struckman * returns -1 if s is not a valid time, otherwise, return time in us 186300779Struckman */ 187300779Struckmanstatic long 188300779Struckmantime_to_us(const char *s) 189300779Struckman{ 190300779Struckman int i, dots = 0; 191300779Struckman int len = strlen(s); 192300779Struckman char strt[16]="", stru[16]=""; 193300779Struckman 194300779Struckman if (len>15) 195300779Struckman return -1; 196300779Struckman for (i = 0; i<len && (isdigit(s[i]) || s[i]=='.') ; i++) 197300779Struckman if (s[i]=='.') { 198300779Struckman if (dots) 199300779Struckman return -1; 200300779Struckman else 201300779Struckman dots++; 202300779Struckman } 203300779Struckman 204300779Struckman if (!i) 205300779Struckman return -1; 206300779Struckman strncpy(strt, s, i); 207300779Struckman if (i<len) 208300779Struckman strcpy(stru, s+i); 209300779Struckman else 210300779Struckman strcpy(stru, "ms"); 211300779Struckman 212300779Struckman if (!strcasecmp(stru, "us")) 213300779Struckman return atol(strt); 214300779Struckman if (!strcasecmp(stru, "ms")) 215300779Struckman return (strtod(strt, NULL) * 1000); 216300779Struckman if (!strcasecmp(stru, "s")) 217300779Struckman return (strtod(strt, NULL)*1000000); 218300779Struckman 219300779Struckman return -1; 220300779Struckman} 221300779Struckman 222300779Struckman 223300779Struckman/* Get AQM or scheduler extra parameters */ 224300779Struckmanvoid 225300779Struckmanget_extra_parms(uint32_t nr, char *out, int subtype) 226300779Struckman{ 227300779Struckman struct dn_extra_parms *ep; 228300779Struckman int ret; 229300779Struckman char strt1[15], strt2[15], strt3[15]; 230300779Struckman u_int l; 231300779Struckman 232300779Struckman /* prepare the request */ 233300779Struckman l = sizeof(struct dn_extra_parms); 234300779Struckman ep = safe_calloc(1, l); 235300779Struckman memset(ep, 0, sizeof(*ep)); 236300779Struckman *out = '\0'; 237300779Struckman 238300779Struckman oid_fill(&ep->oid, l, DN_CMD_GET, DN_API_VERSION); 239300779Struckman ep->oid.len = l; 240300779Struckman ep->oid.subtype = subtype; 241300779Struckman ep->nr = nr; 242300779Struckman 243300779Struckman ret = do_cmd(-IP_DUMMYNET3, ep, (uintptr_t)&l); 244300779Struckman if (ret) { 245300779Struckman free(ep); 246300779Struckman errx(EX_DATAERR, "Error getting extra parameters\n"); 247300779Struckman } 248300779Struckman 249300779Struckman switch (subtype) { 250300779Struckman case DN_AQM_PARAMS: 251300779Struckman if( !strcasecmp(ep->name, "codel")) { 252300779Struckman us_to_time(ep->par[0], strt1); 253300779Struckman us_to_time(ep->par[1], strt2); 254300779Struckman l = sprintf(out, " AQM CoDel target %s interval %s", 255300779Struckman strt1, strt2); 256300779Struckman if (ep->par[2] & CODEL_ECN_ENABLED) 257300779Struckman l = sprintf(out + l, " ECN"); 258300779Struckman else 259300779Struckman l += sprintf(out + l, " NoECN"); 260300779Struckman } else if( !strcasecmp(ep->name, "pie")) { 261300779Struckman us_to_time(ep->par[0], strt1); 262300779Struckman us_to_time(ep->par[1], strt2); 263300779Struckman us_to_time(ep->par[2], strt3); 264300779Struckman l = sprintf(out, " AQM type PIE target %s tupdate %s alpha " 265300779Struckman "%g beta %g max_burst %s max_ecnth %.3g", 266300779Struckman strt1, 267300779Struckman strt2, 268300779Struckman ep->par[4] / (float) PIE_SCALE, 269300779Struckman ep->par[5] / (float) PIE_SCALE, 270300779Struckman strt3, 271300779Struckman ep->par[3] / (float) PIE_SCALE 272300779Struckman ); 273300779Struckman 274300779Struckman if (ep->par[6] & PIE_ECN_ENABLED) 275300779Struckman l += sprintf(out + l, " ECN"); 276300779Struckman else 277300779Struckman l += sprintf(out + l, " NoECN"); 278300779Struckman if (ep->par[6] & PIE_CAPDROP_ENABLED) 279300779Struckman l += sprintf(out + l, " CapDrop"); 280300779Struckman else 281300779Struckman l += sprintf(out + l, " NoCapDrop"); 282300779Struckman if (ep->par[6] & PIE_ON_OFF_MODE_ENABLED) 283300779Struckman l += sprintf(out + l, " OnOff"); 284300779Struckman if (ep->par[6] & PIE_DEPRATEEST_ENABLED) 285300779Struckman l += sprintf(out + l, " DRE"); 286300779Struckman else 287300779Struckman l += sprintf(out + l, " TS"); 288300779Struckman if (ep->par[6] & PIE_DERAND_ENABLED) 289300779Struckman l += sprintf(out + l, " Derand"); 290300779Struckman else 291300779Struckman l += sprintf(out + l, " NoDerand"); 292300779Struckman } 293300779Struckman break; 294300779Struckman 295300779Struckman case DN_SCH_PARAMS: 296300779Struckman if (!strcasecmp(ep->name,"FQ_CODEL")) { 297300779Struckman us_to_time(ep->par[0], strt1); 298300779Struckman us_to_time(ep->par[1], strt2); 299300779Struckman l = sprintf(out," FQ_CODEL target %s interval %s" 300300779Struckman " quantum %jd limit %jd flows %jd", 301300779Struckman strt1, strt2, 302300779Struckman (intmax_t) ep->par[3], 303300779Struckman (intmax_t) ep->par[4], 304300779Struckman (intmax_t) ep->par[5] 305300779Struckman ); 306300779Struckman if (ep->par[2] & CODEL_ECN_ENABLED) 307300779Struckman l += sprintf(out + l, " ECN"); 308300779Struckman else 309300779Struckman l += sprintf(out + l, " NoECN"); 310300779Struckman l += sprintf(out + l, "\n"); 311300779Struckman } else if (!strcasecmp(ep->name,"FQ_PIE")) { 312300779Struckman us_to_time(ep->par[0], strt1); 313300779Struckman us_to_time(ep->par[1], strt2); 314300779Struckman us_to_time(ep->par[2], strt3); 315300779Struckman l = sprintf(out, " FQ_PIE target %s tupdate %s alpha " 316300779Struckman "%g beta %g max_burst %s max_ecnth %.3g" 317300779Struckman " quantum %jd limit %jd flows %jd", 318300779Struckman strt1, 319300779Struckman strt2, 320300779Struckman ep->par[4] / (float) PIE_SCALE, 321300779Struckman ep->par[5] / (float) PIE_SCALE, 322300779Struckman strt3, 323300779Struckman ep->par[3] / (float) PIE_SCALE, 324300779Struckman (intmax_t) ep->par[7], 325300779Struckman (intmax_t) ep->par[8], 326300779Struckman (intmax_t) ep->par[9] 327300779Struckman ); 328300779Struckman 329300779Struckman if (ep->par[6] & PIE_ECN_ENABLED) 330300779Struckman l += sprintf(out + l, " ECN"); 331300779Struckman else 332300779Struckman l += sprintf(out + l, " NoECN"); 333300779Struckman if (ep->par[6] & PIE_CAPDROP_ENABLED) 334300779Struckman l += sprintf(out + l, " CapDrop"); 335300779Struckman else 336300779Struckman l += sprintf(out + l, " NoCapDrop"); 337300779Struckman if (ep->par[6] & PIE_ON_OFF_MODE_ENABLED) 338300779Struckman l += sprintf(out + l, " OnOff"); 339300779Struckman if (ep->par[6] & PIE_DEPRATEEST_ENABLED) 340300779Struckman l += sprintf(out + l, " DRE"); 341300779Struckman else 342300779Struckman l += sprintf(out + l, " TS"); 343300779Struckman if (ep->par[6] & PIE_DERAND_ENABLED) 344300779Struckman l += sprintf(out + l, " Derand"); 345300779Struckman else 346300779Struckman l += sprintf(out + l, " NoDerand"); 347300779Struckman l += sprintf(out + l, "\n"); 348300779Struckman } 349300779Struckman break; 350300779Struckman } 351300779Struckman 352300779Struckman free(ep); 353300779Struckman} 354300779Struckman#endif 355300779Struckman 356300779Struckman 357204591Sluigi#if 0 358187769Sluigistatic int 359200056Sluigisort_q(void *arg, const void *pa, const void *pb) 360187769Sluigi{ 361187769Sluigi int rev = (co.do_sort < 0); 362187769Sluigi int field = rev ? -co.do_sort : co.do_sort; 363187769Sluigi long long res = 0; 364187769Sluigi const struct dn_flow_queue *a = pa; 365187769Sluigi const struct dn_flow_queue *b = pb; 366187769Sluigi 367187769Sluigi switch (field) { 368187769Sluigi case 1: /* pkts */ 369187769Sluigi res = a->len - b->len; 370187769Sluigi break; 371187769Sluigi case 2: /* bytes */ 372187769Sluigi res = a->len_bytes - b->len_bytes; 373187769Sluigi break; 374187769Sluigi 375187769Sluigi case 3: /* tot pkts */ 376187769Sluigi res = a->tot_pkts - b->tot_pkts; 377187769Sluigi break; 378187769Sluigi 379187769Sluigi case 4: /* tot bytes */ 380187769Sluigi res = a->tot_bytes - b->tot_bytes; 381187769Sluigi break; 382187769Sluigi } 383187769Sluigi if (res < 0) 384187769Sluigi res = -1; 385187769Sluigi if (res > 0) 386187769Sluigi res = 1; 387187769Sluigi return (int)(rev ? res : -res); 388187769Sluigi} 389204591Sluigi#endif 390187769Sluigi 391204591Sluigi/* print a mask and header for the subsequent list of flows */ 392187769Sluigistatic void 393204591Sluigiprint_mask(struct ipfw_flow_id *id) 394187769Sluigi{ 395204591Sluigi if (!IS_IP6_FLOW_ID(id)) { 396204591Sluigi printf(" " 397205173Sluigi "mask: %s 0x%02x 0x%08x/0x%04x -> 0x%08x/0x%04x\n", 398205173Sluigi id->extra ? "queue," : "", 399204591Sluigi id->proto, 400204591Sluigi id->src_ip, id->src_port, 401204591Sluigi id->dst_ip, id->dst_port); 402204591Sluigi } else { 403204591Sluigi char buf[255]; 404205173Sluigi printf("\n mask: %sproto: 0x%02x, flow_id: 0x%08x, ", 405205173Sluigi id->extra ? "queue," : "", 406204591Sluigi id->proto, id->flow_id6); 407204591Sluigi inet_ntop(AF_INET6, &(id->src_ip6), buf, sizeof(buf)); 408204591Sluigi printf("%s/0x%04x -> ", buf, id->src_port); 409204591Sluigi inet_ntop(AF_INET6, &(id->dst_ip6), buf, sizeof(buf)); 410204591Sluigi printf("%s/0x%04x\n", buf, id->dst_port); 411210118Sluigi } 412210118Sluigi} 413187769Sluigi 414210118Sluigistatic void 415210118Sluigiprint_header(struct ipfw_flow_id *id) 416210118Sluigi{ 417210118Sluigi if (!IS_IP6_FLOW_ID(id)) 418210118Sluigi printf("BKT Prot ___Source IP/port____ " 419210118Sluigi "____Dest. IP/port____ " 420210118Sluigi "Tot_pkt/bytes Pkt/Byte Drp\n"); 421210118Sluigi else 422204591Sluigi printf("BKT ___Prot___ _flow-id_ " 423204591Sluigi "______________Source IPv6/port_______________ " 424204591Sluigi "_______________Dest. IPv6/port_______________ " 425204591Sluigi "Tot_pkt/bytes Pkt/Byte Drp\n"); 426204591Sluigi} 427187769Sluigi 428204591Sluigistatic void 429270424Smelifarolist_flow(struct buf_pr *bp, struct dn_flow *ni) 430204591Sluigi{ 431204591Sluigi char buff[255]; 432210118Sluigi struct protoent *pe = NULL; 433204591Sluigi struct in_addr ina; 434204591Sluigi struct ipfw_flow_id *id = &ni->fid; 435187769Sluigi 436204591Sluigi pe = getprotobynumber(id->proto); 437187769Sluigi /* XXX: Should check for IPv4 flows */ 438270424Smelifaro bprintf(bp, "%3u%c", (ni->oid.id) & 0xff, 439205173Sluigi id->extra ? '*' : ' '); 440204591Sluigi if (!IS_IP6_FLOW_ID(id)) { 441187769Sluigi if (pe) 442270424Smelifaro bprintf(bp, "%-4s ", pe->p_name); 443187769Sluigi else 444270424Smelifaro bprintf(bp, "%4u ", id->proto); 445204591Sluigi ina.s_addr = htonl(id->src_ip); 446270424Smelifaro bprintf(bp, "%15s/%-5d ", 447204591Sluigi inet_ntoa(ina), id->src_port); 448204591Sluigi ina.s_addr = htonl(id->dst_ip); 449270424Smelifaro bprintf(bp, "%15s/%-5d ", 450204591Sluigi inet_ntoa(ina), id->dst_port); 451204591Sluigi } else { 452204591Sluigi /* Print IPv6 flows */ 453187769Sluigi if (pe != NULL) 454270424Smelifaro bprintf(bp, "%9s ", pe->p_name); 455187769Sluigi else 456270424Smelifaro bprintf(bp, "%9u ", id->proto); 457270424Smelifaro bprintf(bp, "%7d %39s/%-5d ", id->flow_id6, 458204591Sluigi inet_ntop(AF_INET6, &(id->src_ip6), buff, sizeof(buff)), 459204591Sluigi id->src_port); 460270424Smelifaro bprintf(bp, " %39s/%-5d ", 461204591Sluigi inet_ntop(AF_INET6, &(id->dst_ip6), buff, sizeof(buff)), 462204591Sluigi id->dst_port); 463187769Sluigi } 464270424Smelifaro pr_u64(bp, &ni->tot_pkts, 4); 465270424Smelifaro pr_u64(bp, &ni->tot_bytes, 8); 466270424Smelifaro bprintf(bp, "%2u %4u %3u", 467204591Sluigi ni->length, ni->len_bytes, ni->drops); 468187769Sluigi} 469187769Sluigi 470187769Sluigistatic void 471204591Sluigiprint_flowset_parms(struct dn_fs *fs, char *prefix) 472187769Sluigi{ 473187769Sluigi int l; 474187769Sluigi char qs[30]; 475187769Sluigi char plr[30]; 476300779Struckman char red[200]; /* Display RED parameters */ 477187769Sluigi 478187769Sluigi l = fs->qsize; 479204591Sluigi if (fs->flags & DN_QSIZE_BYTES) { 480187769Sluigi if (l >= 8192) 481187769Sluigi sprintf(qs, "%d KB", l / 1024); 482187769Sluigi else 483187769Sluigi sprintf(qs, "%d B", l); 484187769Sluigi } else 485187769Sluigi sprintf(qs, "%3d sl.", l); 486187769Sluigi if (fs->plr) 487187769Sluigi sprintf(plr, "plr %f", 1.0 * fs->plr / (double)(0x7fffffff)); 488187769Sluigi else 489187769Sluigi plr[0] = '\0'; 490204591Sluigi 491266941Shiren if (fs->flags & DN_IS_RED) { /* RED parameters */ 492187769Sluigi sprintf(red, 493194930Soleg "\n\t %cRED w_q %f min_th %d max_th %d max_p %f", 494204591Sluigi (fs->flags & DN_IS_GENTLE_RED) ? 'G' : ' ', 495187769Sluigi 1.0 * fs->w_q / (double)(1 << SCALE_RED), 496204591Sluigi fs->min_th, 497204591Sluigi fs->max_th, 498187769Sluigi 1.0 * fs->max_p / (double)(1 << SCALE_RED)); 499266941Shiren if (fs->flags & DN_IS_ECN) 500266941Shiren strncat(red, " (ecn)", 6); 501300779Struckman#ifdef NEW_AQM 502300779Struckman /* get AQM parameters */ 503300779Struckman } else if (fs->flags & DN_IS_AQM) { 504300779Struckman get_extra_parms(fs->fs_nr, red, DN_AQM_PARAMS); 505300779Struckman#endif 506266941Shiren } else 507187769Sluigi sprintf(red, "droptail"); 508187769Sluigi 509204591Sluigi if (prefix[0]) { 510204591Sluigi printf("%s %s%s %d queues (%d buckets) %s\n", 511204591Sluigi prefix, qs, plr, fs->oid.id, fs->buckets, red); 512204591Sluigi prefix[0] = '\0'; 513204591Sluigi } else { 514204591Sluigi printf("q%05d %s%s %d flows (%d buckets) sched %d " 515204591Sluigi "weight %d lmax %d pri %d %s\n", 516204591Sluigi fs->fs_nr, qs, plr, fs->oid.id, fs->buckets, 517204591Sluigi fs->sched_nr, fs->par[0], fs->par[1], fs->par[2], red); 518204591Sluigi if (fs->flags & DN_HAVE_MASK) 519204591Sluigi print_mask(&fs->flow_mask); 520204591Sluigi } 521187769Sluigi} 522187769Sluigi 523190865Sluigistatic void 524204591Sluigiprint_extra_delay_parms(struct dn_profile *p) 525190865Sluigi{ 526190865Sluigi double loss; 527190865Sluigi if (p->samples_no <= 0) 528190865Sluigi return; 529190865Sluigi 530190865Sluigi loss = p->loss_level; 531190865Sluigi loss /= p->samples_no; 532194930Soleg printf("\t profile: name \"%s\" loss %f samples %d\n", 533194930Soleg p->name, loss, p->samples_no); 534190865Sluigi} 535190865Sluigi 536204591Sluigistatic void 537204591Sluigiflush_buf(char *buf) 538187769Sluigi{ 539204591Sluigi if (buf[0]) 540204591Sluigi printf("%s\n", buf); 541204591Sluigi buf[0] = '\0'; 542204591Sluigi} 543220804Sglebius 544204591Sluigi/* 545204591Sluigi * generic list routine. We expect objects in a specific order, i.e. 546204591Sluigi * PIPES AND SCHEDULERS: 547204591Sluigi * link; scheduler; internal flowset if any; instances 548204591Sluigi * we can tell a pipe from the number. 549204591Sluigi * 550204591Sluigi * FLOWSETS: 551204591Sluigi * flowset; queues; 552204591Sluigi * link i (int queue); scheduler i; si(i) { flowsets() : queues } 553204591Sluigi */ 554204591Sluigistatic void 555204591Sluigilist_pipes(struct dn_id *oid, struct dn_id *end) 556204591Sluigi{ 557204591Sluigi char buf[160]; /* pending buffer */ 558210118Sluigi int toPrint = 1; /* print header */ 559270424Smelifaro struct buf_pr bp; 560206843Sluigi 561204591Sluigi buf[0] = '\0'; 562270424Smelifaro bp_alloc(&bp, 4096); 563204591Sluigi for (; oid != end; oid = O_NEXT(oid, oid->len)) { 564204591Sluigi if (oid->len < sizeof(*oid)) 565204591Sluigi errx(1, "invalid oid len %d\n", oid->len); 566187769Sluigi 567204591Sluigi switch (oid->type) { 568204591Sluigi default: 569204591Sluigi flush_buf(buf); 570204591Sluigi printf("unrecognized object %d size %d\n", oid->type, oid->len); 571204591Sluigi break; 572204591Sluigi case DN_TEXT: /* list of attached flowsets */ 573204591Sluigi { 574204591Sluigi int i, l; 575204591Sluigi struct { 576204591Sluigi struct dn_id id; 577204591Sluigi uint32_t p[0]; 578204591Sluigi } *d = (void *)oid; 579204591Sluigi l = (oid->len - sizeof(*oid))/sizeof(d->p[0]); 580204591Sluigi if (l == 0) 581204591Sluigi break; 582204591Sluigi printf(" Children flowsets: "); 583204591Sluigi for (i = 0; i < l; i++) 584204591Sluigi printf("%u ", d->p[i]); 585204591Sluigi printf("\n"); 586204591Sluigi break; 587204591Sluigi } 588204591Sluigi case DN_CMD_GET: 589204591Sluigi if (co.verbose) 590204591Sluigi printf("answer for cmd %d, len %d\n", oid->type, oid->id); 591204591Sluigi break; 592204591Sluigi case DN_SCH: { 593204591Sluigi struct dn_sch *s = (struct dn_sch *)oid; 594204591Sluigi flush_buf(buf); 595204591Sluigi printf(" sched %d type %s flags 0x%x %d buckets %d active\n", 596204591Sluigi s->sched_nr, 597204591Sluigi s->name, s->flags, s->buckets, s->oid.id); 598300779Struckman#ifdef NEW_AQM 599300779Struckman char parms[200]; 600300779Struckman get_extra_parms(s->sched_nr, parms, DN_SCH_PARAMS); 601300779Struckman printf("%s",parms); 602300779Struckman#endif 603204591Sluigi if (s->flags & DN_HAVE_MASK) 604204591Sluigi print_mask(&s->sched_mask); 605204591Sluigi } 606204591Sluigi break; 607187769Sluigi 608204591Sluigi case DN_FLOW: 609270424Smelifaro if (toPrint != 0) { 610270424Smelifaro print_header(&((struct dn_flow *)oid)->fid); 611270424Smelifaro toPrint = 0; 612270424Smelifaro } 613270424Smelifaro list_flow(&bp, (struct dn_flow *)oid); 614270424Smelifaro printf("%s\n", bp.buf); 615302979Sae bp_flush(&bp); 616204591Sluigi break; 617187769Sluigi 618204591Sluigi case DN_LINK: { 619204591Sluigi struct dn_link *p = (struct dn_link *)oid; 620204591Sluigi double b = p->bandwidth; 621204591Sluigi char bwbuf[30]; 622204591Sluigi char burst[5 + 7]; 623187769Sluigi 624204591Sluigi /* This starts a new object so flush buffer */ 625204591Sluigi flush_buf(buf); 626204591Sluigi /* data rate */ 627204591Sluigi if (b == 0) 628204591Sluigi sprintf(bwbuf, "unlimited "); 629331194Seadler else if (b >= 1000000000) 630331194Seadler sprintf(bwbuf, "%7.3f Gbit/s", b/1000000000); 631204591Sluigi else if (b >= 1000000) 632204591Sluigi sprintf(bwbuf, "%7.3f Mbit/s", b/1000000); 633204591Sluigi else if (b >= 1000) 634204591Sluigi sprintf(bwbuf, "%7.3f Kbit/s", b/1000); 635204591Sluigi else 636204591Sluigi sprintf(bwbuf, "%7.3f bit/s ", b); 637187769Sluigi 638204591Sluigi if (humanize_number(burst, sizeof(burst), p->burst, 639204591Sluigi "", HN_AUTOSCALE, 0) < 0 || co.verbose) 640204591Sluigi sprintf(burst, "%d", (int)p->burst); 641204591Sluigi sprintf(buf, "%05d: %s %4d ms burst %s", 642204591Sluigi p->link_nr % DN_MAX_ID, bwbuf, p->delay, burst); 643204591Sluigi } 644204591Sluigi break; 645190865Sluigi 646204591Sluigi case DN_FS: 647204591Sluigi print_flowset_parms((struct dn_fs *)oid, buf); 648204591Sluigi break; 649204591Sluigi case DN_PROFILE: 650204591Sluigi flush_buf(buf); 651204591Sluigi print_extra_delay_parms((struct dn_profile *)oid); 652187769Sluigi } 653204591Sluigi flush_buf(buf); // XXX does it really go here ? 654204591Sluigi } 655270424Smelifaro 656270424Smelifaro bp_free(&bp); 657187769Sluigi} 658187769Sluigi 659187769Sluigi/* 660204591Sluigi * Delete pipe, queue or scheduler i 661187769Sluigi */ 662187769Sluigiint 663204591Sluigiipfw_delete_pipe(int do_pipe, int i) 664187769Sluigi{ 665204591Sluigi struct { 666204591Sluigi struct dn_id oid; 667204591Sluigi uintptr_t a[1]; /* add more if we want a list */ 668204591Sluigi } cmd; 669204591Sluigi oid_fill((void *)&cmd, sizeof(cmd), DN_CMD_DELETE, DN_API_VERSION); 670204591Sluigi cmd.oid.subtype = (do_pipe == 1) ? DN_LINK : 671204591Sluigi ( (do_pipe == 2) ? DN_FS : DN_SCH); 672204591Sluigi cmd.a[0] = i; 673204591Sluigi i = do_cmd(IP_DUMMYNET3, &cmd, cmd.oid.len); 674187769Sluigi if (i) { 675187769Sluigi i = 1; 676187769Sluigi warn("rule %u: setsockopt(IP_DUMMYNET_DEL)", i); 677187769Sluigi } 678187769Sluigi return i; 679187769Sluigi} 680187769Sluigi 681190865Sluigi/* 682190865Sluigi * Code to parse delay profiles. 683190865Sluigi * 684190865Sluigi * Some link types introduce extra delays in the transmission 685190865Sluigi * of a packet, e.g. because of MAC level framing, contention on 686190865Sluigi * the use of the channel, MAC level retransmissions and so on. 687190865Sluigi * From our point of view, the channel is effectively unavailable 688190865Sluigi * for this extra time, which is constant or variable depending 689190865Sluigi * on the link type. Additionally, packets may be dropped after this 690190865Sluigi * time (e.g. on a wireless link after too many retransmissions). 691190865Sluigi * We can model the additional delay with an empirical curve 692190865Sluigi * that represents its distribution. 693190865Sluigi * 694220802Sglebius * cumulative probability 695220802Sglebius * 1.0 ^ 696220802Sglebius * | 697220802Sglebius * L +-- loss-level x 698220802Sglebius * | ****** 699220802Sglebius * | * 700220802Sglebius * | ***** 701220802Sglebius * | * 702220802Sglebius * | ** 703220802Sglebius * | * 704220802Sglebius * +-------*-------------------> 705220802Sglebius * delay 706190865Sluigi * 707190865Sluigi * The empirical curve may have both vertical and horizontal lines. 708190865Sluigi * Vertical lines represent constant delay for a range of 709190865Sluigi * probabilities; horizontal lines correspond to a discontinuty 710204591Sluigi * in the delay distribution: the link will use the largest delay 711190865Sluigi * for a given probability. 712220802Sglebius * 713190865Sluigi * To pass the curve to dummynet, we must store the parameters 714190865Sluigi * in a file as described below, and issue the command 715190865Sluigi * 716190865Sluigi * ipfw pipe <n> config ... bw XXX profile <filename> ... 717190865Sluigi * 718190865Sluigi * The file format is the following, with whitespace acting as 719190865Sluigi * a separator and '#' indicating the beginning a comment: 720190865Sluigi * 721190865Sluigi * samples N 722190865Sluigi * the number of samples used in the internal 723190865Sluigi * representation (2..1024; default 100); 724190865Sluigi * 725220802Sglebius * loss-level L 726190865Sluigi * The probability above which packets are lost. 727220802Sglebius * (0.0 <= L <= 1.0, default 1.0 i.e. no loss); 728190865Sluigi * 729190865Sluigi * name identifier 730190865Sluigi * Optional a name (listed by "ipfw pipe show") 731190865Sluigi * to identify the distribution; 732190865Sluigi * 733190865Sluigi * "delay prob" | "prob delay" 734190865Sluigi * One of these two lines is mandatory and defines 735190865Sluigi * the format of the following lines with data points. 736190865Sluigi * 737190865Sluigi * XXX YYY 738190865Sluigi * 2 or more lines representing points in the curve, 739190865Sluigi * with either delay or probability first, according 740190865Sluigi * to the chosen format. 741190865Sluigi * The unit for delay is milliseconds. 742190865Sluigi * 743190865Sluigi * Data points does not need to be ordered or equal to the number 744190865Sluigi * specified in the "samples" line. ipfw will sort and interpolate 745190865Sluigi * the curve as needed. 746190865Sluigi * 747190865Sluigi * Example of a profile file: 748220802Sglebius 749220802Sglebius name bla_bla_bla 750220802Sglebius samples 100 751220802Sglebius loss-level 0.86 752220802Sglebius prob delay 753220802Sglebius 0 200 # minimum overhead is 200ms 754220802Sglebius 0.5 200 755220802Sglebius 0.5 300 756220802Sglebius 0.8 1000 757220802Sglebius 0.9 1300 758220802Sglebius 1 1300 759220802Sglebius 760190865Sluigi * Internally, we will convert the curve to a fixed number of 761190865Sluigi * samples, and when it is time to transmit a packet we will 762190865Sluigi * model the extra delay as extra bits in the packet. 763190865Sluigi * 764190865Sluigi */ 765190865Sluigi 766190865Sluigi#define ED_MAX_LINE_LEN 256+ED_MAX_NAME_LEN 767190865Sluigi#define ED_TOK_SAMPLES "samples" 768190865Sluigi#define ED_TOK_LOSS "loss-level" 769190865Sluigi#define ED_TOK_NAME "name" 770190865Sluigi#define ED_TOK_DELAY "delay" 771190865Sluigi#define ED_TOK_PROB "prob" 772193715Sluigi#define ED_TOK_BW "bw" 773190865Sluigi#define ED_SEPARATORS " \t\n" 774190865Sluigi#define ED_MIN_SAMPLES_NO 2 775190865Sluigi 776190865Sluigi/* 777190865Sluigi * returns 1 if s is a non-negative number, with at least one '.' 778190865Sluigi */ 779190865Sluigistatic int 780190865Sluigiis_valid_number(const char *s) 781190865Sluigi{ 782190865Sluigi int i, dots_found = 0; 783190865Sluigi int len = strlen(s); 784190865Sluigi 785190865Sluigi for (i = 0; i<len; ++i) 786190865Sluigi if (!isdigit(s[i]) && (s[i] !='.' || ++dots_found > 1)) 787190865Sluigi return 0; 788190865Sluigi return 1; 789190865Sluigi} 790190865Sluigi 791193715Sluigi/* 792193715Sluigi * Take as input a string describing a bandwidth value 793193715Sluigi * and return the numeric bandwidth value. 794193715Sluigi * set clocking interface or bandwidth value 795193715Sluigi */ 796200056Sluigistatic void 797193715Sluigiread_bandwidth(char *arg, int *bandwidth, char *if_name, int namelen) 798193715Sluigi{ 799193715Sluigi if (*bandwidth != -1) 800204591Sluigi warnx("duplicate token, override bandwidth value!"); 801193715Sluigi 802193715Sluigi if (arg[0] >= 'a' && arg[0] <= 'z') { 803204591Sluigi if (!if_name) { 804204591Sluigi errx(1, "no if support"); 805204591Sluigi } 806193715Sluigi if (namelen >= IFNAMSIZ) 807193715Sluigi warn("interface name truncated"); 808193715Sluigi namelen--; 809193715Sluigi /* interface name */ 810320679Sasomers strlcpy(if_name, arg, namelen); 811193715Sluigi *bandwidth = 0; 812193715Sluigi } else { /* read bandwidth value */ 813193715Sluigi int bw; 814193715Sluigi char *end = NULL; 815193715Sluigi 816193715Sluigi bw = strtoul(arg, &end, 0); 817193715Sluigi if (*end == 'K' || *end == 'k') { 818193715Sluigi end++; 819193715Sluigi bw *= 1000; 820205181Sluigi } else if (*end == 'M' || *end == 'm') { 821193715Sluigi end++; 822193715Sluigi bw *= 1000000; 823331194Seadler } else if (*end == 'G' || *end == 'g') { 824331194Seadler end++; 825331194Seadler bw *= 1000000000; 826193715Sluigi } 827193715Sluigi if ((*end == 'B' && 828193715Sluigi _substrcmp2(end, "Bi", "Bit/s") != 0) || 829193715Sluigi _substrcmp2(end, "by", "bytes") == 0) 830193715Sluigi bw *= 8; 831193715Sluigi 832193715Sluigi if (bw < 0) 833193715Sluigi errx(EX_DATAERR, "bandwidth too large"); 834193715Sluigi 835193715Sluigi *bandwidth = bw; 836204591Sluigi if (if_name) 837204591Sluigi if_name[0] = '\0'; 838193715Sluigi } 839193715Sluigi} 840193715Sluigi 841190865Sluigistruct point { 842190865Sluigi double prob; 843190865Sluigi double delay; 844190865Sluigi}; 845190865Sluigi 846200056Sluigistatic int 847190865Sluigicompare_points(const void *vp1, const void *vp2) 848190865Sluigi{ 849190865Sluigi const struct point *p1 = vp1; 850190865Sluigi const struct point *p2 = vp2; 851190865Sluigi double res = 0; 852190865Sluigi 853190865Sluigi res = p1->prob - p2->prob; 854190865Sluigi if (res == 0) 855190865Sluigi res = p1->delay - p2->delay; 856190865Sluigi if (res < 0) 857190865Sluigi return -1; 858190865Sluigi else if (res > 0) 859190865Sluigi return 1; 860190865Sluigi else 861190865Sluigi return 0; 862190865Sluigi} 863190865Sluigi 864190865Sluigi#define ED_EFMT(s) EX_DATAERR,"error in %s at line %d: "#s,filename,lineno 865190865Sluigi 866190865Sluigistatic void 867204591Sluigiload_extra_delays(const char *filename, struct dn_profile *p, 868204591Sluigi struct dn_link *link) 869190865Sluigi{ 870190865Sluigi char line[ED_MAX_LINE_LEN]; 871190865Sluigi FILE *f; 872190865Sluigi int lineno = 0; 873190865Sluigi int i; 874190865Sluigi 875190865Sluigi int samples = -1; 876190865Sluigi double loss = -1.0; 877190865Sluigi char profile_name[ED_MAX_NAME_LEN]; 878190865Sluigi int delay_first = -1; 879190865Sluigi int do_points = 0; 880190865Sluigi struct point points[ED_MAX_SAMPLES_NO]; 881190865Sluigi int points_no = 0; 882190865Sluigi 883204591Sluigi /* XXX link never NULL? */ 884204591Sluigi p->link_nr = link->link_nr; 885204591Sluigi 886190865Sluigi profile_name[0] = '\0'; 887190865Sluigi f = fopen(filename, "r"); 888190865Sluigi if (f == NULL) 889190865Sluigi err(EX_UNAVAILABLE, "fopen: %s", filename); 890190865Sluigi 891220802Sglebius while (fgets(line, ED_MAX_LINE_LEN, f)) { /* read commands */ 892190865Sluigi char *s, *cur = line, *name = NULL, *arg = NULL; 893190865Sluigi 894190865Sluigi ++lineno; 895190865Sluigi 896190865Sluigi /* parse the line */ 897190865Sluigi while (cur) { 898190865Sluigi s = strsep(&cur, ED_SEPARATORS); 899190865Sluigi if (s == NULL || *s == '#') 900190865Sluigi break; 901190865Sluigi if (*s == '\0') 902190865Sluigi continue; 903190865Sluigi if (arg) 904190865Sluigi errx(ED_EFMT("too many arguments")); 905190865Sluigi if (name == NULL) 906190865Sluigi name = s; 907190865Sluigi else 908190865Sluigi arg = s; 909190865Sluigi } 910190865Sluigi if (name == NULL) /* empty line */ 911190865Sluigi continue; 912190865Sluigi if (arg == NULL) 913190865Sluigi errx(ED_EFMT("missing arg for %s"), name); 914190865Sluigi 915190865Sluigi if (!strcasecmp(name, ED_TOK_SAMPLES)) { 916190865Sluigi if (samples > 0) 917190865Sluigi errx(ED_EFMT("duplicate ``samples'' line")); 918190865Sluigi if (atoi(arg) <=0) 919190865Sluigi errx(ED_EFMT("invalid number of samples")); 920190865Sluigi samples = atoi(arg); 921190865Sluigi if (samples>ED_MAX_SAMPLES_NO) 922190865Sluigi errx(ED_EFMT("too many samples, maximum is %d"), 923190865Sluigi ED_MAX_SAMPLES_NO); 924190865Sluigi do_points = 0; 925193715Sluigi } else if (!strcasecmp(name, ED_TOK_BW)) { 926204591Sluigi char buf[IFNAMSIZ]; 927204591Sluigi read_bandwidth(arg, &link->bandwidth, buf, sizeof(buf)); 928190865Sluigi } else if (!strcasecmp(name, ED_TOK_LOSS)) { 929190865Sluigi if (loss != -1.0) 930190865Sluigi errx(ED_EFMT("duplicated token: %s"), name); 931190865Sluigi if (!is_valid_number(arg)) 932190865Sluigi errx(ED_EFMT("invalid %s"), arg); 933190865Sluigi loss = atof(arg); 934190865Sluigi if (loss > 1) 935190865Sluigi errx(ED_EFMT("%s greater than 1.0"), name); 936190865Sluigi do_points = 0; 937190865Sluigi } else if (!strcasecmp(name, ED_TOK_NAME)) { 938190865Sluigi if (profile_name[0] != '\0') 939190865Sluigi errx(ED_EFMT("duplicated token: %s"), name); 940320679Sasomers strlcpy(profile_name, arg, sizeof(profile_name)); 941190865Sluigi do_points = 0; 942190865Sluigi } else if (!strcasecmp(name, ED_TOK_DELAY)) { 943190865Sluigi if (do_points) 944190865Sluigi errx(ED_EFMT("duplicated token: %s"), name); 945190865Sluigi delay_first = 1; 946190865Sluigi do_points = 1; 947190865Sluigi } else if (!strcasecmp(name, ED_TOK_PROB)) { 948190865Sluigi if (do_points) 949190865Sluigi errx(ED_EFMT("duplicated token: %s"), name); 950190865Sluigi delay_first = 0; 951190865Sluigi do_points = 1; 952190865Sluigi } else if (do_points) { 953190865Sluigi if (!is_valid_number(name) || !is_valid_number(arg)) 954190865Sluigi errx(ED_EFMT("invalid point found")); 955190865Sluigi if (delay_first) { 956190865Sluigi points[points_no].delay = atof(name); 957190865Sluigi points[points_no].prob = atof(arg); 958190865Sluigi } else { 959190865Sluigi points[points_no].delay = atof(arg); 960190865Sluigi points[points_no].prob = atof(name); 961190865Sluigi } 962190865Sluigi if (points[points_no].prob > 1.0) 963190865Sluigi errx(ED_EFMT("probability greater than 1.0")); 964190865Sluigi ++points_no; 965190865Sluigi } else { 966190865Sluigi errx(ED_EFMT("unrecognised command '%s'"), name); 967190865Sluigi } 968190865Sluigi } 969190865Sluigi 970199626Snetchild fclose (f); 971199626Snetchild 972190865Sluigi if (samples == -1) { 973190865Sluigi warnx("'%s' not found, assuming 100", ED_TOK_SAMPLES); 974190865Sluigi samples = 100; 975190865Sluigi } 976190865Sluigi 977190865Sluigi if (loss == -1.0) { 978190865Sluigi warnx("'%s' not found, assuming no loss", ED_TOK_LOSS); 979190865Sluigi loss = 1; 980190865Sluigi } 981190865Sluigi 982190865Sluigi /* make sure that there are enough points. */ 983190865Sluigi if (points_no < ED_MIN_SAMPLES_NO) 984190865Sluigi errx(ED_EFMT("too few samples, need at least %d"), 985190865Sluigi ED_MIN_SAMPLES_NO); 986190865Sluigi 987190865Sluigi qsort(points, points_no, sizeof(struct point), compare_points); 988190865Sluigi 989190865Sluigi /* interpolation */ 990190865Sluigi for (i = 0; i<points_no-1; ++i) { 991190865Sluigi double y1 = points[i].prob * samples; 992190865Sluigi double x1 = points[i].delay; 993190865Sluigi double y2 = points[i+1].prob * samples; 994190865Sluigi double x2 = points[i+1].delay; 995190865Sluigi 996204591Sluigi int ix = y1; 997190865Sluigi int stop = y2; 998190865Sluigi 999190865Sluigi if (x1 == x2) { 1000204591Sluigi for (; ix<stop; ++ix) 1001204591Sluigi p->samples[ix] = x1; 1002190865Sluigi } else { 1003190865Sluigi double m = (y2-y1)/(x2-x1); 1004190865Sluigi double c = y1 - m*x1; 1005204591Sluigi for (; ix<stop ; ++ix) 1006204591Sluigi p->samples[ix] = (ix - c)/m; 1007190865Sluigi } 1008190865Sluigi } 1009190865Sluigi p->samples_no = samples; 1010190865Sluigi p->loss_level = loss * samples; 1011320679Sasomers strlcpy(p->name, profile_name, sizeof(p->name)); 1012190865Sluigi} 1013190865Sluigi 1014300779Struckman#ifdef NEW_AQM 1015300779Struckman 1016300779Struckman/* Parse AQM/extra scheduler parameters */ 1017300779Struckmanstatic int 1018300779Struckmanprocess_extra_parms(int *ac, char **av, struct dn_extra_parms *ep, 1019300779Struckman uint16_t type) 1020300779Struckman{ 1021300779Struckman int i; 1022300779Struckman 1023300779Struckman /* use kernel defaults */ 1024300779Struckman for (i=0; i<DN_MAX_EXTRA_PARM; i++) 1025300779Struckman ep->par[i] = -1; 1026300779Struckman 1027300779Struckman switch(type) { 1028300779Struckman case TOK_CODEL: 1029300779Struckman case TOK_FQ_CODEL: 1030300779Struckman /* Codel 1031300779Struckman * 0- target, 1- interval, 2- flags, 1032300779Struckman * FQ_CODEL 1033300779Struckman * 3- quantum, 4- limit, 5- flows 1034300779Struckman */ 1035300779Struckman if (type==TOK_CODEL) 1036300779Struckman ep->par[2] = 0; 1037300779Struckman else 1038300779Struckman ep->par[2] = CODEL_ECN_ENABLED; 1039300779Struckman 1040300779Struckman while (*ac > 0) { 1041300779Struckman int tok = match_token(aqm_params, *av); 1042300779Struckman (*ac)--; av++; 1043300779Struckman switch(tok) { 1044300779Struckman case TOK_TARGET: 1045300779Struckman if (*ac <= 0 || time_to_us(av[0]) < 0) 1046300779Struckman errx(EX_DATAERR, "target needs time\n"); 1047300779Struckman 1048300779Struckman ep->par[0] = time_to_us(av[0]); 1049300779Struckman (*ac)--; av++; 1050300779Struckman break; 1051300779Struckman 1052300779Struckman case TOK_INTERVAL: 1053300779Struckman if (*ac <= 0 || time_to_us(av[0]) < 0) 1054300779Struckman errx(EX_DATAERR, "interval needs time\n"); 1055300779Struckman 1056300779Struckman ep->par[1] = time_to_us(av[0]); 1057300779Struckman (*ac)--; av++; 1058300779Struckman break; 1059300779Struckman 1060300779Struckman case TOK_ECN: 1061300779Struckman ep->par[2] = CODEL_ECN_ENABLED; 1062300779Struckman break; 1063300779Struckman case TOK_NO_ECN: 1064300779Struckman ep->par[2] &= ~CODEL_ECN_ENABLED; 1065300779Struckman break; 1066300779Struckman /* Config fq_codel parameters */ 1067300779Struckman case TOK_QUANTUM: 1068300779Struckman if (type != TOK_FQ_CODEL) 1069300779Struckman errx(EX_DATAERR, "quantum is not for codel\n"); 1070300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1071300779Struckman errx(EX_DATAERR, "quantum needs number\n"); 1072300779Struckman 1073300779Struckman ep->par[3]= atoi(av[0]); 1074300779Struckman (*ac)--; av++; 1075300779Struckman break; 1076300779Struckman 1077300779Struckman case TOK_LIMIT: 1078300779Struckman if (type != TOK_FQ_CODEL) 1079300779Struckman errx(EX_DATAERR, "limit is not for codel, use queue instead\n"); 1080300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1081300779Struckman errx(EX_DATAERR, "limit needs number\n"); 1082300779Struckman 1083300779Struckman ep->par[4] = atoi(av[0]); 1084300779Struckman (*ac)--; av++; 1085300779Struckman break; 1086300779Struckman 1087300779Struckman case TOK_FLOWS: 1088300779Struckman if (type != TOK_FQ_CODEL) 1089300779Struckman errx(EX_DATAERR, "flows is not for codel\n"); 1090300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1091300779Struckman errx(EX_DATAERR, "flows needs number\n"); 1092300779Struckman 1093300779Struckman ep->par[5] = atoi(av[0]); 1094300779Struckman (*ac)--; av++; 1095300779Struckman break; 1096300779Struckman 1097300779Struckman default: 1098300779Struckman printf("%s is Invalid parameter\n", av[-1]); 1099300779Struckman } 1100300779Struckman } 1101300779Struckman break; 1102300779Struckman case TOK_PIE: 1103300779Struckman case TOK_FQ_PIE: 1104300779Struckman /* PIE 1105300779Struckman * 0- target , 1- tupdate, 2- max_burst, 1106300779Struckman * 3- max_ecnth, 4- alpha, 1107300779Struckman * 5- beta, 6- flags 1108300779Struckman * FQ_CODEL 1109300779Struckman * 7- quantum, 8- limit, 9- flows 1110300779Struckman */ 1111300779Struckman 1112300779Struckman if ( type == TOK_PIE) 1113300779Struckman ep->par[6] = PIE_CAPDROP_ENABLED | PIE_DEPRATEEST_ENABLED 1114300779Struckman | PIE_DERAND_ENABLED; 1115300779Struckman else 1116300779Struckman /* for FQ-PIE, use TS mode */ 1117300779Struckman ep->par[6] = PIE_CAPDROP_ENABLED | PIE_DERAND_ENABLED 1118300779Struckman | PIE_ECN_ENABLED; 1119300779Struckman 1120300779Struckman while (*ac > 0) { 1121300779Struckman int tok = match_token(aqm_params, *av); 1122300779Struckman (*ac)--; av++; 1123300779Struckman switch(tok) { 1124300779Struckman case TOK_TARGET: 1125300779Struckman if (*ac <= 0 || time_to_us(av[0]) < 0) 1126300779Struckman errx(EX_DATAERR, "target needs time\n"); 1127300779Struckman 1128300779Struckman ep->par[0] = time_to_us(av[0]); 1129300779Struckman (*ac)--; av++; 1130300779Struckman break; 1131300779Struckman 1132300779Struckman case TOK_TUPDATE: 1133300779Struckman if (*ac <= 0 || time_to_us(av[0]) < 0) 1134300779Struckman errx(EX_DATAERR, "tupdate needs time\n"); 1135300779Struckman 1136300779Struckman ep->par[1] = time_to_us(av[0]); 1137300779Struckman (*ac)--; av++; 1138300779Struckman break; 1139300779Struckman 1140300779Struckman case TOK_MAX_BURST: 1141300779Struckman if (*ac <= 0 || time_to_us(av[0]) < 0) 1142300779Struckman errx(EX_DATAERR, "max_burst needs time\n"); 1143300779Struckman 1144300779Struckman ep->par[2] = time_to_us(av[0]); 1145300779Struckman (*ac)--; av++; 1146300779Struckman break; 1147300779Struckman 1148300779Struckman case TOK_MAX_ECNTH: 1149300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1150300779Struckman errx(EX_DATAERR, "max_ecnth needs number\n"); 1151300779Struckman 1152300779Struckman ep->par[3] = atof(av[0]) * PIE_SCALE; 1153300779Struckman (*ac)--; av++; 1154300779Struckman break; 1155300779Struckman 1156300779Struckman case TOK_ALPHA: 1157300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1158300779Struckman errx(EX_DATAERR, "alpha needs number\n"); 1159300779Struckman 1160300779Struckman ep->par[4] = atof(av[0]) * PIE_SCALE; 1161300779Struckman (*ac)--; av++; 1162300779Struckman break; 1163300779Struckman 1164300779Struckman case TOK_BETA: 1165300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1166300779Struckman errx(EX_DATAERR, "beta needs number\n"); 1167300779Struckman 1168300779Struckman ep->par[5] = atof(av[0]) * PIE_SCALE; 1169300779Struckman (*ac)--; av++; 1170300779Struckman break; 1171300779Struckman 1172300779Struckman case TOK_ECN: 1173300779Struckman ep->par[6] |= PIE_ECN_ENABLED; 1174300779Struckman break; 1175300779Struckman case TOK_NO_ECN: 1176300779Struckman ep->par[6] &= ~PIE_ECN_ENABLED; 1177300779Struckman break; 1178300779Struckman 1179300779Struckman case TOK_CAPDROP: 1180300779Struckman ep->par[6] |= PIE_CAPDROP_ENABLED; 1181300779Struckman break; 1182300779Struckman case TOK_NO_CAPDROP: 1183300779Struckman ep->par[6] &= ~PIE_CAPDROP_ENABLED; 1184300779Struckman break; 1185300779Struckman 1186300779Struckman case TOK_ONOFF: 1187300779Struckman ep->par[6] |= PIE_ON_OFF_MODE_ENABLED; 1188300779Struckman break; 1189300779Struckman 1190300779Struckman case TOK_DRE: 1191300779Struckman ep->par[6] |= PIE_DEPRATEEST_ENABLED; 1192300779Struckman break; 1193300779Struckman 1194300779Struckman case TOK_TS: 1195300779Struckman ep->par[6] &= ~PIE_DEPRATEEST_ENABLED; 1196300779Struckman break; 1197300779Struckman 1198300779Struckman case TOK_DERAND: 1199300779Struckman ep->par[6] |= PIE_DERAND_ENABLED; 1200300779Struckman break; 1201300779Struckman case TOK_NO_DERAND: 1202300779Struckman ep->par[6] &= ~PIE_DERAND_ENABLED; 1203300779Struckman break; 1204300779Struckman 1205300779Struckman /* Config fq_pie parameters */ 1206300779Struckman case TOK_QUANTUM: 1207300779Struckman if (type != TOK_FQ_PIE) 1208300779Struckman errx(EX_DATAERR, "quantum is not for pie\n"); 1209300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1210300779Struckman errx(EX_DATAERR, "quantum needs number\n"); 1211300779Struckman 1212300779Struckman ep->par[7]= atoi(av[0]); 1213300779Struckman (*ac)--; av++; 1214300779Struckman break; 1215300779Struckman 1216300779Struckman case TOK_LIMIT: 1217300779Struckman if (type != TOK_FQ_PIE) 1218300779Struckman errx(EX_DATAERR, "limit is not for pie, use queue instead\n"); 1219300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1220300779Struckman errx(EX_DATAERR, "limit needs number\n"); 1221300779Struckman 1222300779Struckman ep->par[8] = atoi(av[0]); 1223300779Struckman (*ac)--; av++; 1224300779Struckman break; 1225300779Struckman 1226300779Struckman case TOK_FLOWS: 1227300779Struckman if (type != TOK_FQ_PIE) 1228300779Struckman errx(EX_DATAERR, "flows is not for pie\n"); 1229300779Struckman if (*ac <= 0 || !is_valid_number(av[0])) 1230300779Struckman errx(EX_DATAERR, "flows needs number\n"); 1231300779Struckman 1232300779Struckman ep->par[9] = atoi(av[0]); 1233300779Struckman (*ac)--; av++; 1234300779Struckman break; 1235300779Struckman 1236300779Struckman 1237300779Struckman default: 1238300779Struckman printf("%s is invalid parameter\n", av[-1]); 1239300779Struckman } 1240300779Struckman } 1241300779Struckman break; 1242300779Struckman } 1243300779Struckman 1244300779Struckman return 0; 1245300779Struckman} 1246300779Struckman 1247300779Struckman#endif 1248300779Struckman 1249300779Struckman 1250204591Sluigi/* 1251204591Sluigi * configuration of pipes, schedulers, flowsets. 1252204591Sluigi * When we configure a new scheduler, an empty pipe is created, so: 1253220802Sglebius * 1254204591Sluigi * do_pipe = 1 -> "pipe N config ..." only for backward compatibility 1255204591Sluigi * sched N+Delta type fifo sched_mask ... 1256204591Sluigi * pipe N+Delta <parameters> 1257204591Sluigi * flowset N+Delta pipe N+Delta (no parameters) 1258204591Sluigi * sched N type wf2q+ sched_mask ... 1259204591Sluigi * pipe N <parameters> 1260204591Sluigi * 1261204591Sluigi * do_pipe = 2 -> flowset N config 1262204591Sluigi * flowset N parameters 1263204591Sluigi * 1264204591Sluigi * do_pipe = 3 -> sched N config 1265204591Sluigi * sched N parameters (default no pipe) 1266204591Sluigi * optional Pipe N config ... 1267204591Sluigi * pipe ==> 1268204591Sluigi */ 1269187769Sluigivoid 1270187769Sluigiipfw_config_pipe(int ac, char **av) 1271187769Sluigi{ 1272238900Sluigi int i; 1273238900Sluigi u_int j; 1274187769Sluigi char *end; 1275204591Sluigi struct dn_id *buf, *base; 1276204591Sluigi struct dn_sch *sch = NULL; 1277204591Sluigi struct dn_link *p = NULL; 1278204591Sluigi struct dn_fs *fs = NULL; 1279204591Sluigi struct dn_profile *pf = NULL; 1280204591Sluigi struct ipfw_flow_id *mask = NULL; 1281300779Struckman#ifdef NEW_AQM 1282300779Struckman struct dn_extra_parms *aqm_extra; 1283300779Struckman struct dn_extra_parms *sch_extra; 1284300779Struckman int lmax_extra; 1285300779Struckman#endif 1286300779Struckman 1287204591Sluigi int lmax; 1288204591Sluigi uint32_t _foo = 0, *flags = &_foo , *buckets = &_foo; 1289187769Sluigi 1290204591Sluigi /* 1291204591Sluigi * allocate space for 1 header, 1292204591Sluigi * 1 scheduler, 1 link, 1 flowset, 1 profile 1293204591Sluigi */ 1294204591Sluigi lmax = sizeof(struct dn_id); /* command header */ 1295204591Sluigi lmax += sizeof(struct dn_sch) + sizeof(struct dn_link) + 1296204591Sluigi sizeof(struct dn_fs) + sizeof(struct dn_profile); 1297187769Sluigi 1298300779Struckman#ifdef NEW_AQM 1299300779Struckman /* Extra Params */ 1300300779Struckman lmax_extra = sizeof(struct dn_extra_parms); 1301300779Struckman /* two lmax_extra because one for AQM params and another 1302300779Struckman * sch params 1303300779Struckman */ 1304300779Struckman lmax += lmax_extra*2; 1305300779Struckman#endif 1306300779Struckman 1307187769Sluigi av++; ac--; 1308187769Sluigi /* Pipe number */ 1309187769Sluigi if (ac && isdigit(**av)) { 1310187769Sluigi i = atoi(*av); av++; ac--; 1311204591Sluigi } else 1312204591Sluigi i = -1; 1313204591Sluigi if (i <= 0) 1314204591Sluigi errx(EX_USAGE, "need a pipe/flowset/sched number"); 1315204591Sluigi base = buf = safe_calloc(1, lmax); 1316204591Sluigi /* all commands start with a 'CONFIGURE' and a version */ 1317204591Sluigi o_next(&buf, sizeof(struct dn_id), DN_CMD_CONFIG); 1318204591Sluigi base->id = DN_API_VERSION; 1319204591Sluigi 1320204591Sluigi switch (co.do_pipe) { 1321204591Sluigi case 1: /* "pipe N config ..." */ 1322204591Sluigi /* Allocate space for the WF2Q+ scheduler, its link 1323204591Sluigi * and the FIFO flowset. Set the number, but leave 1324204591Sluigi * the scheduler subtype and other parameters to 0 1325204591Sluigi * so the kernel will use appropriate defaults. 1326204591Sluigi * XXX todo: add a flag to record if a parameter 1327204591Sluigi * is actually configured. 1328204591Sluigi * If we do a 'pipe config' mask -> sched_mask. 1329204591Sluigi * The FIFO scheduler and link are derived from the 1330204591Sluigi * WF2Q+ one in the kernel. 1331204591Sluigi */ 1332300779Struckman#ifdef NEW_AQM 1333300779Struckman sch_extra = o_next(&buf, lmax_extra, DN_TEXT); 1334300779Struckman sch_extra ->oid.subtype = 0; /* don't configure scheduler */ 1335300779Struckman#endif 1336204591Sluigi sch = o_next(&buf, sizeof(*sch), DN_SCH); 1337204591Sluigi p = o_next(&buf, sizeof(*p), DN_LINK); 1338300779Struckman#ifdef NEW_AQM 1339300779Struckman aqm_extra = o_next(&buf, lmax_extra, DN_TEXT); 1340300779Struckman aqm_extra ->oid.subtype = 0; /* don't configure AQM */ 1341300779Struckman#endif 1342204591Sluigi fs = o_next(&buf, sizeof(*fs), DN_FS); 1343204591Sluigi 1344204591Sluigi sch->sched_nr = i; 1345204591Sluigi sch->oid.subtype = 0; /* defaults to WF2Q+ */ 1346204591Sluigi mask = &sch->sched_mask; 1347204591Sluigi flags = &sch->flags; 1348204591Sluigi buckets = &sch->buckets; 1349204591Sluigi *flags |= DN_PIPE_CMD; 1350204591Sluigi 1351204591Sluigi p->link_nr = i; 1352204591Sluigi 1353204591Sluigi /* This flowset is only for the FIFO scheduler */ 1354204591Sluigi fs->fs_nr = i + 2*DN_MAX_ID; 1355204591Sluigi fs->sched_nr = i + DN_MAX_ID; 1356204591Sluigi break; 1357204591Sluigi 1358204591Sluigi case 2: /* "queue N config ... " */ 1359300779Struckman#ifdef NEW_AQM 1360300779Struckman aqm_extra = o_next(&buf, lmax_extra, DN_TEXT); 1361300779Struckman aqm_extra ->oid.subtype = 0; 1362300779Struckman#endif 1363204591Sluigi fs = o_next(&buf, sizeof(*fs), DN_FS); 1364204591Sluigi fs->fs_nr = i; 1365204591Sluigi mask = &fs->flow_mask; 1366204591Sluigi flags = &fs->flags; 1367204591Sluigi buckets = &fs->buckets; 1368204591Sluigi break; 1369204591Sluigi 1370204591Sluigi case 3: /* "sched N config ..." */ 1371300779Struckman#ifdef NEW_AQM 1372300779Struckman sch_extra = o_next(&buf, lmax_extra, DN_TEXT); 1373300779Struckman sch_extra ->oid.subtype = 0; 1374300779Struckman#endif 1375204591Sluigi sch = o_next(&buf, sizeof(*sch), DN_SCH); 1376300779Struckman#ifdef NEW_AQM 1377300779Struckman aqm_extra = o_next(&buf, lmax_extra, DN_TEXT); 1378300779Struckman aqm_extra ->oid.subtype = 0; 1379300779Struckman#endif 1380204591Sluigi fs = o_next(&buf, sizeof(*fs), DN_FS); 1381204591Sluigi sch->sched_nr = i; 1382204591Sluigi mask = &sch->sched_mask; 1383204591Sluigi flags = &sch->flags; 1384204591Sluigi buckets = &sch->buckets; 1385204591Sluigi /* fs is used only with !MULTIQUEUE schedulers */ 1386204591Sluigi fs->fs_nr = i + DN_MAX_ID; 1387204591Sluigi fs->sched_nr = i; 1388204591Sluigi break; 1389187769Sluigi } 1390204591Sluigi /* set to -1 those fields for which we want to reuse existing 1391204591Sluigi * values from the kernel. 1392204591Sluigi * Also, *_nr and subtype = 0 mean reuse the value from the kernel. 1393204591Sluigi * XXX todo: support reuse of the mask. 1394204591Sluigi */ 1395204591Sluigi if (p) 1396204591Sluigi p->bandwidth = -1; 1397204591Sluigi for (j = 0; j < sizeof(fs->par)/sizeof(fs->par[0]); j++) 1398204591Sluigi fs->par[j] = -1; 1399187769Sluigi while (ac > 0) { 1400187769Sluigi double d; 1401187769Sluigi int tok = match_token(dummynet_params, *av); 1402187769Sluigi ac--; av++; 1403187769Sluigi 1404187769Sluigi switch(tok) { 1405187769Sluigi case TOK_NOERROR: 1406204591Sluigi NEED(fs, "noerror is only for pipes"); 1407204591Sluigi fs->flags |= DN_NOERROR; 1408187769Sluigi break; 1409187769Sluigi 1410187769Sluigi case TOK_PLR: 1411204591Sluigi NEED(fs, "plr is only for pipes"); 1412187769Sluigi NEED1("plr needs argument 0..1\n"); 1413187769Sluigi d = strtod(av[0], NULL); 1414187769Sluigi if (d > 1) 1415187769Sluigi d = 1; 1416187769Sluigi else if (d < 0) 1417187769Sluigi d = 0; 1418204591Sluigi fs->plr = (int)(d*0x7fffffff); 1419187769Sluigi ac--; av++; 1420187769Sluigi break; 1421187769Sluigi 1422187769Sluigi case TOK_QUEUE: 1423204591Sluigi NEED(fs, "queue is only for pipes or flowsets"); 1424187769Sluigi NEED1("queue needs queue size\n"); 1425187769Sluigi end = NULL; 1426204591Sluigi fs->qsize = strtoul(av[0], &end, 0); 1427187769Sluigi if (*end == 'K' || *end == 'k') { 1428204591Sluigi fs->flags |= DN_QSIZE_BYTES; 1429204591Sluigi fs->qsize *= 1024; 1430187769Sluigi } else if (*end == 'B' || 1431187769Sluigi _substrcmp2(end, "by", "bytes") == 0) { 1432204591Sluigi fs->flags |= DN_QSIZE_BYTES; 1433187769Sluigi } 1434187769Sluigi ac--; av++; 1435187769Sluigi break; 1436187769Sluigi 1437187769Sluigi case TOK_BUCKETS: 1438204591Sluigi NEED(fs, "buckets is only for pipes or flowsets"); 1439187769Sluigi NEED1("buckets needs argument\n"); 1440204591Sluigi *buckets = strtoul(av[0], NULL, 0); 1441187769Sluigi ac--; av++; 1442187769Sluigi break; 1443187769Sluigi 1444204591Sluigi case TOK_FLOW_MASK: 1445204591Sluigi case TOK_SCHED_MASK: 1446187769Sluigi case TOK_MASK: 1447204591Sluigi NEED(mask, "tok_mask"); 1448187769Sluigi NEED1("mask needs mask specifier\n"); 1449187769Sluigi /* 1450187769Sluigi * per-flow queue, mask is dst_ip, dst_port, 1451187769Sluigi * src_ip, src_port, proto measured in bits 1452187769Sluigi */ 1453187769Sluigi 1454204591Sluigi bzero(mask, sizeof(*mask)); 1455187769Sluigi end = NULL; 1456187769Sluigi 1457187769Sluigi while (ac >= 1) { 1458187769Sluigi uint32_t *p32 = NULL; 1459187769Sluigi uint16_t *p16 = NULL; 1460187769Sluigi uint32_t *p20 = NULL; 1461187769Sluigi struct in6_addr *pa6 = NULL; 1462187769Sluigi uint32_t a; 1463187769Sluigi 1464187769Sluigi tok = match_token(dummynet_params, *av); 1465187769Sluigi ac--; av++; 1466187769Sluigi switch(tok) { 1467187769Sluigi case TOK_ALL: 1468187769Sluigi /* 1469187769Sluigi * special case, all bits significant 1470205173Sluigi * except 'extra' (the queue number) 1471187769Sluigi */ 1472204591Sluigi mask->dst_ip = ~0; 1473204591Sluigi mask->src_ip = ~0; 1474204591Sluigi mask->dst_port = ~0; 1475204591Sluigi mask->src_port = ~0; 1476204591Sluigi mask->proto = ~0; 1477204591Sluigi n2mask(&mask->dst_ip6, 128); 1478204591Sluigi n2mask(&mask->src_ip6, 128); 1479204591Sluigi mask->flow_id6 = ~0; 1480204591Sluigi *flags |= DN_HAVE_MASK; 1481187769Sluigi goto end_mask; 1482187769Sluigi 1483205173Sluigi case TOK_QUEUE: 1484205173Sluigi mask->extra = ~0; 1485205173Sluigi *flags |= DN_HAVE_MASK; 1486205173Sluigi goto end_mask; 1487205173Sluigi 1488187769Sluigi case TOK_DSTIP: 1489204591Sluigi mask->addr_type = 4; 1490204591Sluigi p32 = &mask->dst_ip; 1491187769Sluigi break; 1492187769Sluigi 1493187769Sluigi case TOK_SRCIP: 1494204591Sluigi mask->addr_type = 4; 1495204591Sluigi p32 = &mask->src_ip; 1496187769Sluigi break; 1497187769Sluigi 1498187769Sluigi case TOK_DSTIP6: 1499204591Sluigi mask->addr_type = 6; 1500204591Sluigi pa6 = &mask->dst_ip6; 1501187769Sluigi break; 1502220802Sglebius 1503187769Sluigi case TOK_SRCIP6: 1504204591Sluigi mask->addr_type = 6; 1505204591Sluigi pa6 = &mask->src_ip6; 1506187769Sluigi break; 1507187769Sluigi 1508187769Sluigi case TOK_FLOWID: 1509204591Sluigi mask->addr_type = 6; 1510204591Sluigi p20 = &mask->flow_id6; 1511187769Sluigi break; 1512187769Sluigi 1513187769Sluigi case TOK_DSTPORT: 1514204591Sluigi p16 = &mask->dst_port; 1515187769Sluigi break; 1516187769Sluigi 1517187769Sluigi case TOK_SRCPORT: 1518204591Sluigi p16 = &mask->src_port; 1519187769Sluigi break; 1520187769Sluigi 1521187769Sluigi case TOK_PROTO: 1522187769Sluigi break; 1523187769Sluigi 1524187769Sluigi default: 1525187769Sluigi ac++; av--; /* backtrack */ 1526187769Sluigi goto end_mask; 1527187769Sluigi } 1528187769Sluigi if (ac < 1) 1529187769Sluigi errx(EX_USAGE, "mask: value missing"); 1530187769Sluigi if (*av[0] == '/') { 1531187769Sluigi a = strtoul(av[0]+1, &end, 0); 1532187769Sluigi if (pa6 == NULL) 1533187769Sluigi a = (a == 32) ? ~0 : (1 << a) - 1; 1534187769Sluigi } else 1535187769Sluigi a = strtoul(av[0], &end, 0); 1536187769Sluigi if (p32 != NULL) 1537187769Sluigi *p32 = a; 1538187769Sluigi else if (p16 != NULL) { 1539187769Sluigi if (a > 0xFFFF) 1540187769Sluigi errx(EX_DATAERR, 1541187769Sluigi "port mask must be 16 bit"); 1542187769Sluigi *p16 = (uint16_t)a; 1543187769Sluigi } else if (p20 != NULL) { 1544187769Sluigi if (a > 0xfffff) 1545187769Sluigi errx(EX_DATAERR, 1546187769Sluigi "flow_id mask must be 20 bit"); 1547187769Sluigi *p20 = (uint32_t)a; 1548187769Sluigi } else if (pa6 != NULL) { 1549187769Sluigi if (a > 128) 1550187769Sluigi errx(EX_DATAERR, 1551187769Sluigi "in6addr invalid mask len"); 1552187769Sluigi else 1553187769Sluigi n2mask(pa6, a); 1554187769Sluigi } else { 1555187769Sluigi if (a > 0xFF) 1556187769Sluigi errx(EX_DATAERR, 1557187769Sluigi "proto mask must be 8 bit"); 1558205173Sluigi mask->proto = (uint8_t)a; 1559187769Sluigi } 1560187769Sluigi if (a != 0) 1561204591Sluigi *flags |= DN_HAVE_MASK; 1562187769Sluigi ac--; av++; 1563187769Sluigi } /* end while, config masks */ 1564187769Sluigiend_mask: 1565187769Sluigi break; 1566300779Struckman#ifdef NEW_AQM 1567300779Struckman case TOK_CODEL: 1568300779Struckman case TOK_PIE: 1569300779Struckman NEED(fs, "codel/pie is only for flowsets"); 1570187769Sluigi 1571300779Struckman fs->flags &= ~(DN_IS_RED|DN_IS_GENTLE_RED); 1572300779Struckman fs->flags |= DN_IS_AQM; 1573300779Struckman 1574320679Sasomers strlcpy(aqm_extra->name, av[-1], 1575320679Sasomers sizeof(aqm_extra->name)); 1576300779Struckman aqm_extra->oid.subtype = DN_AQM_PARAMS; 1577300779Struckman 1578300779Struckman process_extra_parms(&ac, av, aqm_extra, tok); 1579300779Struckman break; 1580300779Struckman 1581300779Struckman case TOK_FQ_CODEL: 1582300779Struckman case TOK_FQ_PIE: 1583300779Struckman if (!strcmp(av[-1],"type")) 1584300779Struckman errx(EX_DATAERR, "use type before fq_codel/fq_pie"); 1585300779Struckman 1586300779Struckman NEED(sch, "fq_codel/fq_pie is only for schd"); 1587320679Sasomers strlcpy(sch_extra->name, av[-1], 1588320679Sasomers sizeof(sch_extra->name)); 1589300779Struckman sch_extra->oid.subtype = DN_SCH_PARAMS; 1590300779Struckman process_extra_parms(&ac, av, sch_extra, tok); 1591300779Struckman break; 1592300779Struckman#endif 1593187769Sluigi case TOK_RED: 1594187769Sluigi case TOK_GRED: 1595187769Sluigi NEED1("red/gred needs w_q/min_th/max_th/max_p\n"); 1596204591Sluigi fs->flags |= DN_IS_RED; 1597187769Sluigi if (tok == TOK_GRED) 1598204591Sluigi fs->flags |= DN_IS_GENTLE_RED; 1599187769Sluigi /* 1600187769Sluigi * the format for parameters is w_q/min_th/max_th/max_p 1601187769Sluigi */ 1602187769Sluigi if ((end = strsep(&av[0], "/"))) { 1603187769Sluigi double w_q = strtod(end, NULL); 1604187769Sluigi if (w_q > 1 || w_q <= 0) 1605187769Sluigi errx(EX_DATAERR, "0 < w_q <= 1"); 1606204591Sluigi fs->w_q = (int) (w_q * (1 << SCALE_RED)); 1607187769Sluigi } 1608187769Sluigi if ((end = strsep(&av[0], "/"))) { 1609204591Sluigi fs->min_th = strtoul(end, &end, 0); 1610187769Sluigi if (*end == 'K' || *end == 'k') 1611204591Sluigi fs->min_th *= 1024; 1612187769Sluigi } 1613187769Sluigi if ((end = strsep(&av[0], "/"))) { 1614204591Sluigi fs->max_th = strtoul(end, &end, 0); 1615187769Sluigi if (*end == 'K' || *end == 'k') 1616204591Sluigi fs->max_th *= 1024; 1617187769Sluigi } 1618187769Sluigi if ((end = strsep(&av[0], "/"))) { 1619187769Sluigi double max_p = strtod(end, NULL); 1620266941Shiren if (max_p > 1 || max_p < 0) 1621266941Shiren errx(EX_DATAERR, "0 <= max_p <= 1"); 1622204591Sluigi fs->max_p = (int)(max_p * (1 << SCALE_RED)); 1623187769Sluigi } 1624187769Sluigi ac--; av++; 1625187769Sluigi break; 1626187769Sluigi 1627266941Shiren case TOK_ECN: 1628266941Shiren fs->flags |= DN_IS_ECN; 1629266941Shiren break; 1630266941Shiren 1631187769Sluigi case TOK_DROPTAIL: 1632204591Sluigi NEED(fs, "droptail is only for flowsets"); 1633204591Sluigi fs->flags &= ~(DN_IS_RED|DN_IS_GENTLE_RED); 1634187769Sluigi break; 1635187769Sluigi 1636187769Sluigi case TOK_BW: 1637204591Sluigi NEED(p, "bw is only for links"); 1638187769Sluigi NEED1("bw needs bandwidth or interface\n"); 1639204591Sluigi read_bandwidth(av[0], &p->bandwidth, NULL, 0); 1640187769Sluigi ac--; av++; 1641187769Sluigi break; 1642187769Sluigi 1643187769Sluigi case TOK_DELAY: 1644204591Sluigi NEED(p, "delay is only for links"); 1645187769Sluigi NEED1("delay needs argument 0..10000ms\n"); 1646204591Sluigi p->delay = strtoul(av[0], NULL, 0); 1647187769Sluigi ac--; av++; 1648187769Sluigi break; 1649187769Sluigi 1650204591Sluigi case TOK_TYPE: { 1651204591Sluigi int l; 1652204591Sluigi NEED(sch, "type is only for schedulers"); 1653204591Sluigi NEED1("type needs a string"); 1654204591Sluigi l = strlen(av[0]); 1655204591Sluigi if (l == 0 || l > 15) 1656204591Sluigi errx(1, "type %s too long\n", av[0]); 1657320679Sasomers strlcpy(sch->name, av[0], sizeof(sch->name)); 1658204591Sluigi sch->oid.subtype = 0; /* use string */ 1659300779Struckman#ifdef NEW_AQM 1660300779Struckman /* if fq_codel is selected, consider all tokens after it 1661300779Struckman * as parameters 1662300779Struckman */ 1663300779Struckman if (!strcasecmp(av[0],"fq_codel") || !strcasecmp(av[0],"fq_pie")){ 1664320679Sasomers strlcpy(sch_extra->name, av[0], 1665320679Sasomers sizeof(sch_extra->name)); 1666300779Struckman sch_extra->oid.subtype = DN_SCH_PARAMS; 1667300779Struckman process_extra_parms(&ac, av, sch_extra, tok); 1668300779Struckman } else { 1669300779Struckman ac--;av++; 1670300779Struckman } 1671300779Struckman#else 1672300779Struckman ac--;av++; 1673300779Struckman#endif 1674204591Sluigi break; 1675204591Sluigi } 1676204591Sluigi 1677187769Sluigi case TOK_WEIGHT: 1678204591Sluigi NEED(fs, "weight is only for flowsets"); 1679204591Sluigi NEED1("weight needs argument\n"); 1680204591Sluigi fs->par[0] = strtol(av[0], &end, 0); 1681187769Sluigi ac--; av++; 1682187769Sluigi break; 1683187769Sluigi 1684204591Sluigi case TOK_LMAX: 1685204591Sluigi NEED(fs, "lmax is only for flowsets"); 1686204591Sluigi NEED1("lmax needs argument\n"); 1687204591Sluigi fs->par[1] = strtol(av[0], &end, 0); 1688204591Sluigi ac--; av++; 1689204591Sluigi break; 1690204591Sluigi 1691204591Sluigi case TOK_PRI: 1692204591Sluigi NEED(fs, "priority is only for flowsets"); 1693204591Sluigi NEED1("priority needs argument\n"); 1694204591Sluigi fs->par[2] = strtol(av[0], &end, 0); 1695204591Sluigi ac--; av++; 1696204591Sluigi break; 1697204591Sluigi 1698204591Sluigi case TOK_SCHED: 1699187769Sluigi case TOK_PIPE: 1700204591Sluigi NEED(fs, "pipe/sched"); 1701204591Sluigi NEED1("pipe/link/sched needs number\n"); 1702204591Sluigi fs->sched_nr = strtoul(av[0], &end, 0); 1703187769Sluigi ac--; av++; 1704187769Sluigi break; 1705187769Sluigi 1706204591Sluigi case TOK_PROFILE: 1707204591Sluigi NEED((!pf), "profile already set"); 1708204591Sluigi NEED(p, "profile"); 1709204591Sluigi { 1710190865Sluigi NEED1("extra delay needs the file name\n"); 1711204591Sluigi pf = o_next(&buf, sizeof(*pf), DN_PROFILE); 1712204591Sluigi load_extra_delays(av[0], pf, p); //XXX can't fail? 1713190865Sluigi --ac; ++av; 1714204591Sluigi } 1715190865Sluigi break; 1716190865Sluigi 1717194930Soleg case TOK_BURST: 1718204591Sluigi NEED(p, "burst"); 1719194930Soleg NEED1("burst needs argument\n"); 1720194930Soleg errno = 0; 1721211499Sdes if (expand_number(av[0], &p->burst) < 0) 1722194930Soleg if (errno != ERANGE) 1723194930Soleg errx(EX_DATAERR, 1724194930Soleg "burst: invalid argument"); 1725204591Sluigi if (errno || p->burst > (1ULL << 48) - 1) 1726194930Soleg errx(EX_DATAERR, 1727194930Soleg "burst: out of range (0..2^48-1)"); 1728194930Soleg ac--; av++; 1729194930Soleg break; 1730194930Soleg 1731187769Sluigi default: 1732187769Sluigi errx(EX_DATAERR, "unrecognised option ``%s''", av[-1]); 1733187769Sluigi } 1734187769Sluigi } 1735204591Sluigi 1736204591Sluigi /* check validity of parameters */ 1737204591Sluigi if (p) { 1738204591Sluigi if (p->delay > 10000) 1739187769Sluigi errx(EX_DATAERR, "delay must be < 10000"); 1740204591Sluigi if (p->bandwidth == -1) 1741204591Sluigi p->bandwidth = 0; 1742187769Sluigi } 1743204591Sluigi if (fs) { 1744204591Sluigi /* XXX accept a 0 scheduler to keep the default */ 1745204591Sluigi if (fs->flags & DN_QSIZE_BYTES) { 1746187769Sluigi size_t len; 1747187769Sluigi long limit; 1748187769Sluigi 1749187769Sluigi len = sizeof(limit); 1750187769Sluigi if (sysctlbyname("net.inet.ip.dummynet.pipe_byte_limit", 1751187769Sluigi &limit, &len, NULL, 0) == -1) 1752187769Sluigi limit = 1024*1024; 1753204591Sluigi if (fs->qsize > limit) 1754187769Sluigi errx(EX_DATAERR, "queue size must be < %ldB", limit); 1755204591Sluigi } else { 1756187769Sluigi size_t len; 1757187769Sluigi long limit; 1758187769Sluigi 1759187769Sluigi len = sizeof(limit); 1760187769Sluigi if (sysctlbyname("net.inet.ip.dummynet.pipe_slot_limit", 1761187769Sluigi &limit, &len, NULL, 0) == -1) 1762187769Sluigi limit = 100; 1763204591Sluigi if (fs->qsize > limit) 1764187769Sluigi errx(EX_DATAERR, "2 <= queue size <= %ld", limit); 1765204591Sluigi } 1766204591Sluigi 1767300779Struckman#ifdef NEW_AQM 1768300779Struckman if ((fs->flags & DN_IS_ECN) && !((fs->flags & DN_IS_RED)|| 1769300779Struckman (fs->flags & DN_IS_AQM))) 1770300779Struckman errx(EX_USAGE, "ECN can be used with red/gred/" 1771300779Struckman "codel/fq_codel only!"); 1772300779Struckman#else 1773266941Shiren if ((fs->flags & DN_IS_ECN) && !(fs->flags & DN_IS_RED)) 1774266941Shiren errx(EX_USAGE, "enable red/gred for ECN"); 1775266941Shiren 1776300779Struckman#endif 1777300779Struckman 1778204591Sluigi if (fs->flags & DN_IS_RED) { 1779187769Sluigi size_t len; 1780187769Sluigi int lookup_depth, avg_pkt_size; 1781187769Sluigi 1782266941Shiren if (!(fs->flags & DN_IS_ECN) && (fs->min_th >= fs->max_th)) 1783187769Sluigi errx(EX_DATAERR, "min_th %d must be < than max_th %d", 1784204591Sluigi fs->min_th, fs->max_th); 1785266941Shiren else if ((fs->flags & DN_IS_ECN) && (fs->min_th > fs->max_th)) 1786266941Shiren errx(EX_DATAERR, "min_th %d must be =< than max_th %d", 1787266941Shiren fs->min_th, fs->max_th); 1788266941Shiren 1789204591Sluigi if (fs->max_th == 0) 1790187769Sluigi errx(EX_DATAERR, "max_th must be > 0"); 1791187769Sluigi 1792187769Sluigi len = sizeof(int); 1793187769Sluigi if (sysctlbyname("net.inet.ip.dummynet.red_lookup_depth", 1794187769Sluigi &lookup_depth, &len, NULL, 0) == -1) 1795204591Sluigi lookup_depth = 256; 1796187769Sluigi if (lookup_depth == 0) 1797187769Sluigi errx(EX_DATAERR, "net.inet.ip.dummynet.red_lookup_depth" 1798187769Sluigi " must be greater than zero"); 1799187769Sluigi 1800187769Sluigi len = sizeof(int); 1801187769Sluigi if (sysctlbyname("net.inet.ip.dummynet.red_avg_pkt_size", 1802187769Sluigi &avg_pkt_size, &len, NULL, 0) == -1) 1803204591Sluigi avg_pkt_size = 512; 1804187769Sluigi 1805187769Sluigi if (avg_pkt_size == 0) 1806187769Sluigi errx(EX_DATAERR, 1807187769Sluigi "net.inet.ip.dummynet.red_avg_pkt_size must" 1808187769Sluigi " be greater than zero"); 1809187769Sluigi 1810232347Sluigi#if 0 /* the following computation is now done in the kernel */ 1811187769Sluigi /* 1812187769Sluigi * Ticks needed for sending a medium-sized packet. 1813187769Sluigi * Unfortunately, when we are configuring a WF2Q+ queue, we 1814187769Sluigi * do not have bandwidth information, because that is stored 1815187769Sluigi * in the parent pipe, and also we have multiple queues 1816187769Sluigi * competing for it. So we set s=0, which is not very 1817187769Sluigi * correct. But on the other hand, why do we want RED with 1818187769Sluigi * WF2Q+ ? 1819187769Sluigi */ 1820187769Sluigi if (p.bandwidth==0) /* this is a WF2Q+ queue */ 1821187769Sluigi s = 0; 1822187769Sluigi else 1823187769Sluigi s = (double)ck.hz * avg_pkt_size * 8 / p.bandwidth; 1824187769Sluigi /* 1825187769Sluigi * max idle time (in ticks) before avg queue size becomes 0. 1826187769Sluigi * NOTA: (3/w_q) is approx the value x so that 1827187769Sluigi * (1-w_q)^x < 10^-3. 1828187769Sluigi */ 1829204591Sluigi w_q = ((double)fs->w_q) / (1 << SCALE_RED); 1830187769Sluigi idle = s * 3. / w_q; 1831204591Sluigi fs->lookup_step = (int)idle / lookup_depth; 1832204591Sluigi if (!fs->lookup_step) 1833204591Sluigi fs->lookup_step = 1; 1834187769Sluigi weight = 1 - w_q; 1835204591Sluigi for (t = fs->lookup_step; t > 1; --t) 1836187769Sluigi weight *= 1 - w_q; 1837204591Sluigi fs->lookup_weight = (int)(weight * (1 << SCALE_RED)); 1838232347Sluigi#endif /* code moved in the kernel */ 1839204591Sluigi } 1840187769Sluigi } 1841190865Sluigi 1842204591Sluigi i = do_cmd(IP_DUMMYNET3, base, (char *)buf - (char *)base); 1843190865Sluigi 1844187769Sluigi if (i) 1845187769Sluigi err(1, "setsockopt(%s)", "IP_DUMMYNET_CONFIGURE"); 1846187769Sluigi} 1847204591Sluigi 1848204591Sluigivoid 1849204591Sluigidummynet_flush(void) 1850204591Sluigi{ 1851204591Sluigi struct dn_id oid; 1852204591Sluigi oid_fill(&oid, sizeof(oid), DN_CMD_FLUSH, DN_API_VERSION); 1853204591Sluigi do_cmd(IP_DUMMYNET3, &oid, oid.len); 1854204591Sluigi} 1855204591Sluigi 1856205050Sluigi/* Parse input for 'ipfw [pipe|sched|queue] show [range list]' 1857205050Sluigi * Returns the number of ranges, and possibly stores them 1858205050Sluigi * in the array v of size len. 1859205050Sluigi */ 1860205050Sluigistatic int 1861205050Sluigiparse_range(int ac, char *av[], uint32_t *v, int len) 1862205050Sluigi{ 1863205050Sluigi int n = 0; 1864205050Sluigi char *endptr, *s; 1865205050Sluigi uint32_t base[2]; 1866205050Sluigi 1867205050Sluigi if (v == NULL || len < 2) { 1868205050Sluigi v = base; 1869205050Sluigi len = 2; 1870205050Sluigi } 1871205050Sluigi 1872205050Sluigi for (s = *av; s != NULL; av++, ac--) { 1873205050Sluigi v[0] = strtoul(s, &endptr, 10); 1874205050Sluigi v[1] = (*endptr != '-') ? v[0] : 1875205050Sluigi strtoul(endptr+1, &endptr, 10); 1876205050Sluigi if (*endptr == '\0') { /* prepare for next round */ 1877205050Sluigi s = (ac > 0) ? *(av+1) : NULL; 1878205050Sluigi } else { 1879205050Sluigi if (*endptr != ',') { 1880205050Sluigi warn("invalid number: %s", s); 1881205050Sluigi s = ++endptr; 1882205050Sluigi continue; 1883205050Sluigi } 1884205050Sluigi /* continue processing from here */ 1885205050Sluigi s = ++endptr; 1886205050Sluigi ac++; 1887205050Sluigi av--; 1888205050Sluigi } 1889205050Sluigi if (v[1] < v[0] || 1890318133Sae v[0] >= DN_MAX_ID-1 || 1891238900Sluigi v[1] >= DN_MAX_ID-1) { 1892205050Sluigi continue; /* invalid entry */ 1893205050Sluigi } 1894205050Sluigi n++; 1895205050Sluigi /* translate if 'pipe list' */ 1896205050Sluigi if (co.do_pipe == 1) { 1897205050Sluigi v[0] += DN_MAX_ID; 1898205050Sluigi v[1] += DN_MAX_ID; 1899205050Sluigi } 1900205050Sluigi v = (n*2 < len) ? v + 2 : base; 1901205050Sluigi } 1902205050Sluigi return n; 1903205050Sluigi} 1904205050Sluigi 1905204591Sluigi/* main entry point for dummynet list functions. co.do_pipe indicates 1906204591Sluigi * which function we want to support. 1907205050Sluigi * av may contain filtering arguments, either individual entries 1908205050Sluigi * or ranges, or lists (space or commas are valid separators). 1909205050Sluigi * Format for a range can be n1-n2 or n3 n4 n5 ... 1910205050Sluigi * In a range n1 must be <= n2, otherwise the range is ignored. 1911205050Sluigi * A number 'n4' is translate in a range 'n4-n4' 1912205050Sluigi * All number must be > 0 and < DN_MAX_ID-1 1913204591Sluigi */ 1914204591Sluigivoid 1915204591Sluigidummynet_list(int ac, char *av[], int show_counters) 1916204591Sluigi{ 1917205050Sluigi struct dn_id *oid, *x = NULL; 1918238900Sluigi int ret, i; 1919205050Sluigi int n; /* # of ranges */ 1920238900Sluigi u_int buflen, l; 1921238900Sluigi u_int max_size; /* largest obj passed up */ 1922204591Sluigi 1923238900Sluigi (void)show_counters; // XXX unused, but we should use it. 1924205050Sluigi ac--; 1925205050Sluigi av++; /* skip 'list' | 'show' word */ 1926205050Sluigi 1927205050Sluigi n = parse_range(ac, av, NULL, 0); /* Count # of ranges. */ 1928205050Sluigi 1929205050Sluigi /* Allocate space to store ranges */ 1930205050Sluigi l = sizeof(*oid) + sizeof(uint32_t) * n * 2; 1931205050Sluigi oid = safe_calloc(1, l); 1932205050Sluigi oid_fill(oid, l, DN_CMD_GET, DN_API_VERSION); 1933205050Sluigi 1934205050Sluigi if (n > 0) /* store ranges in idx */ 1935205050Sluigi parse_range(ac, av, (uint32_t *)(oid + 1), n*2); 1936205050Sluigi /* 1937205050Sluigi * Compute the size of the largest object returned. If the 1938205050Sluigi * response leaves at least this much spare space in the 1939205050Sluigi * buffer, then surely the response is complete; otherwise 1940205050Sluigi * there might be a risk of truncation and we will need to 1941205050Sluigi * retry with a larger buffer. 1942205050Sluigi * XXX don't bother with smaller structs. 1943205050Sluigi */ 1944205050Sluigi max_size = sizeof(struct dn_fs); 1945205050Sluigi if (max_size < sizeof(struct dn_sch)) 1946205050Sluigi max_size = sizeof(struct dn_sch); 1947205050Sluigi if (max_size < sizeof(struct dn_flow)) 1948205050Sluigi max_size = sizeof(struct dn_flow); 1949205050Sluigi 1950204591Sluigi switch (co.do_pipe) { 1951204591Sluigi case 1: 1952205050Sluigi oid->subtype = DN_LINK; /* list pipe */ 1953204591Sluigi break; 1954204591Sluigi case 2: 1955205050Sluigi oid->subtype = DN_FS; /* list queue */ 1956204591Sluigi break; 1957204591Sluigi case 3: 1958205050Sluigi oid->subtype = DN_SCH; /* list sched */ 1959204591Sluigi break; 1960204591Sluigi } 1961204718Sluigi 1962205050Sluigi /* 1963205050Sluigi * Ask the kernel an estimate of the required space (result 1964205050Sluigi * in oid.id), unless we are requesting a subset of objects, 1965205050Sluigi * in which case the kernel does not give an exact answer. 1966205050Sluigi * In any case, space might grow in the meantime due to the 1967205050Sluigi * creation of new queues, so we must be prepared to retry. 1968204718Sluigi */ 1969205050Sluigi if (n > 0) { 1970205050Sluigi buflen = 4*1024; 1971205050Sluigi } else { 1972205050Sluigi ret = do_cmd(-IP_DUMMYNET3, oid, (uintptr_t)&l); 1973205050Sluigi if (ret != 0 || oid->id <= sizeof(*oid)) 1974205050Sluigi goto done; 1975205050Sluigi buflen = oid->id + max_size; 1976205050Sluigi oid->len = sizeof(*oid); /* restore */ 1977205050Sluigi } 1978205050Sluigi /* Try a few times, until the buffer fits */ 1979205050Sluigi for (i = 0; i < 20; i++) { 1980205050Sluigi l = buflen; 1981204718Sluigi x = safe_realloc(x, l); 1982205050Sluigi bcopy(oid, x, oid->len); 1983205050Sluigi ret = do_cmd(-IP_DUMMYNET3, x, (uintptr_t)&l); 1984205050Sluigi if (ret != 0 || x->id <= sizeof(*oid)) 1985205050Sluigi goto done; /* no response */ 1986205050Sluigi if (l + max_size <= buflen) 1987204718Sluigi break; /* ok */ 1988205050Sluigi buflen *= 2; /* double for next attempt */ 1989204718Sluigi } 1990204591Sluigi list_pipes(x, O_NEXT(x, l)); 1991205050Sluigidone: 1992205050Sluigi if (x) 1993205050Sluigi free(x); 1994205050Sluigi free(oid); 1995204591Sluigi} 1996