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