#include <sys/stat.h>
#include <fcntl.h>
#include <net/if.h>
-#include <linux/if_tun.h>
-#include <sys/ioctl.h>
-#include <linux/virtio_net.h>
-#include <linux/vhost.h>
-#include <sys/eventfd.h>
#include <linux/netlink.h>
#include <linux/rtnetlink.h>
#include <vlib/vlib.h>
#include <vlib/unix/unix.h>
+#include <vnet/devices/netlink.h>
-clib_error_t *
-vnet_netlink_set_if_attr (int ifindex, unsigned short rta_type, void *data,
- int data_len)
+typedef struct
+{
+ u8 *data;
+} vnet_netlink_msg_t;
+
+static void
+vnet_netlink_msg_init (vnet_netlink_msg_t * m, u16 type, u16 flags,
+ void *msg_data, int msg_len)
+{
+ struct nlmsghdr *nh;
+ u8 *p;
+ clib_memset (m, 0, sizeof (vnet_netlink_msg_t));
+ vec_add2 (m->data, p, NLMSG_SPACE (msg_len));
+ ASSERT (m->data == p);
+
+ nh = (struct nlmsghdr *) p;
+ nh->nlmsg_flags = flags | NLM_F_ACK;
+ nh->nlmsg_type = type;
+ clib_memcpy (m->data + sizeof (struct nlmsghdr), msg_data, msg_len);
+}
+
+static void
+vnet_netlink_msg_add_rtattr (vnet_netlink_msg_t * m, u16 rta_type,
+ void *rta_data, int rta_data_len)
+{
+ struct rtattr *rta;
+ u8 *p;
+
+ vec_add2 (m->data, p, RTA_SPACE (rta_data_len));
+ rta = (struct rtattr *) p;
+ rta->rta_type = rta_type;
+ rta->rta_len = RTA_LENGTH (rta_data_len);
+ clib_memcpy (RTA_DATA (rta), rta_data, rta_data_len);
+}
+
+static clib_error_t *
+vnet_netlink_msg_send (vnet_netlink_msg_t * m)
{
clib_error_t *err = 0;
- int sock;
struct sockaddr_nl ra = { 0 };
- struct
- {
- struct nlmsghdr nh;
- struct ifinfomsg ifmsg;
- char attrbuf[512];
- } req;
- struct rtattr *rta;
+ int len, sock;
+ struct nlmsghdr *nh = (struct nlmsghdr *) m->data;
+ nh->nlmsg_len = vec_len (m->data);
+ char buf[4096];
- memset (&req, 0, sizeof (req));
if ((sock = socket (AF_NETLINK, SOCK_RAW, NETLINK_ROUTE)) == -1)
- {
- err = clib_error_return_unix (0, "socket(AF_NETLINK)");
- goto error;
- }
+ return clib_error_return_unix (0, "socket(AF_NETLINK)");
ra.nl_family = AF_NETLINK;
- ra.nl_pid = getpid ();
+ ra.nl_pid = 0;
if ((bind (sock, (struct sockaddr *) &ra, sizeof (ra))) == -1)
- return clib_error_return_unix (0, "bind");
-
- req.nh.nlmsg_len = NLMSG_LENGTH (sizeof (struct ifinfomsg));
- req.nh.nlmsg_flags = NLM_F_REQUEST;
- req.nh.nlmsg_type = RTM_SETLINK;
- req.ifmsg.ifi_family = AF_UNSPEC;
- req.ifmsg.ifi_index = ifindex;
- req.ifmsg.ifi_change = 0xffffffff;
- rta = (struct rtattr *) (((char *) &req) + NLMSG_ALIGN (req.nh.nlmsg_len));
- rta->rta_type = rta_type;
- rta->rta_len = RTA_LENGTH (data_len);
- req.nh.nlmsg_len = NLMSG_ALIGN (req.nh.nlmsg_len) + RTA_LENGTH (data_len);
- memcpy (RTA_DATA (rta), data, data_len);
+ {
+ err = clib_error_return_unix (0, "bind");
+ goto done;
+ }
- if ((send (sock, &req, req.nh.nlmsg_len, 0)) == -1)
+ if ((send (sock, m->data, vec_len (m->data), 0)) == -1)
err = clib_error_return_unix (0, "send");
-error:
+ if ((len = recv (sock, buf, sizeof (buf), 0)) == -1)
+ err = clib_error_return_unix (0, "recv");
+
+ for (nh = (struct nlmsghdr *) buf; NLMSG_OK (nh, len);
+ nh = NLMSG_NEXT (nh, len))
+ {
+ if (nh->nlmsg_type == NLMSG_DONE)
+ goto done;
+
+ if (nh->nlmsg_type == NLMSG_ERROR)
+ {
+ struct nlmsgerr *e = (struct nlmsgerr *) NLMSG_DATA (nh);
+ if (e->error)
+ err = clib_error_return (0, "netlink error %d", e->error);
+ goto done;
+ }
+ }
+
+done:
+ close (sock);
+ vec_free (m->data);
+ return err;
+}
+
+clib_error_t *
+vnet_netlink_set_link_name (int ifindex, char *new_ifname)
+{
+ vnet_netlink_msg_t m;
+ struct ifinfomsg ifmsg = { 0 };
+ clib_error_t *err = 0;
+
+ ifmsg.ifi_index = ifindex;
+ vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
+ &ifmsg, sizeof (struct ifinfomsg));
+
+ vnet_netlink_msg_add_rtattr (&m, IFLA_IFNAME, new_ifname,
+ strlen (new_ifname) + 1);
+
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "set link name %U", format_clib_error, err);
+ return err;
+}
+
+clib_error_t *
+vnet_netlink_set_link_netns (int ifindex, int netns_fd, char *new_ifname)
+{
+ vnet_netlink_msg_t m;
+ struct ifinfomsg ifmsg = { 0 };
+ clib_error_t *err = 0;
+
+ ifmsg.ifi_index = ifindex;
+ vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
+ &ifmsg, sizeof (struct ifinfomsg));
+
+ vnet_netlink_msg_add_rtattr (&m, IFLA_NET_NS_FD, &netns_fd, sizeof (int));
+ if (new_ifname)
+ vnet_netlink_msg_add_rtattr (&m, IFLA_IFNAME, new_ifname,
+ strlen (new_ifname) + 1);
+
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "set link netns %U", format_clib_error, err);
+ return err;
+}
+
+clib_error_t *
+vnet_netlink_set_link_master (int ifindex, char *master_ifname)
+{
+ vnet_netlink_msg_t m;
+ struct ifinfomsg ifmsg = { 0 };
+ int i;
+ clib_error_t *err = 0;
+
+ ifmsg.ifi_index = ifindex;
+
+ if ((i = if_nametoindex (master_ifname)) == 0)
+ clib_error_return_unix (0, "unknown master interface '%s'",
+ master_ifname);
+
+ vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
+ &ifmsg, sizeof (struct ifinfomsg));
+ vnet_netlink_msg_add_rtattr (&m, IFLA_MASTER, &i, sizeof (int));
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "set link master %U", format_clib_error, err);
+ return err;
+}
+
+clib_error_t *
+vnet_netlink_set_link_addr (int ifindex, u8 * mac)
+{
+ vnet_netlink_msg_t m;
+ struct ifinfomsg ifmsg = { 0 };
+ clib_error_t *err = 0;
+
+ ifmsg.ifi_index = ifindex;
+
+ vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
+ &ifmsg, sizeof (struct ifinfomsg));
+ vnet_netlink_msg_add_rtattr (&m, IFLA_ADDRESS, mac, 6);
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "set link addr %U", format_clib_error, err);
+ return err;
+}
+
+clib_error_t *
+vnet_netlink_set_link_state (int ifindex, int up)
+{
+ vnet_netlink_msg_t m;
+ struct ifinfomsg ifmsg = { 0 };
+ clib_error_t *err = 0;
+
+ ifmsg.ifi_flags = IFF_UP;
+ ifmsg.ifi_change = IFF_UP;
+ ifmsg.ifi_index = ifindex;
+
+ vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
+ &ifmsg, sizeof (struct ifinfomsg));
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "set link state %U", format_clib_error, err);
+ return err;
+}
+
+clib_error_t *
+vnet_netlink_set_link_mtu (int ifindex, int mtu)
+{
+ vnet_netlink_msg_t m;
+ struct ifinfomsg ifmsg = { 0 };
+ clib_error_t *err = 0;
+
+ ifmsg.ifi_index = ifindex;
+
+ vnet_netlink_msg_init (&m, RTM_SETLINK, NLM_F_REQUEST,
+ &ifmsg, sizeof (struct ifinfomsg));
+ vnet_netlink_msg_add_rtattr (&m, IFLA_MTU, &mtu, sizeof (int));
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "set link mtu %U", format_clib_error, err);
return err;
}
clib_error_t *
-vnet_netlink_set_if_mtu (int ifindex, int mtu)
+vnet_netlink_add_ip4_addr (int ifindex, void *addr, int pfx_len)
{
- clib_error_t *err;
+ vnet_netlink_msg_t m;
+ struct ifaddrmsg ifa = { 0 };
+ clib_error_t *err = 0;
+
+ ifa.ifa_family = AF_INET;
+ ifa.ifa_prefixlen = pfx_len;
+ ifa.ifa_index = ifindex;
- err = vnet_netlink_set_if_attr (ifindex, IFLA_MTU, &mtu, sizeof (int));
+ vnet_netlink_msg_init (&m, RTM_NEWADDR,
+ NLM_F_REQUEST | NLM_F_REPLACE,
+ &ifa, sizeof (struct ifaddrmsg));
+
+ vnet_netlink_msg_add_rtattr (&m, IFA_LOCAL, addr, 4);
+ vnet_netlink_msg_add_rtattr (&m, IFA_ADDRESS, addr, 4);
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "add ip4 addr %U", format_clib_error, err);
return err;
}
clib_error_t *
-vnet_netlink_set_if_namespace (int ifindex, char *net_ns)
+vnet_netlink_add_ip6_addr (int ifindex, void *addr, int pfx_len)
{
- clib_error_t *err;
- int ns_fd;
- u8 *s;
- s = format (0, "/var/run/netns/%s%c", net_ns, 0);
- ns_fd = open ((char *) s, O_RDONLY);
- vec_free (s);
- if (ns_fd == -1)
- return clib_error_return (0, "namespace '%s' doesn't exist", net_ns);
-
- err =
- vnet_netlink_set_if_attr (ifindex, IFLA_NET_NS_FD, &ns_fd, sizeof (int));
- close (ns_fd);
+ vnet_netlink_msg_t m;
+ struct ifaddrmsg ifa = { 0 };
+ clib_error_t *err = 0;
+
+ ifa.ifa_family = AF_INET6;
+ ifa.ifa_prefixlen = pfx_len;
+ ifa.ifa_index = ifindex;
+
+ vnet_netlink_msg_init (&m, RTM_NEWADDR,
+ NLM_F_REQUEST | NLM_F_REPLACE,
+ &ifa, sizeof (struct ifaddrmsg));
+
+ vnet_netlink_msg_add_rtattr (&m, IFA_LOCAL, addr, 16);
+ vnet_netlink_msg_add_rtattr (&m, IFA_ADDRESS, addr, 16);
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "add ip6 addr %U", format_clib_error, err);
+ return err;
+}
+
+clib_error_t *
+vnet_netlink_add_ip4_route (void *dst, u8 dst_len, void *gw)
+{
+ vnet_netlink_msg_t m;
+ struct rtmsg rtm = { 0 };
+ u8 dflt[4] = { 0 };
+ clib_error_t *err = 0;
+
+ rtm.rtm_family = AF_INET;
+ rtm.rtm_table = RT_TABLE_MAIN;
+ rtm.rtm_type = RTN_UNICAST;
+ rtm.rtm_dst_len = dst_len;
+
+ vnet_netlink_msg_init (&m, RTM_NEWROUTE,
+ NLM_F_REQUEST | NLM_F_REPLACE,
+ &rtm, sizeof (struct rtmsg));
+
+ vnet_netlink_msg_add_rtattr (&m, RTA_GATEWAY, gw, 4);
+ vnet_netlink_msg_add_rtattr (&m, RTA_DST, dst ? dst : dflt, 4);
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "add ip4 route %U", format_clib_error, err);
+ return err;
+}
+
+clib_error_t *
+vnet_netlink_add_ip6_route (void *dst, u8 dst_len, void *gw)
+{
+ vnet_netlink_msg_t m;
+ struct rtmsg rtm = { 0 };
+ u8 dflt[16] = { 0 };
+ clib_error_t *err = 0;
+
+ rtm.rtm_family = AF_INET6;
+ rtm.rtm_table = RT_TABLE_MAIN;
+ rtm.rtm_type = RTN_UNICAST;
+ rtm.rtm_dst_len = dst_len;
+
+ vnet_netlink_msg_init (&m, RTM_NEWROUTE,
+ NLM_F_REQUEST | NLM_F_REPLACE,
+ &rtm, sizeof (struct rtmsg));
+
+ vnet_netlink_msg_add_rtattr (&m, RTA_GATEWAY, gw, 16);
+ vnet_netlink_msg_add_rtattr (&m, RTA_DST, dst ? dst : dflt, 16);
+ err = vnet_netlink_msg_send (&m);
+ if (err)
+ err = clib_error_return (0, "add ip6 route %U", format_clib_error, err);
return err;
}
Code Review / vpp.git / blobdiff