/* ip.c - Show / manipulate routing, devices, policy routing and tunnels. * * Copyright 2014 Sameer Prakash Pradhan * Copyright 2014 Ranjan Kumar * Copyright 2014 Rajni Kant * Copyright 2014 Bilal Qureshi * * No Standard. * USE_IP(NEWTOY(ip, NULL, TOYFLAG_SBIN)) USE_IP(OLDTOY(ipaddr, ip, TOYFLAG_SBIN)) USE_IP(OLDTOY(iplink, ip, TOYFLAG_SBIN)) USE_IP(OLDTOY(iproute, ip, TOYFLAG_SBIN)) USE_IP(OLDTOY(iprule, ip, TOYFLAG_SBIN)) USE_IP(OLDTOY(iptunnel, ip, TOYFLAG_SBIN)) config IP bool "ip" default n help usage: ip [ OPTIONS ] OBJECT { COMMAND } Show / manipulate routing, devices, policy routing and tunnels. where OBJECT := {address | link | route | rule | tunnel} OPTIONS := { -f[amily] { inet | inet6 | link } | -o[neline] } */ #define FOR_ip #include "toys.h" #include #include #include #include #include #include #include #include #ifndef IP_DF #define IP_DF 0x4000 /* don't fragment flag. */ #endif GLOBALS( char stats, singleline, flush, *filter_dev, gbuf[8192]; int sockfd, connected, from_ok, route_cmd; int8_t addressfamily, is_addr; ) struct arglist { char *name; int idx; }; static struct { int ifindex, scope, scopemask, up, to; char *label, *addr; } addrinfo; struct linkdata { struct linkdata *next, *prev; int flags, iface_idx, mtu, txqueuelen, parent,iface_type; char qdiscpline[IFNAMSIZ+1], state[IFNAMSIZ+1], type[IFNAMSIZ+1], iface[IFNAMSIZ+1], laddr[64], bcast[64]; struct rtnl_link_stats rt_stat; }*linfo; typedef int (*cmdobj)(char **argv); #define MESG_LEN 8192 // For "/etc/iproute2/RPDB_tables" enum { RPDB_rtdsfield = 1, RPDB_rtprotos = 2, RPDB_rtrealms = 3, RPDB_rtscopes = 4, RPDB_rttables = 5 }; #define RPDB_ENTRIES 256 static int8_t rttable_init; static int8_t rtprotos_init; static int8_t rtdsfield_init; static int8_t rtscope_init; static int8_t rtrealms_init; static struct arglist *rt_dsfield[RPDB_ENTRIES]; static struct arglist *rt_protos[RPDB_ENTRIES]; static struct arglist *rt_tables[RPDB_ENTRIES]; static struct arglist *rt_realms[RPDB_ENTRIES]; static struct arglist *rt_scope[RPDB_ENTRIES]; static struct arglist rtmtypes[] = { {"none", RTN_UNSPEC}, {"unicast", RTN_UNICAST}, {"local", RTN_LOCAL}, {"broadcast", RTN_BROADCAST}, {"anycast", RTN_ANYCAST}, {"multicast", RTN_MULTICAST}, {"blackhole", RTN_BLACKHOLE}, {"unreachable", RTN_UNREACHABLE}, {"prohibit", RTN_PROHIBIT}, {"throw", RTN_THROW}, {"nat", RTN_NAT}, {"xresolve", RTN_XRESOLVE}, {NULL, -1} }; static int filter_nlmesg(int (*fun)(struct nlmsghdr *mhdr, char **), char **); static int ipaddr_print(struct linkdata *, int flg); // extended route attribute metrics. static const char *mx_names[RTAX_MAX + 1] = { [RTAX_MTU] = "mtu", [RTAX_WINDOW] = "window", [RTAX_RTT] = "rtt", [RTAX_RTTVAR] = "rttvar", [RTAX_SSTHRESH] = "ssthresh", [RTAX_CWND] = "cwnd", [RTAX_ADVMSS] = "advmss", [RTAX_REORDERING] = "reordering", [RTAX_HOPLIMIT] = "hoplimit", [RTAX_INITCWND] = "initcwnd", [RTAX_FEATURES] = "features", [RTAX_RTO_MIN] = "rto_min", [RTAX_INITRWND] = "initrwnd", [RTAX_QUICKACK] = "quickack", [RTAX_CC_ALGO] = "congctl"}; // =========================================================================== // Common Code for IP Options (like: addr, link, route etc.) // =========================================================================== static int substring_to_idx(char *str, struct arglist *list) { struct arglist *alist; int len; if (!str) return -1; len = strlen(str); for (alist = list; alist->name; alist++) if (!memcmp(str, alist->name, len)) return alist->idx; return -1; } static int string_to_idx(char *str, struct arglist *list) { struct arglist *alist; if (!str) return -1; for (alist = list; alist->name; alist++) if (!strcmp(str, alist->name)) return alist->idx; return -1; } static char *idx_to_string(int idx, struct arglist *list) { struct arglist *alist; if (idx < 0) return NULL; for (alist = list; alist->name; alist++) if (idx == alist->idx) return alist->name; return NULL; } static void send_nlmesg(int type, int flags, int family, void *buf, int blen) { struct { struct nlmsghdr nlh; struct rtgenmsg g; } req; if (!buf) { memset(&req, 0, sizeof(req)); req.nlh.nlmsg_len = sizeof(req); req.nlh.nlmsg_type = type; req.nlh.nlmsg_flags = flags; req.g.rtgen_family = family; buf = &req; blen = sizeof(req); } if (send(TT.sockfd , (void*)buf, blen, 0) < 0) perror_exit("Unable to send data on socket."); } // Parse /etc/iproute2/RPDB_tables and prepare list. static void parseRPDB(char *fname, struct arglist **list, int32_t size) { FILE *fp = fopen(fname, "r"); char *line = 0; size_t l = 0; ssize_t len; if (!fp) return; while ((len = getline(&line, &l, fp)) > 0) { char *ptr = line; int32_t idx; while (*ptr == ' ' || *ptr == '\t') ptr++; if (*ptr == 0 || *ptr == '#' || *ptr == '\n') continue; if ((sscanf(ptr, "0x%x %s\n", &idx, toybuf) != 2) && (sscanf(ptr, "0x%x %s #", &idx, toybuf) != 2) && (sscanf(ptr, "%d %s\n", &idx, toybuf) != 2) && (sscanf(ptr, "%d %s #", &idx, toybuf) != 2)) { error_msg("corrupt %s", fname); break; } if (idx >= 0 && idx < size) { int index = idx & (size-1); if (list[index]) free(list[index]->name); else list[index] = xzalloc(sizeof(struct arglist)); list[index]->idx = idx; list[index]->name = xstrdup(toybuf); } } free(line); fclose(fp); } static void free_alist(struct arglist **list) { int i; for (i = 0;iname); free(list[i]); } } } static void init_arglist(struct arglist **list,int value, char* name) { if (!list[value]) list[value] = xzalloc(sizeof(struct arglist)); list[value]->idx = value; list[value]->name = xstrdup(name); } static struct arglist **getlist(u_int8_t whichDB) { struct arglist **alist; switch (whichDB) { case RPDB_rtdsfield: alist = rt_dsfield; if (!rtdsfield_init) { rtdsfield_init = 1; parseRPDB("/etc/iproute2/rt_dsfield", alist, ARRAY_LEN(rt_dsfield)); } break; case RPDB_rtprotos: alist = rt_protos; if (!rttable_init) { rtprotos_init = 1; init_arglist(rt_protos,0,"none"); init_arglist(rt_protos,1,"redirect"); init_arglist(rt_protos,2,"kernel"); init_arglist(rt_protos,3,"boot"); init_arglist(rt_protos,4,"static"); init_arglist(rt_protos,8,"gated"); init_arglist(rt_protos,9,"ra"); init_arglist(rt_protos,10,"mrt"); init_arglist(rt_protos,11,"zebra"); init_arglist(rt_protos,12,"bird"); parseRPDB("/etc/iproute2/rt_protos", alist, ARRAY_LEN(rt_protos)); } break; case RPDB_rtrealms: alist = rt_realms; if (!rtrealms_init) { rtrealms_init = 1; init_arglist(rt_realms,0,"unspec"); parseRPDB("/etc/iproute2/rt_realms", alist, ARRAY_LEN(rt_realms)); } break; case RPDB_rtscopes: alist = rt_scope; if (!rtscope_init) { rtscope_init = 1; init_arglist(rt_scope,0,"global"); init_arglist(rt_scope,200,"site"); init_arglist(rt_scope,253,"link"); init_arglist(rt_scope,254,"host"); init_arglist(rt_scope,255,"nowhere"); parseRPDB("/etc/iproute2/rt_scopes", alist, ARRAY_LEN(rt_scope)); } break; case RPDB_rttables: alist = rt_tables; if (!rttable_init) { rttable_init = 1; init_arglist(rt_tables,RT_TABLE_DEFAULT,"default"); init_arglist(rt_tables,RT_TABLE_MAIN,"main"); init_arglist(rt_tables,RT_TABLE_LOCAL,"local"); parseRPDB("/etc/iproute2/rt_tables", alist, ARRAY_LEN(rt_tables)); } break; default: error_exit("wrong database"); break; // Unreachable code. } return alist; } /* * Parse RPBD tables (if not parsed already). * return RPDB table name as per idx. */ static char *namefromRPDB(int idx, u_int8_t whichDB) { struct arglist **alist; if (idx < 0 || idx >= RPDB_ENTRIES) { snprintf(toybuf, RPDB_ENTRIES, "%u", idx); return toybuf; } alist = getlist(whichDB); if (alist[idx] && alist[idx]->name) return alist[idx]->name; if (whichDB == RPDB_rtdsfield) snprintf(toybuf, RPDB_ENTRIES, "0x%02x", idx); else snprintf(toybuf, RPDB_ENTRIES, "%u", idx); return toybuf; } static int idxfromRPDB(char *name, u_int8_t whichDB) { struct arglist **alist; long i = 0; char *ptr = NULL; for (alist = getlist(whichDB); i < RPDB_ENTRIES; i++) { if (!alist[i] || !alist[i]->name) continue; if (!strcmp(alist[i]->name, name)) return i; } i = strtol(name, &ptr, 0); if (errno || (ptr && *ptr) || i < 0 || i > 255) return -1; return i; } static char *rtmtype_idx2str(u_int8_t idx) { char *name = idx_to_string(idx, rtmtypes); if (!name) snprintf(toybuf, RPDB_ENTRIES, "%u", idx); else snprintf(toybuf, sizeof(toybuf), "%s", name); return toybuf; } static int rtmtype_str2idx(char *name) { int idx = string_to_idx(name, rtmtypes); if (idx < 0) return atolx_range(name, 0, 255); return idx; } /* * Used to get the prefix value in binary form. * For IPv4: non-standard parsing used; as 10.10 will be treated as 10.10.0.0 * unlike inet_aton which is 10.0.0.10 */ static int get_prefix(uint32_t *addr, uint8_t *af, char *name, int family) { if (family == AF_PACKET) error_exit("'%s' may be inet prefix", name); if (!memcmp(name, "default", strlen(name)) || !memcmp(name, "all", strlen(name)) || !memcmp(name, "any", strlen(name))) { *af = family; return 0; } if (strchr(name, ':')) { *af = AF_INET6; if (family != AF_UNSPEC && family != AF_INET6) return 1; if (inet_pton(AF_INET6, name, (void *)addr) != 1) return 1; } else { // for IPv4. char *ptr = name; uint8_t count = 0; *af = AF_INET; if (family != AF_UNSPEC && family != AF_INET) return 1; while (*ptr) { int val, len = 0; if (*ptr == '.') ptr++; sscanf(ptr, "%d%n", &val, &len); if (!len || len > 3 || val < 0 || val > 255 || count > 3) return 1; ptr += len; ((uint8_t*)addr)[count++] = val; } } return 0; } /* * Used to calculate netmask, which can be in the form of * either 255.255.255.0 or 24 or default or any or all strings. */ static int get_nmask_prefix(uint32_t *netmask, uint8_t af, char *name, uint8_t family) { char *ptr; uint32_t naddr[4] = {0,}; uint64_t plen; uint8_t naf = AF_UNSPEC; *netmask = (af == AF_INET6) ? 128 : 32; // set default netmask plen = strtoul(name, &ptr, 0); if (!ptr || ptr == name || *ptr || !plen || plen > *netmask) { if (get_prefix(naddr, &naf, name, family)) return -1; if (naf == AF_INET) { uint32_t mask = htonl(*naddr), host = ~mask; if (host & (host + 1)) return -1; for (plen = 0; mask; mask <<= 1) ++plen; if (plen > 32) return -1; } } *netmask = plen; return 0; } /* * Parse prefix, which will be in form of * either default or default/default or default/24 or default/255.255.255.0 * or 10.20.30.40 or 10.20.30.40/default or 10.20.30.40/24 * or 10.20.30.40/255.255.255.0 */ static void parse_prefix(uint32_t *addr, uint32_t *netmask, uint8_t *len, char *name, int family) { uint8_t af = AF_UNSPEC; char *slash = strchr(name, '/'); if (slash) *slash = 0; if (get_prefix(addr, &af, name, family)) error_exit("Invalid prefix"); if (slash) { // grab netmask. if (get_nmask_prefix(netmask, af, slash+1, family)) error_exit("Invalid prefix"); *slash ='/'; } else if (af == AF_INET && *addr) *netmask = 32; else if (af == AF_INET6 && (*addr || *(addr+3))) *netmask = 128; if (!*addr && !slash && !af) *len = 0; else *len = (af == AF_INET6) ? 16 : 4; } /* * Add a route attribute to a buffer; this is primarily used for extended * attributes which get collected in a separate buffer from the normal route * attributes and later get added to the main rtm message. */ static void add_varlen_rtattr_to_buffer(struct rtattr *rta, int maxlen, int type, void *data, int alen) { struct rtattr *subrta; int len = RTA_LENGTH(alen); if (RTA_ALIGN(rta->rta_len) + RTA_ALIGN(len) > maxlen) { error_exit("RTA exceeds max length %d", maxlen); } subrta = (struct rtattr*)(((char*)rta) + RTA_ALIGN(rta->rta_len)); subrta->rta_type = type; subrta->rta_len = len; if (alen) { memcpy(RTA_DATA(subrta), data, alen); } rta->rta_len = NLMSG_ALIGN(rta->rta_len) + RTA_ALIGN(len); } static void add_uint32_rtattr_to_buffer(struct rtattr *rta, int maxlen, int type, uint32_t attr) { add_varlen_rtattr_to_buffer(rta, maxlen, type, (char*)&attr, sizeof(attr)); } /* * Add a route attribute to a RTM message. */ static void add_string_to_rtattr(struct nlmsghdr *n, int maxlen, int type, void *data, int alen) { int len = RTA_LENGTH(alen); struct rtattr *rta; if ((int)(NLMSG_ALIGN(n->nlmsg_len) + len) > maxlen) return; rta = (struct rtattr*)(((char*)n) + NLMSG_ALIGN(n->nlmsg_len)); rta->rta_type = type; rta->rta_len = len; memcpy(RTA_DATA(rta), data, alen); n->nlmsg_len = NLMSG_ALIGN(n->nlmsg_len) + len; } // =========================================================================== // Code for ip link. // =========================================================================== #ifndef NLMSG_TAIL #define NLMSG_TAIL(nmsg) \ ((struct rtattr *) (((void *) (nmsg)) + NLMSG_ALIGN((nmsg)->nlmsg_len))) #endif static uint32_t get_ifaceindex(char *name, int ext) { struct if_nameindex *if_ni, *i; int index = -1; if_ni = if_nameindex(); if (!if_ni) perror_exit("if_nameindex"); for (i = if_ni; i->if_index && i->if_name; i++) if (!strcmp(name, i->if_name)) { index = i->if_index; break; } if_freenameindex(if_ni); if (index == -1 && ext) perror_exit("can't find device '%s'", name); return index; } static void fill_hwaddr(char *arg, int len, unsigned char *address) { int count = 0, val, length; while (count < len) { val = length = 0; if (!arg) error_exit("bad hw-addr '%s'", ""); if (*arg == ':') arg++, count++; sscanf(arg, "%2x%n", &val, &length); if (!length || length > 2) error_exit("bad hw-addr '%s'", arg); arg += length; count += length; *address++ = val; } } // Multimach = 1, single match = 0 static char *get_flag_string(struct arglist *aflags, int flags, int ismulti) { struct arglist *p = aflags; char *out = NULL, *tmp = NULL; for (; p->name; p++) { int test = (ismulti ? p->idx & flags : 0) || p->idx == flags; if (test) { // flags can be zero tmp = out ? xmprintf("%s,%s", out, p->name) : xmprintf("%s", p->name); if (out) free(out); out = tmp; } } return out; } static void vlan_parse_opt(char **argv, struct nlmsghdr *n, unsigned int size) { struct arglist vlan_optlist[] = {{"id", 0}, {"protocol", 1}, {"reorder_hdr", 2}, {"gvrp", 3}, {NULL,-1}}; struct arglist vlan_protolist[] = {{"802.1q", 0}, {"802.1ad", 1}, {NULL,-1}}; struct arglist on_off[] = { {"on", 0}, {"off", 1}, {NULL,-1}}; int idx; struct ifla_vlan_flags flags; memset(&flags, 0, sizeof(flags)); for (; *argv; argv++) { int param, proto; if ((idx = substring_to_idx(*argv++, vlan_optlist)) == -1) help_exit(0); switch (idx) { case 0: // ARG_id if (!*argv) help_exit(0); param = atolx(*argv); add_string_to_rtattr(n, size, IFLA_VLAN_ID, ¶m, sizeof(param)); break; case 1: // ARG_protocol if (!*argv) error_exit("Invalid vlan id."); if ((idx = substring_to_idx(*argv, vlan_protolist)) == -1) help_exit(0); if (!idx) proto = ETH_P_8021Q; // PROTO_8021Q - 0 else if (idx == 1) proto = 0x88A8; // ETH Protocol - 8021AD // IFLA VLAN PROTOCOL - 5 add_string_to_rtattr(n, size, 5, &proto, sizeof(proto)); break; case 2: // ARG_reorder_hdr case 3: // ARG_gvrp if ((param = substring_to_idx(*argv, on_off)) == -1) help_exit(0); flags.mask |= (idx -1); // VLAN FLAG REORDER Header flags.flags &= ~(idx -1); // VLAN FLAG REORDER Header if (!param) flags.flags |= (idx -1); // VLAN FLAG REORDER Header break; } } if (flags.mask) add_string_to_rtattr(n, size, IFLA_VLAN_FLAGS, &flags, sizeof(flags)); } static int linkupdate(char **argv) { struct { struct nlmsghdr mhdr; struct ifinfomsg info; char buf[1024]; } request; char *name, *dev, *type, *link, *addr; struct rtattr *attr = NULL; int len = 0, add = (*argv[-1] == 'a') ? 1 : 0; name = dev = type = link = addr = NULL; for (; *argv; argv++) { struct arglist objectlist[] = { {"type", 0}, {"name", 1}, {"link", 2}, {"address", 3}, {NULL,-1}}; uint8_t idx = substring_to_idx(*argv, objectlist); if (!idx) { type = *++argv; break; } else if (idx == 1) dev = name = *++argv; else if (idx == 2) link = *++argv; else if (idx == 3) addr = *++argv; else if (!dev) name = dev = *argv; } if (!name && !add) error_exit("Not enough information: \"dev\" argument is required.\n"); else if (!type && add) error_exit("Not enough information: \"type\" argument is required.\n"); memset(&request, 0, sizeof(request)); request.mhdr.nlmsg_len = NLMSG_LENGTH(sizeof(struct ifinfomsg)); request.mhdr.nlmsg_flags = NLM_F_REQUEST|NLM_F_ACK; if (add) { request.mhdr.nlmsg_flags |= NLM_F_CREATE|NLM_F_EXCL; request.mhdr.nlmsg_type = RTM_NEWLINK; } else { request.mhdr.nlmsg_type = RTM_DELLINK; request.info.ifi_index = get_ifaceindex(name, 1); } request.info.ifi_family = AF_UNSPEC; attr = NLMSG_TAIL(&request.mhdr); if (type) { add_string_to_rtattr(&request.mhdr, sizeof(request), IFLA_LINKINFO, NULL, 0); add_string_to_rtattr(&request.mhdr, sizeof(request), IFLA_INFO_KIND, type, strlen(type)); if (!strcmp(type, "vlan")) { struct rtattr *data = NLMSG_TAIL(&request.mhdr); add_string_to_rtattr(&request.mhdr, sizeof(request), IFLA_INFO_DATA, NULL, 0); vlan_parse_opt(++argv, &request.mhdr, sizeof(request)); data->rta_len = (void *)NLMSG_TAIL(&request.mhdr) - (void *)data; } attr->rta_len = (void *)NLMSG_TAIL(&request.mhdr) - (void *)attr; } if (link) { uint32_t idx = get_ifaceindex(link, 1); add_string_to_rtattr(&request.mhdr, sizeof(request), IFLA_LINK, &idx, sizeof(uint32_t)); } if (addr) { char abuf[IF_NAMESIZE] = {0,}; fill_hwaddr(addr, IF_NAMESIZE, (unsigned char *)abuf); add_string_to_rtattr(&request.mhdr, sizeof(request), IFLA_ADDRESS, abuf, strlen(abuf)); } if (!name) { snprintf(toybuf, IFNAMSIZ, "%s%d", type, 0); for (len = 1; ; len++) { if (!get_ifaceindex(toybuf, 0)) break; snprintf(toybuf, IFNAMSIZ, "%s%d", type, len); } name = toybuf; } len = strlen(name) + 1; if (len < 2 || len > IFNAMSIZ) error_exit("Invalid device name."); add_string_to_rtattr(&request.mhdr, sizeof(request), IFLA_IFNAME, name, len); send_nlmesg(0, 0, 0, (void *)&request, request.mhdr.nlmsg_len); return (filter_nlmesg(NULL,NULL)); } static int link_set(char **argv) { struct arglist cmd_objectlist[] = {{"up", 0}, {"down", 1}, {"arp", 2}, {"multicast", 3}, {"dynamic", 4}, {"name", 5}, {"txqueuelen", 6}, {"mtu", 7},{"address", 8}, {"broadcast", 9}, {NULL,-1}}; int case_flags[] = {IFF_NOARP,IFF_MULTICAST,IFF_DYNAMIC}; struct ifreq req; int idx, flags = 0, masks = 0xffff, fd; memset(&req, 0, sizeof(req)); if (!*argv) error_exit("\"dev\" missing"); xstrncpy(req.ifr_name, *argv, IF_NAMESIZE); fd = xsocket(AF_INET, SOCK_DGRAM, 0); xioctl(fd, SIOCGIFINDEX, &req); for (++argv; *argv;) { if ((idx = substring_to_idx(*argv++, cmd_objectlist)) == -1) help_exit(0); switch(idx) { case 0: flags |= IFF_UP; break; case 1: masks &= ~IFF_UP; break; case 2: case 3: case 4: if (!*argv) help_exit(0); else if (!strcmp(*argv, "on")) { if (idx == 2) { masks &= ~case_flags[idx-2]; flags &= ~case_flags[idx-2]; } else flags |= case_flags[idx-2]; } else if (!strcmp(*argv,"off")) { if (idx == 2) { masks |= case_flags[idx-2]; flags |= case_flags[idx-2]; } else masks &= ~case_flags[idx-2]; } else help_exit(0); ++argv; break; case 5: xstrncpy(req.ifr_ifru.ifru_newname, *argv, IF_NAMESIZE); xioctl(fd, SIOCSIFNAME, &req); xstrncpy(req.ifr_name, *argv++, IF_NAMESIZE); xioctl(fd, SIOCGIFINDEX, &req); break; case 6: req.ifr_ifru.ifru_ivalue = atolx(*argv++); xioctl(fd, SIOCSIFTXQLEN, &req); break; case 7: req.ifr_ifru.ifru_mtu = atolx(*argv++); xioctl(fd, SIOCSIFMTU, &req); break; case 8: xioctl(fd, SIOCGIFHWADDR, &req); fill_hwaddr(*argv++, IF_NAMESIZE, (unsigned char *)(req.ifr_hwaddr.sa_data)); xioctl(fd, SIOCSIFHWADDR, &req); break; case 9: xioctl(fd, SIOCGIFHWADDR, &req); fill_hwaddr(*argv++, IF_NAMESIZE, (unsigned char *)(req.ifr_hwaddr.sa_data)); xioctl(fd, SIOCSIFHWBROADCAST, &req); break; } } xioctl(fd, SIOCGIFFLAGS, &req); req.ifr_ifru.ifru_flags |= flags; req.ifr_ifru.ifru_flags &= masks; xioctl(fd, SIOCSIFFLAGS, &req); xclose(fd); return 0; } static void print_stats(struct rtnl_link_stats *rtstat) { char *line_feed = (!TT.singleline ? "\n " : " "); if (TT.stats > 0) { xprintf(" RX: bytes packets errors " "dropped overrun mcast%s%-10u %-8u %-7u %-8u %-8u %-8u\n", line_feed, rtstat->rx_bytes, rtstat->rx_packets, rtstat->rx_errors, rtstat->rx_dropped, rtstat->rx_over_errors, rtstat->multicast); if (TT.stats > 1) { xprintf(" RX: errors length crc " "frame fifo missed%s%-10u %-8u %-7u %-8u %-8u %-8u\n", line_feed, rtstat->rx_errors, rtstat->rx_length_errors, rtstat->rx_crc_errors, rtstat->rx_frame_errors, rtstat->rx_fifo_errors, rtstat->rx_missed_errors); } xprintf(" TX: bytes packets errors " "dropped carrier collsns%s%-10u %-8u %-7u %-8u %-8u %-8u\n", line_feed, rtstat->tx_bytes, rtstat->tx_packets, rtstat->tx_errors, rtstat->tx_dropped, rtstat->tx_carrier_errors, rtstat->collisions); if (TT.stats > 1) { xprintf(" TX: errors aborted fifo window " "heartbeat%s%-10u %-8u %-7u %-8u %-8u\n", line_feed, rtstat->tx_errors, rtstat->tx_aborted_errors, rtstat->tx_fifo_errors, rtstat->tx_window_errors, rtstat->tx_heartbeat_errors); } } } static int print_link_output(struct linkdata *link) { char *line_feed = " ", *flags,*peer = "brd"; struct arglist iface_flags[] = {{"",0},{"UP", IFF_UP}, {"BROADCAST", IFF_BROADCAST}, {"DEBUG", IFF_DEBUG}, {"LOOPBACK", IFF_LOOPBACK}, {"POINTOPOINT", IFF_POINTOPOINT}, {"NOTRAILERS", IFF_NOTRAILERS}, {"RUNNING", IFF_RUNNING}, {"NOARP", IFF_NOARP}, {"PROMISC",IFF_PROMISC}, {"ALLMULTI", IFF_ALLMULTI}, {"MASTER", IFF_MASTER}, {"SLAVE", IFF_SLAVE}, {"MULTICAST", IFF_MULTICAST}, {"PORTSEL", IFF_PORTSEL}, {"AUTOMEDIA", IFF_AUTOMEDIA}, {"DYNAMIC", IFF_DYNAMIC}, {NULL,-1}}; if (link->parent != -1) { int fd = 0; struct ifreq req; memset(&req, 0, sizeof(req)); if_indextoname( link->parent,req.ifr_ifrn.ifrn_name); fd = xsocket(AF_INET, SOCK_DGRAM, 0); if (ioctl(fd, SIOCGIFTXQLEN, &req)) perror(""); else link->txqueuelen = req.ifr_ifru.ifru_ivalue; xclose(fd); } if (TT.is_addr && addrinfo.label && fnmatch(addrinfo.label, link->iface, 0)) return 0; if (!(flags = get_flag_string(iface_flags, link->flags, 1))) error_exit("Invalid data."); if (!TT.singleline) line_feed="\n "; if (link->parent != -1) { char iface[IF_NAMESIZE]; if (!if_indextoname(link->parent, iface)) perror_exit(NULL); sprintf(toybuf,"%s@%s", link->iface, iface); } if (link->flags & IFF_POINTOPOINT) peer = "peer"; if (TT.is_addr && TT.singleline && TT.addressfamily) xprintf("%d: %s", link->iface_idx, ((link->parent == -1) ? link->iface : toybuf)); else xprintf("%d: %s: <%s> mtu %d qdisc %s state %s qlen %d", link->iface_idx, ((link->parent == -1) ? link->iface : toybuf), flags, link->mtu, link->qdiscpline, link->state, link->txqueuelen); if (!TT.addressfamily || TT.addressfamily == AF_PACKET) xprintf("%slink/%s %s %s %s", line_feed, link->type, link->laddr, peer ,link->bcast); xputc('\n'); //user can specify stats flag two times //one for stats and other for erros e.g. -s and -s -s print_stats(&link->rt_stat); free(flags); return 0; } static void fill_address(void *p, char *ip) { unsigned char *ptr = (unsigned char*)p; snprintf(ip, 64, " %02x:%02x:%02x:%02x:%02x:%02x", ptr[0], ptr[1], ptr[2], ptr[3], ptr[4], ptr[5]); } static int get_link_info(struct nlmsghdr* h,struct linkdata* link,char **argv) { struct ifinfomsg *iface = NLMSG_DATA(h); struct rtattr *attr = IFLA_RTA(iface); int len = h->nlmsg_len - NLMSG_LENGTH(sizeof(*iface)); struct arglist hwtypes[]={{"generic",0},{"ether",ARPHRD_ETHER}, {"loopback", ARPHRD_LOOPBACK},{"sit",ARPHRD_SIT}, #ifdef ARPHRD_INFINIBAND {"infiniband",ARPHRD_INFINIBAND}, #endif #ifdef ARPHRD_IEEE802_TR {"ieee802",ARPHRD_IEEE802}, {"tr",ARPHRD_IEEE802_TR}, #else {"tr",ARPHRD_IEEE802}, #endif #ifdef ARPHRD_IEEE80211 {"ieee802.11",ARPHRD_IEEE80211}, #endif #ifdef ARPHRD_IEEE1394 {"ieee1394",ARPHRD_IEEE1394}, #endif {"irda",ARPHRD_IRDA},{"slip",ARPHRD_SLIP},{"cslip",ARPHRD_CSLIP}, {"slip6",ARPHRD_SLIP6}, {"cslip6",ARPHRD_CSLIP6}, {"ppp",ARPHRD_PPP}, {"ipip",ARPHRD_TUNNEL}, {"tunnel6",ARPHRD_TUNNEL6}, {"gre",ARPHRD_IPGRE}, #ifdef ARPHRD_VOID {"void",ARPHRD_VOID}, #endif {NULL,-1}}; char *lname = get_flag_string(hwtypes, iface->ifi_type, 0); link->next = link->prev = 0; link->iface_type = iface->ifi_type; if (!lname) error_exit("Invalid link."); xstrncpy(link->type, lname, IFNAMSIZ); free(lname); link->iface_idx = iface->ifi_index; link->flags = iface->ifi_flags; if (*argv && !strcasecmp("up",*argv) && !(link->flags & IFF_UP)) return 1; link->parent = -1; for (; RTA_OK(attr, len); attr = RTA_NEXT(attr, len)) { switch(attr->rta_type) { case IFLA_IFNAME: snprintf(link->iface, IFNAMSIZ, "%s",(char *) RTA_DATA(attr)); break; case IFLA_ADDRESS: if ( iface->ifi_type== ARPHRD_TUNNEL || iface->ifi_type == ARPHRD_SIT || iface->ifi_type == ARPHRD_IPGRE) inet_ntop(AF_INET, RTA_DATA(attr), link->laddr, 64); else fill_address(RTA_DATA(attr), link->laddr); break; case IFLA_BROADCAST: if (iface->ifi_type== ARPHRD_TUNNEL || iface->ifi_type == ARPHRD_SIT || iface->ifi_type == ARPHRD_IPGRE) inet_ntop(AF_INET, RTA_DATA(attr), link->bcast, 64); else fill_address(RTA_DATA(attr), link->bcast); break; case IFLA_MTU: link->mtu = *((int*)(RTA_DATA(attr))); break; case IFLA_QDISC: snprintf(link->qdiscpline, IFNAMSIZ, "%s", (char *) RTA_DATA(attr)); break; case IFLA_STATS : link->rt_stat = *((struct rtnl_link_stats*) RTA_DATA(attr)); break; case IFLA_LINK: link->parent = *((int*)(RTA_DATA(attr))); break; case IFLA_TXQLEN: link->txqueuelen = *((int*)(RTA_DATA(attr))); break; case IFLA_OPERSTATE: { struct arglist flags[]={{"UNKNOWN", 0}, {"NOTPRESENT", 1}, {"DOWN", 2}, {"LOWERLAYERDOWN", 3}, {"TESTING", 4}, {"DORMANT", 5}, {"UP", 6}, {NULL, -1}}; if (!(lname = get_flag_string(flags, *((int*)(RTA_DATA(attr))), 0))) error_exit("Invalid state."); xstrncpy(link->state, lname,IFNAMSIZ); free(lname); } break; default: break; } } return 0; } static int display_link_info(struct nlmsghdr *mhdr, char **argv) { struct linkdata link; if (!get_link_info(mhdr, &link, argv)) { if (TT.is_addr) { struct linkdata *lnk = xzalloc(sizeof(struct linkdata)); memcpy(lnk, &link, sizeof(struct linkdata)); dlist_add_nomalloc((struct double_list **)&linfo, (struct double_list *)lnk); } else print_link_output(&link); } return 0; } static int link_show(char **argv) { struct { struct nlmsghdr mhdr; struct ifinfomsg info; } request; uint32_t index = 0; if (*argv && strcasecmp("up",*argv)) index = get_ifaceindex(*argv, 1); memset(&request, 0, sizeof(request)); request.mhdr.nlmsg_len = NLMSG_LENGTH(sizeof(struct ifinfomsg)); request.mhdr.nlmsg_flags = NLM_F_REQUEST|NLM_F_ACK; if (!index) request.mhdr.nlmsg_flags |= NLM_F_ROOT|NLM_F_MATCH; else request.info.ifi_change = 0xffffffff; // used in single operation request.mhdr.nlmsg_type = RTM_GETLINK; request.info.ifi_index = index; request.info.ifi_family = AF_UNSPEC; send_nlmesg(0, 0, 0, (void*)&request, sizeof(request)); return (filter_nlmesg(display_link_info, argv)); } static int iplink(char **argv) { int idx; cmdobj ipcmd, cmdobjlist[] = {linkupdate, link_set, link_show}; struct arglist cmd_objectlist[] = {{"add", 0}, {"delete", 0}, {"set", 1}, {"show", 2}, {"list", 2}, {"lst", 2}, {NULL,-1}}; if (!*argv) idx = 2; else if ((idx = substring_to_idx(*argv++, cmd_objectlist)) == -1) help_exit(0); ipcmd = cmdobjlist[idx]; return ipcmd(argv); } // =========================================================================== // Code for ip addr. // =========================================================================== static int print_addrinfo(struct nlmsghdr *h, int flag_l) { struct rtattr *rta, *rta_tb[IFA_MAX+1] = {0,}; char *family = toybuf, *scope = toybuf+256, *label = toybuf+512, *brd = toybuf+768, *peer = toybuf+1024, *any = toybuf+1280, lbuf[INET6_ADDRSTRLEN] = {0,}, lbuf_ifa[INET6_ADDRSTRLEN] = {0,}; struct ifaddrmsg *ifa = NLMSG_DATA(h); int len; if ((len = h->nlmsg_len - NLMSG_LENGTH(sizeof(*ifa))) < 0) { error_msg("wrong nlmsg len %d", len); return 0; } for (rta = IFA_RTA(ifa); RTA_OK(rta, len); rta=RTA_NEXT(rta, len)) if (rta->rta_type <= IFA_MAX) rta_tb[rta->rta_type] = rta; if (!rta_tb[IFA_LOCAL]) rta_tb[IFA_LOCAL] = rta_tb[IFA_ADDRESS]; if (!rta_tb[IFA_ADDRESS]) rta_tb[IFA_ADDRESS] = rta_tb[IFA_LOCAL]; if ((addrinfo.scope ^ ifa->ifa_scope)&addrinfo.scopemask) return 0; if (addrinfo.ifindex && addrinfo.ifindex != ifa->ifa_index) return 0; if (flag_l && addrinfo.label && ifa->ifa_family == AF_INET6) return 0; if ((rta_tb[IFA_LABEL])) { xstrncpy(label, RTA_DATA(rta_tb[IFA_LABEL]), 256); label[255] = '\0'; if (addrinfo.label && fnmatch(addrinfo.label, label, 0)) return 0; } if (TT.flush) { if (ifa->ifa_index == addrinfo.ifindex) { h->nlmsg_type = RTM_DELADDR; h->nlmsg_flags = NLM_F_REQUEST; send_nlmesg(RTM_DELADDR, 0, 0, h, h->nlmsg_len); return 0; } } if (h->nlmsg_type == RTM_DELADDR) printf("Deleted "); if (TT.singleline) { if (!if_indextoname(ifa->ifa_index, lbuf)) perror_exit(NULL); printf("%u: %s",ifa->ifa_index, lbuf); } sprintf(scope, " scope %s ", namefromRPDB(ifa->ifa_scope, RPDB_rtscopes)); if (ifa->ifa_family == AF_INET) strcpy(family, " inet "); else if (ifa->ifa_family == AF_INET6) strcpy(family, " inet6 "); else sprintf(family, " family %d", ifa->ifa_family); if (rta_tb[IFA_LOCAL]) { if (!inet_ntop(ifa->ifa_family, RTA_DATA(rta_tb[IFA_LOCAL]), lbuf, sizeof(lbuf))) perror_exit("inet"); sprintf(family+strlen(family), lbuf, strlen(lbuf)); if (!rta_tb[IFA_ADDRESS] || !memcmp(RTA_DATA(rta_tb[IFA_ADDRESS]), RTA_DATA(rta_tb[IFA_LOCAL]), 4)) sprintf(family+strlen(family), "/%d ", ifa->ifa_prefixlen); else { if (!inet_ntop(ifa->ifa_family, RTA_DATA(rta_tb[IFA_ADDRESS]), lbuf_ifa, sizeof(lbuf_ifa))) perror_exit("inet"); sprintf(peer, " peer %s/%d ", lbuf_ifa, ifa->ifa_prefixlen); } } if (addrinfo.to && strcmp(addrinfo.addr, lbuf)) return 0; if (rta_tb[IFA_BROADCAST]) { if (!inet_ntop(ifa->ifa_family, RTA_DATA(rta_tb[IFA_BROADCAST]), lbuf, sizeof(lbuf))) perror_exit("inet"); sprintf(brd, " brd %s", lbuf); }else brd = ""; if (rta_tb[IFA_ANYCAST]) { if (!inet_ntop(ifa->ifa_family, RTA_DATA(rta_tb[IFA_ANYCAST]), lbuf, sizeof(lbuf))) perror_exit("inet"); sprintf(any, " any %s", lbuf); } if (ifa->ifa_family == AF_INET) printf("%s%s%s%s%s %c", family, brd, peer, scope, label, (TT.singleline? '\0' : '\n')); else printf("%s%s %c", family, scope, (TT.singleline? '\0' : '\n')); if (TT.singleline && (ifa->ifa_family == AF_INET)) xputc('\n'); if (rta_tb[IFA_CACHEINFO]) { struct ifa_cacheinfo *ci = RTA_DATA(rta_tb[IFA_CACHEINFO]); printf("%c valid_lft ", (TT.singleline? '\\' : '\0')); if (ci->ifa_valid == 0xFFFFFFFFU) printf("forever"); else printf("%usec", ci->ifa_valid); printf(" preferred_lft "); if (ci->ifa_prefered == 0xFFFFFFFFU) printf("forever"); else printf("%dsec", ci->ifa_prefered); xputc('\n'); } return 0; } static int ipaddrupdate(char **argv) { int length, cmd = !memcmp("add", argv[-1], strlen(argv[-1])) ? RTM_NEWADDR: RTM_DELADDR; int idx = 0,length_brd = 0, length_peer = 0,length_any = 0,length_local = 0, scoped = 0; char *dev = NULL,*label = NULL, reply[8192]; struct nlmsghdr *addr_ptr = NULL; struct nlmsgerr *err = NULL; struct arglist cmd_objectlist[] = {{"dev",0}, {"peer", 1}, {"remote", 2}, {"broadcast", 3}, {"brd", 4}, {"label", 5}, {"anycast", 6},{"scope", 7}, {"local", 8}, {NULL, -1}}; struct { struct nlmsghdr nlm; struct ifaddrmsg ifadd; char buf[256]; } req; typedef struct { int family, bytelen, bitlen; __u32 data[8]; } option_data; option_data local; memset(&req, 0, sizeof(req)); req.nlm.nlmsg_len = NLMSG_LENGTH(sizeof(struct ifaddrmsg)); req.nlm.nlmsg_flags = NLM_F_REQUEST|NLM_F_ACK; req.nlm.nlmsg_type = cmd; req.ifadd.ifa_family = TT.addressfamily; while (*argv) { idx = substring_to_idx(*argv, cmd_objectlist); if (idx >= 0) if (!*++argv) error_exit("Incomplete Command line"); switch(idx) { case 0: dev = *argv; break; case 1: case 2: { uint32_t addr[4] = {0,}, netmask = 0; uint8_t len = 0; parse_prefix(addr, &netmask, &len, *argv, req.ifadd.ifa_family); if (len) req.ifadd.ifa_family = ((len == 4) ? AF_INET : AF_INET6); length_peer = len; add_string_to_rtattr(&req.nlm, sizeof(req), IFA_ADDRESS, addr, len); req.ifadd.ifa_prefixlen = netmask; } break; case 3: case 4: if (*argv[0] == '+') { length_brd = -1; } else if (*argv[0] == '-') { length_brd = -2; } else { uint32_t addr[4] = {0,}; uint8_t af = AF_UNSPEC; if (get_prefix(addr, &af, *argv, req.ifadd.ifa_family)) error_exit("Invalid prefix"); length_brd = ((af == AF_INET6) ? 16 : 4); if (req.ifadd.ifa_family == AF_UNSPEC) req.ifadd.ifa_family = af; add_string_to_rtattr(&req.nlm, sizeof(req), IFA_BROADCAST, &addr, length_brd); } break; case 5: label = *argv; add_string_to_rtattr(&req.nlm, sizeof(req), IFA_LABEL, label, strlen(label) + 1); break; case 6: { uint32_t addr[4] = {0,}; uint8_t af = AF_UNSPEC; if (get_prefix(addr, &af, *argv, req.ifadd.ifa_family)) error_exit("Invalid prefix"); length_any = ((af == AF_INET6) ? 16 : 4); if (req.ifadd.ifa_family == AF_UNSPEC) req.ifadd.ifa_family = af; add_string_to_rtattr(&req.nlm, sizeof(req), IFA_ANYCAST, &addr, length_any); } break; case 7: { int scope = idxfromRPDB(*argv, RPDB_rtscopes); if (scope < 0) error_exit("wrong scope '%s'", *argv); req.ifadd.ifa_scope = scope; scoped = 1; } break; default: { //local is by default uint32_t addr[8] = {0,}, netmask = 0; uint8_t len = 0; parse_prefix(addr, &netmask, &len, *argv, req.ifadd.ifa_family); if (len) req.ifadd.ifa_family = ((len == 4) ? AF_INET : AF_INET6); length_local = len; local.bitlen = netmask; local.bytelen = len; memcpy(local.data, addr, sizeof(local.data)); local.family = req.ifadd.ifa_family; add_string_to_rtattr(&req.nlm, sizeof(req), IFA_LOCAL, &local.data, local.bytelen); } break; } argv++; } if (!dev) error_exit("need \"dev \" argument"); if (label && strncmp(dev, label, strlen(dev)) != 0) error_exit("\"dev\" (%s) must match \"label\" (%s)", dev, label); if (length_peer == 0 && length_local && cmd != RTM_DELADDR){ add_string_to_rtattr(&req.nlm, sizeof(req), IFA_ADDRESS, &local.data, local.bytelen); } if (length_brd < 0 && cmd != RTM_DELADDR){ int i; if (req.ifadd.ifa_family != AF_INET) error_exit("broadcast can be set only for IPv4 addresses"); if (local.bitlen <= 30) { for (i = 31; i >= local.bitlen; i--) { if (length_brd == -1) local.data[0] |= htonl(1<<(31-i)); else local.data[0] &= ~htonl(1<<(31-i)); } add_string_to_rtattr(&req.nlm, sizeof(req), IFA_BROADCAST, &local.data, local.bytelen); length_brd = local.bytelen; } } if (req.ifadd.ifa_prefixlen == 0) req.ifadd.ifa_prefixlen = local.bitlen; if (!scoped && (cmd != RTM_DELADDR) && (local.family == AF_INET) && (local.bytelen >= 1 && *(uint8_t*)&local.data == 127)) req.ifadd.ifa_scope = RT_SCOPE_HOST; req.ifadd.ifa_index = get_ifaceindex(dev, 1); send_nlmesg(RTM_NEWADDR, 0, AF_UNSPEC, (void *)&req, req.nlm.nlmsg_len); length = recv(TT.sockfd, reply, sizeof(reply), 0); addr_ptr = (struct nlmsghdr *) reply; for (; NLMSG_OK(addr_ptr, length); addr_ptr = NLMSG_NEXT(addr_ptr, length)) { if (addr_ptr->nlmsg_type == NLMSG_DONE) return 1; if (addr_ptr->nlmsg_type == NLMSG_ERROR) err = (struct nlmsgerr*) NLMSG_DATA(addr_ptr); if (err && err->error) { errno = -err->error; perror_exit("RTNETLINK answers:"); } } return 0; } static int ipaddr_listflush(char **argv) { int idx; uint32_t netmask = 0, found = 0; char *tmp = NULL, *name = NULL; struct double_list *dlist; struct arglist cmd_objectlist[] = {{"to", 0}, {"scope", 1}, {"up", 2}, {"label", 3}, {"dev", 4}, {NULL, -1}}; TT.flush = *argv[-1] == 'f' ? 1 : 0; memset(&addrinfo, 0, sizeof(addrinfo)); if (TT.flush) { if (!*argv) error_exit("Incomplete command for \"flush\""); if (TT.addressfamily == AF_PACKET) error_exit("Can't flush link Addressess"); } addrinfo.scope = -1; while (*argv) { switch (idx = substring_to_idx(*argv, cmd_objectlist)) { case 0: {// ADDR_TO if (!*++argv) error_exit("Incomplete Command line"); else if (!strcmp(*argv, "0")) return 0; uint32_t addr[4] = {0,}; uint8_t len = 0; addrinfo.to = 1; parse_prefix(addr, &netmask, &len, *argv, TT.addressfamily); if (len) TT.addressfamily = ((len == 4) ? AF_INET : AF_INET6); addrinfo.addr = strtok(*argv, "/"); } break; case 1: // ADDR_SCOPE { int scope = 0; if (!*++argv) error_exit("Incomplete Command line"); name = *argv; addrinfo.scopemask = -1; if (isdigit(**argv)) { int idx = atolx(*argv); name = xstrdup(namefromRPDB(idx, RPDB_rtscopes)); } if ((scope = idxfromRPDB(name, RPDB_rtscopes)) < 0) { if (strcmp(name, "all")) error_exit("wrong scope '%s'", name); scope = RT_SCOPE_NOWHERE; addrinfo.scopemask = 0; } if (isdigit(**argv)) free(name); addrinfo.scope = scope; } break; case 2: // ADDR_UP addrinfo.up = 1; break; case 3: // ADDR_LABEL if (!*++argv) error_exit("Incomplete Command line"); addrinfo.label = *argv; break; case 4: // ADDR_DEV if (!*++argv) error_exit("Incomplete Command line"); default: if (TT.filter_dev) error_exit("Either \"dev\" is duplicate or %s is garbage", *argv); TT.filter_dev = *argv; break; } argv++; } link_show(&tmp); while ( linfo && (dlist = dlist_pop(&linfo))){ struct linkdata *tmp = (struct linkdata*) dlist; char *temp = &tmp->iface[0]; if (TT.filter_dev && strcmp(TT.filter_dev, temp)) continue; found = 1; if (TT.flush && addrinfo.label) ipaddr_print( tmp, 0); if (addrinfo.up && !(tmp->flags & IFF_UP)){ ipaddr_print(tmp, 0); continue; } if (addrinfo.label){ if ( fnmatch(addrinfo.label, temp, 0)) { ipaddr_print(tmp, 1); continue; } } if (!TT.addressfamily && ! TT.flush ) print_link_output(tmp); ipaddr_print(tmp, 0); free(tmp); } if (TT.filter_dev && !found) error_exit("Device \"%s\" doesn't exist. \n", TT.filter_dev); return 0; } static int ipaddr_print( struct linkdata *link, int flag_l) { struct nlmsghdr *addr_ptr; int ip_match = 0; addrinfo.ifindex = link->iface_idx; send_nlmesg(RTM_GETADDR, NLM_F_ROOT|NLM_F_MATCH|NLM_F_REQUEST, AF_UNSPEC, NULL, 0); if (TT.addressfamily == AF_PACKET) print_link_output(link); if (addrinfo.label){ char *col = strchr(addrinfo.label, ':'); if (!col && (fnmatch(addrinfo.label, &link->iface[0], 0))) return 0; } while (1){ int len = recv(TT.sockfd, TT.gbuf, sizeof(TT.gbuf), 0); addr_ptr = (struct nlmsghdr *)TT.gbuf; struct ifaddrmsg *addressInfo = NLMSG_DATA(addr_ptr); char lbuf[INET6_ADDRSTRLEN]; struct rtattr *rta, *rta_tb[IFA_MAX+1] = {0,}; int len1 = addr_ptr->nlmsg_len - NLMSG_LENGTH(sizeof(*addressInfo)); if (len1 > 0) { for (; NLMSG_OK(addr_ptr, len); addr_ptr = NLMSG_NEXT(addr_ptr, len)) { addressInfo = NLMSG_DATA(addr_ptr); if (TT.addressfamily && TT.addressfamily != addressInfo->ifa_family) continue; if (addrinfo.ifindex && addrinfo.ifindex != addressInfo->ifa_index) continue; if (addrinfo.to) { memset(rta_tb, 0, sizeof(rta_tb)); int rt_len = IFA_PAYLOAD(addr_ptr); for (rta = IFA_RTA(addressInfo); RTA_OK(rta, rt_len); rta=RTA_NEXT(rta, rt_len)) { if (rta->rta_type <= IFA_MAX) rta_tb[rta->rta_type] = rta; } if (!rta_tb[IFA_LOCAL]) rta_tb[IFA_LOCAL] = rta_tb[IFA_ADDRESS]; if (rta_tb[IFA_LOCAL]) { if (!inet_ntop(TT.addressfamily, RTA_DATA(rta_tb[IFA_LOCAL]), lbuf, sizeof(lbuf))) perror_exit("inet"); if (strcmp(addrinfo.addr, lbuf)) continue; ip_match=1; } if (!ip_match) continue; } if (!TT.flush){ if (addrinfo.scope != -1 && TT.addressfamily && TT.addressfamily == addressInfo->ifa_family && (addrinfo.ifindex == addressInfo->ifa_index)) { if ((addrinfo.scope ^ addressInfo->ifa_scope) & addrinfo.scopemask) continue; else if (addrinfo.up && (link->flags & IFF_UP)) print_link_output(link); else if (!addrinfo.up) print_link_output(link); } if (TT.addressfamily && (addrinfo.ifindex == addressInfo->ifa_index) && (addrinfo.scope == -1)){ if (addrinfo.up && (link->flags & IFF_UP)) print_link_output(link); else if (!addrinfo.up) print_link_output(link); } } for (; NLMSG_OK(addr_ptr, len); addr_ptr = NLMSG_NEXT(addr_ptr, len)) { if (addr_ptr->nlmsg_type == RTM_NEWADDR) print_addrinfo(addr_ptr, flag_l); if ((addr_ptr->nlmsg_type == NLMSG_DONE) || (addr_ptr->nlmsg_type == NLMSG_ERROR) || (TT.flush && addrinfo.to)) goto ret_stop; } if ((addr_ptr->nlmsg_type == NLMSG_DONE) || (addr_ptr->nlmsg_type == NLMSG_ERROR)) break; } } else return 0; } ret_stop: return 0; } static int ipaddr(char **argv) { int idx; cmdobj ipcmd, cmdobjlist[] = {ipaddrupdate, ipaddr_listflush}; struct arglist cmd_objectlist[] = { {"add", 0}, {"delete", 0}, {"list", 1},{"show", 1},{"lst", 1}, {"flush", 1}, {NULL,-1}}; TT.is_addr++; if (!*argv) idx = 1; else if ((idx = substring_to_idx(*argv++, cmd_objectlist)) == -1) help_exit(0); ipcmd = cmdobjlist[idx]; return ipcmd(argv); } // =========================================================================== // code for ip route // =========================================================================== struct I_data { unsigned char family; uint32_t addr[8] , netmask ; uint8_t len ; }; struct { int tb,idev,odev,proto; struct I_data rvia, rdst, mdst, rsrc, msrc; } gfilter; static void show_iproute_help(void) { error_exit("\n\n" \ "iproute { list | flush } SELECTOR\n" \ "iproute get ADDRESS [from ADDRESS iif STRING]\n" \ " [oif STRING]\n" \ "iproute { add | del | change | append | replace | test } ROUTE\n" \ " SELECTOR := [root PREFIX] [match PREFIX] [proto RTPROTO]\n" \ " ROUTE := [TYPE] PREFIX [proto RTPROTO] [metric METRIC]"); } static void print_rta_metrics(char* out, const struct rtattr *mxattr) { int32_t tvar = RTA_PAYLOAD(mxattr); struct rtattr *rta, *mxrta[RTAX_MAX+1] = {0,}; unsigned int mxlock = 0; int i; for (rta = RTA_DATA(mxattr); RTA_OK(rta, tvar); rta=RTA_NEXT(rta, tvar)) if (rta->rta_type <= RTA_MAX) mxrta[rta->rta_type] = rta; if (mxrta[RTAX_LOCK]) mxlock = *(u_int32_t *)RTA_DATA(mxrta[RTAX_LOCK]); for (i = 2; i <= RTAX_MAX; i++) { uint32_t val = 0; if (mxrta[i] == NULL && !(mxlock & (1 << i))) continue; if (mxrta[i] != NULL && i != RTAX_CC_ALGO) val = *(u_int32_t *)RTA_DATA(mxrta[i]); if (i == RTAX_HOPLIMIT && (int)val == -1) continue; if (i < sizeof(mx_names)/sizeof(char *) && mx_names[i]) sprintf(out, "%s%s ", out, mx_names[i]); else sprintf(out, "%smetric %d ", out, i); if (mxlock & (1<= 1000) sprintf(out, "%s%gs ", out, val / 1e3); else sprintf(out, "%s%ums ", out, val); break; case RTAX_CC_ALGO: sprintf(out, "%scongestion %s ", out, (const char*)RTA_DATA(mxrta[i])); break; default: sprintf(out, "%s%u ", out, val); break; } } } static int display_route_info(struct nlmsghdr *mhdr, char **argv) { char *inetval = NULL, out[1024] = {0}; struct rtmsg *msg = NLMSG_DATA(mhdr); struct rtattr *rta, *attr[RTA_MAX+1] = {0,}; int32_t tvar, msglen = mhdr->nlmsg_len - NLMSG_LENGTH(sizeof(struct rtmsg)); int hlen = ((msg->rtm_family == AF_INET) ? 32 : ((msg->rtm_family == AF_INET6) ? 128 : -1)); if (mhdr->nlmsg_type != RTM_NEWROUTE) return 0; if (msglen < 0) return 1; if (msg->rtm_family == AF_INET6) { if (gfilter.tb) { if (gfilter.tb < 0) { if (!(msg->rtm_flags & RTM_F_CLONED)) return 0; } else { if (msg->rtm_flags & RTM_F_CLONED) return 0; if (gfilter.tb == RT_TABLE_LOCAL && msg->rtm_type != RTN_LOCAL) return 0; else if (gfilter.tb == RT_TABLE_MAIN && msg->rtm_type == RTN_LOCAL) return 0; } } } else if (gfilter.tb > 0 && gfilter.tb != msg->rtm_table) return 0; if (gfilter.proto && (msg->rtm_protocol != gfilter.proto)) return 0; if (gfilter.rdst.family && (msg->rtm_family != gfilter.rdst.family || gfilter.rdst.netmask > msg->rtm_dst_len)) return 0; if (gfilter.mdst.family && (msg->rtm_family != gfilter.mdst.family || (gfilter.mdst.netmask < msg->rtm_dst_len))) return 0; if (gfilter.rsrc.family && (msg->rtm_family != gfilter.rsrc.family || gfilter.rsrc.netmask > msg->rtm_src_len)) return 0; if (gfilter.msrc.family && (msg->rtm_family != gfilter.msrc.family || (gfilter.msrc.netmask < msg->rtm_src_len))) return 0; tvar = msglen; for (rta = RTM_RTA(msg); RTA_OK(rta, tvar); rta=RTA_NEXT(rta, tvar)) if (rta->rta_type <= RTA_MAX) attr[rta->rta_type] = rta; if (msg->rtm_type != RTN_UNICAST) sprintf(out,"%s%s ", out,rtmtype_idx2str(msg->rtm_type)); if (attr[RTA_DST]) { inetval = (char *)inet_ntop(msg->rtm_family, RTA_DATA(attr[RTA_DST]), toybuf, sizeof(toybuf)); if (gfilter.rdst.family && memcmp(RTA_DATA(attr[RTA_DST]), &gfilter.rdst.addr, gfilter.rdst.len)) return 0; if (gfilter.mdst.family && memcmp(RTA_DATA(attr[RTA_DST]), &gfilter.mdst.addr, gfilter.mdst.len)) return 0; sprintf(out,"%s%s",out,inetval); } if (msg->rtm_dst_len) sprintf(out,"%s/%d ", out,msg->rtm_dst_len); else sprintf(out,"%s%s",out,"default "); if (attr[RTA_SRC]) { inetval = (char *)inet_ntop(msg->rtm_family, RTA_DATA(attr[RTA_SRC]), toybuf, sizeof(toybuf)); if (gfilter.rsrc.family && memcmp(RTA_DATA(attr[RTA_SRC]), &gfilter.rsrc.addr, gfilter.rsrc.len)) return 0; if (gfilter.msrc.family && memcmp(RTA_DATA(attr[RTA_SRC]), &gfilter.msrc.addr, gfilter.msrc.len)) return 0; sprintf(out, "%s from %s", out, inetval); } if (msg->rtm_src_len) sprintf(out, "%s/%d ", out, msg->rtm_src_len); if (attr[RTA_GATEWAY]) { inetval = (char *)inet_ntop(msg->rtm_family, RTA_DATA(attr[RTA_GATEWAY]), toybuf, sizeof(toybuf)); sprintf(out, "%s via %s ", out, inetval); } if (gfilter.rvia.family) { char tmp[256]; if (!attr[RTA_GATEWAY]) return 0; if (strcmp((char *)inet_ntop(msg->rtm_family, gfilter.rvia.addr, tmp, sizeof(tmp)), inetval)) return 0; } if (gfilter.odev != 0) if (!attr[RTA_OIF]) return 0; if (attr[RTA_OIF]) { if (gfilter.odev !=0 && gfilter.odev != *(int*)RTA_DATA(attr[RTA_OIF])) return 0; sprintf(out, "%s dev %s ", out, if_indextoname(*(int*)RTA_DATA(attr[RTA_OIF]), toybuf)); } if (attr[RTA_PREFSRC] && hlen) { inetval = (char *)inet_ntop(msg->rtm_family, RTA_DATA(attr[RTA_PREFSRC]), toybuf, sizeof(toybuf)); sprintf(out, "%s src %s ", out, inetval); } if (attr[RTA_PRIORITY]) sprintf(out, "%s metric %d ", out, *(uint32_t*)RTA_DATA(attr[RTA_PRIORITY])); if (msg->rtm_family == AF_INET6) { struct rta_cacheinfo *ci = NULL; if (attr[RTA_CACHEINFO]) ci = RTA_DATA(attr[RTA_CACHEINFO]); if ((msg->rtm_flags & RTM_F_CLONED) || (ci && ci->rta_expires)) { if (msg->rtm_flags & RTM_F_CLONED) sprintf(out, "%s%s cache ", out, (!TT.singleline ? "\n" : " ")); if (ci && ci->rta_expires) { int hz = 0; FILE *fp = xfopen("/proc/net/psched","r"); if (fp) { unsigned int nom, denom; if (fscanf(fp, "%*08x%*08x%08x%08x", &nom, &denom) == 2) if (nom == 1000000) hz = denom; fclose(fp); } if (!hz) hz = sysconf(_SC_CLK_TCK); sprintf(out, "%s expires %dsec", out, ci->rta_expires /hz); } if (ci && ci->rta_error) sprintf(out, "%s error %d", out, ci->rta_error); } else if (ci && ci->rta_error) sprintf(out, "%s error %d", out, ci->rta_error); } if (attr[RTA_IIF] && !gfilter.idev) sprintf(out, "%s iif %s", out, if_indextoname(*(int*)RTA_DATA(attr[RTA_IIF]), toybuf)); if (attr[RTA_METRICS]) print_rta_metrics(out, attr[RTA_METRICS]); if (TT.flush || (TT.connected && !TT.from_ok)) memcpy(toybuf, (void*)mhdr,mhdr->nlmsg_len); if (TT.flush) { int sockfd = 0; struct nlmsghdr* mhdr = (struct nlmsghdr*)toybuf; struct rtmsg *msg = NLMSG_DATA(mhdr); int tvar, msglen = mhdr->nlmsg_len - NLMSG_LENGTH(sizeof(struct rtmsg)); struct rtattr *rta, *attr[RTA_MAX+1] = {0,}; tvar = msglen; for (rta = RTM_RTA(msg); RTA_OK(rta, tvar); rta=RTA_NEXT(rta, tvar)) if (rta->rta_type <= RTA_MAX) attr[rta->rta_type] = rta; if (msg->rtm_family == AF_INET6 && !msg->rtm_dst_len && msg->rtm_type == RTN_UNREACHABLE && attr[RTA_PRIORITY] && *(int*)RTA_DATA(attr[RTA_PRIORITY]) == -1) return 0; mhdr->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK; mhdr->nlmsg_type = RTM_DELROUTE; mhdr->nlmsg_pid = 0; sockfd = xsocket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE); if (send(sockfd , (void*)mhdr, mhdr->nlmsg_len, 0) < 0) perror_exit("Unable to send data on socket."); while (1) { struct nlmsghdr *mhdr; int msglen = recv(sockfd, toybuf, sizeof(toybuf), 0); if ((msglen < 0) && (errno == EINTR || errno == EAGAIN)) continue; else if (msglen < 0) { error_msg("netlink receive error %s", strerror(errno)); xclose(sockfd); return 1; } else if (!msglen) { error_msg("EOF on netlink"); xclose(sockfd); return 1; } for (mhdr = (struct nlmsghdr*)toybuf; NLMSG_OK(mhdr, msglen); mhdr = NLMSG_NEXT(mhdr, msglen)) { switch (mhdr->nlmsg_type) { case NLMSG_DONE: xclose(sockfd); return 0; case NLMSG_ERROR: { struct nlmsgerr *merr = (struct nlmsgerr*)NLMSG_DATA(mhdr); if (merr->error == 0) { xclose(sockfd); return 0; } if (mhdr->nlmsg_len < NLMSG_LENGTH(sizeof(struct nlmsgerr))) error_msg("ERROR truncated"); else { errno = -merr->error; perror_msg("RTNETLINK answers"); } xclose(sockfd); return 1; } default: break; } } // End of for loop. } // End of while loop. xclose(sockfd); } else printf("%s\n",out); return 0; } static int route_get(char **argv) { int idx, flag; struct arglist cmd_objectlist[] = {{"from", 0}, {"iif", 1}, {"oif", 2}, {"dev", 3}, {"notify", 4}, {"connected", 5}, {"to", 6}, {NULL, -1}}; char *idev = NULL, *odev = NULL; struct { struct nlmsghdr mhdr; struct rtmsg msg; char buf[1024]; } request; memset(&request, 0, sizeof(request)); request.mhdr.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg)); request.mhdr.nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK; request.mhdr.nlmsg_type = RTM_GETROUTE; request.msg.rtm_family = AF_UNSPEC; for (; *argv; argv++) { switch(idx = substring_to_idx(*argv, cmd_objectlist)) { case 0: TT.from_ok = 1; // dst address case 6: argv++; //fallthrough default: { uint32_t addr[8] = {0,}, netmask = 0; uint8_t len = 0; if (!*argv) error_exit("'%s': Missing Prefix", argv[-1]); parse_prefix(addr, &netmask, &len, *argv, request.msg.rtm_family); if (len) request.msg.rtm_family = ((len == 4) ? AF_INET : AF_INET6); netmask = (request.msg.rtm_family == AF_INET6) ? 128 : 32; if (!idx) request.msg.rtm_src_len = netmask; else request.msg.rtm_dst_len = netmask; add_string_to_rtattr(&request.mhdr, sizeof(request), (!idx ? RTA_SRC : RTA_DST), addr, len); break; } case 1: case 2: case 3: if (!*++argv) show_iproute_help(); if (idx == 1) idev = *argv, flag = RTA_IIF; else odev = *argv, flag = RTA_OIF; idx = get_ifaceindex(*argv, 1); add_string_to_rtattr(&request.mhdr, sizeof(request), flag, (char*)&idx, sizeof(idx)); break; case 4: request.msg.rtm_flags |= RTM_F_NOTIFY; break; case 5: TT.connected = 1; break; } } if (!request.msg.rtm_dst_len) error_exit("need at least destination address"); send_nlmesg(0, 0, 0, &request, sizeof(request)); filter_nlmesg(display_route_info, NULL); if (TT.connected && !TT.from_ok) { struct nlmsghdr *mhdr = (struct nlmsghdr*)toybuf; struct rtmsg *msg = NLMSG_DATA(mhdr); int tvar, msglen = mhdr->nlmsg_len - NLMSG_LENGTH(sizeof(struct rtmsg)); struct rtattr *rta, *attr[RTA_MAX+1] = {0,}; if (mhdr->nlmsg_type != RTM_NEWROUTE) error_exit("not a route?"); if (msglen < 0) error_exit("wrong len %d", msglen); tvar = msglen; for (rta = RTM_RTA(msg); RTA_OK(rta, tvar); rta=RTA_NEXT(rta, tvar)) if (rta->rta_type <= RTA_MAX) attr[rta->rta_type] = rta; if (attr[RTA_PREFSRC]) { attr[RTA_PREFSRC]->rta_type = RTA_SRC; msg->rtm_src_len = 8*RTA_PAYLOAD(attr[RTA_PREFSRC]); } else if (!attr[RTA_SRC]) error_exit("can't connect the route"); if (!odev && attr[RTA_OIF]) attr[RTA_OIF]->rta_type = 0; if (attr[RTA_GATEWAY]) attr[RTA_GATEWAY]->rta_type = 0; if (!idev && attr[RTA_IIF]) attr[RTA_IIF]->rta_type = 0; mhdr->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK; mhdr->nlmsg_type = RTM_GETROUTE; mhdr->nlmsg_pid = 0; xclose(TT.sockfd); TT.sockfd = xsocket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE); send_nlmesg(0, 0, 0, mhdr, mhdr->nlmsg_len); filter_nlmesg(display_route_info, NULL); } return 0; } static int route_show_flush(char **argv) { struct arglist cmd_objectlist[] = {{"protocol", 0}, {"dev", 1}, {"oif", 2}, {"iif", 3}, {"via", 4}, {"table", 5}, {"cache", 6}, {"from", 7}, {"to", 8}, {"all", 9}, {"root", 10}, {"match", 11}, {"exact", 12}, {"main", 13}, {NULL,-1}}; int family = TT.addressfamily, idx; struct { struct nlmsghdr mhdr; struct rtmsg msg; } request; if (*argv[-1] == 'f') TT.flush = 1; if (TT.flush && !*argv) show_iproute_help(); gfilter.tb = RT_TABLE_MAIN; for (; *argv; argv++) { switch (idx = substring_to_idx(*argv, cmd_objectlist)) { case 0: if (!*++argv) show_iproute_help(); if ((idx = idxfromRPDB(*argv,RPDB_rtprotos)) < 0) error_exit("Invalid argument protocol."); gfilter.proto = idx; break; case 1: case 2: case 3: { if (!*++argv) show_iproute_help(); int dev = get_ifaceindex(*argv, 1); if (idx == 3) gfilter.idev = dev; else gfilter.odev = dev; } break; case 4: if (!*++argv) show_iproute_help(); parse_prefix(gfilter.rvia.addr, &gfilter.rvia.netmask, &gfilter.rvia.len, *argv, gfilter.rvia.family); if (gfilter.rvia.len) gfilter.rvia.family = ((gfilter.rvia.len == 4) ? AF_INET : AF_INET6); break; case 5: if (!*++argv) show_iproute_help(); idx = substring_to_idx(*argv, cmd_objectlist); if (idx == 6) gfilter.tb = -1; else if (idx == 9) gfilter.tb = 0; else if (idx != 13) { if ((gfilter.tb = idxfromRPDB(*argv, RPDB_rttables)) < 0) error_exit("table %s is invalid.", *argv); } break; case 6: gfilter.tb = -1; break; case 7: if (!*++argv) show_iproute_help(); idx = substring_to_idx(*argv, cmd_objectlist); if (idx < 0) if (!*++argv) show_iproute_help(); if (idx == 10) if (!*++argv) show_iproute_help(); parse_prefix(gfilter.rsrc.addr, &gfilter.rsrc.netmask, &gfilter.rsrc.len, *argv, gfilter.rsrc.family); if (gfilter.rsrc.len) gfilter.rsrc.family = ((gfilter.rsrc.len == 4) ? AF_INET : AF_INET6); else { if ((idx == 12 ||idx == 11) && !*++argv) show_iproute_help(); parse_prefix(gfilter.msrc.addr, &gfilter.msrc.netmask, &gfilter.msrc.len, *argv, gfilter.msrc.family); if (gfilter.msrc.len) gfilter.msrc.family = ((gfilter.msrc.len == 4) ? AF_INET : AF_INET6); if (idx != 11) gfilter.rsrc = gfilter.msrc; } break; case 8: idx = substring_to_idx(*argv, cmd_objectlist); if (idx != -1 && !*++argv) show_iproute_help(); default: // fallthrough if (idx == 10) { if (!*++argv) show_iproute_help(); parse_prefix(gfilter.rdst.addr, &gfilter.rdst.netmask, &gfilter.rdst.len, *argv, gfilter.rdst.family); if (gfilter.rdst.len) gfilter.rdst.family = ((gfilter.rdst.len == 4) ? AF_INET : AF_INET6); } else { if ((idx == 12 ||idx == 11) && !*++argv) show_iproute_help(); parse_prefix(gfilter.mdst.addr, &gfilter.mdst.netmask, &gfilter.mdst.len, *argv, gfilter.mdst.family); if (gfilter.mdst.len) gfilter.mdst.family = ((gfilter.mdst.len == 4) ? AF_INET : AF_INET6); if (idx != 11) gfilter.rdst = gfilter.mdst; } break; } } if (family == AF_UNSPEC && gfilter.tb) family = AF_INET; if (TT.flush) { if (gfilter.tb < 0) { // flush table cache if (family != AF_INET6) { FILE *fp = xfopen("/proc/sys/net/ipv4/route/flush", "w"); if (fwrite("-1",1,2,fp) < 2) error_exit("can't flush routing cache"); fclose(fp); } if (family == AF_INET) return 0; } } memset(&request, 0, sizeof (request)); request.mhdr.nlmsg_len = NLMSG_LENGTH(sizeof (struct rtmsg)); request.mhdr.nlmsg_flags = NLM_F_REQUEST; request.mhdr.nlmsg_flags |= NLM_F_ROOT | NLM_F_MATCH; request.mhdr.nlmsg_type = RTM_GETROUTE; request.msg.rtm_family = family; if (gfilter.tb < 0) request.msg.rtm_flags = RTM_F_CLONED; send_nlmesg(0, 0, 0, (void*)&request, sizeof (request)); return (filter_nlmesg(display_route_info, NULL)); } static int route_update(char **argv, unsigned int route_flags) { char mxbuf[256], *d = NULL; struct rtattr *mxrta = (void*)mxbuf; unsigned mxlock = 0, ok = 0; int idx; uint32_t addr[8] = {0,}, netmask = 0; uint8_t len = 0; struct arglist cmd_objectlist[] = {{"src", 0}, {"via", 1}, {"mtu", 2}, {"lock", 3}, {"protocol", 4}, {"table", 5}, {"dev", 6}, {"oif", 7}, {"to", 8}, {"metric", 9}, {NULL,-1} }; enum { gtwy_ok = 1, dst_ok = 2, proto_ok = 4, type_ok = 8 }; struct { struct nlmsghdr hdr; struct rtmsg msg; char buf[1024]; } req; memset(&req, 0, sizeof(req)); req.hdr.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg)); req.hdr.nlmsg_flags = NLM_F_ACK| NLM_F_REQUEST | route_flags; req.hdr.nlmsg_type = TT.route_cmd; req.msg.rtm_family = AF_UNSPEC; req.msg.rtm_table = RT_TABLE_MAIN; req.msg.rtm_scope = RT_SCOPE_NOWHERE; if (TT.route_cmd != RTM_DELROUTE) { req.msg.rtm_protocol = RTPROT_BOOT; req.msg.rtm_scope = RT_SCOPE_UNIVERSE; req.msg.rtm_type = RTN_UNICAST; } mxrta->rta_type = RTA_METRICS; mxrta->rta_len = RTA_LENGTH(0); for (; *argv; argv++) { idx = substring_to_idx(*argv, cmd_objectlist); if (!idx) { if (!*++argv) show_iproute_help(); parse_prefix(addr, &netmask, &len, *argv, req.msg.rtm_family); if (len) req.msg.rtm_family = ((len == 4) ? AF_INET : AF_INET6); add_string_to_rtattr(&req.hdr, sizeof(req), RTA_PREFSRC, addr, len); } else if (idx == 1) { ok |= gtwy_ok; if (!*++argv) show_iproute_help(); parse_prefix(addr, &netmask, &len, *argv, req.msg.rtm_family); if (len) req.msg.rtm_family = ((len == 4) ? AF_INET : AF_INET6); add_string_to_rtattr(&req.hdr, sizeof(req),RTA_GATEWAY, addr, len); } else if (idx == 2) { if (!*++argv) show_iproute_help(); if (substring_to_idx(*argv, cmd_objectlist ) == 3) { mxlock |= (1 << RTAX_MTU); if (!*++argv) show_iproute_help(); } idx = atolx(*argv); add_uint32_rtattr_to_buffer(mxrta, sizeof(mxbuf), RTAX_MTU, idx); } else if (idx == 4) { if (!*++argv) show_iproute_help(); if ((idx = idxfromRPDB(*argv,RPDB_rtprotos)) < 0) error_exit("Invalid argument protocol %s.",*argv); req.msg.rtm_protocol = idx; ok |= proto_ok; } else if (idx == 5) { if (!*++argv) show_iproute_help(); req.msg.rtm_table = idxfromRPDB(*argv, RPDB_rttables); } else if (idx == 6 || idx == 7) { if (!*++argv) show_iproute_help(); d = *argv; } else if (idx == 9) { unsigned long metric; unsigned int res; char* ptr; if (!*++argv) show_iproute_help(); metric = strtoul(*argv, &ptr, 0); if (!(!*ptr && metric <= 0xFFFFFFFFUL)) error_exit("Invalid argument metric %s.",*argv); else res = metric; add_string_to_rtattr(&req.hdr, sizeof(req), RTA_PRIORITY, (char*)&res, sizeof(res)); } else { if (idx == 8) if (!*++argv) show_iproute_help(); idx = substring_to_idx(*argv,rtmtypes); if (idx != -1) { if (!*++argv) show_iproute_help(); req.msg.rtm_type = idx; ok |= type_ok; } if (ok & dst_ok) error_exit("Duplicate argument 'to'"); parse_prefix(addr, &netmask, &len, *argv, req.msg.rtm_family); if (len) req.msg.rtm_family = ((len == 4) ? AF_INET : AF_INET6); req.msg.rtm_dst_len = netmask; ok |= dst_ok; if (len) add_string_to_rtattr(&req.hdr, sizeof(req),RTA_DST, addr, len); } } if (d) { idx = get_ifaceindex(d,1); add_string_to_rtattr(&req.hdr, sizeof(req), RTA_OIF, (char*)&idx, sizeof(idx)); } if (mxrta->rta_len > RTA_LENGTH(0)) { if (mxlock) add_uint32_rtattr_to_buffer(mxrta, sizeof(mxbuf), RTAX_LOCK, mxlock); add_string_to_rtattr(&req.hdr, sizeof(req), RTA_METRICS, RTA_DATA(mxrta), RTA_PAYLOAD(mxrta)); } if (req.msg.rtm_type == RTN_LOCAL || req.msg.rtm_type == RTN_NAT) req.msg.rtm_scope = RT_SCOPE_HOST; else if (req.msg.rtm_type == RTN_BROADCAST||req.msg.rtm_type == RTN_MULTICAST || req.msg.rtm_type == RTN_ANYCAST) req.msg.rtm_scope = RT_SCOPE_LINK; else if (req.msg.rtm_type == RTN_UNICAST || req.msg.rtm_type == RTN_UNSPEC) { if (TT.route_cmd == RTM_DELROUTE) req.msg.rtm_scope = RT_SCOPE_NOWHERE; else if (!(ok & gtwy_ok)) req.msg.rtm_scope = RT_SCOPE_LINK; } if (req.msg.rtm_family == AF_UNSPEC) req.msg.rtm_family = AF_INET; send_nlmesg(0, 0, 0, &req, sizeof(req)); filter_nlmesg(NULL, NULL); return 0; } static int iproute(char **argv) { int idx = 1; struct arglist cmd_objectlist1[] = {{"add", 0}, {"append", 1},{"change", 2}, {"chg", 3},{"delete",4}, {"get", 5}, {"list", 6}, {"show", 7}, {"prepend", 8},{"replace", 9},{"test", 10}, {"flush", 11},{NULL,-1}}; TT.route_cmd = RTM_NEWROUTE; switch (idx = substring_to_idx(*argv , cmd_objectlist1)) { case 0: // add return route_update(++argv , NLM_F_CREATE|NLM_F_EXCL); case 1: // append return route_update(++argv , NLM_F_CREATE|NLM_F_APPEND); case 2: // change case 3: // chg return route_update(++argv , NLM_F_REPLACE); case 4: // delete TT.route_cmd = RTM_DELROUTE; return route_update(++argv , RTM_DELROUTE); case 5: return route_get(++argv); case 6: case 7: return route_show_flush(++argv); case 8: // prepend return route_update(++argv , NLM_F_CREATE); case 9: // replace return route_update(++argv , NLM_F_CREATE|NLM_F_REPLACE); case 10: // test return route_update(++argv , NLM_F_EXCL); case 11: // flush return route_show_flush(++argv); default: if (!*argv) return route_show_flush(argv); else show_iproute_help(); } return 0; // non reachable code. } // =========================================================================== // code for ip rule. // =========================================================================== static void show_iprule_help(void) { error_exit("usage: ip rule [ list | add | del ] SELECTOR ACTION\n" "SELECTOR := [ from PREFIX ] [ to PREFIX ] [pref NUMBER] [ tos TOS ]\n" " [ fwmark FWMARK] [ dev/iif STRING ] [type TYPE]\n" "ACTION := [ table TABLE_ID ] [ realms [SRCREALM/]DSTREALM ]"); } static int ruleupdate(char **argv) { int8_t idx, tflag = 0, opt = (*argv[-1] == 'a') ? RTM_NEWRULE : RTM_DELRULE; struct arglist options[] = {{"from", 0}, {"to", 1}, {"preference", 2}, {"order", 2}, {"priority", 2}, {"tos", 3}, {"dsfield", 3}, {"fwmark", 4}, {"realms", 5}, {"table", 6}, {"lookup", 6}, {"dev", 7}, {"iif", 7}, {"nat", 8}, {"map-to", 8}, {"type", 9}, {"help", 10}, {NULL, -1}}; struct { struct nlmsghdr mhdr; struct rtmsg msg; char buf[1024]; } request; memset(&request, 0, sizeof(request)); request.mhdr.nlmsg_type = opt; request.mhdr.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg)); request.mhdr.nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK | ((opt == RTM_DELRULE) ? 0 : NLM_F_CREATE | NLM_F_EXCL); request.msg.rtm_family = TT.addressfamily; request.msg.rtm_protocol = RTPROT_BOOT; request.msg.rtm_scope = RT_SCOPE_UNIVERSE; request.msg.rtm_table = 0; request.msg.rtm_type = ((opt == RTM_DELRULE) ? RTN_UNSPEC : RTN_UNICAST); for (; *argv; argv++) { switch ((idx = substring_to_idx(*argv, options))) { case 0: case 1: { // e.g. from IP/Netmask and to IP/Netmask. uint32_t addr[4] = {0,}, netmask = 0; uint8_t len = 0, *tmp; if (!*++argv) error_exit("'%s': Missing Prefix", argv[-1]); parse_prefix(addr, &netmask, &len, *argv, request.msg.rtm_family); tmp = idx ? &request.msg.rtm_dst_len : &request.msg.rtm_src_len; if (!netmask) *tmp = 0; else *tmp = netmask; add_string_to_rtattr(&request.mhdr, sizeof(request), (idx ? RTA_DST : RTA_SRC), addr, len); } break; case 2: case 4: { // e.g. Preference p# and fwmark MARK uint32_t pref; char *ptr; if (!*++argv) error_exit("Missing %s", (idx == 2) ? "Preference" : "fwmark"); pref = strtoul(*argv, &ptr, 0); if (!ptr || (ptr == *argv) || *ptr || pref > 0xFFFFFFFFUL) error_exit("Invalid %s", (idx == 2) ? "Preference" : "fwmark"); add_string_to_rtattr(&request.mhdr, sizeof(request), ((idx == 2) ? RTA_PRIORITY : RTA_PROTOINFO), (void *)&pref, sizeof(uint32_t)); } break; case 3: { uint32_t tos; if (!*++argv) error_exit("Missing TOS key"); if ((tos = idxfromRPDB(*argv, RPDB_rtdsfield)) < 0) error_exit("Invalid TOS"); request.msg.rtm_tos = tos; } break; case 5: { // e.g. realms FROM_realm/TO_realm uint32_t realms = 0; int ret; char *ptr; if (!*++argv) error_exit("Missing REALMSID"); if ((ptr = strchr(*argv, '/'))) { *ptr = 0; if ((ret = idxfromRPDB(*argv, RPDB_rtrealms)) < 0) error_exit("Invalid realms"); realms = ret; realms <<= 16; *ptr++ = '/'; } else ptr = *argv; if ((ret = idxfromRPDB(ptr, RPDB_rtrealms)) < 0) error_exit("Invalid realms"); realms |= ret; add_string_to_rtattr(&request.mhdr, sizeof(request), RTA_FLOW, (void *)&realms, sizeof(uint32_t)); } break; case 6: { // e.g. table tid/tableName int tid; if (!*++argv) error_exit("Missing TableID"); if ((tid = idxfromRPDB(*argv, RPDB_rttables)) < 0) error_exit("Invalid TID"); request.msg.rtm_table = tid; tflag = 1; } break; case 7: { if (!*++argv) error_exit("Missing dev/iif NAME"); add_string_to_rtattr(&request.mhdr, sizeof(request), RTA_IIF, *argv, strlen(*argv)+1); } break; case 8: { uint32_t addr[4] = {0,}; uint8_t af = AF_UNSPEC; if (!*++argv) error_exit("Missing nat/map-to ADDRESS"); if (get_prefix(addr, &af /* Un-used variable */, *argv, AF_INET)) error_exit("Invalid mapping Address"); add_string_to_rtattr(&request.mhdr, sizeof(request), RTA_GATEWAY, addr, sizeof(uint32_t)); request.msg.rtm_type = RTN_NAT; } break; case 9: { if (!*++argv) error_exit("TYPE Missing"); request.msg.rtm_type = rtmtype_str2idx(*argv); } break; case 10: show_iprule_help(); break; // Unreachable code. default: error_exit("Invalid argument '%s'", *argv); break; // Unreachable code. } } if (!request.msg.rtm_family) request.msg.rtm_family = AF_INET; if (!tflag && opt == RTM_NEWRULE) request.msg.rtm_table = RT_TABLE_MAIN; send_nlmesg(0, 0, 0, &request, sizeof(request)); return (filter_nlmesg(NULL, NULL)); } static int show_rules(struct nlmsghdr *mhdr, char **argv __attribute__ ((__unused__))) { struct rtmsg *msg = NLMSG_DATA(mhdr); struct rtattr *rta, *attr[RTA_MAX+1] = {0,}; int32_t tvar, msglen = mhdr->nlmsg_len - NLMSG_LENGTH(sizeof(struct rtmsg)); int hlen = ((msg->rtm_family == AF_INET) ? 32 : ((msg->rtm_family == AF_INET6) ? 128 : -1)); if (mhdr->nlmsg_type != RTM_NEWRULE) return 0; if (msglen < 0) return 1; tvar = msglen; for (rta = RTM_RTA(msg); RTA_OK(rta, tvar); rta=RTA_NEXT(rta, tvar)) if (rta->rta_type <= RTA_MAX) attr[rta->rta_type] = rta; if (tvar) error_msg("deficit %d, rtalen = %d!", tvar, rta->rta_len); printf("%u:\tfrom ", attr[RTA_PRIORITY] ? *(unsigned *)RTA_DATA(attr[RTA_PRIORITY]) : 0); if (attr[RTA_SRC]) { printf("%s", (msg->rtm_family == AF_INET || msg->rtm_family == AF_INET6) ? inet_ntop(msg->rtm_family, RTA_DATA(attr[RTA_SRC]), toybuf, sizeof(toybuf)) : "???"); (msg->rtm_src_len != hlen) ? printf("/%u", msg->rtm_src_len) : 0; } else msg->rtm_src_len ? printf("0/%d", msg->rtm_src_len) : printf("all"); xputc(' '); if (attr[RTA_DST]) { printf("to %s", (msg->rtm_family == AF_INET || msg->rtm_family == AF_INET6) ? inet_ntop(msg->rtm_family, RTA_DATA(attr[RTA_DST]), toybuf, sizeof(toybuf)) : "???"); (msg->rtm_dst_len != hlen) ? printf("/%u", msg->rtm_dst_len) : xputc(' '); } else if (msg->rtm_dst_len) printf("to 0/%d ", msg->rtm_dst_len); if (msg->rtm_tos) printf("tos %s ", namefromRPDB(msg->rtm_tos, RPDB_rtdsfield)); if (attr[RTA_PROTOINFO]) printf("fwmark %#x ", *(uint32_t*)RTA_DATA(attr[RTA_PROTOINFO])); if (attr[RTA_IIF]) printf("iif %s ", (char*)RTA_DATA(attr[RTA_IIF])); if (msg->rtm_table) printf("lookup %s ", namefromRPDB(msg->rtm_table, RPDB_rttables)); if (attr[RTA_FLOW]) { u_int32_t from, to = *(u_int32_t *)RTA_DATA(attr[RTA_FLOW]); char *format = "realms %s/"; to = (from = (to >> 16)) & 0xFFFF; format = (from ? format: "%s"); printf(format, namefromRPDB((from ? from : to), RPDB_rtrealms)); } if (msg->rtm_type == RTN_NAT) { if (!attr[RTA_GATEWAY]) printf("masquerade"); else printf("map-to %s ", inet_ntop(msg->rtm_family, RTA_DATA(attr[RTA_GATEWAY]), toybuf, sizeof(toybuf))); } else if (msg->rtm_type != RTN_UNICAST) printf("%s", rtmtype_idx2str(msg->rtm_type)); xputc('\n'); return 0; } static int rulelist(char **argv) { if (*argv) { error_msg("'ip rule show' does not take any arguments."); return 1; } send_nlmesg(RTM_GETRULE, NLM_F_ROOT | NLM_F_MATCH | NLM_F_REQUEST, ((TT.addressfamily != AF_UNSPEC) ? TT.addressfamily : AF_INET), NULL, 0); return filter_nlmesg(show_rules, argv); } static int iprule(char **argv) { int idx; struct arglist options[] = {{"add", 0}, {"delete", 0}, {"list", 1}, {"show", 1}, {NULL, -1}}; cmdobj ipcmd, cmdobjlist[] = {ruleupdate, rulelist}; if (!*argv) idx = 1; else if ((idx = substring_to_idx(*argv++, options)) == -1) show_iprule_help(); ipcmd = cmdobjlist[idx]; return ipcmd(argv); } //============================================================================ // code for ip tunnel. //============================================================================ static void show_iptunnel_help(void) { error_exit("usage: iptunnel { add | change | del | show } [NAME]\n" " [mode { ipip | gre | sit }] [remote ADDR] [local ADDR]\n" " [[i|o]seq] [[i|o]key KEY] [[i|o]csum] [ttl TTL]\n" " [tos TOS] [[no]pmtudisc] [dev PHYS_DEV]"); } static int tnl_ioctl(char *dev, int rtype, struct ip_tunnel_parm *ptnl) { struct ifreq req; int fd, ret = 0; if ((rtype == SIOCCHGTUNNEL || rtype == SIOCDELTUNNEL) && *ptnl->name) xstrncpy(req.ifr_name, ptnl->name, IF_NAMESIZE); else xstrncpy(req.ifr_name, dev, IF_NAMESIZE); if (rtype != SIOCGIFHWADDR) req.ifr_ifru.ifru_data = (void*)ptnl; fd = xsocket(AF_INET, SOCK_DGRAM, 0); if (rtype == SIOCGETTUNNEL) ret = ioctl(fd, rtype, &req); else if (rtype == SIOCGIFHWADDR) ret = (ioctl(fd, rtype, &req) < 0) ? -1 : req.ifr_addr.sa_family; else xioctl(fd, rtype, &req); close(fd); return ret; } static int display_tunnel(struct ip_tunnel_parm *ptnl) { char rmt_addr[64], lcl_addr[64], ikey_str[64], okey_str[64]; printf("%s: %s/ip", ptnl->name, ptnl->iph.protocol == IPPROTO_IPIP ? "ip" : (ptnl->iph.protocol == IPPROTO_GRE ? "gre" : (ptnl->iph.protocol == IPPROTO_IPV6 ? "ipv6" : "unknown"))); printf(" remote %s local %s ", ptnl->iph.daddr ? inet_ntop(AF_INET, &ptnl->iph.daddr, rmt_addr, sizeof(rmt_addr)) : "any", ptnl->iph.saddr ? inet_ntop(AF_INET, &ptnl->iph.saddr, lcl_addr, sizeof(lcl_addr)) : "any"); if (ptnl->link) { struct ifreq req; int fd; req.ifr_ifindex = ptnl->link; fd = xsocket(AF_INET, SOCK_DGRAM, 0); if (ioctl(fd, SIOCGIFNAME, &req) < 0) perror_msg("SIOCGIFNAME"); else printf(" dev %s ", req.ifr_name); close(fd); } if (ptnl->iph.ttl) printf(" ttl %d ", ptnl->iph.ttl); else printf(" ttl inherit "); if (ptnl->iph.tos) { printf(" tos"); if (ptnl->iph.tos & 1) printf(" inherit"); if (ptnl->iph.tos & ~1) printf("%c%s ", ptnl->iph.tos & 1 ? '/' : ' ', namefromRPDB((ptnl->iph.tos & ~1), RPDB_rtdsfield)); } if (!(ptnl->iph.frag_off & htons(IP_DF))) printf(" nopmtudisc"); inet_ntop(AF_INET, &ptnl->i_key, ikey_str, sizeof(ikey_str)); if ((ptnl->i_flags & GRE_KEY) && (ptnl->o_flags & GRE_KEY) && ptnl->o_key == ptnl->i_key) printf(" key %s", ikey_str); else if ((ptnl->i_flags | ptnl->o_flags) & GRE_KEY) { inet_ntop(AF_INET, &ptnl->o_key, okey_str, sizeof(okey_str)); if (ptnl->i_flags & GRE_KEY) printf(" ikey %s ", ikey_str); if (ptnl->o_flags & GRE_KEY) printf(" okey %s ", okey_str); } if (ptnl->i_flags & GRE_SEQ) printf("\n Drop packets out of sequence.\n"); if (ptnl->i_flags & GRE_CSUM) printf("\n Checksum in received packet is required."); if (ptnl->o_flags & GRE_SEQ) printf("\n Sequence packets on output."); if (ptnl->o_flags & GRE_CSUM) printf("\n Checksum output packets."); xputc('\n'); return 0; } static int read_tunnel(struct ip_tunnel_parm *ptnl) { int count = 0; char iface[IF_NAMESIZE]; struct ip_tunnel_parm iptnl; FILE *fp = xfopen("/proc/net/dev", "r"); while (fgets(toybuf, sizeof(toybuf), fp)) { char *ptr; int ret; if (count++ < 2) continue; // 1st two lines are header. ptr = strchr(toybuf, ':'); if (!ptr || (*ptr++ = 0, sscanf(toybuf, "%s", iface) != 1)) error_exit("invalid format of '/proc/net/dev'"); if (*ptnl->name && strcmp(ptnl->name, iface)) continue; if ((ret = tnl_ioctl(iface, SIOCGIFHWADDR, &iptnl)) < 0) { error_msg("failed to get type of '%s'", iface); continue; } if (ret != ARPHRD_TUNNEL && ret != ARPHRD_SIT && ret != ARPHRD_IPGRE) continue; memset(&iptnl, 0, sizeof(iptnl)); if (tnl_ioctl(iface, SIOCGETTUNNEL, &iptnl) < 0) continue; if ((ptnl->link && iptnl.link != ptnl->link) || (*ptnl->name && strcmp(iptnl.name, ptnl->name)) || (ptnl->iph.daddr && iptnl.iph.daddr != ptnl->iph.daddr) || (ptnl->iph.saddr && iptnl.iph.saddr != ptnl->iph.saddr) || (ptnl->i_key && iptnl.i_key != ptnl->i_key)) continue; display_tunnel(&iptnl); } fclose(fp); return 0; } static void parse_iptunnel_args(struct ip_tunnel_parm *ptnl, char **argv, int ipt_opt_idx) { int idx; uint8_t af = AF_INET; uint32_t addr = 0; struct arglist opts[] = { {"mode", 0}, {"key", 1}, {"ikey", 2}, {"okey", 3}, {"seq", 4}, {"iseq", 5}, {"oseq", 6}, {"csum", 7}, {"icsum", 8}, {"ocsum", 9}, {"nopmtudisc", 10}, {"pmtudisc", 11}, {"remote", 12}, {"local", 13},{"dev", 14}, {"ttl", 15}, {"tos", 16}, {"dsfield", 17}, {"name", 18}, {NULL, -1} }; ptnl->iph.version = 4; // The value indicates the version of IP (4 or 6) ptnl->iph.ihl = 5; // Minimum Internet Header Length // frag_off is measured in units of 8 octets (64 bits) ptnl->iph.frag_off = htons(IP_DF); if (*argv && ipt_opt_idx <= 2 && string_to_idx(*argv, opts) == -1) { xstrncpy(ptnl->name, *argv, IF_NAMESIZE); if (ipt_opt_idx == 1) { struct ip_tunnel_parm iptnl_old; memset(&iptnl_old, 0, sizeof(iptnl_old)); tnl_ioctl(ptnl->name, SIOCGETTUNNEL, &iptnl_old); *ptnl = iptnl_old; } argv++; } for (; *argv; argv++, addr = 0) { switch (idx = string_to_idx(*argv, opts)) { case 0: if (!*++argv) error_exit("mode is missing"); if ((!strcmp("ipip", *argv) || !strcmp("ip/ip", *argv))) ptnl->iph.protocol = IPPROTO_IPIP; else if ((!strcmp("gre", *argv) || !strcmp("gre/ip", *argv))) ptnl->iph.protocol = IPPROTO_GRE; else if ((!strcmp("sit", *argv) || !strcmp("ipv6/ip", *argv))) ptnl->iph.protocol = IPPROTO_IPV6; else show_iptunnel_help(); break; case 1: case 2: case 3: { struct addrinfo *info, hint; int ret; if (!*++argv) error_exit("key value is missing"); memset(&hint, 0, sizeof(hint)); hint.ai_family = AF_INET; ret = getaddrinfo(*argv, NULL, &hint, &info); if (ret || !info) error_exit("invalid argument to key"); freeaddrinfo(info); if (strchr(*argv, '.')) { if (get_prefix(&addr, &af, *argv, AF_INET)) error_exit("invalid key '%s'", *argv); } else { unsigned key_val; sscanf(*argv, "%u", &key_val); addr = htonl(key_val); } if (idx == 1) { ptnl->i_flags |= GRE_KEY; ptnl->o_flags |= GRE_KEY; ptnl->i_key = ptnl->o_key = addr; } else if (idx == 2) { ptnl->i_flags |= GRE_KEY; ptnl->i_key = addr; } else { ptnl->o_flags |= GRE_KEY; ptnl->o_key = addr; } } break; case 4: ptnl->i_flags |= GRE_SEQ; ptnl->o_flags |= GRE_SEQ; break; case 5: ptnl->i_flags |= GRE_SEQ; break; case 6: ptnl->o_flags |= GRE_SEQ; break; case 7: ptnl->i_flags |= GRE_CSUM; ptnl->o_flags |= GRE_CSUM; break; case 8: ptnl->i_flags |= GRE_CSUM; break; case 9: ptnl->o_flags |= GRE_CSUM; break; case 10: ptnl->iph.frag_off = 0; break; case 11: ptnl->iph.frag_off = htons(IP_DF); break; case 12: case 13: if (!*++argv) error_exit("remote/local address is missing"); if (get_prefix(&addr, &af, *argv, AF_INET)) error_exit("invalid remote/local address '%s'", *argv); (idx == 12) ? (ptnl->iph.daddr = addr) : (ptnl->iph.saddr = addr); break; case 14: if (!*++argv) error_exit("device name is missing"); else { struct ifreq req; int fd; xstrncpy(req.ifr_name, *argv, IFNAMSIZ); fd = xsocket(AF_INET, SOCK_DGRAM, 0); xioctl(fd, SIOCGIFINDEX, &req); close(fd); ptnl->link = req.ifr_ifindex; } break; case 15: if (!*++argv) error_exit("ttl value is missing"); if (strcmp(*argv, "inherit")) ptnl->iph.ttl = atolx_range(*argv, 0, 255); break; case 16: case 17: if (!*++argv) error_exit("tos value is missing"); if (strcmp(*argv, "inherit")) { char *ptr; unsigned long tval = strtoul(*argv, &ptr, 16); if (tval > 255) error_exit("invalid tos value '%s'", *argv); if (*ptr) { int ret; if ((ret = idxfromRPDB(*argv, RPDB_rtdsfield)) < 0) error_exit("invalid tos value"); ptnl->iph.tos = ret; } else ptnl->iph.tos = tval; } else ptnl->iph.tos = 1; break; case 18: if (*ptnl->name) error_exit("invalid tunnel"); else { if (!*++argv) error_exit("name is missing"); xstrncpy(ptnl->name, *argv, IF_NAMESIZE); } break; default: if (*ptnl->name) error_exit("invalid tunnel"); xstrncpy(ptnl->name, *argv, IF_NAMESIZE); break; } } if (ptnl->iph.protocol == IPPROTO_IPIP || ptnl->iph.protocol == IPPROTO_IPV6) { if ((ptnl->i_flags & GRE_KEY) || (ptnl->o_flags & GRE_KEY)) error_exit("[i|o]key is allowed with gre only"); if ((ptnl->i_flags & GRE_SEQ) || (ptnl->o_flags & GRE_SEQ)) error_exit("[i|o]seq is allowed with gre only"); if ((ptnl->i_flags & GRE_CSUM) || (ptnl->o_flags & GRE_CSUM)) error_exit("[i|o]csum is allowed with gre only"); } if (!ptnl->i_key && IN_MULTICAST(ntohl(ptnl->iph.daddr))) { ptnl->i_key = ptnl->iph.daddr; ptnl->i_flags |= GRE_KEY; } if (!ptnl->o_key && IN_MULTICAST(ntohl(ptnl->iph.daddr))) { ptnl->o_key = ptnl->iph.daddr; ptnl->o_flags |= GRE_KEY; } if (IN_MULTICAST(ntohl(ptnl->iph.daddr)) && !ptnl->iph.saddr) error_exit("broadcast tunnel requires a source address"); } static int tunnellist(char **argv) { struct ip_tunnel_parm iptnl; int ret = 0; memset(&iptnl, 0, sizeof(iptnl)); parse_iptunnel_args(&iptnl, argv, 3); if (iptnl.iph.protocol == IPPROTO_IPIP) ret = tnl_ioctl(*iptnl.name ? iptnl.name : "tunl0", SIOCGETTUNNEL, &iptnl); else if (iptnl.iph.protocol == IPPROTO_GRE) ret = tnl_ioctl(*iptnl.name ? iptnl.name : "gre0", SIOCGETTUNNEL, &iptnl); else if (iptnl.iph.protocol == IPPROTO_IPV6) ret = tnl_ioctl(*iptnl.name ? iptnl.name : "sit0", SIOCGETTUNNEL, &iptnl); else return read_tunnel(&iptnl); if (ret < 0) { perror_msg("SIOCGETTUNNEL"); return ret; } else return display_tunnel(&iptnl); } // Performing add, change, & delete tunnel action, according to passed req_type static int tunnelupdate(char **argv) { struct ip_tunnel_parm iptnl; int idx = 2, rtype = SIOCDELTUNNEL; if (*argv[-1] == 'a') { idx = 0; rtype = SIOCADDTUNNEL; } else if (*argv[-1] == 'c') { idx = 1; rtype = SIOCCHGTUNNEL; } memset(&iptnl, 0, sizeof(iptnl)); parse_iptunnel_args(&iptnl, argv, idx); if (idx != 2 && iptnl.iph.ttl && !(iptnl.iph.frag_off)) error_exit("ttl > 0 and nopmtudisc are incompatible"); if (iptnl.iph.protocol == IPPROTO_IPIP) return (tnl_ioctl("tunl0", rtype, &iptnl) < 0) ? 1 : 0; else if (iptnl.iph.protocol == IPPROTO_GRE) return (tnl_ioctl("gre0", rtype, &iptnl) < 0) ? 1 : 0; else if (iptnl.iph.protocol == IPPROTO_IPV6) return (tnl_ioctl("sit0", rtype, &iptnl) < 0) ? 1 : 0; else { if (idx != 2) error_exit("invalid tunnel mode"); return (tnl_ioctl(iptnl.name, rtype, &iptnl) < 0) ? 1 : 0; } } static int iptunnel(char **argv) { int idx; struct arglist opts[] = {{"add", 0}, {"change", 0}, {"del", 0}, {"delete", 0}, {"show", 1}, {"list", 1}, {"lst", 1}, {NULL, -1} }; cmdobj ipcmd, cmdobjlist[] = {tunnelupdate, tunnellist}; if (!*argv) idx = 1; else if ((idx = substring_to_idx(*argv++, opts)) == -1) show_iptunnel_help(); ipcmd = cmdobjlist[idx]; return ipcmd(argv); } // =========================================================================== // Common code, which is used for all ip options. // =========================================================================== // Parse netlink messages and call input callback handler for action static int filter_nlmesg(int (*fun)(struct nlmsghdr *mhdr, char **argv), char **argv) { while (1) { struct nlmsghdr *mhdr; int msglen = recv(TT.sockfd, TT.gbuf, MESG_LEN, 0); if ((msglen < 0) && (errno == EINTR || errno == EAGAIN)) continue; else if (msglen < 0) { error_msg("netlink receive error %s", strerror(errno)); return 1; } else if (!msglen) { error_msg("EOF on netlink"); return 1; } for (mhdr = (struct nlmsghdr*)TT.gbuf; NLMSG_OK(mhdr, msglen); mhdr = NLMSG_NEXT(mhdr, msglen)) { int err; if (mhdr->nlmsg_pid != getpid()) continue; switch (mhdr->nlmsg_type) { case NLMSG_DONE: return 0; case NLMSG_ERROR: { struct nlmsgerr *merr = (struct nlmsgerr*)NLMSG_DATA(mhdr); if (merr->error == 0) return 0; if (mhdr->nlmsg_len < NLMSG_LENGTH(sizeof(struct nlmsgerr))) error_msg("ERROR truncated"); else { errno = -merr->error; perror_msg("RTNETLINK answers"); } return 1; } default: if (fun && (err = fun(mhdr, argv))) return err; break; } } // End of for loop. } // End of while loop. return 0; } void ip_main(void) { char **optargv = toys.argv; int idx, isip = !(toys.which->name[2]); //1 -> if only ip cmdobj ipcmd, cmdobjlist[] = {ipaddr, iplink, iproute, iprule, iptunnel}; for (++optargv; *optargv; ++optargv) { char *ptr = *optargv; struct arglist ip_options[] = {{"oneline", 0}, {"family", 1}, {"4", 1}, {"6", 1}, {"0", 1}, {"stats", 2}, {NULL, -1}}; if (*ptr != '-') break; else if ((*(ptr+1) == '-') && (*(ptr+2))) ptr +=2; //escape "--" and stop ip arg parsing. else if ((*(ptr+1) == '-') && (!*(ptr+2))) { *ptr +=1; break; } else ptr +=1; switch (substring_to_idx(ptr, ip_options)) { case 0: TT.singleline = 1; break; case 1: { if (isdigit(*ptr)) { long num = atolx(ptr); if (num == 4) TT.addressfamily = AF_INET; else if (num == 6) TT.addressfamily = AF_INET6; else TT.addressfamily = AF_PACKET; } else { struct arglist ip_aflist[] = {{"inet", AF_INET}, {"inet6", AF_INET6}, {"link", AF_PACKET}, {NULL, -1}}; if (!*++optargv) help_exit(0); if ((TT.addressfamily = string_to_idx(*optargv, ip_aflist)) == -1) error_exit("wrong family '%s'", *optargv); } } break; case 2: TT.stats++; break; default: help_exit(0); break; // unreachable code. } } TT.sockfd = xsocket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE); if (isip) {// only for ip if (*optargv) { struct arglist ip_objectlist[] = { {"address", 0}, {"link", 1}, {"route", 2}, {"rule", 3}, {"tunnel", 4}, {"tunl", 4}, {NULL, -1}}; if ((idx = substring_to_idx(*optargv, ip_objectlist)) == -1) help_exit(0); ipcmd = cmdobjlist[idx]; toys.exitval = ipcmd(++optargv); } else help_exit(0); } else { struct arglist ip_objectlist[] = { {"ipaddr", 0}, {"iplink", 1}, {"iproute", 2}, {"iprule", 3}, {"iptunnel", 4}, {NULL, -1}}; if ((idx = string_to_idx(toys.which->name, ip_objectlist)) == -1) help_exit(0); ipcmd = cmdobjlist[idx]; toys.exitval = ipcmd(optargv); } xclose(TT.sockfd); if (rtdsfield_init) free_alist(rt_dsfield); if (rtrealms_init) free_alist(rt_realms); if (rtscope_init) free_alist(rt_scope); if (rttable_init) free_alist(rt_tables); if (rtprotos_init) free_alist(rt_protos); }