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