platform/trivial: move code (nm_rtnl_link_parse_info_data)
This commit is contained in:
@@ -292,6 +292,90 @@ _nl_rtnl_addr_set_prefixlen (struct rtnl_addr *rtnladdr, int plen)
|
||||
|
||||
/******************************************************************/
|
||||
|
||||
/* nm_rtnl_link_parse_info_data(): Re-fetches a link from the kernel
|
||||
* and parses its IFLA_INFO_DATA using a caller-provided parser.
|
||||
*
|
||||
* Code is stolen from rtnl_link_get_kernel(), nl_pickup(), and link_msg_parser().
|
||||
*/
|
||||
|
||||
typedef int (*NMNLInfoDataParser) (struct nlattr *info_data, gpointer parser_data);
|
||||
|
||||
typedef struct {
|
||||
NMNLInfoDataParser parser;
|
||||
gpointer parser_data;
|
||||
} NMNLInfoDataClosure;
|
||||
|
||||
static struct nla_policy info_data_link_policy[IFLA_MAX + 1] = {
|
||||
[IFLA_LINKINFO] = { .type = NLA_NESTED },
|
||||
};
|
||||
|
||||
static struct nla_policy info_data_link_info_policy[IFLA_INFO_MAX + 1] = {
|
||||
[IFLA_INFO_DATA] = { .type = NLA_NESTED },
|
||||
};
|
||||
|
||||
static int
|
||||
info_data_parser (struct nl_msg *msg, void *arg)
|
||||
{
|
||||
NMNLInfoDataClosure *closure = arg;
|
||||
struct nlmsghdr *n = nlmsg_hdr (msg);
|
||||
struct nlattr *tb[IFLA_MAX + 1];
|
||||
struct nlattr *li[IFLA_INFO_MAX + 1];
|
||||
int err;
|
||||
|
||||
if (!nlmsg_valid_hdr (n, sizeof (struct ifinfomsg)))
|
||||
return -NLE_MSG_TOOSHORT;
|
||||
|
||||
err = nlmsg_parse (n, sizeof (struct ifinfomsg), tb, IFLA_MAX, info_data_link_policy);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
if (!tb[IFLA_LINKINFO])
|
||||
return -NLE_MISSING_ATTR;
|
||||
|
||||
err = nla_parse_nested (li, IFLA_INFO_MAX, tb[IFLA_LINKINFO], info_data_link_info_policy);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
if (!li[IFLA_INFO_DATA])
|
||||
return -NLE_MISSING_ATTR;
|
||||
|
||||
return closure->parser (li[IFLA_INFO_DATA], closure->parser_data);
|
||||
}
|
||||
|
||||
static int
|
||||
nm_rtnl_link_parse_info_data (struct nl_sock *sk, int ifindex,
|
||||
NMNLInfoDataParser parser, gpointer parser_data)
|
||||
{
|
||||
NMNLInfoDataClosure data = { .parser = parser, .parser_data = parser_data };
|
||||
struct nl_msg *msg = NULL;
|
||||
struct nl_cb *cb;
|
||||
int err;
|
||||
|
||||
err = rtnl_link_build_get_request (ifindex, NULL, &msg);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
err = nl_send_auto (sk, msg);
|
||||
nlmsg_free (msg);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
cb = nl_cb_clone (nl_socket_get_cb (sk));
|
||||
if (cb == NULL)
|
||||
return -NLE_NOMEM;
|
||||
nl_cb_set (cb, NL_CB_VALID, NL_CB_CUSTOM, info_data_parser, &data);
|
||||
|
||||
err = nl_recvmsgs (sk, cb);
|
||||
nl_cb_put (cb);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
nl_wait_for_ack (sk);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/******************************************************************/
|
||||
|
||||
static int
|
||||
_nl_sock_flush_data (struct nl_sock *sk)
|
||||
{
|
||||
@@ -564,88 +648,6 @@ _nlo_get_object_type (const struct nl_object *object)
|
||||
return OBJECT_TYPE_UNKNOWN;
|
||||
}
|
||||
|
||||
/* nm_rtnl_link_parse_info_data(): Re-fetches a link from the kernel
|
||||
* and parses its IFLA_INFO_DATA using a caller-provided parser.
|
||||
*
|
||||
* Code is stolen from rtnl_link_get_kernel(), nl_pickup(), and link_msg_parser().
|
||||
*/
|
||||
|
||||
typedef int (*NMNLInfoDataParser) (struct nlattr *info_data, gpointer parser_data);
|
||||
|
||||
typedef struct {
|
||||
NMNLInfoDataParser parser;
|
||||
gpointer parser_data;
|
||||
} NMNLInfoDataClosure;
|
||||
|
||||
static struct nla_policy info_data_link_policy[IFLA_MAX + 1] = {
|
||||
[IFLA_LINKINFO] = { .type = NLA_NESTED },
|
||||
};
|
||||
|
||||
static struct nla_policy info_data_link_info_policy[IFLA_INFO_MAX + 1] = {
|
||||
[IFLA_INFO_DATA] = { .type = NLA_NESTED },
|
||||
};
|
||||
|
||||
static int
|
||||
info_data_parser (struct nl_msg *msg, void *arg)
|
||||
{
|
||||
NMNLInfoDataClosure *closure = arg;
|
||||
struct nlmsghdr *n = nlmsg_hdr (msg);
|
||||
struct nlattr *tb[IFLA_MAX + 1];
|
||||
struct nlattr *li[IFLA_INFO_MAX + 1];
|
||||
int err;
|
||||
|
||||
if (!nlmsg_valid_hdr (n, sizeof (struct ifinfomsg)))
|
||||
return -NLE_MSG_TOOSHORT;
|
||||
|
||||
err = nlmsg_parse (n, sizeof (struct ifinfomsg), tb, IFLA_MAX, info_data_link_policy);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
if (!tb[IFLA_LINKINFO])
|
||||
return -NLE_MISSING_ATTR;
|
||||
|
||||
err = nla_parse_nested (li, IFLA_INFO_MAX, tb[IFLA_LINKINFO], info_data_link_info_policy);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
if (!li[IFLA_INFO_DATA])
|
||||
return -NLE_MISSING_ATTR;
|
||||
|
||||
return closure->parser (li[IFLA_INFO_DATA], closure->parser_data);
|
||||
}
|
||||
|
||||
static int
|
||||
nm_rtnl_link_parse_info_data (struct nl_sock *sk, int ifindex,
|
||||
NMNLInfoDataParser parser, gpointer parser_data)
|
||||
{
|
||||
NMNLInfoDataClosure data = { .parser = parser, .parser_data = parser_data };
|
||||
struct nl_msg *msg = NULL;
|
||||
struct nl_cb *cb;
|
||||
int err;
|
||||
|
||||
err = rtnl_link_build_get_request (ifindex, NULL, &msg);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
err = nl_send_auto (sk, msg);
|
||||
nlmsg_free (msg);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
cb = nl_cb_clone (nl_socket_get_cb (sk));
|
||||
if (cb == NULL)
|
||||
return -NLE_NOMEM;
|
||||
nl_cb_set (cb, NL_CB_VALID, NL_CB_CUSTOM, info_data_parser, &data);
|
||||
|
||||
err = nl_recvmsgs (sk, cb);
|
||||
nl_cb_put (cb);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
nl_wait_for_ack (sk);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/******************************************************************/
|
||||
|
||||
static gboolean
|
||||
|
Reference in New Issue
Block a user