Blame tipc/msg.c

Packit Service 3880ab
/*
Packit Service 3880ab
 * msg.c	Messaging (netlink) helper functions.
Packit Service 3880ab
 *
Packit Service 3880ab
 *		This program is free software; you can redistribute it and/or
Packit Service 3880ab
 *		modify it under the terms of the GNU General Public License
Packit Service 3880ab
 *		as published by the Free Software Foundation; either version
Packit Service 3880ab
 *		2 of the License, or (at your option) any later version.
Packit Service 3880ab
 *
Packit Service 3880ab
 * Authors:	Richard Alpe <richard.alpe@ericsson.com>
Packit Service 3880ab
 */
Packit Service 3880ab
Packit Service 3880ab
#include <stdio.h>
Packit Service 3880ab
#include <time.h>
Packit Service 3880ab
#include <errno.h>
Packit Service 3880ab
Packit Service 3880ab
#include <linux/tipc_netlink.h>
Packit Service 3880ab
#include <linux/tipc.h>
Packit Service 3880ab
#include <linux/genetlink.h>
Packit Service 3880ab
#include <libmnl/libmnl.h>
Packit Service 3880ab
Packit Service 3880ab
#include "msg.h"
Packit Service 3880ab
Packit Service 3880ab
int parse_attrs(const struct nlattr *attr, void *data)
Packit Service 3880ab
{
Packit Service 3880ab
	const struct nlattr **tb = data;
Packit Service 3880ab
	int type = mnl_attr_get_type(attr);
Packit Service 3880ab
Packit Service 3880ab
	tb[type] = attr;
Packit Service 3880ab
Packit Service 3880ab
	return MNL_CB_OK;
Packit Service 3880ab
}
Packit Service 3880ab
Packit Service 3880ab
static int family_id_cb(const struct nlmsghdr *nlh, void *data)
Packit Service 3880ab
{
Packit Service 3880ab
	struct nlattr *tb[CTRL_ATTR_MAX + 1] = {};
Packit Service 3880ab
	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
Packit Service 3880ab
	int *id = data;
Packit Service 3880ab
Packit Service 3880ab
	mnl_attr_parse(nlh, sizeof(*genl), parse_attrs, tb);
Packit Service 3880ab
	if (!tb[CTRL_ATTR_FAMILY_ID])
Packit Service 3880ab
		return MNL_CB_ERROR;
Packit Service 3880ab
Packit Service 3880ab
	*id = mnl_attr_get_u16(tb[CTRL_ATTR_FAMILY_ID]);
Packit Service 3880ab
Packit Service 3880ab
	return MNL_CB_OK;
Packit Service 3880ab
}
Packit Service 3880ab
Packit Service 3880ab
static struct mnl_socket *msg_send(struct nlmsghdr *nlh)
Packit Service 3880ab
{
Packit Service 3880ab
	int ret;
Packit Service 3880ab
	struct mnl_socket *nl;
Packit Service 3880ab
Packit Service 3880ab
	nl = mnl_socket_open(NETLINK_GENERIC);
Packit Service 3880ab
	if (nl == NULL) {
Packit Service 3880ab
		perror("mnl_socket_open");
Packit Service 3880ab
		return NULL;
Packit Service 3880ab
	}
Packit Service 3880ab
Packit Service 3880ab
	ret = mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID);
Packit Service 3880ab
	if (ret < 0) {
Packit Service 3880ab
		perror("mnl_socket_bind");
Packit Service 3880ab
		return NULL;
Packit Service 3880ab
	}
Packit Service 3880ab
Packit Service 3880ab
	ret = mnl_socket_sendto(nl, nlh, nlh->nlmsg_len);
Packit Service 3880ab
	if (ret < 0) {
Packit Service 3880ab
		perror("mnl_socket_send");
Packit Service 3880ab
		return NULL;
Packit Service 3880ab
	}
Packit Service 3880ab
Packit Service 3880ab
	return nl;
Packit Service 3880ab
}
Packit Service 3880ab
Packit Service 3880ab
static int msg_recv(struct mnl_socket *nl, mnl_cb_t callback, void *data, int seq)
Packit Service 3880ab
{
Packit Service 3880ab
	int ret;
Packit Service 3880ab
	unsigned int portid;
Packit Service 3880ab
	char buf[MNL_SOCKET_BUFFER_SIZE];
Packit Service 3880ab
Packit Service 3880ab
	portid = mnl_socket_get_portid(nl);
Packit Service 3880ab
Packit Service 3880ab
	ret = mnl_socket_recvfrom(nl, buf, sizeof(buf));
Packit Service 3880ab
	while (ret > 0) {
Packit Service 3880ab
		ret = mnl_cb_run(buf, ret, seq, portid, callback, data);
Packit Service 3880ab
		if (ret <= 0)
Packit Service 3880ab
			break;
Packit Service 3880ab
		ret = mnl_socket_recvfrom(nl, buf, sizeof(buf));
Packit Service 3880ab
	}
Packit Service 3880ab
	if (ret == -1)
Packit Service 3880ab
		perror("error");
Packit Service 3880ab
Packit Service 3880ab
	mnl_socket_close(nl);
Packit Service 3880ab
Packit Service 3880ab
	return ret;
Packit Service 3880ab
}
Packit Service 3880ab
Packit Service 3880ab
static int msg_query(struct nlmsghdr *nlh, mnl_cb_t callback, void *data)
Packit Service 3880ab
{
Packit Service 3880ab
	unsigned int seq;
Packit Service 3880ab
	struct mnl_socket *nl;
Packit Service 3880ab
Packit Service 3880ab
	seq = time(NULL);
Packit Service 3880ab
	nlh->nlmsg_seq = seq;
Packit Service 3880ab
Packit Service 3880ab
	nl = msg_send(nlh);
Packit Service 3880ab
	if (!nl)
Packit Service 3880ab
		return -ENOTSUP;
Packit Service 3880ab
Packit Service 3880ab
	return msg_recv(nl, callback, data, seq);
Packit Service 3880ab
}
Packit Service 3880ab
Packit Service 3880ab
static int get_family(void)
Packit Service 3880ab
{
Packit Service 3880ab
	int err;
Packit Service 3880ab
	int nl_family;
Packit Service 3880ab
	struct nlmsghdr *nlh;
Packit Service 3880ab
	struct genlmsghdr *genl;
Packit Service 3880ab
	char buf[MNL_SOCKET_BUFFER_SIZE];
Packit Service 3880ab
Packit Service 3880ab
	nlh = mnl_nlmsg_put_header(buf);
Packit Service 3880ab
	nlh->nlmsg_type	= GENL_ID_CTRL;
Packit Service 3880ab
	nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK;
Packit Service 3880ab
Packit Service 3880ab
	genl = mnl_nlmsg_put_extra_header(nlh, sizeof(struct genlmsghdr));
Packit Service 3880ab
	genl->cmd = CTRL_CMD_GETFAMILY;
Packit Service 3880ab
	genl->version = 1;
Packit Service 3880ab
Packit Service 3880ab
	mnl_attr_put_u16(nlh, CTRL_ATTR_FAMILY_ID, GENL_ID_CTRL);
Packit Service 3880ab
	mnl_attr_put_strz(nlh, CTRL_ATTR_FAMILY_NAME, TIPC_GENL_V2_NAME);
Packit Service 3880ab
Packit Service 3880ab
	if ((err = msg_query(nlh, family_id_cb, &nl_family)))
Packit Service 3880ab
		return err;
Packit Service 3880ab
Packit Service 3880ab
	return nl_family;
Packit Service 3880ab
}
Packit Service 3880ab
Packit Service 3880ab
int msg_doit(struct nlmsghdr *nlh, mnl_cb_t callback, void *data)
Packit Service 3880ab
{
Packit Service 3880ab
	nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK;
Packit Service 3880ab
	return msg_query(nlh, callback, data);
Packit Service 3880ab
}
Packit Service 3880ab
Packit Service 3880ab
int msg_dumpit(struct nlmsghdr *nlh, mnl_cb_t callback, void *data)
Packit Service 3880ab
{
Packit Service 3880ab
	nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
Packit Service 3880ab
	return msg_query(nlh, callback, data);
Packit Service 3880ab
}
Packit Service 3880ab
Packit Service 3880ab
struct nlmsghdr *msg_init(char *buf, int cmd)
Packit Service 3880ab
{
Packit Service 3880ab
	int family;
Packit Service 3880ab
	struct nlmsghdr *nlh;
Packit Service 3880ab
	struct genlmsghdr *genl;
Packit Service 3880ab
Packit Service 3880ab
	family = get_family();
Packit Service 3880ab
	if (family <= 0) {
Packit Service 3880ab
		fprintf(stderr,
Packit Service 3880ab
			"Unable to get TIPC nl family id (module loaded?)\n");
Packit Service 3880ab
		return NULL;
Packit Service 3880ab
	}
Packit Service 3880ab
Packit Service 3880ab
	nlh = mnl_nlmsg_put_header(buf);
Packit Service 3880ab
	nlh->nlmsg_type	= family;
Packit Service 3880ab
Packit Service 3880ab
	genl = mnl_nlmsg_put_extra_header(nlh, sizeof(struct genlmsghdr));
Packit Service 3880ab
	genl->cmd = cmd;
Packit Service 3880ab
	genl->version = 1;
Packit Service 3880ab
Packit Service 3880ab
	return nlh;
Packit Service 3880ab
}