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);
276 clib_warning ("mtu: %d", *mtu);
279 offset = NLA_ALIGN (attr->nla_len);
281 attr = (struct nlattr *) ((u8 *) attr + offset);
283 while (len > sizeof (struct nlattr));
286 err = clib_error_return (0, "mtu not found in netlink message");
289 vec_foreach (msg, replies)
291 vec_free (msg->data);
299 vnet_netlink_set_link_mtu (int ifindex, int mtu)
301 vnet_netlink_msg_t m;
302 struct ifinfomsg ifmsg = { 0 };
303 clib_error_t *err = 0;
305 ifmsg.ifi_index = ifindex;
307 vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
308 &ifmsg, sizeof (struct ifinfomsg));
309 vnet_netlink_msg_add_rtattr (&m, IFLA_MTU, &mtu, sizeof (int));
310 err = vnet_netlink_msg_send (&m, NULL);
312 err = clib_error_return (0, "set link mtu %U", format_clib_error, err);
317 vnet_netlink_add_ip4_addr (int ifindex, void *addr, int pfx_len)
319 vnet_netlink_msg_t m;
320 struct ifaddrmsg ifa = { 0 };
321 clib_error_t *err = 0;
323 ifa.ifa_family = AF_INET;
324 ifa.ifa_prefixlen = pfx_len;
325 ifa.ifa_index = ifindex;
327 vnet_netlink_msg_init (&m, RTM_NEWADDR,
328 NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE,
329 &ifa, sizeof (struct ifaddrmsg));
331 vnet_netlink_msg_add_rtattr (&m, IFA_LOCAL, addr, 4);
332 vnet_netlink_msg_add_rtattr (&m, IFA_ADDRESS, addr, 4);
333 err = vnet_netlink_msg_send (&m, NULL);
335 err = clib_error_return (0, "add ip4 addr %U", format_clib_error, err);
340 vnet_netlink_add_ip6_addr (int ifindex, void *addr, int pfx_len)
342 vnet_netlink_msg_t m;
343 struct ifaddrmsg ifa = { 0 };
344 clib_error_t *err = 0;
346 ifa.ifa_family = AF_INET6;
347 ifa.ifa_prefixlen = pfx_len;
348 ifa.ifa_index = ifindex;
350 vnet_netlink_msg_init (&m, RTM_NEWADDR,
351 NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE,
352 &ifa, sizeof (struct ifaddrmsg));
354 vnet_netlink_msg_add_rtattr (&m, IFA_LOCAL, addr, 16);
355 vnet_netlink_msg_add_rtattr (&m, IFA_ADDRESS, addr, 16);
356 err = vnet_netlink_msg_send (&m, NULL);
358 err = clib_error_return (0, "add ip6 addr %U", format_clib_error, err);
363 vnet_netlink_add_ip4_route (void *dst, u8 dst_len, void *gw)
365 vnet_netlink_msg_t m;
366 struct rtmsg rtm = { 0 };
368 clib_error_t *err = 0;
370 rtm.rtm_family = AF_INET;
371 rtm.rtm_table = RT_TABLE_MAIN;
372 rtm.rtm_type = RTN_UNICAST;
373 rtm.rtm_dst_len = dst_len;
375 vnet_netlink_msg_init (&m, RTM_NEWROUTE,
376 NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE,
377 &rtm, sizeof (struct rtmsg));
379 vnet_netlink_msg_add_rtattr (&m, RTA_GATEWAY, gw, 4);
380 vnet_netlink_msg_add_rtattr (&m, RTA_DST, dst ? dst : dflt, 4);
381 err = vnet_netlink_msg_send (&m, NULL);
383 err = clib_error_return (0, "add ip4 route %U", format_clib_error, err);
388 vnet_netlink_add_ip6_route (void *dst, u8 dst_len, void *gw)
390 vnet_netlink_msg_t m;
391 struct rtmsg rtm = { 0 };
393 clib_error_t *err = 0;
395 rtm.rtm_family = AF_INET6;
396 rtm.rtm_table = RT_TABLE_MAIN;
397 rtm.rtm_type = RTN_UNICAST;
398 rtm.rtm_dst_len = dst_len;
400 vnet_netlink_msg_init (&m, RTM_NEWROUTE,
401 NLM_F_REQUEST | NLM_F_CREATE | NLM_F_REPLACE,
402 &rtm, sizeof (struct rtmsg));
404 vnet_netlink_msg_add_rtattr (&m, RTA_GATEWAY, gw, 16);
405 vnet_netlink_msg_add_rtattr (&m, RTA_DST, dst ? dst : dflt, 16);
406 err = vnet_netlink_msg_send (&m, NULL);
408 err = clib_error_return (0, "add ip6 route %U", format_clib_error, err);
413 * fd.io coding-style-patch-verification: ON
416 * eval: (c-set-style "gnu")