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 (at) 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 21 static void print_explain(FILE *f) 22 { 23 fprintf(f, 24 "Usage: ... vlan [ protocol VLANPROTO ] id VLANID" 25 " [ FLAG-LIST ]\n" 26 " [ ingress-qos-map QOS-MAP ] [ egress-qos-map QOS-MAP ]\n" 27 "\n" 28 "VLANPROTO: [ 802.1Q / 802.1ad ]\n" 29 "VLANID := 0-4095\n" 30 "FLAG-LIST := [ FLAG-LIST ] FLAG\n" 31 "FLAG := [ reorder_hdr { on | off } ] [ gvrp { on | off } ] [ mvrp { on | off } ]\n" 32 " [ loose_binding { on | off } ]\n" 33 "QOS-MAP := [ QOS-MAP ] QOS-MAPPING\n" 34 "QOS-MAPPING := FROM:TO\n" 35 ); 36 } 37 38 static void explain(void) 39 { 40 print_explain(stderr); 41 } 42 43 static int on_off(const char *msg, const char *arg) 44 { 45 fprintf(stderr, "Error: argument of \"%s\" must be \"on\" or \"off\", not \"%s\"\n", msg, arg); 46 return -1; 47 } 48 49 static int vlan_parse_qos_map(int *argcp, char ***argvp, struct nlmsghdr *n, 50 int attrtype) 51 { 52 int argc = *argcp; 53 char **argv = *argvp; 54 struct ifla_vlan_qos_mapping m; 55 struct rtattr *tail; 56 57 tail = NLMSG_TAIL(n); 58 addattr_l(n, 1024, attrtype, NULL, 0); 59 60 while (argc > 0) { 61 char *colon = strchr(*argv, ':'); 62 63 if (!colon) 64 break; 65 *colon = '\0'; 66 67 if (get_u32(&m.from, *argv, 0)) 68 return 1; 69 if (get_u32(&m.to, colon + 1, 0)) 70 return 1; 71 argc--, argv++; 72 73 addattr_l(n, 1024, IFLA_VLAN_QOS_MAPPING, &m, sizeof(m)); 74 } 75 76 tail->rta_len = (void *) NLMSG_TAIL(n) - (void *)tail; 77 78 *argcp = argc; 79 *argvp = argv; 80 return 0; 81 } 82 83 static int vlan_parse_opt(struct link_util *lu, int argc, char **argv, 84 struct nlmsghdr *n) 85 { 86 struct ifla_vlan_flags flags = { 0 }; 87 __u16 id, proto; 88 89 while (argc > 0) { 90 if (matches(*argv, "protocol") == 0) { 91 NEXT_ARG(); 92 if (ll_proto_a2n(&proto, *argv)) 93 invarg("protocol is invalid", *argv); 94 addattr_l(n, 1024, IFLA_VLAN_PROTOCOL, &proto, 2); 95 } else if (matches(*argv, "id") == 0) { 96 NEXT_ARG(); 97 if (get_u16(&id, *argv, 0)) 98 invarg("id is invalid", *argv); 99 addattr_l(n, 1024, IFLA_VLAN_ID, &id, 2); 100 } else if (matches(*argv, "reorder_hdr") == 0) { 101 NEXT_ARG(); 102 flags.mask |= VLAN_FLAG_REORDER_HDR; 103 if (strcmp(*argv, "on") == 0) 104 flags.flags |= VLAN_FLAG_REORDER_HDR; 105 else if (strcmp(*argv, "off") == 0) 106 flags.flags &= ~VLAN_FLAG_REORDER_HDR; 107 else 108 return on_off("reorder_hdr", *argv); 109 } else if (matches(*argv, "gvrp") == 0) { 110 NEXT_ARG(); 111 flags.mask |= VLAN_FLAG_GVRP; 112 if (strcmp(*argv, "on") == 0) 113 flags.flags |= VLAN_FLAG_GVRP; 114 else if (strcmp(*argv, "off") == 0) 115 flags.flags &= ~VLAN_FLAG_GVRP; 116 else 117 return on_off("gvrp", *argv); 118 } else if (matches(*argv, "mvrp") == 0) { 119 NEXT_ARG(); 120 flags.mask |= VLAN_FLAG_MVRP; 121 if (strcmp(*argv, "on") == 0) 122 flags.flags |= VLAN_FLAG_MVRP; 123 else if (strcmp(*argv, "off") == 0) 124 flags.flags &= ~VLAN_FLAG_MVRP; 125 else 126 return on_off("mvrp", *argv); 127 } else if (matches(*argv, "loose_binding") == 0) { 128 NEXT_ARG(); 129 flags.mask |= VLAN_FLAG_LOOSE_BINDING; 130 if (strcmp(*argv, "on") == 0) 131 flags.flags |= VLAN_FLAG_LOOSE_BINDING; 132 else if (strcmp(*argv, "off") == 0) 133 flags.flags &= ~VLAN_FLAG_LOOSE_BINDING; 134 else 135 return on_off("loose_binding", *argv); 136 } else if (matches(*argv, "ingress-qos-map") == 0) { 137 NEXT_ARG(); 138 if (vlan_parse_qos_map(&argc, &argv, n, 139 IFLA_VLAN_INGRESS_QOS)) 140 invarg("invalid ingress-qos-map", *argv); 141 continue; 142 } else if (matches(*argv, "egress-qos-map") == 0) { 143 NEXT_ARG(); 144 if (vlan_parse_qos_map(&argc, &argv, n, 145 IFLA_VLAN_EGRESS_QOS)) 146 invarg("invalid egress-qos-map", *argv); 147 continue; 148 } else if (matches(*argv, "help") == 0) { 149 explain(); 150 return -1; 151 } else { 152 fprintf(stderr, "vlan: unknown command \"%s\"?\n", *argv); 153 explain(); 154 return -1; 155 } 156 argc--, argv++; 157 } 158 159 if (flags.mask) 160 addattr_l(n, 1024, IFLA_VLAN_FLAGS, &flags, sizeof(flags)); 161 162 return 0; 163 } 164 165 static void vlan_print_map(FILE *f, char *name, struct rtattr *attr) 166 { 167 struct ifla_vlan_qos_mapping *m; 168 struct rtattr *i; 169 int rem; 170 171 fprintf(f, "\n %s { ", name); 172 173 rem = RTA_PAYLOAD(attr); 174 for (i = RTA_DATA(attr); RTA_OK(i, rem); i = RTA_NEXT(i, rem)) { 175 m = RTA_DATA(i); 176 fprintf(f, "%u:%u ", m->from, m->to); 177 } 178 fprintf(f, "} "); 179 } 180 181 static void vlan_print_flags(FILE *fp, __u32 flags) 182 { 183 fprintf(fp, "<"); 184 #define _PF(f) if (flags & VLAN_FLAG_##f) { \ 185 flags &= ~ VLAN_FLAG_##f; \ 186 fprintf(fp, #f "%s", flags ? "," : ""); \ 187 } 188 _PF(REORDER_HDR); 189 _PF(GVRP); 190 _PF(MVRP); 191 _PF(LOOSE_BINDING); 192 #undef _PF 193 if (flags) 194 fprintf(fp, "%x", flags); 195 fprintf(fp, "> "); 196 } 197 198 static void vlan_print_opt(struct link_util *lu, FILE *f, struct rtattr *tb[]) 199 { 200 struct ifla_vlan_flags *flags; 201 SPRINT_BUF(b1); 202 203 if (!tb) 204 return; 205 206 if (tb[IFLA_VLAN_PROTOCOL] && 207 RTA_PAYLOAD(tb[IFLA_VLAN_PROTOCOL]) < sizeof(__u16)) 208 return; 209 if (!tb[IFLA_VLAN_ID] || 210 RTA_PAYLOAD(tb[IFLA_VLAN_ID]) < sizeof(__u16)) 211 return; 212 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 220 fprintf(f, "id %u ", rta_getattr_u16(tb[IFLA_VLAN_ID])); 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 234 static void vlan_print_help(struct link_util *lu, int argc, char **argv, 235 FILE *f) 236 { 237 print_explain(f); 238 } 239 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, 245 .print_help = vlan_print_help, 246 }; 247
