utils.c revision 30d10db5667d3ca86917ca86c1a65cfcc45965f9
1aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger/* 2aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * utils.c 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 <string.h> 21aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <netdb.h> 22aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <arpa/inet.h> 23aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <resolv.h> 245dfe556188df2a3b2bfe73c8bc3b3b9216171a93osdl.org!shemminger#include <asm/types.h> 25aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <linux/pkt_sched.h> 2690f93024a0818dc691138d8401721e797004b042shemminger#include <time.h> 2790f93024a0818dc691138d8401721e797004b042shemminger#include <sys/time.h> 2830d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer#include <errno.h> 2990f93024a0818dc691138d8401721e797004b042shemminger 30aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 31aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include "utils.h" 32aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 334094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint get_integer(int *val, const char *arg, int base) 34aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 35aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger long res; 36aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char *ptr; 37aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 38aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!arg || !*arg) 39aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 40aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger res = strtol(arg, &ptr, base); 41aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!ptr || ptr == arg || *ptr || res > INT_MAX || res < INT_MIN) 42aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 43aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *val = res; 44aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 45aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 46aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 476b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemmingerint mask2bits(__u32 netmask) 484b270b172a6e570f4e9fa1ebb4bc67b0e715ee48Stephen Hemminger{ 494b270b172a6e570f4e9fa1ebb4bc67b0e715ee48Stephen Hemminger unsigned bits = 0; 506b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger __u32 mask = ntohl(netmask); 516b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger __u32 host = ~mask; 524b270b172a6e570f4e9fa1ebb4bc67b0e715ee48Stephen Hemminger 536b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger /* a valid netmask must be 2^n - 1 */ 546b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger if ((host & (host + 1)) != 0) 556b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger return -1; 564b270b172a6e570f4e9fa1ebb4bc67b0e715ee48Stephen Hemminger 576b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger for (; mask; mask <<= 1) 586b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger ++bits; 594b270b172a6e570f4e9fa1ebb4bc67b0e715ee48Stephen Hemminger return bits; 604b270b172a6e570f4e9fa1ebb4bc67b0e715ee48Stephen Hemminger} 614b270b172a6e570f4e9fa1ebb4bc67b0e715ee48Stephen Hemminger 625a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henrikssonstatic int get_netmask(unsigned *val, const char *arg, int base) 635a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson{ 645a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson inet_prefix addr; 655a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson 665a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson if (!get_unsigned(val, arg, base)) 675a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson return 0; 685a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson 695a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson /* try coverting dotted quad to CIDR */ 706b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger if (!get_addr_1(&addr, arg, AF_INET) && addr.family == AF_INET) { 716b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger int b = mask2bits(addr.data[0]); 726b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger 736b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger if (b >= 0) { 746b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger *val = b; 755a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson return 0; 766b1ac654e9364ad279d3c82d8a3ef93efa9f3dfaStephen Hemminger } 775a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson } 785a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson 795a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson return -1; 805a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson} 815a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson 824094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint get_unsigned(unsigned *val, const char *arg, int base) 83aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 84aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned long res; 85aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char *ptr; 86aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 87aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!arg || !*arg) 88aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 89aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger res = strtoul(arg, &ptr, base); 90aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!ptr || ptr == arg || *ptr || res > UINT_MAX) 91aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 92aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *val = res; 93aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 94aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 95aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 9654e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones/* 97db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renker * get_time_rtt is "translated" from a similar routine "get_time" in 98db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renker * tc_util.c. We don't use the exact same routine because tc passes 99db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renker * microseconds to the kernel and the callers of get_time_rtt want to 100db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renker * pass milliseconds (standard unit for rtt values since 2.6.27), and 101db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renker * have a different assumption for the units of a "raw" number. 10254e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones */ 103db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renkerint get_time_rtt(unsigned *val, const char *arg, int *raw) 10454e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones{ 10554e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones double t; 10654e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones unsigned long res; 10754e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones char *p; 10854e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones 10954e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones if (strchr(arg,'.') != NULL) { 11054e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones t = strtod(arg,&p); 11154e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones if (t < 0.0) 11254e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones return -1; 11354e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones } 11454e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones else { 115897fb84fd9b872a544076f88430bc35fc12b7cc8Gerrit Renker res = strtoul(arg, &p, 0); 11654e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones if (res > UINT_MAX) 11754e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones return -1; 11854e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones t = (double)res; 11954e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones } 12054e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones if (p == arg) 12154e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones return -1; 12254e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones *raw = 1; 12354e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones 12454e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones if (*p) { 12554e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones *raw = 0; 12654e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones if (strcasecmp(p, "s") == 0 || strcasecmp(p, "sec")==0 || 12754e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones strcasecmp(p, "secs")==0) 128fca1dae821d627101914c36c9282fc244cd92744Gerrit Renker t *= 1000; 12954e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones else if (strcasecmp(p, "ms") == 0 || strcasecmp(p, "msec")==0 || 13054e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones strcasecmp(p, "msecs") == 0) 13154e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones t *= 1.0; /* allow suffix, do nothing */ 13254e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones else 13354e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones return -1; 13454e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones } 13554e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones 13654e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones /* emulate ceil() without having to bring-in -lm and always be >= 1 */ 13754e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones 138db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renker *val = t; 139db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renker if (*val < t) 140db6b0cfa518de3b27c05bdf3efe05a7f77c4d97dGerrit Renker *val += 1; 14154e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones 14254e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones return 0; 14354e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones 14454e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones} 14554e0b2e71d723e3b493ff53d1332b48250f5d4bcRick Jones 146c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemmingerint get_u64(__u64 *val, const char *arg, int base) 147c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger{ 148c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger unsigned long long res; 149c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger char *ptr; 150c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger 151c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger if (!arg || !*arg) 152c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger return -1; 153c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger res = strtoull(arg, &ptr, base); 154c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger if (!ptr || ptr == arg || *ptr || res == 0xFFFFFFFFULL) 155c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger return -1; 156c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger *val = res; 157c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger return 0; 158c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger} 159c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger 1604094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint get_u32(__u32 *val, const char *arg, int base) 161aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 162aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned long res; 163aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char *ptr; 164aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 165aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!arg || !*arg) 166aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 167aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger res = strtoul(arg, &ptr, base); 168aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!ptr || ptr == arg || *ptr || res > 0xFFFFFFFFUL) 169aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 170aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *val = res; 171aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 172aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 173aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1744094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint get_u16(__u16 *val, const char *arg, int base) 175aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 176aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned long res; 177aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char *ptr; 178aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 179aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!arg || !*arg) 180aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 181aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger res = strtoul(arg, &ptr, base); 182aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!ptr || ptr == arg || *ptr || res > 0xFFFF) 183aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 184aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *val = res; 185aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 186aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 187aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1884094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint get_u8(__u8 *val, const char *arg, int base) 189aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 190aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned long res; 191aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char *ptr; 192aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 193aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!arg || !*arg) 194aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 195aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger res = strtoul(arg, &ptr, base); 196aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!ptr || ptr == arg || *ptr || res > 0xFF) 197aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 198aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *val = res; 199aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 200aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 201aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 20230d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeiferint get_s32(__s32 *val, const char *arg, int base) 20330d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer{ 20430d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer long res; 20530d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer char *ptr; 20630d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer 20730d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer errno = 0; 20830d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer 20930d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer if (!arg || !*arg) 21030d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer return -1; 21130d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer res = strtol(arg, &ptr, base); 21230d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer if (ptr == arg || *ptr || 21330d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer ((res == LONG_MIN || res == LONG_MAX) && errno == ERANGE) || 21430d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer res > INT32_MAX || res < INT32_MIN) 21530d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer return -1; 21630d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer *val = res; 21730d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer return 0; 21830d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer} 21930d10db5667d3ca86917ca86c1a65cfcc45965f9Hagen Paul Pfeifer 2204094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint get_s16(__s16 *val, const char *arg, int base) 221aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 222aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger long res; 223aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char *ptr; 224aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 225aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!arg || !*arg) 226aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 227aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger res = strtol(arg, &ptr, base); 228aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!ptr || ptr == arg || *ptr || res > 0x7FFF || res < -0x8000) 229aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 230aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *val = res; 231aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 232aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 233aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 2344094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint get_s8(__s8 *val, const char *arg, int base) 235aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 236aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger long res; 237aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char *ptr; 238aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 239aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!arg || !*arg) 240aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 241aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger res = strtol(arg, &ptr, base); 242aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!ptr || ptr == arg || *ptr || res > 0x7F || res < -0x80) 243aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 244aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *val = res; 245aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 246aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 247aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 248cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger/* This uses a non-standard parsing (ie not inet_aton, or inet_pton) 249cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger * because of legacy choice to parse 10.8 as 10.8.0.0 not 10.0.0.8 250cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger */ 251cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemmingerstatic int get_addr_ipv4(__u8 *ap, const char *cp) 252aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 253cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger int i; 254cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger 255cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger for (i = 0; i < 4; i++) { 256cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger unsigned long n; 257cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger char *endp; 258cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger 259cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger n = strtoul(cp, &endp, 0); 260cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger if (n > 255) 261cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger return -1; /* bogus network value */ 262cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger 263cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger if (endp == cp) /* no digits */ 264cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger return -1; 26594afda752956ddc6ff1accf931bc3d03c070bb18Stephen Hemminger 266cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger ap[i] = n; 267cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger 268cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger if (*endp == '\0') 269cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger break; 270cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger 271cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger if (i == 3 || *endp != '.') 272cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger return -1; /* extra characters */ 273cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger cp = endp + 1; 274cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger } 275cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger 276cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger return 1; 277cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger} 278cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger 279cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemmingerint get_addr_1(inet_prefix *addr, const char *name, int family) 280cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger{ 281aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memset(addr, 0, sizeof(*addr)); 282aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 283aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (strcmp(name, "default") == 0 || 284aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(name, "all") == 0 || 285aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(name, "any") == 0) { 286aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (family == AF_DECnet) 287aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 288aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->family = family; 289aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->bytelen = (family == AF_INET6 ? 16 : 4); 290aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->bitlen = -1; 291aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 292aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 293aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 294aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (strchr(name, ':')) { 295aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->family = AF_INET6; 296aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (family != AF_UNSPEC && family != AF_INET6) 297aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 298aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (inet_pton(AF_INET6, name, addr->data) <= 0) 299aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 300aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->bytelen = 16; 301aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->bitlen = -1; 302aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 303aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 304aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 305aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (family == AF_DECnet) { 306aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct dn_naddr dna; 307aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->family = AF_DECnet; 308aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (dnet_pton(AF_DECnet, name, &dna) <= 0) 309aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 310aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memcpy(addr->data, dna.a_addr, 2); 311aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->bytelen = 2; 312aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->bitlen = -1; 313aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 314aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 315aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 316aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->family = AF_INET; 317aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (family != AF_UNSPEC && family != AF_INET) 318aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 31994afda752956ddc6ff1accf931bc3d03c070bb18Stephen Hemminger 320cafa6c8ec1d6e4bddde190edb742be864ce3f9b3Stephen Hemminger if (get_addr_ipv4((__u8 *)addr->data, name) <= 0) 321516ffb6b7724e97ca035293dcfd9f94cf6ce3a47Stephen Hemminger return -1; 32294afda752956ddc6ff1accf931bc3d03c070bb18Stephen Hemminger 323aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->bytelen = 4; 324aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr->bitlen = -1; 325aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 326aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 327aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 328fb9b1d0f6a9f355bceae435ea43f1c8f3635b2dfosdl.net!shemmingerint get_prefix_1(inet_prefix *dst, char *arg, int family) 329aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 330aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger int err; 331aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned plen; 332aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char *slash; 333aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 334aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memset(dst, 0, sizeof(*dst)); 335aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 336aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (strcmp(arg, "default") == 0 || 337aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(arg, "any") == 0 || 338aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(arg, "all") == 0) { 339aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (family == AF_DECnet) 340aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 341aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger dst->family = family; 342aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger dst->bytelen = 0; 343aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger dst->bitlen = 0; 344aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 345aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 346aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 347aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger slash = strchr(arg, '/'); 348aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (slash) 349aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *slash = 0; 350fb9b1d0f6a9f355bceae435ea43f1c8f3635b2dfosdl.net!shemminger 351aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger err = get_addr_1(dst, arg, family); 352aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (err == 0) { 353aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger switch(dst->family) { 354aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_INET6: 355aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger dst->bitlen = 128; 356aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger break; 357aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_DECnet: 358aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger dst->bitlen = 16; 359aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger break; 360aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger default: 361aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_INET: 362aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger dst->bitlen = 32; 363aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 364aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (slash) { 3655a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson if (get_netmask(&plen, slash+1, 0) 3665a0d1cbf69269bfcb510a8b861b8a83aed0f6b85Andreas Henriksson || plen > dst->bitlen) { 367aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger err = -1; 368aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger goto done; 369aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 370f082b64fb40b467bc1f9e5d245114aae4e256d5cnet[shemminger]!shemminger dst->flags |= PREFIXLEN_SPECIFIED; 371aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger dst->bitlen = plen; 372aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 373aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 374aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerdone: 375aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (slash) 376aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *slash = '/'; 377aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return err; 378aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 379aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 380c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemmingerint get_addr(inet_prefix *dst, const char *arg, int family) 381aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 382aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (family == AF_PACKET) { 383aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Error: \"%s\" may be inet address, but it is not allowed in this context.\n", arg); 384aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(1); 385aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 386aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_addr_1(dst, arg, family)) { 387aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Error: an inet address is expected rather than \"%s\".\n", arg); 388aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(1); 389aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 390aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 391aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 392aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 393fb9b1d0f6a9f355bceae435ea43f1c8f3635b2dfosdl.net!shemmingerint get_prefix(inet_prefix *dst, char *arg, int family) 394aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 395aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (family == AF_PACKET) { 396aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Error: \"%s\" may be inet prefix, but it is not allowed in this context.\n", arg); 397aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(1); 398aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 399aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_prefix_1(dst, arg, family)) { 400aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Error: an inet prefix is expected rather than \"%s\".\n", arg); 401aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(1); 402aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 403aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 404aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 405aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 406c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger__u32 get_addr32(const char *name) 407aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 408aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger inet_prefix addr; 409aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_addr_1(&addr, name, AF_INET)) { 410aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Error: an IP address is expected rather than \"%s\"\n", name); 411aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(1); 412aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 413aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return addr.data[0]; 414aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 415aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 4164094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingervoid incomplete_command(void) 417aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 418aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Command line is not complete. Try option \"help\"\n"); 419aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(-1); 420aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 421aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 422c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemmingervoid missarg(const char *key) 423c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger{ 424c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger fprintf(stderr, "Error: argument \"%s\" is required\n", key); 425c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger exit(-1); 426c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger} 427c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger 4284094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingervoid invarg(const char *msg, const char *arg) 429aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 430aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Error: argument \"%s\" is wrong: %s\n", arg, msg); 431aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(-1); 432aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 433aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 4344094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingervoid duparg(const char *key, const char *arg) 435aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 436aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Error: duplicate \"%s\": \"%s\" is the second value.\n", key, arg); 437aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(-1); 438aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 439aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 4404094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingervoid duparg2(const char *key, const char *arg) 441aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 442aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Error: either \"%s\" is duplicate, or \"%s\" is a garbage.\n", key, arg); 443aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger exit(-1); 444aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 445aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 4464094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint matches(const char *cmd, const char *pattern) 447aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 448aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger int len = strlen(cmd); 449aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (len > strlen(pattern)) 450aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 451aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return memcmp(pattern, cmd, len); 452aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 453aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 4544094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerint inet_addr_match(const inet_prefix *a, const inet_prefix *b, int bits) 455aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 4569626dfd54c3cc4deec1c651a0bfee65b50feb78bStephen Hemminger const __u32 *a1 = a->data; 4579626dfd54c3cc4deec1c651a0bfee65b50feb78bStephen Hemminger const __u32 *a2 = b->data; 458aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger int words = bits >> 0x05; 459aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 460aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger bits &= 0x1f; 461aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 462aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (words) 463aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (memcmp(a1, a2, words << 2)) 464aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 465aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 466aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (bits) { 467aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 w1, w2; 468aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 mask; 469aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 470aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger w1 = a1[words]; 471aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger w2 = a2[words]; 472aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 473aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger mask = htonl((0xffffffff) << (0x20 - bits)); 474aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 475aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if ((w1 ^ w2) & mask) 476aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 1; 477aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 478aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 479aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 480aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 481aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 482aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerint __iproute2_hz_internal; 483aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 484aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerint __get_hz(void) 485aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 486aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char name[1024]; 487aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger int hz = 0; 488aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger FILE *fp; 489aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 490aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (getenv("HZ")) 491aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return atoi(getenv("HZ")) ? : HZ; 492aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 493aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (getenv("PROC_NET_PSCHED")) { 494aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger snprintf(name, sizeof(name)-1, "%s", getenv("PROC_NET_PSCHED")); 495c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger } else if (getenv("PROC_ROOT")) { 496aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger snprintf(name, sizeof(name)-1, "%s/net/psched", getenv("PROC_ROOT")); 497aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else { 498aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcpy(name, "/proc/net/psched"); 499aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 500aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fp = fopen(name, "r"); 501aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 502aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (fp) { 503aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned nom, denom; 504aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (fscanf(fp, "%*08x%*08x%08x%08x", &nom, &denom) == 2) 505aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (nom == 1000000) 506aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger hz = denom; 507aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fclose(fp); 508aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 509aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (hz) 510aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return hz; 511aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return HZ; 512aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 513aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 5145e8bc6316b1a6c56598cdb29a737d1d670d74e69net[shemminger]!shemmingerint __iproute2_user_hz_internal; 5155e8bc6316b1a6c56598cdb29a737d1d670d74e69net[shemminger]!shemminger 5165e8bc6316b1a6c56598cdb29a737d1d670d74e69net[shemminger]!shemmingerint __get_user_hz(void) 5175e8bc6316b1a6c56598cdb29a737d1d670d74e69net[shemminger]!shemminger{ 5185e8bc6316b1a6c56598cdb29a737d1d670d74e69net[shemminger]!shemminger return sysconf(_SC_CLK_TCK); 5195e8bc6316b1a6c56598cdb29a737d1d670d74e69net[shemminger]!shemminger} 5205e8bc6316b1a6c56598cdb29a737d1d670d74e69net[shemminger]!shemminger 5214094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemmingerconst char *rt_addr_n2a(int af, int len, const void *addr, char *buf, int buflen) 522aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 523aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger switch (af) { 524aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_INET: 525aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_INET6: 526aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return inet_ntop(af, addr, buf, buflen); 527aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_IPX: 528aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return ipx_ntop(af, addr, buf, buflen); 529aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_DECnet: 530aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger { 531aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct dn_naddr dna = { 2, { 0, 0, }}; 532aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memcpy(dna.a_addr, addr, 2); 533aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return dnet_ntop(af, &dna, buf, buflen); 534aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 535aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger default: 536aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return "???"; 537aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 538aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 539aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 540aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#ifdef RESOLVE_HOSTNAMES 541aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstruct namerec 542aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 543aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct namerec *next; 5447dec1bf88bc34e2d0b320f0c23bd1a060c73852bStephen Hemminger const char *name; 545aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger inet_prefix addr; 546aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger}; 547aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 5487dec1bf88bc34e2d0b320f0c23bd1a060c73852bStephen Hemminger#define NHASH 257 5497dec1bf88bc34e2d0b320f0c23bd1a060c73852bStephen Hemmingerstatic struct namerec *nht[NHASH]; 550aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 5517dec1bf88bc34e2d0b320f0c23bd1a060c73852bStephen Hemmingerstatic const char *resolve_address(const void *addr, int len, int af) 552aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 553aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct namerec *n; 554aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct hostent *h_ent; 555aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned hash; 556aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger static int notfirst; 557aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 558aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 559aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (af == AF_INET6 && ((__u32*)addr)[0] == 0 && 560aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ((__u32*)addr)[1] == 0 && ((__u32*)addr)[2] == htonl(0xffff)) { 561aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger af = AF_INET; 562aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addr += 12; 563aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger len = 4; 564aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 565aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 5667dec1bf88bc34e2d0b320f0c23bd1a060c73852bStephen Hemminger hash = *(__u32 *)(addr + len - 4) % NHASH; 567aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 568aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger for (n = nht[hash]; n; n = n->next) { 569aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (n->addr.family == af && 570aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger n->addr.bytelen == len && 571aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memcmp(n->addr.data, addr, len) == 0) 572aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return n->name; 573aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 574aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if ((n = malloc(sizeof(*n))) == NULL) 575aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return NULL; 576aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger n->addr.family = af; 577aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger n->addr.bytelen = len; 578aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger n->name = NULL; 579aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memcpy(n->addr.data, addr, len); 580aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger n->next = nht[hash]; 581aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger nht[hash] = n; 582aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (++notfirst == 1) 583aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger sethostent(1); 584aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fflush(stdout); 585aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 586c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemminger if ((h_ent = gethostbyaddr(addr, len, af)) != NULL) 587aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger n->name = strdup(h_ent->h_name); 588aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 589aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger /* Even if we fail, "negative" entry is remembered. */ 590aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return n->name; 591aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 592aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#endif 593aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 594aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 595c7699875bee00fbcd057fc62c30d6560b044e007net[shemminger]!shemmingerconst char *format_host(int af, int len, const void *addr, 5964094db72b61dadd16e180eab5f62ccbc82e3976dosdl.org!shemminger char *buf, int buflen) 597aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 598aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#ifdef RESOLVE_HOSTNAMES 599aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (resolve_hosts) { 6007dec1bf88bc34e2d0b320f0c23bd1a060c73852bStephen Hemminger const char *n; 6017dec1bf88bc34e2d0b320f0c23bd1a060c73852bStephen Hemminger 602aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (len <= 0) { 603aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger switch (af) { 604aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_INET: 605aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger len = 4; 606aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger break; 607aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_INET6: 608aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger len = 16; 609aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger break; 610aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_IPX: 611aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger len = 10; 612aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger break; 613aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#ifdef AF_DECnet 614aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger /* I see no reasons why gethostbyname 615aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger may not work for DECnet */ 616aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger case AF_DECnet: 617aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger len = 2; 618aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger break; 619aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#endif 620aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger default: ; 621aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 622aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 623aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (len > 0 && 624aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger (n = resolve_address(addr, len, af)) != NULL) 625aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return n; 626aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 627aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#endif 628aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return rt_addr_n2a(af, len, addr, buf, buflen); 629aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 630aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 631aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 632f332d169246447bd5e258ac03d5ee840a70adb1eshemmingerchar *hexstring_n2a(const __u8 *str, int len, char *buf, int blen) 633aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 634f332d169246447bd5e258ac03d5ee840a70adb1eshemminger char *ptr = buf; 635aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger int i; 636aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 637aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger for (i=0; i<len; i++) { 638aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (blen < 3) 639aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger break; 640aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger sprintf(ptr, "%02x", str[i]); 641aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ptr += 2; 642aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger blen -= 2; 643aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (i != len-1 && blen > 1) { 644aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger *ptr++ = ':'; 645aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger blen--; 646aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 647aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 648aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return buf; 649aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 650aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 651f332d169246447bd5e258ac03d5ee840a70adb1eshemminger__u8* hexstring_a2n(const char *str, __u8 *buf, int blen) 652aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 653aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger int cnt = 0; 654aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 655aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger for (;;) { 656aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned acc; 657aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger char ch; 658aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 659aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger acc = 0; 660aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 661aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger while ((ch = *str) != ':' && ch != 0) { 662aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (ch >= '0' && ch <= '9') 663aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ch -= '0'; 664aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger else if (ch >= 'a' && ch <= 'f') 665aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ch -= 'a'-10; 666aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger else if (ch >= 'A' && ch <= 'F') 667aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ch -= 'A'-10; 668aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger else 669aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return NULL; 670aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger acc = (acc<<4) + ch; 671aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger str++; 672aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 673aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 674aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (acc > 255) 675aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return NULL; 676aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (cnt < blen) { 677aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger buf[cnt] = acc; 678aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger cnt++; 679aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 680aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (ch == 0) 681aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger break; 682aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger ++str; 683aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 684aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (cnt < blen) 685aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memset(buf+cnt, 0, blen-cnt); 686aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return buf; 687aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 68890f93024a0818dc691138d8401721e797004b042shemminger 68990f93024a0818dc691138d8401721e797004b042shemmingerint print_timestamp(FILE *fp) 69090f93024a0818dc691138d8401721e797004b042shemminger{ 69190f93024a0818dc691138d8401721e797004b042shemminger struct timeval tv; 69290f93024a0818dc691138d8401721e797004b042shemminger char *tstr; 69390f93024a0818dc691138d8401721e797004b042shemminger 69490f93024a0818dc691138d8401721e797004b042shemminger memset(&tv, 0, sizeof(tv)); 69590f93024a0818dc691138d8401721e797004b042shemminger gettimeofday(&tv, NULL); 69690f93024a0818dc691138d8401721e797004b042shemminger 69790f93024a0818dc691138d8401721e797004b042shemminger tstr = asctime(localtime(&tv.tv_sec)); 69890f93024a0818dc691138d8401721e797004b042shemminger tstr[strlen(tstr)-1] = 0; 69990f93024a0818dc691138d8401721e797004b042shemminger fprintf(fp, "Timestamp: %s %lu usec\n", tstr, tv.tv_usec); 70090f93024a0818dc691138d8401721e797004b042shemminger return 0; 70190f93024a0818dc691138d8401721e797004b042shemminger} 702351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 703351efcde4e62967362a10b29f3b701cfecd7cdfcshemmingerint cmdlineno; 704351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 705351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger/* Like glibc getline but handle continuation lines and comments */ 706d21e88354b2a42b026384730a767f2108bcf8efeAndreas Henrikssonssize_t getcmdline(char **linep, size_t *lenp, FILE *in) 707351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger{ 708d21e88354b2a42b026384730a767f2108bcf8efeAndreas Henriksson ssize_t cc; 709351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger char *cp; 710ae665a522bd46bea44c5ea84c89c8b1731954170Stephen Hemminger 711351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger if ((cc = getline(linep, lenp, in)) < 0) 712351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger return cc; /* eof or error */ 713351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger ++cmdlineno; 714351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 715351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger cp = strchr(*linep, '#'); 716ae665a522bd46bea44c5ea84c89c8b1731954170Stephen Hemminger if (cp) 717351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger *cp = '\0'; 718ae665a522bd46bea44c5ea84c89c8b1731954170Stephen Hemminger 719351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger while ((cp = strstr(*linep, "\\\n")) != NULL) { 720351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger char *line1 = NULL; 721351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger size_t len1 = 0; 72221a85d3becf45e02985c466764ae19433d907c40Stephen Hemminger ssize_t cc1; 723351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 724351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger if ((cc1 = getline(&line1, &len1, in)) < 0) { 725351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger fprintf(stderr, "Missing continuation line\n"); 726351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger return cc1; 727351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger } 728351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 729351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger ++cmdlineno; 730351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger *cp = 0; 731351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 732351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger cp = strchr(line1, '#'); 733ae665a522bd46bea44c5ea84c89c8b1731954170Stephen Hemminger if (cp) 734351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger *cp = '\0'; 735351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 736d21e88354b2a42b026384730a767f2108bcf8efeAndreas Henriksson *lenp = strlen(*linep) + strlen(line1) + 1; 737d21e88354b2a42b026384730a767f2108bcf8efeAndreas Henriksson *linep = realloc(*linep, *lenp); 738351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger if (!*linep) { 739351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger fprintf(stderr, "Out of memory\n"); 740d21e88354b2a42b026384730a767f2108bcf8efeAndreas Henriksson *lenp = 0; 741351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger return -1; 742351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger } 743351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger cc += cc1 - 2; 744351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger strcat(*linep, line1); 745351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger free(line1); 746351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger } 747351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger return cc; 748351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger} 749351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 750351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger/* split command line into argument vector */ 751351efcde4e62967362a10b29f3b701cfecd7cdfcshemmingerint makeargs(char *line, char *argv[], int maxargs) 752351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger{ 753351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger static const char ws[] = " \t\r\n"; 754351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger char *cp; 755351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger int argc = 0; 756351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 757351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger for (cp = strtok(line, ws); cp; cp = strtok(NULL, ws)) { 758351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger if (argc >= (maxargs - 1)) { 759351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger fprintf(stderr, "Too many arguments to command\n"); 760351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger exit(1); 761351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger } 762351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger argv[argc++] = cp; 763351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger } 764351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger argv[argc] = NULL; 765351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger 766351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger return argc; 767351efcde4e62967362a10b29f3b701cfecd7cdfcshemminger} 768