bridge/mdb.c

   1 /*
   2  * Get mdb table with netlink
   3  */
   4
   5 #include <stdio.h>
   6 #include <stdlib.h>
   7 #include <unistd.h>
   8 #include <fcntl.h>
   9 #include <sys/socket.h>
  10 #include <net/if.h>
  11 #include <netinet/in.h>
  12 #include <linux/if_bridge.h>
  13 #include <linux/if_ether.h>
  14 #include <string.h>
  15 #include <arpa/inet.h>
  16
  17 #include "libnetlink.h"
  18 #include "br_common.h"
  19 #include "rt_names.h"
  20 #include "utils.h"
  21
  22 #ifndef MDBA_RTA
  23 #define MDBA_RTA(r) \
  24         ((struct rtattr*)(((char*)(r)) + NLMSG_ALIGN(sizeof(struct br_port_msg))))
  25 #endif
  26
  27 static unsigned int filter_index;
  28
  29 static void usage(void)
  30 {
  31         fprintf(stderr, "Usage: bridge mdb { add | del } dev DEV port PORT grp GROUP [permanent | temp] [vid VID]\n");
  32         fprintf(stderr, "       bridge mdb {show} [ dev DEV ]\n");
  33         exit(-1);
  34 }
  35
  36 static void br_print_router_ports(FILE *f, struct rtattr *attr)
  37 {
  38         uint32_t *port_ifindex;
  39         struct rtattr *i;
  40         int rem;
  41
  42         rem = RTA_PAYLOAD(attr);
  43         for (i = RTA_DATA(attr); RTA_OK(i, rem); i = RTA_NEXT(i, rem)) {
  44                 port_ifindex = RTA_DATA(i);
  45                 fprintf(f, "%s ", ll_index_to_name(*port_ifindex));
  46         }
  47
  48         fprintf(f, "\n");
  49 }
  50
  51 static void print_mdb_entry(FILE *f, int ifindex, struct br_mdb_entry *e,
  52                             struct nlmsghdr *n, struct rtattr **tb)
  53 {
  54         SPRINT_BUF(abuf);
  55         const void *src;
  56         int af;
  57
  58         af = e->addr.proto == htons(ETH_P_IP) ? AF_INET : AF_INET6;
  59         src = af == AF_INET ? (const void *)&e->addr.u.ip4 :
  60                               (const void *)&e->addr.u.ip6;
  61         if (n->nlmsg_type == RTM_DELMDB)
  62                 fprintf(f, "Deleted ");
  63         fprintf(f, "dev %s port %s grp %s %s", ll_index_to_name(ifindex),
  64                 ll_index_to_name(e->ifindex),
  65                 inet_ntop(af, src, abuf, sizeof(abuf)),
  66                 (e->state & MDB_PERMANENT) ? "permanent" : "temp");
  67         if (e->vid)
  68                 fprintf(f, " vid %hu", e->vid);
  69         if (show_stats && tb && tb[MDBA_MDB_EATTR_TIMER]) {
  70                 struct timeval tv;
  71
  72                 __jiffies_to_tv(&tv, rta_getattr_u32(tb[MDBA_MDB_EATTR_TIMER]));
  73                 fprintf(f, "%4i.%.2i", (int)tv.tv_sec, (int)tv.tv_usec/10000);
  74         }
  75         fprintf(f, "\n");
  76 }
  77
  78 static void br_print_mdb_entry(FILE *f, int ifindex, struct rtattr *attr,
  79                                struct nlmsghdr *n)
  80 {
  81         struct rtattr *etb[MDBA_MDB_EATTR_MAX + 1];
  82         struct br_mdb_entry *e;
  83         struct rtattr *i;
  84         int rem;
  85
  86         rem = RTA_PAYLOAD(attr);
  87         for (i = RTA_DATA(attr); RTA_OK(i, rem); i = RTA_NEXT(i, rem)) {
  88                 e = RTA_DATA(i);
  89                 parse_rtattr(etb, MDBA_MDB_EATTR_MAX, MDB_RTA(RTA_DATA(i)),
  90                              RTA_PAYLOAD(i) - RTA_ALIGN(sizeof(*e)));
  91                 print_mdb_entry(f, ifindex, e, n, etb);
  92         }
  93 }
  94
  95 int print_mdb(const struct sockaddr_nl *who, struct nlmsghdr *n, void *arg)
  96 {
  97         FILE *fp = arg;
  98         struct br_port_msg *r = NLMSG_DATA(n);
  99         int len = n->nlmsg_len;
 100         struct rtattr *tb[MDBA_MAX+1], *i;
 101
 102         if (n->nlmsg_type != RTM_GETMDB && n->nlmsg_type != RTM_NEWMDB && n->nlmsg_type != RTM_DELMDB) {
 103                 fprintf(stderr, "Not RTM_GETMDB, RTM_NEWMDB or RTM_DELMDB: %08x %08x %08x\n",
 104                         n->nlmsg_len, n->nlmsg_type, n->nlmsg_flags);
 105
 106                 return 0;
 107         }
 108
 109         len -= NLMSG_LENGTH(sizeof(*r));
 110         if (len < 0) {
 111                 fprintf(stderr, "BUG: wrong nlmsg len %d\n", len);
 112                 return -1;
 113         }
 114
 115         if (filter_index && filter_index != r->ifindex)
 116                 return 0;
 117
 118         parse_rtattr(tb, MDBA_MAX, MDBA_RTA(r), n->nlmsg_len - NLMSG_LENGTH(sizeof(*r)));
 119
 120         if (tb[MDBA_MDB]) {
 121                 int rem = RTA_PAYLOAD(tb[MDBA_MDB]);
 122
 123                 for (i = RTA_DATA(tb[MDBA_MDB]); RTA_OK(i, rem); i = RTA_NEXT(i, rem))
 124                         br_print_mdb_entry(fp, r->ifindex, i, n);
 125         }
 126
 127         if (tb[MDBA_ROUTER]) {
 128                 if (n->nlmsg_type == RTM_GETMDB) {
 129                         if (show_details) {
 130                                 fprintf(fp, "router ports on %s: ",
 131                                         ll_index_to_name(r->ifindex));
 132                                 br_print_router_ports(fp, tb[MDBA_ROUTER]);
 133                         }
 134                 } else {
 135                         uint32_t *port_ifindex;
 136
 137                         i = RTA_DATA(tb[MDBA_ROUTER]);
 138                         port_ifindex = RTA_DATA(i);
 139                         if (n->nlmsg_type == RTM_DELMDB)
 140                                 fprintf(fp, "Deleted ");
 141                         fprintf(fp, "router port dev %s master %s\n",
 142                                 ll_index_to_name(*port_ifindex),
 143                                 ll_index_to_name(r->ifindex));
 144                 }
 145         }
 146
 147         fflush(fp);
 148
 149         return 0;
 150 }
 151
 152 static int mdb_show(int argc, char **argv)
 153 {
 154         char *filter_dev = NULL;
 155
 156         while (argc > 0) {
 157                 if (strcmp(*argv, "dev") == 0) {
 158                         NEXT_ARG();
 159                         if (filter_dev)
 160                                 duparg("dev", *argv);
 161                         filter_dev = *argv;
 162                 }
 163                 argc--; argv++;
 164         }
 165
 166         if (filter_dev) {
 167                 filter_index = if_nametoindex(filter_dev);
 168                 if (filter_index == 0) {
 169                         fprintf(stderr, "Cannot find device \"%s\"\n",
 170                                 filter_dev);
 171                         return -1;
 172                 }
 173         }
 174
 175         if (rtnl_wilddump_request(&rth, PF_BRIDGE, RTM_GETMDB) < 0) {
 176                 perror("Cannot send dump request");
 177                 return -1;
 178         }
 179
 180         if (rtnl_dump_filter(&rth, print_mdb, stdout) < 0) {
 181                 fprintf(stderr, "Dump terminated\n");
 182                 return -1;
 183         }
 184
 185         return 0;
 186 }
 187
 188 static int mdb_modify(int cmd, int flags, int argc, char **argv)
 189 {
 190         struct {
 191                 struct nlmsghdr         n;
 192                 struct br_port_msg      bpm;
 193                 char                    buf[1024];
 194         } req;
 195         struct br_mdb_entry entry;
 196         char *d = NULL, *p = NULL, *grp = NULL;
 197         short vid = 0;
 198
 199         memset(&req, 0, sizeof(req));
 200         memset(&entry, 0, sizeof(entry));
 201
 202         req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct br_port_msg));
 203         req.n.nlmsg_flags = NLM_F_REQUEST|flags;
 204         req.n.nlmsg_type = cmd;
 205         req.bpm.family = PF_BRIDGE;
 206
 207         while (argc > 0) {
 208                 if (strcmp(*argv, "dev") == 0) {
 209                         NEXT_ARG();
 210                         d = *argv;
 211                 } else if (strcmp(*argv, "grp") == 0) {
 212                         NEXT_ARG();
 213                         grp = *argv;
 214                 } else if (strcmp(*argv, "port") == 0) {
 215                         NEXT_ARG();
 216                         p = *argv;
 217                 } else if (strcmp(*argv, "permanent") == 0) {
 218                         if (cmd == RTM_NEWMDB)
 219                                 entry.state |= MDB_PERMANENT;
 220                 } else if (strcmp(*argv, "temp") == 0) {
 221                         ;/* nothing */
 222                 } else if (strcmp(*argv, "vid") == 0) {
 223                         NEXT_ARG();
 224                         vid = atoi(*argv);
 225                 } else {
 226                         if (matches(*argv, "help") == 0)
 227                                 usage();
 228                 }
 229                 argc--; argv++;
 230         }
 231
 232         if (d == NULL || grp == NULL || p == NULL) {
 233                 fprintf(stderr, "Device, group address and port name are required arguments.\n");
 234                 return -1;
 235         }
 236
 237         req.bpm.ifindex = ll_name_to_index(d);
 238         if (req.bpm.ifindex == 0) {
 239                 fprintf(stderr, "Cannot find device \"%s\"\n", d);
 240                 return -1;
 241         }
 242
 243         entry.ifindex = ll_name_to_index(p);
 244         if (entry.ifindex == 0) {
 245                 fprintf(stderr, "Cannot find device \"%s\"\n", p);
 246                 return -1;
 247         }
 248
 249         if (!inet_pton(AF_INET, grp, &entry.addr.u.ip4)) {
 250                 if (!inet_pton(AF_INET6, grp, &entry.addr.u.ip6)) {
 251                         fprintf(stderr, "Invalid address \"%s\"\n", grp);
 252                         return -1;
 253                 } else
 254                         entry.addr.proto = htons(ETH_P_IPV6);
 255         } else
 256                 entry.addr.proto = htons(ETH_P_IP);
 257
 258         entry.vid = vid;
 259         addattr_l(&req.n, sizeof(req), MDBA_SET_ENTRY, &entry, sizeof(entry));
 260
 261         if (rtnl_talk(&rth, &req.n, NULL, 0) < 0)
 262                 return -1;
 263
 264         return 0;
 265 }
 266
 267 int do_mdb(int argc, char **argv)
 268 {
 269         ll_init_map(&rth);
 270
 271         if (argc > 0) {
 272                 if (matches(*argv, "add") == 0)
 273                         return mdb_modify(RTM_NEWMDB, NLM_F_CREATE|NLM_F_EXCL, argc-1, argv+1);
 274                 if (matches(*argv, "delete") == 0)
 275                         return mdb_modify(RTM_DELMDB, 0, argc-1, argv+1);
 276
 277                 if (matches(*argv, "show") == 0 ||
 278                     matches(*argv, "lst") == 0 ||
 279                     matches(*argv, "list") == 0)
 280                         return mdb_show(argc-1, argv+1);
 281                 if (matches(*argv, "help") == 0)
 282                         usage();
 283         } else
 284                 return mdb_show(0, NULL);
 285
 286         fprintf(stderr, "Command \"%s\" is unknown, try \"bridge mdb help\".\n", *argv);
 287         exit(-1);
 288 }