ip link: add support for "address ETHADDR". Closes 4862
[oweals/busybox.git] / networking / libiproute / libnetlink.c
index d29d035d0ccaf8a44dfa5804ab4ac260f9f83f48..c7533a4a706bcd5d4b1dcc59608cdd1eb34db6a1 100644 (file)
@@ -1,14 +1,11 @@
 /* vi: set sw=4 ts=4: */
 /*
- * libnetlink.c        RTnetlink service routines.
- *
- *             This program is free software; you can redistribute it and/or
- *             modify it under the terms of the GNU General Public License
- *             as published by the Free Software Foundation; either version
- *             2 of the License, or (at your option) any later version.
- *
- * Authors:    Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version
+ * 2 of the License, or (at your option) any later version.
  *
+ * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
  */
 
 #include <sys/socket.h>
 #include "libbb.h"
 #include "libnetlink.h"
 
-void rtnl_close(struct rtnl_handle *rth)
-{
-       close(rth->fd);
-}
-
-int xrtnl_open(struct rtnl_handle *rth/*, unsigned subscriptions*/)
+void FAST_FUNC xrtnl_open(struct rtnl_handle *rth/*, unsigned subscriptions*/)
 {
        socklen_t addr_len;
 
-       memset(rth, 0, sizeof(rth));
-
+       memset(rth, 0, sizeof(*rth));
        rth->fd = xsocket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
-
-       memset(&rth->local, 0, sizeof(rth->local));
        rth->local.nl_family = AF_NETLINK;
        /*rth->local.nl_groups = subscriptions;*/
 
        xbind(rth->fd, (struct sockaddr*)&rth->local, sizeof(rth->local));
        addr_len = sizeof(rth->local);
+       getsockname(rth->fd, (struct sockaddr*)&rth->local, &addr_len);
+
+/* too much paranoia
        if (getsockname(rth->fd, (struct sockaddr*)&rth->local, &addr_len) < 0)
-               bb_perror_msg_and_die("cannot getsockname");
+               bb_perror_msg_and_die("getsockname");
        if (addr_len != sizeof(rth->local))
                bb_error_msg_and_die("wrong address length %d", addr_len);
        if (rth->local.nl_family != AF_NETLINK)
                bb_error_msg_and_die("wrong address family %d", rth->local.nl_family);
+*/
        rth->seq = time(NULL);
-       return 0;
 }
 
-int xrtnl_wilddump_request(struct rtnl_handle *rth, int family, int type)
+int FAST_FUNC xrtnl_wilddump_request(struct rtnl_handle *rth, int family, int type)
 {
        struct {
                struct nlmsghdr nlh;
                struct rtgenmsg g;
        } req;
-       struct sockaddr_nl nladdr;
-
-       memset(&nladdr, 0, sizeof(nladdr));
-       nladdr.nl_family = AF_NETLINK;
 
        req.nlh.nlmsg_len = sizeof(req);
        req.nlh.nlmsg_type = type;
@@ -64,11 +52,11 @@ int xrtnl_wilddump_request(struct rtnl_handle *rth, int family, int type)
        req.nlh.nlmsg_seq = rth->dump = ++rth->seq;
        req.g.rtgen_family = family;
 
-       return xsendto(rth->fd, (void*)&req, sizeof(req),
-                                (struct sockaddr*)&nladdr, sizeof(nladdr));
+       return rtnl_send(rth, (void*)&req, sizeof(req));
 }
 
-int rtnl_send(struct rtnl_handle *rth, char *buf, int len)
+//TODO: pass rth->fd instead of full rth?
+int FAST_FUNC rtnl_send(struct rtnl_handle *rth, char *buf, int len)
 {
        struct sockaddr_nl nladdr;
 
@@ -78,15 +66,15 @@ int rtnl_send(struct rtnl_handle *rth, char *buf, int len)
        return xsendto(rth->fd, buf, len, (struct sockaddr*)&nladdr, sizeof(nladdr));
 }
 
-int rtnl_dump_request(struct rtnl_handle *rth, int type, void *req, int len)
+int FAST_FUNC rtnl_dump_request(struct rtnl_handle *rth, int type, void *req, int len)
 {
        struct nlmsghdr nlh;
        struct sockaddr_nl nladdr;
        struct iovec iov[2] = { { &nlh, sizeof(nlh) }, { req, len } };
        struct msghdr msg = {
                (void*)&nladdr, sizeof(nladdr),
-               iov,    2,
-               NULL,   0,
+               iov,  2,
+               NULL, 0,
                0
        };
 
@@ -103,7 +91,7 @@ int rtnl_dump_request(struct rtnl_handle *rth, int type, void *req, int len)
 }
 
 static int rtnl_dump_filter(struct rtnl_handle *rth,
-               int (*filter)(struct sockaddr_nl *, struct nlmsghdr *n, void *),
+               int (*filter)(const struct sockaddr_nl *, struct nlmsghdr *n, void *) FAST_FUNC,
                void *arg1/*,
                int (*junk)(struct sockaddr_nl *, struct nlmsghdr *n, void *),
                void *arg2*/)
@@ -119,8 +107,8 @@ static int rtnl_dump_filter(struct rtnl_handle *rth,
 
                struct msghdr msg = {
                        (void*)&nladdr, sizeof(nladdr),
-                       &iov,   1,
-                       NULL,   0,
+                       &iov, 1,
+                       NULL, 0,
                        0
                };
 
@@ -146,7 +134,8 @@ static int rtnl_dump_filter(struct rtnl_handle *rth,
 
                        if (nladdr.nl_pid != 0 ||
                            h->nlmsg_pid != rth->local.nl_pid ||
-                           h->nlmsg_seq != rth->dump) {
+                           h->nlmsg_seq != rth->dump
+                       ) {
 //                             if (junk) {
 //                                     err = junk(&nladdr, h, arg2);
 //                                     if (err < 0) {
@@ -194,8 +183,8 @@ static int rtnl_dump_filter(struct rtnl_handle *rth,
        return retval;
 }
 
-int xrtnl_dump_filter(struct rtnl_handle *rth,
-               int (*filter)(struct sockaddr_nl *, struct nlmsghdr *n, void *),
+int FAST_FUNC xrtnl_dump_filter(struct rtnl_handle *rth,
+               int (*filter)(const struct sockaddr_nl *, struct nlmsghdr *, void *) FAST_FUNC,
                void *arg1)
 {
        int ret = rtnl_dump_filter(rth, filter, arg1/*, NULL, NULL*/);
@@ -204,11 +193,11 @@ int xrtnl_dump_filter(struct rtnl_handle *rth,
        return ret;
 }
 
-int rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n,
-             pid_t peer, unsigned groups,
-             struct nlmsghdr *answer,
-             int (*junk)(struct sockaddr_nl *, struct nlmsghdr *n, void *),
-             void *jarg)
+int FAST_FUNC rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n,
+               pid_t peer, unsigned groups,
+               struct nlmsghdr *answer,
+               int (*junk)(struct sockaddr_nl *, struct nlmsghdr *, void *),
+               void *jarg)
 {
 /* bbox doesn't use parameters no. 3, 4, 6, 7, they are stubbed out */
 #define peer   0
@@ -224,8 +213,8 @@ int rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n,
        char   *buf = xmalloc(8*1024); /* avoid big stack buffer */
        struct msghdr msg = {
                (void*)&nladdr, sizeof(nladdr),
-               &iov,   1,
-               NULL,   0,
+               &iov, 1,
+               NULL, 0,
                0
        };
 
@@ -241,7 +230,7 @@ int rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n,
        status = sendmsg(rtnl->fd, &msg, 0);
 
        if (status < 0) {
-               bb_perror_msg("cannot talk to rtnetlink");
+               bb_perror_msg("can't talk to rtnetlink");
                goto ret;
        }
 
@@ -265,7 +254,7 @@ int rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n,
                if (msg.msg_namelen != sizeof(nladdr)) {
                        bb_error_msg_and_die("sender address length == %d", msg.msg_namelen);
                }
-               for (h = (struct nlmsghdr*)buf; status >= sizeof(*h); ) {
+               for (h = (struct nlmsghdr*)buf; status >= (int)sizeof(*h); ) {
 //                     int l_err;
                        int len = h->nlmsg_len;
                        int l = len - sizeof(*h);
@@ -280,7 +269,8 @@ int rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n,
 
                        if (nladdr.nl_pid != peer ||
                            h->nlmsg_pid != rtnl->local.nl_pid ||
-                           h->nlmsg_seq != seq) {
+                           h->nlmsg_seq != seq
+                       ) {
 //                             if (junk) {
 //                                     l_err = junk(&nladdr, h, jarg);
 //                                     if (l_err < 0) {
@@ -293,7 +283,7 @@ int rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n,
 
                        if (h->nlmsg_type == NLMSG_ERROR) {
                                struct nlmsgerr *err = (struct nlmsgerr*)NLMSG_DATA(h);
-                               if (l < sizeof(struct nlmsgerr)) {
+                               if (l < (int)sizeof(struct nlmsgerr)) {
                                        bb_error_msg("ERROR truncated");
                                } else {
                                        errno = - err->error;
@@ -332,27 +322,30 @@ int rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n,
        return retval;
 }
 
-int addattr32(struct nlmsghdr *n, int maxlen, int type, uint32_t data)
+int FAST_FUNC addattr32(struct nlmsghdr *n, int maxlen, int type, uint32_t data)
 {
        int len = RTA_LENGTH(4);
        struct rtattr *rta;
-       if (NLMSG_ALIGN(n->nlmsg_len) + len > maxlen)
+
+       if ((int)(NLMSG_ALIGN(n->nlmsg_len) + len) > maxlen) {
                return -1;
+       }
        rta = (struct rtattr*)(((char*)n) + NLMSG_ALIGN(n->nlmsg_len));
        rta->rta_type = type;
        rta->rta_len = len;
-       memcpy(RTA_DATA(rta), &data, 4);
+       move_to_unaligned32(RTA_DATA(rta), data);
        n->nlmsg_len = NLMSG_ALIGN(n->nlmsg_len) + len;
        return 0;
 }
 
-int addattr_l(struct nlmsghdr *n, int maxlen, int type, void *data, int alen)
+int FAST_FUNC addattr_l(struct nlmsghdr *n, int maxlen, int type, void *data, int alen)
 {
        int len = RTA_LENGTH(alen);
        struct rtattr *rta;
 
-       if (NLMSG_ALIGN(n->nlmsg_len) + len > maxlen)
+       if ((int)(NLMSG_ALIGN(n->nlmsg_len) + len) > maxlen) {
                return -1;
+       }
        rta = (struct rtattr*)(((char*)n) + NLMSG_ALIGN(n->nlmsg_len));
        rta->rta_type = type;
        rta->rta_len = len;
@@ -361,7 +354,7 @@ int addattr_l(struct nlmsghdr *n, int maxlen, int type, void *data, int alen)
        return 0;
 }
 
-int rta_addattr32(struct rtattr *rta, int maxlen, int type, uint32_t data)
+int FAST_FUNC rta_addattr32(struct rtattr *rta, int maxlen, int type, uint32_t data)
 {
        int len = RTA_LENGTH(4);
        struct rtattr *subrta;
@@ -372,12 +365,12 @@ int rta_addattr32(struct rtattr *rta, int maxlen, int type, uint32_t data)
        subrta = (struct rtattr*)(((char*)rta) + RTA_ALIGN(rta->rta_len));
        subrta->rta_type = type;
        subrta->rta_len = len;
-       memcpy(RTA_DATA(subrta), &data, 4);
+       move_to_unaligned32(RTA_DATA(subrta), data);
        rta->rta_len = NLMSG_ALIGN(rta->rta_len) + len;
        return 0;
 }
 
-int rta_addattr_l(struct rtattr *rta, int maxlen, int type, void *data, int alen)
+int FAST_FUNC rta_addattr_l(struct rtattr *rta, int maxlen, int type, void *data, int alen)
 {
        struct rtattr *subrta;
        int len = RTA_LENGTH(alen);
@@ -394,16 +387,15 @@ int rta_addattr_l(struct rtattr *rta, int maxlen, int type, void *data, int alen
 }
 
 
-int parse_rtattr(struct rtattr *tb[], int max, struct rtattr *rta, int len)
+void FAST_FUNC parse_rtattr(struct rtattr *tb[], int max, struct rtattr *rta, int len)
 {
        while (RTA_OK(rta, len)) {
                if (rta->rta_type <= max) {
                        tb[rta->rta_type] = rta;
                }
-               rta = RTA_NEXT(rta,len);
+               rta = RTA_NEXT(rta, len);
        }
        if (len) {
                bb_error_msg("deficit %d, rta_len=%d!", len, rta->rta_len);
        }
-       return 0;
 }