Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 1 | /* |
| 2 | * iplink_vlan.c VLAN device support |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or |
| 5 | * modify it under the terms of the GNU General Public License |
| 6 | * as published by the Free Software Foundation; either version |
| 7 | * 2 of the License, or (at your option) any later version. |
| 8 | * |
| 9 | * Authors: Patrick McHardy <kaber@trash.net> |
| 10 | */ |
| 11 | |
| 12 | #include <stdio.h> |
| 13 | #include <stdlib.h> |
| 14 | #include <string.h> |
| 15 | #include <linux/if_vlan.h> |
| 16 | |
| 17 | #include "rt_names.h" |
| 18 | #include "utils.h" |
| 19 | #include "ip_common.h" |
| 20 | |
vadimk | 561e650 | 2014-09-30 08:17:31 +0300 | [diff] [blame] | 21 | static void print_explain(FILE *f) |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 22 | { |
vadimk | 561e650 | 2014-09-30 08:17:31 +0300 | [diff] [blame] | 23 | fprintf(f, |
Stephen Hemminger | 56f5daa | 2016-03-21 11:52:19 -0700 | [diff] [blame] | 24 | "Usage: ... vlan [ protocol VLANPROTO ] id VLANID [ FLAG-LIST ]\n" |
Patric McHardy | 8fd8f6e | 2013-06-21 08:59:24 -0700 | [diff] [blame] | 25 | " [ ingress-qos-map QOS-MAP ] [ egress-qos-map QOS-MAP ]\n" |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 26 | "\n" |
Patric McHardy | 8fd8f6e | 2013-06-21 08:59:24 -0700 | [diff] [blame] | 27 | "VLANPROTO: [ 802.1Q / 802.1ad ]\n" |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 28 | "VLANID := 0-4095\n" |
| 29 | "FLAG-LIST := [ FLAG-LIST ] FLAG\n" |
David Ward | 4e9a686 | 2013-02-27 13:00:40 +0000 | [diff] [blame] | 30 | "FLAG := [ reorder_hdr { on | off } ] [ gvrp { on | off } ] [ mvrp { on | off } ]\n" |
Patrick McHardy | 2180b6b | 2009-12-01 01:21:39 +0000 | [diff] [blame] | 31 | " [ loose_binding { on | off } ]\n" |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 32 | "QOS-MAP := [ QOS-MAP ] QOS-MAPPING\n" |
| 33 | "QOS-MAPPING := FROM:TO\n" |
| 34 | ); |
| 35 | } |
| 36 | |
vadimk | 561e650 | 2014-09-30 08:17:31 +0300 | [diff] [blame] | 37 | static void explain(void) |
| 38 | { |
| 39 | print_explain(stderr); |
| 40 | } |
| 41 | |
Kees van Reeuwijk | 14645ec | 2013-02-08 03:32:36 +0000 | [diff] [blame] | 42 | static int on_off(const char *msg, const char *arg) |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 43 | { |
Kees van Reeuwijk | 14645ec | 2013-02-08 03:32:36 +0000 | [diff] [blame] | 44 | fprintf(stderr, "Error: argument of \"%s\" must be \"on\" or \"off\", not \"%s\"\n", msg, arg); |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 45 | return -1; |
| 46 | } |
| 47 | |
| 48 | static int vlan_parse_qos_map(int *argcp, char ***argvp, struct nlmsghdr *n, |
| 49 | int attrtype) |
| 50 | { |
| 51 | int argc = *argcp; |
| 52 | char **argv = *argvp; |
| 53 | struct ifla_vlan_qos_mapping m; |
| 54 | struct rtattr *tail; |
| 55 | |
| 56 | tail = NLMSG_TAIL(n); |
| 57 | addattr_l(n, 1024, attrtype, NULL, 0); |
| 58 | |
| 59 | while (argc > 0) { |
| 60 | char *colon = strchr(*argv, ':'); |
| 61 | |
| 62 | if (!colon) |
| 63 | break; |
| 64 | *colon = '\0'; |
| 65 | |
| 66 | if (get_u32(&m.from, *argv, 0)) |
| 67 | return 1; |
| 68 | if (get_u32(&m.to, colon + 1, 0)) |
| 69 | return 1; |
| 70 | argc--, argv++; |
| 71 | |
| 72 | addattr_l(n, 1024, IFLA_VLAN_QOS_MAPPING, &m, sizeof(m)); |
| 73 | } |
| 74 | |
| 75 | tail->rta_len = (void *) NLMSG_TAIL(n) - (void *)tail; |
| 76 | |
| 77 | *argcp = argc; |
| 78 | *argvp = argv; |
| 79 | return 0; |
| 80 | } |
| 81 | |
| 82 | static int vlan_parse_opt(struct link_util *lu, int argc, char **argv, |
| 83 | struct nlmsghdr *n) |
| 84 | { |
| 85 | struct ifla_vlan_flags flags = { 0 }; |
Patric McHardy | 8fd8f6e | 2013-06-21 08:59:24 -0700 | [diff] [blame] | 86 | __u16 id, proto; |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 87 | |
| 88 | while (argc > 0) { |
Patric McHardy | 8fd8f6e | 2013-06-21 08:59:24 -0700 | [diff] [blame] | 89 | if (matches(*argv, "protocol") == 0) { |
| 90 | NEXT_ARG(); |
| 91 | if (ll_proto_a2n(&proto, *argv)) |
| 92 | invarg("protocol is invalid", *argv); |
| 93 | addattr_l(n, 1024, IFLA_VLAN_PROTOCOL, &proto, 2); |
| 94 | } else if (matches(*argv, "id") == 0) { |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 95 | NEXT_ARG(); |
| 96 | if (get_u16(&id, *argv, 0)) |
| 97 | invarg("id is invalid", *argv); |
| 98 | addattr_l(n, 1024, IFLA_VLAN_ID, &id, 2); |
| 99 | } else if (matches(*argv, "reorder_hdr") == 0) { |
| 100 | NEXT_ARG(); |
| 101 | flags.mask |= VLAN_FLAG_REORDER_HDR; |
| 102 | if (strcmp(*argv, "on") == 0) |
| 103 | flags.flags |= VLAN_FLAG_REORDER_HDR; |
| 104 | else if (strcmp(*argv, "off") == 0) |
| 105 | flags.flags &= ~VLAN_FLAG_REORDER_HDR; |
| 106 | else |
Kees van Reeuwijk | 14645ec | 2013-02-08 03:32:36 +0000 | [diff] [blame] | 107 | return on_off("reorder_hdr", *argv); |
Patrick McHardy | 4742064 | 2008-07-03 19:06:29 +0200 | [diff] [blame] | 108 | } else if (matches(*argv, "gvrp") == 0) { |
| 109 | NEXT_ARG(); |
| 110 | flags.mask |= VLAN_FLAG_GVRP; |
| 111 | if (strcmp(*argv, "on") == 0) |
| 112 | flags.flags |= VLAN_FLAG_GVRP; |
| 113 | else if (strcmp(*argv, "off") == 0) |
| 114 | flags.flags &= ~VLAN_FLAG_GVRP; |
| 115 | else |
Kees van Reeuwijk | 14645ec | 2013-02-08 03:32:36 +0000 | [diff] [blame] | 116 | return on_off("gvrp", *argv); |
David Ward | 4e9a686 | 2013-02-27 13:00:40 +0000 | [diff] [blame] | 117 | } else if (matches(*argv, "mvrp") == 0) { |
| 118 | NEXT_ARG(); |
| 119 | flags.mask |= VLAN_FLAG_MVRP; |
| 120 | if (strcmp(*argv, "on") == 0) |
| 121 | flags.flags |= VLAN_FLAG_MVRP; |
| 122 | else if (strcmp(*argv, "off") == 0) |
| 123 | flags.flags &= ~VLAN_FLAG_MVRP; |
| 124 | else |
| 125 | return on_off("mvrp", *argv); |
Patrick McHardy | 2180b6b | 2009-12-01 01:21:39 +0000 | [diff] [blame] | 126 | } else if (matches(*argv, "loose_binding") == 0) { |
| 127 | NEXT_ARG(); |
| 128 | flags.mask |= VLAN_FLAG_LOOSE_BINDING; |
| 129 | if (strcmp(*argv, "on") == 0) |
| 130 | flags.flags |= VLAN_FLAG_LOOSE_BINDING; |
| 131 | else if (strcmp(*argv, "off") == 0) |
| 132 | flags.flags &= ~VLAN_FLAG_LOOSE_BINDING; |
| 133 | else |
Kees van Reeuwijk | 14645ec | 2013-02-08 03:32:36 +0000 | [diff] [blame] | 134 | return on_off("loose_binding", *argv); |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 135 | } else if (matches(*argv, "ingress-qos-map") == 0) { |
| 136 | NEXT_ARG(); |
| 137 | if (vlan_parse_qos_map(&argc, &argv, n, |
| 138 | IFLA_VLAN_INGRESS_QOS)) |
| 139 | invarg("invalid ingress-qos-map", *argv); |
| 140 | continue; |
| 141 | } else if (matches(*argv, "egress-qos-map") == 0) { |
| 142 | NEXT_ARG(); |
| 143 | if (vlan_parse_qos_map(&argc, &argv, n, |
| 144 | IFLA_VLAN_EGRESS_QOS)) |
| 145 | invarg("invalid egress-qos-map", *argv); |
| 146 | continue; |
| 147 | } else if (matches(*argv, "help") == 0) { |
| 148 | explain(); |
| 149 | return -1; |
| 150 | } else { |
Kees van Reeuwijk | 14645ec | 2013-02-08 03:32:36 +0000 | [diff] [blame] | 151 | fprintf(stderr, "vlan: unknown command \"%s\"?\n", *argv); |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 152 | explain(); |
| 153 | return -1; |
| 154 | } |
| 155 | argc--, argv++; |
| 156 | } |
| 157 | |
| 158 | if (flags.mask) |
| 159 | addattr_l(n, 1024, IFLA_VLAN_FLAGS, &flags, sizeof(flags)); |
| 160 | |
| 161 | return 0; |
| 162 | } |
| 163 | |
| 164 | static void vlan_print_map(FILE *f, char *name, struct rtattr *attr) |
| 165 | { |
| 166 | struct ifla_vlan_qos_mapping *m; |
| 167 | struct rtattr *i; |
| 168 | int rem; |
| 169 | |
| 170 | fprintf(f, "\n %s { ", name); |
| 171 | |
| 172 | rem = RTA_PAYLOAD(attr); |
| 173 | for (i = RTA_DATA(attr); RTA_OK(i, rem); i = RTA_NEXT(i, rem)) { |
| 174 | m = RTA_DATA(i); |
| 175 | fprintf(f, "%u:%u ", m->from, m->to); |
| 176 | } |
| 177 | fprintf(f, "} "); |
| 178 | } |
| 179 | |
| 180 | static void vlan_print_flags(FILE *fp, __u32 flags) |
| 181 | { |
| 182 | fprintf(fp, "<"); |
| 183 | #define _PF(f) if (flags & VLAN_FLAG_##f) { \ |
Stephen Hemminger | 56f5daa | 2016-03-21 11:52:19 -0700 | [diff] [blame] | 184 | flags &= ~VLAN_FLAG_##f; \ |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 185 | fprintf(fp, #f "%s", flags ? "," : ""); \ |
| 186 | } |
| 187 | _PF(REORDER_HDR); |
Patrick McHardy | 4742064 | 2008-07-03 19:06:29 +0200 | [diff] [blame] | 188 | _PF(GVRP); |
David Ward | 4e9a686 | 2013-02-27 13:00:40 +0000 | [diff] [blame] | 189 | _PF(MVRP); |
Patrick McHardy | 2180b6b | 2009-12-01 01:21:39 +0000 | [diff] [blame] | 190 | _PF(LOOSE_BINDING); |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 191 | #undef _PF |
| 192 | if (flags) |
| 193 | fprintf(fp, "%x", flags); |
| 194 | fprintf(fp, "> "); |
| 195 | } |
| 196 | |
| 197 | static void vlan_print_opt(struct link_util *lu, FILE *f, struct rtattr *tb[]) |
| 198 | { |
| 199 | struct ifla_vlan_flags *flags; |
Stephen Hemminger | 56f5daa | 2016-03-21 11:52:19 -0700 | [diff] [blame] | 200 | |
Patric McHardy | 8fd8f6e | 2013-06-21 08:59:24 -0700 | [diff] [blame] | 201 | SPRINT_BUF(b1); |
| 202 | |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 203 | if (!tb) |
| 204 | return; |
| 205 | |
Patric McHardy | 8fd8f6e | 2013-06-21 08:59:24 -0700 | [diff] [blame] | 206 | if (tb[IFLA_VLAN_PROTOCOL] && |
| 207 | RTA_PAYLOAD(tb[IFLA_VLAN_PROTOCOL]) < sizeof(__u16)) |
| 208 | return; |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 209 | if (!tb[IFLA_VLAN_ID] || |
| 210 | RTA_PAYLOAD(tb[IFLA_VLAN_ID]) < sizeof(__u16)) |
| 211 | return; |
| 212 | |
Patric McHardy | 8fd8f6e | 2013-06-21 08:59:24 -0700 | [diff] [blame] | 213 | if (tb[IFLA_VLAN_PROTOCOL]) |
| 214 | fprintf(f, "protocol %s ", |
| 215 | ll_proto_n2a(rta_getattr_u16(tb[IFLA_VLAN_PROTOCOL]), |
| 216 | b1, sizeof(b1))); |
| 217 | else |
| 218 | fprintf(f, "protocol 802.1q "); |
| 219 | |
Stephen Hemminger | ff24746 | 2012-04-10 08:47:55 -0700 | [diff] [blame] | 220 | fprintf(f, "id %u ", rta_getattr_u16(tb[IFLA_VLAN_ID])); |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 221 | |
| 222 | if (tb[IFLA_VLAN_FLAGS]) { |
| 223 | if (RTA_PAYLOAD(tb[IFLA_VLAN_FLAGS]) < sizeof(*flags)) |
| 224 | return; |
| 225 | flags = RTA_DATA(tb[IFLA_VLAN_FLAGS]); |
| 226 | vlan_print_flags(f, flags->flags); |
| 227 | } |
| 228 | if (tb[IFLA_VLAN_INGRESS_QOS]) |
| 229 | vlan_print_map(f, "ingress-qos-map", tb[IFLA_VLAN_INGRESS_QOS]); |
| 230 | if (tb[IFLA_VLAN_EGRESS_QOS]) |
| 231 | vlan_print_map(f, "egress-qos-map", tb[IFLA_VLAN_EGRESS_QOS]); |
| 232 | } |
| 233 | |
vadimk | 561e650 | 2014-09-30 08:17:31 +0300 | [diff] [blame] | 234 | static void vlan_print_help(struct link_util *lu, int argc, char **argv, |
| 235 | FILE *f) |
| 236 | { |
| 237 | print_explain(f); |
| 238 | } |
| 239 | |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 240 | struct link_util vlan_link_util = { |
| 241 | .id = "vlan", |
| 242 | .maxattr = IFLA_VLAN_MAX, |
| 243 | .parse_opt = vlan_parse_opt, |
| 244 | .print_opt = vlan_print_opt, |
vadimk | 561e650 | 2014-09-30 08:17:31 +0300 | [diff] [blame] | 245 | .print_help = vlan_print_help, |
Patrick McHardy | 5c302d5 | 2007-09-01 18:47:19 +0200 | [diff] [blame] | 246 | }; |