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)
  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         fprintf(f, "\n");
  70 }
  71
  72 static void br_print_mdb_entry(FILE *f, int ifindex, struct rtattr *attr,
  73                                struct nlmsghdr *n)
  74 {
  75         struct rtattr *i;
  76         int rem;
  77         struct br_mdb_entry *e;
  78
  79         rem = RTA_PAYLOAD(attr);
  80         for (i = RTA_DATA(attr); RTA_OK(i, rem); i = RTA_NEXT(i, rem)) {
  81                 e = RTA_DATA(i);
  82                 print_mdb_entry(f, ifindex, e, n);
  83         }
  84 }
  85
  86 int print_mdb(const struct sockaddr_nl *who, struct nlmsghdr *n, void *arg)
  87 {
  88         FILE *fp = arg;
  89         struct br_port_msg *r = NLMSG_DATA(n);
  90         int len = n->nlmsg_len;
  91         struct rtattr *tb[MDBA_MAX+1], *i;
  92
  93         if (n->nlmsg_type != RTM_GETMDB && n->nlmsg_type != RTM_NEWMDB && n->nlmsg_type != RTM_DELMDB) {
  94                 fprintf(stderr, "Not RTM_GETMDB, RTM_NEWMDB or RTM_DELMDB: %08x %08x %08x\n",
  95                         n->nlmsg_len, n->nlmsg_type, n->nlmsg_flags);
  96
  97                 return 0;
  98         }
  99
 100         len -= NLMSG_LENGTH(sizeof(*r));
 101         if (len < 0) {
 102                 fprintf(stderr, "BUG: wrong nlmsg len %d\n", len);
 103                 return -1;
 104         }
 105
 106         if (filter_index && filter_index != r->ifindex)
 107                 return 0;
 108
 109         parse_rtattr(tb, MDBA_MAX, MDBA_RTA(r), n->nlmsg_len - NLMSG_LENGTH(sizeof(*r)));
 110
 111         if (tb[MDBA_MDB]) {
 112                 int rem = RTA_PAYLOAD(tb[MDBA_MDB]);
 113
 114                 for (i = RTA_DATA(tb[MDBA_MDB]); RTA_OK(i, rem); i = RTA_NEXT(i, rem))
 115                         br_print_mdb_entry(fp, r->ifindex, i, n);
 116         }
 117
 118         if (tb[MDBA_ROUTER]) {
 119                 if (n->nlmsg_type == RTM_GETMDB) {
 120                         if (show_details) {
 121                                 fprintf(fp, "router ports on %s: ",
 122                                         ll_index_to_name(r->ifindex));
 123                                 br_print_router_ports(fp, tb[MDBA_ROUTER]);
 124                         }
 125                 } else {
 126                         uint32_t *port_ifindex;
 127
 128                         i = RTA_DATA(tb[MDBA_ROUTER]);
 129                         port_ifindex = RTA_DATA(i);
 130                         if (n->nlmsg_type == RTM_DELMDB)
 131                                 fprintf(fp, "Deleted ");
 132                         fprintf(fp, "router port dev %s master %s\n",
 133                                 ll_index_to_name(*port_ifindex),
 134                                 ll_index_to_name(r->ifindex));
 135                 }
 136         }
 137
 138         return 0;
 139 }
 140
 141 static int mdb_show(int argc, char **argv)
 142 {
 143         char *filter_dev = NULL;
 144
 145         while (argc > 0) {
 146                 if (strcmp(*argv, "dev") == 0) {
 147                         NEXT_ARG();
 148                         if (filter_dev)
 149                                 duparg("dev", *argv);
 150                         filter_dev = *argv;
 151                 }
 152                 argc--; argv++;
 153         }
 154
 155         if (filter_dev) {
 156                 filter_index = if_nametoindex(filter_dev);
 157                 if (filter_index == 0) {
 158                         fprintf(stderr, "Cannot find device \"%s\"\n",
 159                                 filter_dev);
 160                         return -1;
 161                 }
 162         }
 163
 164         if (rtnl_wilddump_request(&rth, PF_BRIDGE, RTM_GETMDB) < 0) {
 165                 perror("Cannot send dump request");
 166                 return -1;
 167         }
 168
 169         if (rtnl_dump_filter(&rth, print_mdb, stdout) < 0) {
 170                 fprintf(stderr, "Dump terminated\n");
 171                 return -1;
 172         }
 173
 174         return 0;
 175 }
 176
 177 static int mdb_modify(int cmd, int flags, int argc, char **argv)
 178 {
 179         struct {
 180                 struct nlmsghdr         n;
 181                 struct br_port_msg      bpm;
 182                 char                    buf[1024];
 183         } req;
 184         struct br_mdb_entry entry;
 185         char *d = NULL, *p = NULL, *grp = NULL;
 186         short vid = 0;
 187
 188         memset(&req, 0, sizeof(req));
 189         memset(&entry, 0, sizeof(entry));
 190
 191         req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct br_port_msg));
 192         req.n.nlmsg_flags = NLM_F_REQUEST|flags;
 193         req.n.nlmsg_type = cmd;
 194         req.bpm.family = PF_BRIDGE;
 195
 196         while (argc > 0) {
 197                 if (strcmp(*argv, "dev") == 0) {
 198                         NEXT_ARG();
 199                         d = *argv;
 200                 } else if (strcmp(*argv, "grp") == 0) {
 201                         NEXT_ARG();
 202                         grp = *argv;
 203                 } else if (strcmp(*argv, "port") == 0) {
 204                         NEXT_ARG();
 205                         p = *argv;
 206                 } else if (strcmp(*argv, "permanent") == 0) {
 207                         if (cmd == RTM_NEWMDB)
 208                                 entry.state |= MDB_PERMANENT;
 209                 } else if (strcmp(*argv, "temp") == 0) {
 210                         ;/* nothing */
 211                 } else if (strcmp(*argv, "vid") == 0) {
 212                         NEXT_ARG();
 213                         vid = atoi(*argv);
 214                 } else {
 215                         if (matches(*argv, "help") == 0)
 216                                 usage();
 217                 }
 218                 argc--; argv++;
 219         }
 220
 221         if (d == NULL || grp == NULL || p == NULL) {
 222                 fprintf(stderr, "Device, group address and port name are required arguments.\n");
 223                 return -1;
 224         }
 225
 226         req.bpm.ifindex = ll_name_to_index(d);
 227         if (req.bpm.ifindex == 0) {
 228                 fprintf(stderr, "Cannot find device \"%s\"\n", d);
 229                 return -1;
 230         }
 231
 232         entry.ifindex = ll_name_to_index(p);
 233         if (entry.ifindex == 0) {
 234                 fprintf(stderr, "Cannot find device \"%s\"\n", p);
 235                 return -1;
 236         }
 237
 238         if (!inet_pton(AF_INET, grp, &entry.addr.u.ip4)) {
 239                 if (!inet_pton(AF_INET6, grp, &entry.addr.u.ip6)) {
 240                         fprintf(stderr, "Invalid address \"%s\"\n", grp);
 241                         return -1;
 242                 } else
 243                         entry.addr.proto = htons(ETH_P_IPV6);
 244         } else
 245                 entry.addr.proto = htons(ETH_P_IP);
 246
 247         entry.vid = vid;
 248         addattr_l(&req.n, sizeof(req), MDBA_SET_ENTRY, &entry, sizeof(entry));
 249
 250         if (rtnl_talk(&rth, &req.n, NULL, 0) < 0)
 251                 return -1;
 252
 253         return 0;
 254 }
 255
 256 int do_mdb(int argc, char **argv)
 257 {
 258         ll_init_map(&rth);
 259
 260         if (argc > 0) {
 261                 if (matches(*argv, "add") == 0)
 262                         return mdb_modify(RTM_NEWMDB, NLM_F_CREATE|NLM_F_EXCL, argc-1, argv+1);
 263                 if (matches(*argv, "delete") == 0)
 264                         return mdb_modify(RTM_DELMDB, 0, argc-1, argv+1);
 265
 266                 if (matches(*argv, "show") == 0 ||
 267                     matches(*argv, "lst") == 0 ||
 268                     matches(*argv, "list") == 0)
 269                         return mdb_show(argc-1, argv+1);
 270                 if (matches(*argv, "help") == 0)
 271                         usage();
 272         } else
 273                 return mdb_show(0, NULL);
 274
 275         fprintf(stderr, "Command \"%s\" is unknown, try \"bridge mdb help\".\n", *argv);
 276         exit(-1);
 277 }