Branch data Line data Source code
1 : : /* SPDX-License-Identifier: LGPL-2.1+ */
2 : : /***
3 : : Copyright © 2016 BISDN GmbH. All rights reserved.
4 : : ***/
5 : :
6 : : #include <netinet/in.h>
7 : : #include <linux/if_bridge.h>
8 : : #include <stdbool.h>
9 : :
10 : : #include "alloc-util.h"
11 : : #include "conf-parser.h"
12 : : #include "netlink-util.h"
13 : : #include "networkd-brvlan.h"
14 : : #include "networkd-link.h"
15 : : #include "networkd-manager.h"
16 : : #include "networkd-network.h"
17 : : #include "parse-util.h"
18 : : #include "vlan-util.h"
19 : :
20 : 0 : static bool is_bit_set(unsigned bit, uint32_t scope) {
21 [ # # ]: 0 : assert(bit < sizeof(scope)*8);
22 : 0 : return scope & (UINT32_C(1) << bit);
23 : : }
24 : :
25 : 0 : static void set_bit(unsigned nr, uint32_t *addr) {
26 [ # # ]: 0 : if (nr < BRIDGE_VLAN_BITMAP_MAX)
27 : 0 : addr[nr / 32] |= (UINT32_C(1) << (nr % 32));
28 : 0 : }
29 : :
30 : 0 : static int find_next_bit(int i, uint32_t x) {
31 : : int j;
32 : :
33 [ # # ]: 0 : if (i >= 32)
34 : 0 : return -1;
35 : :
36 : : /* find first bit */
37 [ # # ]: 0 : if (i < 0)
38 : 0 : return BUILTIN_FFS_U32(x);
39 : :
40 : : /* mask off prior finds to get next */
41 : 0 : j = __builtin_ffs(x >> i);
42 [ # # ]: 0 : return j ? j + i : 0;
43 : : }
44 : :
45 : 0 : static int append_vlan_info_data(Link *const link, sd_netlink_message *req, uint16_t pvid, const uint32_t *br_vid_bitmap, const uint32_t *br_untagged_bitmap) {
46 : : struct bridge_vlan_info br_vlan;
47 : : int i, j, k, r, cnt;
48 : : uint16_t begin, end;
49 : 0 : bool done, untagged = false;
50 : :
51 [ # # ]: 0 : assert(link);
52 [ # # ]: 0 : assert(req);
53 [ # # ]: 0 : assert(br_vid_bitmap);
54 [ # # ]: 0 : assert(br_untagged_bitmap);
55 : :
56 : 0 : cnt = 0;
57 : :
58 : 0 : begin = end = UINT16_MAX;
59 [ # # ]: 0 : for (k = 0; k < BRIDGE_VLAN_BITMAP_LEN; k++) {
60 : : unsigned base_bit;
61 : 0 : uint32_t vid_map = br_vid_bitmap[k];
62 : 0 : uint32_t untagged_map = br_untagged_bitmap[k];
63 : :
64 : 0 : base_bit = k * 32;
65 : 0 : i = -1;
66 : 0 : done = false;
67 : : do {
68 : 0 : j = find_next_bit(i, vid_map);
69 [ # # ]: 0 : if (j > 0) {
70 : : /* first hit of any bit */
71 [ # # # # ]: 0 : if (begin == UINT16_MAX && end == UINT16_MAX) {
72 : 0 : begin = end = j - 1 + base_bit;
73 : 0 : untagged = is_bit_set(j - 1, untagged_map);
74 : 0 : goto next;
75 : : }
76 : :
77 : : /* this bit is a continuation of prior bits */
78 [ # # # # : 0 : if (j - 2 + base_bit == end && untagged == is_bit_set(j - 1, untagged_map) && (uint16_t)j - 1 + base_bit != pvid && (uint16_t)begin != pvid) {
# # # # ]
79 : 0 : end++;
80 : 0 : goto next;
81 : : }
82 : : } else
83 : 0 : done = true;
84 : :
85 [ # # ]: 0 : if (begin != UINT16_MAX) {
86 : 0 : cnt++;
87 [ # # # # ]: 0 : if (done && k < BRIDGE_VLAN_BITMAP_LEN - 1)
88 : 0 : break;
89 : :
90 : 0 : br_vlan.flags = 0;
91 [ # # ]: 0 : if (untagged)
92 : 0 : br_vlan.flags |= BRIDGE_VLAN_INFO_UNTAGGED;
93 : :
94 [ # # ]: 0 : if (begin == end) {
95 : 0 : br_vlan.vid = begin;
96 : :
97 [ # # ]: 0 : if (begin == pvid)
98 : 0 : br_vlan.flags |= BRIDGE_VLAN_INFO_PVID;
99 : :
100 : 0 : r = sd_netlink_message_append_data(req, IFLA_BRIDGE_VLAN_INFO, &br_vlan, sizeof(br_vlan));
101 [ # # ]: 0 : if (r < 0)
102 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not append IFLA_BRIDGE_VLAN_INFO attribute: %m");
103 : : } else {
104 : 0 : br_vlan.vid = begin;
105 : 0 : br_vlan.flags |= BRIDGE_VLAN_INFO_RANGE_BEGIN;
106 : :
107 : 0 : r = sd_netlink_message_append_data(req, IFLA_BRIDGE_VLAN_INFO, &br_vlan, sizeof(br_vlan));
108 [ # # ]: 0 : if (r < 0)
109 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not append IFLA_BRIDGE_VLAN_INFO attribute: %m");
110 : :
111 : 0 : br_vlan.vid = end;
112 : 0 : br_vlan.flags &= ~BRIDGE_VLAN_INFO_RANGE_BEGIN;
113 : 0 : br_vlan.flags |= BRIDGE_VLAN_INFO_RANGE_END;
114 : :
115 : 0 : r = sd_netlink_message_append_data(req, IFLA_BRIDGE_VLAN_INFO, &br_vlan, sizeof(br_vlan));
116 [ # # ]: 0 : if (r < 0)
117 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not append IFLA_BRIDGE_VLAN_INFO attribute: %m");
118 : : }
119 : :
120 [ # # ]: 0 : if (done)
121 : 0 : break;
122 : : }
123 [ # # ]: 0 : if (j > 0) {
124 : 0 : begin = end = j - 1 + base_bit;
125 : 0 : untagged = is_bit_set(j - 1, untagged_map);
126 : : }
127 : :
128 : 0 : next:
129 : 0 : i = j;
130 [ # # ]: 0 : } while (!done);
131 : : }
132 : :
133 [ # # ]: 0 : assert(cnt > 0);
134 : 0 : return cnt;
135 : : }
136 : :
137 : 0 : static int set_brvlan_handler(sd_netlink *rtnl, sd_netlink_message *m, Link *link) {
138 : : int r;
139 : :
140 [ # # ]: 0 : assert(link);
141 : :
142 : 0 : r = sd_netlink_message_get_errno(m);
143 [ # # # # ]: 0 : if (r < 0 && r != -EEXIST)
144 [ # # # # ]: 0 : log_link_error_errno(link, r, "Could not add VLAN to bridge port: %m");
145 : :
146 : 0 : return 1;
147 : : }
148 : :
149 : 0 : int br_vlan_configure(Link *link, uint16_t pvid, uint32_t *br_vid_bitmap, uint32_t *br_untagged_bitmap) {
150 : 0 : _cleanup_(sd_netlink_message_unrefp) sd_netlink_message *req = NULL;
151 : : sd_netlink *rtnl;
152 : : uint16_t flags;
153 : : int r;
154 : :
155 [ # # ]: 0 : assert(link);
156 [ # # ]: 0 : assert(link->manager);
157 [ # # ]: 0 : assert(br_vid_bitmap);
158 [ # # ]: 0 : assert(br_untagged_bitmap);
159 [ # # ]: 0 : assert(link->network);
160 : :
161 : : /* pvid might not be in br_vid_bitmap yet */
162 [ # # ]: 0 : if (pvid)
163 : 0 : set_bit(pvid, br_vid_bitmap);
164 : :
165 : 0 : rtnl = link->manager->rtnl;
166 : :
167 : : /* create new RTM message */
168 : 0 : r = sd_rtnl_message_new_link(rtnl, &req, RTM_SETLINK, link->ifindex);
169 [ # # ]: 0 : if (r < 0)
170 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not allocate RTM_SETLINK message: %m");
171 : :
172 : 0 : r = sd_rtnl_message_link_set_family(req, PF_BRIDGE);
173 [ # # ]: 0 : if (r < 0)
174 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not set message family: %m");
175 : :
176 : 0 : r = sd_netlink_message_open_container(req, IFLA_AF_SPEC);
177 [ # # ]: 0 : if (r < 0)
178 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not open IFLA_AF_SPEC container: %m");
179 : :
180 : : /* master needs flag self */
181 [ # # ]: 0 : if (!link->network->bridge) {
182 : 0 : flags = BRIDGE_FLAGS_SELF;
183 : 0 : sd_netlink_message_append_data(req, IFLA_BRIDGE_FLAGS, &flags, sizeof(uint16_t));
184 : : }
185 : :
186 : : /* add vlan info */
187 : 0 : r = append_vlan_info_data(link, req, pvid, br_vid_bitmap, br_untagged_bitmap);
188 [ # # ]: 0 : if (r < 0)
189 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not append VLANs: %m");
190 : :
191 : 0 : r = sd_netlink_message_close_container(req);
192 [ # # ]: 0 : if (r < 0)
193 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not close IFLA_AF_SPEC container: %m");
194 : :
195 : : /* send message to the kernel */
196 : 0 : r = netlink_call_async(rtnl, NULL, req, set_brvlan_handler,
197 : : link_netlink_destroy_callback, link);
198 [ # # ]: 0 : if (r < 0)
199 [ # # # # ]: 0 : return log_link_error_errno(link, r, "Could not send rtnetlink message: %m");
200 : :
201 : 0 : link_ref(link);
202 : :
203 : 0 : return 0;
204 : : }
205 : :
206 : 0 : int config_parse_brvlan_pvid(const char *unit, const char *filename,
207 : : unsigned line, const char *section,
208 : : unsigned section_line, const char *lvalue,
209 : : int ltype, const char *rvalue, void *data,
210 : : void *userdata) {
211 : 0 : Network *network = userdata;
212 : : uint16_t pvid;
213 : : int r;
214 : :
215 : 0 : r = parse_vlanid(rvalue, &pvid);
216 [ # # ]: 0 : if (r < 0)
217 : 0 : return r;
218 : :
219 : 0 : network->pvid = pvid;
220 : 0 : network->use_br_vlan = true;
221 : :
222 : 0 : return 0;
223 : : }
224 : :
225 : 0 : int config_parse_brvlan_vlan(const char *unit, const char *filename,
226 : : unsigned line, const char *section,
227 : : unsigned section_line, const char *lvalue,
228 : : int ltype, const char *rvalue, void *data,
229 : : void *userdata) {
230 : 0 : Network *network = userdata;
231 : : uint16_t vid, vid_end;
232 : : int r;
233 : :
234 [ # # ]: 0 : assert(filename);
235 [ # # ]: 0 : assert(section);
236 [ # # ]: 0 : assert(lvalue);
237 [ # # ]: 0 : assert(rvalue);
238 [ # # ]: 0 : assert(data);
239 : :
240 : 0 : r = parse_vid_range(rvalue, &vid, &vid_end);
241 [ # # ]: 0 : if (r < 0) {
242 [ # # ]: 0 : log_syntax(unit, LOG_ERR, filename, line, r, "Failed to parse VLAN, ignoring: %s", rvalue);
243 : 0 : return 0;
244 : : }
245 : :
246 [ # # ]: 0 : for (; vid <= vid_end; vid++)
247 : 0 : set_bit(vid, network->br_vid_bitmap);
248 : :
249 : 0 : network->use_br_vlan = true;
250 : 0 : return 0;
251 : : }
252 : :
253 : 0 : int config_parse_brvlan_untagged(const char *unit, const char *filename,
254 : : unsigned line, const char *section,
255 : : unsigned section_line, const char *lvalue,
256 : : int ltype, const char *rvalue, void *data,
257 : : void *userdata) {
258 : 0 : Network *network = userdata;
259 : : int r;
260 : : uint16_t vid, vid_end;
261 : :
262 [ # # ]: 0 : assert(filename);
263 [ # # ]: 0 : assert(section);
264 [ # # ]: 0 : assert(lvalue);
265 [ # # ]: 0 : assert(rvalue);
266 [ # # ]: 0 : assert(data);
267 : :
268 : 0 : r = parse_vid_range(rvalue, &vid, &vid_end);
269 [ # # ]: 0 : if (r < 0) {
270 [ # # ]: 0 : log_syntax(unit, LOG_ERR, filename, line, r, "Could not parse VLAN: %s", rvalue);
271 : 0 : return 0;
272 : : }
273 : :
274 [ # # ]: 0 : for (; vid <= vid_end; vid++) {
275 : 0 : set_bit(vid, network->br_vid_bitmap);
276 : 0 : set_bit(vid, network->br_untagged_bitmap);
277 : : }
278 : :
279 : 0 : network->use_br_vlan = true;
280 : 0 : return 0;
281 : : }
|
