2 *------------------------------------------------------------------
3 * Copyright (c) 2017 Cisco and/or its affiliates.
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at:
8 * http://www.apache.org/licenses/LICENSE-2.0
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 *------------------------------------------------------------------
18 #include <sys/types.h>
23 #include <linux/netlink.h>
24 #include <linux/rtnetlink.h>
26 #include <vlib/vlib.h>
27 #include <vlib/unix/unix.h>
28 #include <vnet/devices/netlink.h>
36 vnet_netlink_msg_init (vnet_netlink_msg_t * m, u16 type, u16 flags,
37 void *msg_data, int msg_len)
41 clib_memset (m, 0, sizeof (vnet_netlink_msg_t));
42 vec_add2 (m->data, p, NLMSG_SPACE (msg_len));
43 ASSERT (m->data == p);
45 nh = (struct nlmsghdr *) p;
46 nh->nlmsg_flags = flags | NLM_F_ACK;
47 nh->nlmsg_type = type;
48 clib_memcpy (m->data + sizeof (struct nlmsghdr), msg_data, msg_len);
52 vnet_netlink_msg_add_rtattr (vnet_netlink_msg_t * m, u16 rta_type,
53 void *rta_data, int rta_data_len)
58 vec_add2 (m->data, p, RTA_SPACE (rta_data_len));
59 rta = (struct rtattr *) p;
60 rta->rta_type = rta_type;
61 rta->rta_len = RTA_LENGTH (rta_data_len);
62 clib_memcpy (RTA_DATA (rta), rta_data, rta_data_len);
66 vnet_netlink_msg_send (vnet_netlink_msg_t *m, vnet_netlink_msg_t **replies)
68 clib_error_t *err = 0;
69 struct sockaddr_nl ra = { 0 };
71 struct nlmsghdr *nh = (struct nlmsghdr *) m->data;
72 nh->nlmsg_len = vec_len (m->data);
75 if ((sock = socket (AF_NETLINK, SOCK_RAW, NETLINK_ROUTE)) == -1)
76 return clib_error_return_unix (0, "socket(AF_NETLINK)");
78 ra.nl_family = AF_NETLINK;
81 if ((bind (sock, (struct sockaddr *) &ra, sizeof (ra))) == -1)
83 err = clib_error_return_unix (0, "bind");
87 if ((send (sock, m->data, vec_len (m->data), 0)) == -1)
88 err = clib_error_return_unix (0, "send");
90 if ((len = recv (sock, buf, sizeof (buf), 0)) == -1)
91 err = clib_error_return_unix (0, "recv");
93 for (nh = (struct nlmsghdr *) buf; NLMSG_OK (nh, len);
94 nh = NLMSG_NEXT (nh, len))
96 if (nh->nlmsg_type == NLMSG_DONE)
99 if (nh->nlmsg_type == NLMSG_ERROR)
101 struct nlmsgerr *e = (struct nlmsgerr *) NLMSG_DATA (nh);
103 err = clib_error_return (0, "netlink error %d", e->error);
109 vnet_netlink_msg_t msg = { NULL };
111 vec_add2 (msg.data, p, nh->nlmsg_len);
112 clib_memcpy (p, nh, nh->nlmsg_len);
113 vec_add1 (*replies, msg);
124 vnet_netlink_set_link_name (int ifindex, char *new_ifname)
126 vnet_netlink_msg_t m;
127 struct ifinfomsg ifmsg = { 0 };
128 clib_error_t *err = 0;
130 ifmsg.ifi_index = ifindex;
131 vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
132 &ifmsg, sizeof (struct ifinfomsg));
134 vnet_netlink_msg_add_rtattr (&m, IFLA_IFNAME, new_ifname,
135 strlen (new_ifname) + 1);
137 err = vnet_netlink_msg_send (&m, NULL);
139 err = clib_error_return (0, "set link name %U", format_clib_error, err);
144 vnet_netlink_set_link_netns (int ifindex, int netns_fd, char *new_ifname)
146 vnet_netlink_msg_t m;
147 struct ifinfomsg ifmsg = { 0 };
148 clib_error_t *err = 0;
150 ifmsg.ifi_index = ifindex;
151 vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
152 &ifmsg, sizeof (struct ifinfomsg));
154 vnet_netlink_msg_add_rtattr (&m, IFLA_NET_NS_FD, &netns_fd, sizeof (int));
156 vnet_netlink_msg_add_rtattr (&m, IFLA_IFNAME, new_ifname,
157 strlen (new_ifname) + 1);
159 err = vnet_netlink_msg_send (&m, NULL);
161 err = clib_error_return (0, "set link netns %U", format_clib_error, err);
166 vnet_netlink_set_link_master (int ifindex, char *master_ifname)
168 vnet_netlink_msg_t m;
169 struct ifinfomsg ifmsg = { 0 };
171 clib_error_t *err = 0;
173 ifmsg.ifi_index = ifindex;
175 if ((i = if_nametoindex (master_ifname)) == 0)
176 clib_error_return_unix (0, "unknown master interface '%s'",
179 vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
180 &ifmsg, sizeof (struct ifinfomsg));
181 vnet_netlink_msg_add_rtattr (&m, IFLA_MASTER, &i, sizeof (int));
182 err = vnet_netlink_msg_send (&m, NULL);
184 err = clib_error_return (0, "set link master %U", format_clib_error, err);
189 vnet_netlink_set_link_addr (int ifindex, u8 * mac)
191 vnet_netlink_msg_t m;
192 struct ifinfomsg ifmsg = { 0 };
193 clib_error_t *err = 0;
195 ifmsg.ifi_index = ifindex;
197 vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
198 &ifmsg, sizeof (struct ifinfomsg));
199 vnet_netlink_msg_add_rtattr (&m, IFLA_ADDRESS, mac, 6);
200 err = vnet_netlink_msg_send (&m, NULL);
202 err = clib_error_return (0, "set link addr %U", format_clib_error, err);
207 vnet_netlink_set_link_state (int ifindex, int up)
209 vnet_netlink_msg_t m;
210 struct ifinfomsg ifmsg = { 0 };
211 clib_error_t *err = 0;
213 ifmsg.ifi_flags = ((up) ? IFF_UP : 0);
214 ifmsg.ifi_change = IFF_UP;
215 ifmsg.ifi_index = ifindex;
217 vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
218 &ifmsg, sizeof (struct ifinfomsg));
219 err = vnet_netlink_msg_send (&m, NULL);
221 err = clib_error_return (0, "set link state %U", format_clib_error, err);
226 vnet_netlink_get_link_mtu (int ifindex, u32 *mtu)
228 vnet_netlink_msg_t m, *msg;
229 struct ifinfomsg ifmsg = { 0 };
231 clib_error_t *err = 0;
232 vnet_netlink_msg_t *replies = NULL;
233 int len = 0, offset = 0;
236 ifmsg.ifi_index = ifindex;
238 vnet_netlink_msg_init (&m, RTM_GETLINK, NLM_F_REQUEST, &ifmsg,
239 sizeof (struct ifinfomsg));
240 // vnet_netlink_msg_add_rtattr (&m, IFLA_MTU, &mtu, sizeof (int));
241 err = vnet_netlink_msg_send (&m, &replies);
244 err = clib_error_return (0, "get link mtu %U", format_clib_error, err);
248 if (vec_len (replies) != 1)
250 err = clib_error_return (0, "got %d != 1 netlink reply msg",
255 struct nlmsghdr *nh = (struct nlmsghdr *) replies[0].data;
256 if (nh->nlmsg_type != RTM_NEWLINK)
258 err = clib_error_return (
259 0, "netlink reply has wrong type: %d != RTM_NEWLINK", nh->nlmsg_type);
263 offset = NLMSG_HDRLEN + NLMSG_ALIGN (sizeof (struct ifinfomsg));
264 attr = (struct nlattr *) ((u8 *) nh + offset);
265 len = nh->nlmsg_len - offset;
269 if ((attr->nla_type & NLA_TYPE_MASK) == IFLA_MTU)
271 msg_mtu = *(u32 *) ((u8 *) attr + NLA_HDRLEN);
272 if (attr->nla_type & NLA_F_NET_BYTEORDER)
273 *mtu = clib_net_to_host_u32 (msg_mtu);
278 offset = NLA_ALIGN (attr->nla_len);
280 attr = (struct nlattr *) ((u8 *) attr + offset);
282 while (len > sizeof (struct nlattr));
285 err = clib_error_return (0, "mtu not found in netlink message");
288 vec_foreach (msg, replies)
290 vec_free (msg->data);
298 vnet_netlink_set_link_mtu (int ifindex, int mtu)
300 vnet_netlink_msg_t m;
301 struct ifinfomsg ifmsg = { 0 };
302 clib_error_t *err = 0;
304 ifmsg.ifi_index = ifindex;
306 vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
307 &ifmsg, sizeof (struct ifinfomsg));
308 vnet_netlink_msg_add_rtattr (&m, IFLA_MTU, &mtu, sizeof (int));
309 err = vnet_netlink_msg_send (&m, NULL);
311 err = clib_error_return (0, "set link mtu %U", format_clib_error, err);
316 vnet_netlink_add_ip4_addr (int ifindex, void *addr, int pfx_len)
318 vnet_netlink_msg_t m;
319 struct ifaddrmsg ifa = { 0 };
320 clib_error_t *err = 0;
322 ifa.ifa_family = AF_INET;
323 ifa.ifa_prefixlen = pfx_len;
324 ifa.ifa_index = ifindex;
326 vnet_netlink_msg_init (&m, RTM_NEWADDR,
327 NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE,
328 &ifa, sizeof (struct ifaddrmsg));
330 vnet_netlink_msg_add_rtattr (&m, IFA_LOCAL, addr, 4);
331 vnet_netlink_msg_add_rtattr (&m, IFA_ADDRESS, addr, 4);
332 err = vnet_netlink_msg_send (&m, NULL);
334 err = clib_error_return (0, "add ip4 addr %U", format_clib_error, err);
339 vnet_netlink_add_ip6_addr (int ifindex, void *addr, int pfx_len)
341 vnet_netlink_msg_t m;
342 struct ifaddrmsg ifa = { 0 };
343 clib_error_t *err = 0;
345 ifa.ifa_family = AF_INET6;
346 ifa.ifa_prefixlen = pfx_len;
347 ifa.ifa_index = ifindex;
349 vnet_netlink_msg_init (&m, RTM_NEWADDR,
350 NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE,
351 &ifa, sizeof (struct ifaddrmsg));
353 vnet_netlink_msg_add_rtattr (&m, IFA_LOCAL, addr, 16);
354 vnet_netlink_msg_add_rtattr (&m, IFA_ADDRESS, addr, 16);
355 err = vnet_netlink_msg_send (&m, NULL);
357 err = clib_error_return (0, "add ip6 addr %U", format_clib_error, err);
362 vnet_netlink_add_ip4_route (void *dst, u8 dst_len, void *gw)
364 vnet_netlink_msg_t m;
365 struct rtmsg rtm = { 0 };
367 clib_error_t *err = 0;
369 rtm.rtm_family = AF_INET;
370 rtm.rtm_table = RT_TABLE_MAIN;
371 rtm.rtm_type = RTN_UNICAST;
372 rtm.rtm_dst_len = dst_len;
374 vnet_netlink_msg_init (&m, RTM_NEWROUTE,
375 NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE,
376 &rtm, sizeof (struct rtmsg));
378 vnet_netlink_msg_add_rtattr (&m, RTA_GATEWAY, gw, 4);
379 vnet_netlink_msg_add_rtattr (&m, RTA_DST, dst ? dst : dflt, 4);
380 err = vnet_netlink_msg_send (&m, NULL);
382 err = clib_error_return (0, "add ip4 route %U", format_clib_error, err);
387 vnet_netlink_add_ip6_route (void *dst, u8 dst_len, void *gw)
389 vnet_netlink_msg_t m;
390 struct rtmsg rtm = { 0 };
392 clib_error_t *err = 0;
394 rtm.rtm_family = AF_INET6;
395 rtm.rtm_table = RT_TABLE_MAIN;
396 rtm.rtm_type = RTN_UNICAST;
397 rtm.rtm_dst_len = dst_len;
399 vnet_netlink_msg_init (&m, RTM_NEWROUTE,
400 NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE,
401 &rtm, sizeof (struct rtmsg));
403 vnet_netlink_msg_add_rtattr (&m, RTA_GATEWAY, gw, 16);
404 vnet_netlink_msg_add_rtattr (&m, RTA_DST, dst ? dst : dflt, 16);
405 err = vnet_netlink_msg_send (&m, NULL);
407 err = clib_error_return (0, "add ip6 route %U", format_clib_error, err);
412 vnet_netlink_del_ip4_addr (int ifindex, void *addr, int pfx_len)
414 vnet_netlink_msg_t m;
415 struct ifaddrmsg ifa = { 0 };
416 clib_error_t *err = 0;
418 ifa.ifa_family = AF_INET;
419 ifa.ifa_prefixlen = pfx_len;
420 ifa.ifa_index = ifindex;
422 vnet_netlink_msg_init (&m, RTM_DELADDR, NLM_F_REQUEST, &ifa,
423 sizeof (struct ifaddrmsg));
425 vnet_netlink_msg_add_rtattr (&m, IFA_LOCAL, addr, 4);
426 vnet_netlink_msg_add_rtattr (&m, IFA_ADDRESS, addr, 4);
427 err = vnet_netlink_msg_send (&m, NULL);
429 err = clib_error_return (0, "del ip4 addr %U", format_clib_error, err);
434 vnet_netlink_del_ip6_addr (int ifindex, void *addr, int pfx_len)
436 vnet_netlink_msg_t m;
437 struct ifaddrmsg ifa = { 0 };
438 clib_error_t *err = 0;
440 ifa.ifa_family = AF_INET6;
441 ifa.ifa_prefixlen = pfx_len;
442 ifa.ifa_index = ifindex;
444 vnet_netlink_msg_init (&m, RTM_DELADDR, NLM_F_REQUEST, &ifa,
445 sizeof (struct ifaddrmsg));
447 vnet_netlink_msg_add_rtattr (&m, IFA_LOCAL, addr, 16);
448 vnet_netlink_msg_add_rtattr (&m, IFA_ADDRESS, addr, 16);
449 err = vnet_netlink_msg_send (&m, NULL);
451 err = clib_error_return (0, "del ip6 addr %U", format_clib_error, err);
456 * fd.io coding-style-patch-verification: ON
459 * eval: (c-set-style "gnu")