Blob Blame History Raw
// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (C) 2018 Red Hat, Inc.
 */

#ifndef __NM_NETLINK_H__
#define __NM_NETLINK_H__

#include <linux/netlink.h>
#include <linux/rtnetlink.h>
#include <linux/genetlink.h>

#include "nm-std-aux/unaligned.h"

/*****************************************************************************/

#define NLMSGERR_ATTR_UNUSED            0
#define NLMSGERR_ATTR_MSG               1
#define NLMSGERR_ATTR_OFFS              2
#define NLMSGERR_ATTR_COOKIE            3
#define NLMSGERR_ATTR_MAX               3

#ifndef NLM_F_ACK_TLVS
#define NLM_F_ACK_TLVS                  0x200
#endif

/*****************************************************************************/

/* Basic attribute data types */
enum {
	NLA_UNSPEC,     /* Unspecified type, binary data chunk */
	NLA_U8,         /* 8 bit integer */
	NLA_U16,        /* 16 bit integer */
	NLA_U32,        /* 32 bit integer */
	NLA_U64,        /* 64 bit integer */
	NLA_STRING,     /* NUL terminated character string */
	NLA_FLAG,       /* Flag */
	NLA_MSECS,      /* Micro seconds (64bit) */
	NLA_NESTED,     /* Nested attributes */
	NLA_NESTED_COMPAT,
	NLA_NUL_STRING,
	NLA_BINARY,
	NLA_S8,
	NLA_S16,
	NLA_S32,
	NLA_S64,
	__NLA_TYPE_MAX,
};

#define NLA_TYPE_MAX (__NLA_TYPE_MAX - 1)

struct nl_msg;

/*****************************************************************************/

const char *nl_nlmsgtype2str (int type, char *buf, size_t size);

const char *nl_nlmsg_flags2str (int flags, char *buf, size_t len);

const char *nl_nlmsghdr_to_str (const struct nlmsghdr *hdr, char *buf, gsize len);

/*****************************************************************************/

struct nla_policy {
	/* Type of attribute or NLA_UNSPEC */
	uint16_t type;

	/* Minimal length of payload required */
	uint16_t minlen;

	/* Maximal length of payload allowed */
	uint16_t maxlen;
};

/*****************************************************************************/

/* static asserts that @tb and @policy are suitable arguments to nla_parse(). */
#define _nl_static_assert_tb(tb, policy) \
	G_STMT_START { \
		G_STATIC_ASSERT_EXPR (G_N_ELEMENTS (tb) > 0); \
		\
		/* We allow @policy to be either a C array or NULL. The sizeof()
		 * must either match the expected array size or the sizeof(NULL),
		 * but not both. */ \
		G_STATIC_ASSERT_EXPR (  (sizeof (policy) == G_N_ELEMENTS (tb) * sizeof (struct nla_policy)) \
		                      ^ (sizeof (policy) == sizeof (NULL))); \
	} G_STMT_END

/*****************************************************************************/

static inline int
nla_attr_size (int payload)
{
	nm_assert (payload >= 0);

	return NLA_HDRLEN + payload;
}

static inline int
nla_total_size (int payload)
{
	return NLA_ALIGN (nla_attr_size (payload));
}

static inline int
nla_padlen (int payload)
{
	return nla_total_size (payload) - nla_attr_size (payload);
}

struct nlattr *nla_reserve (struct nl_msg *msg, int attrtype, int attrlen);

static inline int
nla_len (const struct nlattr *nla)
{
	nm_assert (nla);
	nm_assert (nla->nla_len >= NLA_HDRLEN);

	return ((int) nla->nla_len) - NLA_HDRLEN;
}

static inline int
nla_type (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= 0);

	return nla->nla_type & NLA_TYPE_MASK;
}

static inline void *
nla_data (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= 0);

	return &(((char *) nla)[NLA_HDRLEN]);
}

#define nla_data_as(type, nla) \
	({ \
		const struct nlattr *_nla = (nla); \
		\
		nm_assert (nla_len (_nla) >= sizeof (type)); \
		\
		/* note that casting the pointer is undefined behavior in C, if
		 * the data has wrong alignment. Netlink data is aligned to 4 bytes,
		 * that means, if the alignment is larger than 4, this is invalid. */ \
		G_STATIC_ASSERT_EXPR (_nm_alignof (type) <= NLA_ALIGNTO); \
		\
		(type *) nla_data (_nla); \
	})

static inline uint8_t
nla_get_u8 (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= sizeof (uint8_t));

	return *((const uint8_t *) nla_data (nla));
}

static inline int8_t
nla_get_s8 (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= sizeof (int8_t));

	return *((const int8_t *) nla_data (nla));
}

static inline uint8_t
nla_get_u8_cond (/*const*/ struct nlattr *const*tb, int attr, uint8_t default_val)
{
	nm_assert (tb);
	nm_assert (attr >= 0);

	return tb[attr] ? nla_get_u8 (tb[attr]) : default_val;
}

static inline uint16_t
nla_get_u16 (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= sizeof (uint16_t));

	return *((const uint16_t *) nla_data (nla));
}

static inline uint32_t
nla_get_u32 (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= sizeof (uint32_t));

	return *((const uint32_t *) nla_data (nla));
}

static inline int32_t
nla_get_s32 (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= sizeof (int32_t));

	return *((const int32_t *) nla_data (nla));
}

static inline uint64_t
nla_get_u64 (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= sizeof (uint64_t));

	return unaligned_read_ne64 (nla_data (nla));
}

static inline uint64_t
nla_get_be64 (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= sizeof (uint64_t));

	return unaligned_read_be64 (nla_data (nla));
}

static inline char *
nla_get_string (const struct nlattr *nla)
{
	nm_assert (nla_len (nla) >= 0);

	return (char *) nla_data (nla);
}

size_t nla_strlcpy (char *dst, const struct nlattr *nla, size_t dstsize);

size_t nla_memcpy (void *dst, const struct nlattr *nla, size_t dstsize);

#define nla_memcpy_checked_size(dst, nla, dstsize) \
	G_STMT_START { \
		void *const _dst = (dst); \
		const struct nlattr *const _nla = (nla); \
		const size_t _dstsize = (dstsize); \
		size_t _srcsize; \
		\
		/* assert that, if @nla is given, that it has the exact expected
		 * size. This implies that the caller previously verified the length
		 * of the attribute (via minlen/maxlen at nla_parse()). */ \
		\
		if (_nla) { \
			_srcsize = nla_memcpy (_dst, _nla, _dstsize); \
			nm_assert (_srcsize == _dstsize); \
		} \
	} G_STMT_END

int nla_put (struct nl_msg *msg, int attrtype, int datalen, const void *data);

static inline int
nla_put_string (struct nl_msg *msg, int attrtype, const char *str)
{
	nm_assert (str);

	return nla_put (msg, attrtype, strlen (str) + 1, str);
}

static inline int
nla_put_uint8 (struct nl_msg *msg, int attrtype, uint8_t val)
{
	return nla_put (msg, attrtype, sizeof (val), &val);
}

static inline int
nla_put_uint16 (struct nl_msg *msg, int attrtype, uint16_t val)
{
	return nla_put (msg, attrtype, sizeof (val), &val);
}

static inline int
nla_put_uint32 (struct nl_msg *msg, int attrtype, uint32_t val)
{
	return nla_put (msg, attrtype, sizeof (val), &val);
}

#define NLA_PUT(msg, attrtype, attrlen, data) \
	G_STMT_START { \
		if (nla_put (msg, attrtype, attrlen, data) < 0) \
			goto nla_put_failure; \
	} G_STMT_END

#define NLA_PUT_TYPE(msg, type, attrtype, value) \
	G_STMT_START { \
		type __nla_tmp = value; \
		NLA_PUT (msg, attrtype, sizeof (type), &__nla_tmp); \
	} G_STMT_END

#define NLA_PUT_U8(msg, attrtype, value) \
	NLA_PUT_TYPE (msg, uint8_t, attrtype, value)

#define NLA_PUT_S8(msg, attrtype, value) \
	NLA_PUT_TYPE (msg, int8_t, attrtype, value)

#define NLA_PUT_U16(msg, attrtype, value) \
	NLA_PUT_TYPE (msg, uint16_t, attrtype, value)

#define NLA_PUT_U32(msg, attrtype, value) \
	NLA_PUT_TYPE (msg, uint32_t, attrtype, value)

#define NLA_PUT_S32(msg, attrtype, value) \
	NLA_PUT_TYPE (msg, int32_t, attrtype, value)

#define NLA_PUT_U64(msg, attrtype, value) \
	NLA_PUT_TYPE (msg, uint64_t, attrtype, value)

#define NLA_PUT_STRING(msg, attrtype, value) \
	NLA_PUT (msg, attrtype, (int) strlen (value) + 1, value)

#define NLA_PUT_FLAG(msg, attrtype) \
	NLA_PUT (msg, attrtype, 0, NULL)

struct nlattr *nla_find (const struct nlattr *head, int len, int attrtype);

static inline int
nla_ok (const struct nlattr *nla, int remaining)
{
	return remaining >= (int) sizeof (*nla) &&
	       nla->nla_len >= sizeof (*nla) &&
	       nla->nla_len <= remaining;
}

static inline struct nlattr *
nla_next (const struct nlattr *nla, int *remaining)
{
	int totlen = NLA_ALIGN (nla->nla_len);

	*remaining -= totlen;
	return (struct nlattr *) ((char *) nla + totlen);
}

#define nla_for_each_attr(pos, head, len, rem) \
	for (pos = head, rem = len; \
	     nla_ok (pos, rem); \
	     pos = nla_next (pos, &(rem)))

#define nla_for_each_nested(pos, nla, rem) \
	for (pos = (struct nlattr *) nla_data (nla), rem = nla_len (nla); \
	     nla_ok (pos, rem); \
	     pos = nla_next (pos, &(rem)))

void nla_nest_cancel (struct nl_msg *msg, const struct nlattr *attr);
struct nlattr *nla_nest_start (struct nl_msg *msg, int attrtype);
int nla_nest_end (struct nl_msg *msg, struct nlattr *start);

int nla_parse (struct nlattr *tb[],
               int maxtype,
               struct nlattr *head,
               int len,
               const struct nla_policy *policy);

#define nla_parse_arr(tb, head, len, policy) \
	({ \
		_nl_static_assert_tb ((tb), (policy)); \
		\
		nla_parse ((tb), G_N_ELEMENTS (tb) - 1, (head), (len), (policy)); \
	})

static inline int
nla_parse_nested (struct nlattr *tb[],
                  int maxtype,
                  struct nlattr *nla,
                  const struct nla_policy *policy)
{
	return nla_parse (tb, maxtype, nla_data (nla), nla_len (nla), policy);
}

#define nla_parse_nested_arr(tb, nla, policy) \
	({ \
		_nl_static_assert_tb ((tb), (policy)); \
		\
		nla_parse_nested ((tb), G_N_ELEMENTS (tb) - 1, (nla), (policy)); \
	})

/*****************************************************************************/

struct nl_msg *nlmsg_alloc (void);

struct nl_msg *nlmsg_alloc_size (size_t max);

struct nl_msg *nlmsg_alloc_convert (struct nlmsghdr *hdr);

struct nl_msg *nlmsg_alloc_simple (int nlmsgtype, int flags);

void *nlmsg_reserve (struct nl_msg *n, size_t len, int pad);

int nlmsg_append (struct nl_msg *n,
                  const void *data,
                  size_t len,
                  int pad);

#define nlmsg_append_struct(n, data) \
	nlmsg_append (n, (data), sizeof (*(data)), NLMSG_ALIGNTO)

void nlmsg_free (struct nl_msg *msg);

static inline int
nlmsg_size (int payload)
{
	nm_assert (payload >= 0 && payload < G_MAXINT - NLMSG_HDRLEN - 4);
	return NLMSG_HDRLEN + payload;
}

static inline int
nlmsg_total_size (int payload)
{
	return NLMSG_ALIGN (nlmsg_size (payload));
}

static inline int
nlmsg_ok (const struct nlmsghdr *nlh, int remaining)
{
	return (remaining >= (int) sizeof (struct nlmsghdr) &&
	       nlh->nlmsg_len >= sizeof (struct nlmsghdr) &&
	       nlh->nlmsg_len <= remaining);
}

static inline struct nlmsghdr *
nlmsg_next (struct nlmsghdr *nlh, int *remaining)
{
	int totlen = NLMSG_ALIGN (nlh->nlmsg_len);

	*remaining -= totlen;

	return (struct nlmsghdr *) ((unsigned char *) nlh + totlen);
}

int nlmsg_get_proto (struct nl_msg *msg);
void nlmsg_set_proto (struct nl_msg *msg, int protocol);

void nlmsg_set_src (struct nl_msg *msg, struct sockaddr_nl *addr);

struct ucred *nlmsg_get_creds (struct nl_msg *msg);
void nlmsg_set_creds (struct nl_msg *msg, struct ucred *creds);

static inline void
_nm_auto_nl_msg_cleanup (struct nl_msg **ptr)
{
	nlmsg_free (*ptr);
}
#define nm_auto_nlmsg nm_auto (_nm_auto_nl_msg_cleanup)

static inline void *
nlmsg_data (const struct nlmsghdr *nlh)
{
	return (unsigned char *) nlh + NLMSG_HDRLEN;
}

static inline void *
nlmsg_tail (const struct nlmsghdr *nlh)
{
	return (unsigned char *) nlh + NLMSG_ALIGN (nlh->nlmsg_len);
}

struct nlmsghdr *nlmsg_hdr (struct nl_msg *n);

static inline int
nlmsg_valid_hdr (const struct nlmsghdr *nlh, int hdrlen)
{
	if (nlh->nlmsg_len < nlmsg_size (hdrlen))
		return 0;

	return 1;
}

static inline int
nlmsg_datalen (const struct nlmsghdr *nlh)
{
	return nlh->nlmsg_len - NLMSG_HDRLEN;
}

static inline int
nlmsg_attrlen (const struct nlmsghdr *nlh, int hdrlen)
{
	return NM_MAX ((int) (nlmsg_datalen (nlh) - NLMSG_ALIGN (hdrlen)), 0);
}

static inline struct nlattr *
nlmsg_attrdata (const struct nlmsghdr *nlh, int hdrlen)
{
	unsigned char *data = nlmsg_data (nlh);
	return (struct nlattr *) (data + NLMSG_ALIGN (hdrlen));
}

static inline struct nlattr *
nlmsg_find_attr (struct nlmsghdr *nlh, int hdrlen, int attrtype)
{
	return nla_find (nlmsg_attrdata (nlh, hdrlen),
	                 nlmsg_attrlen (nlh, hdrlen),
	                 attrtype);
}

int nlmsg_parse (struct nlmsghdr *nlh,
                 int hdrlen,
                 struct nlattr *tb[],
                 int maxtype,
                 const struct nla_policy *policy);

#define nlmsg_parse_arr(nlh, hdrlen, tb, policy) \
	({ \
		_nl_static_assert_tb ((tb), (policy)); \
		G_STATIC_ASSERT_EXPR ((hdrlen) >= 0); \
		\
		nlmsg_parse ((nlh), (hdrlen), (tb), G_N_ELEMENTS (tb) - 1, (policy)); \
	})

struct nlmsghdr *nlmsg_put (struct nl_msg *n, uint32_t pid, uint32_t seq,
                            int type, int payload, int flags);

/*****************************************************************************/

#define NL_AUTO_PORT 0
#define NL_AUTO_SEQ  0

struct nl_sock;

struct nl_sock *nl_socket_alloc (void);

void nl_socket_free (struct nl_sock *sk);

int nl_socket_get_fd (const struct nl_sock *sk);

struct sockaddr_nl *nlmsg_get_dst (struct nl_msg *msg);

size_t nl_socket_get_msg_buf_size (struct nl_sock *sk);
int nl_socket_set_msg_buf_size (struct nl_sock *sk, size_t bufsize);

int nl_socket_set_buffer_size (struct nl_sock *sk, int rxbuf, int txbuf);

int nl_socket_set_passcred (struct nl_sock *sk, int state);

int nl_socket_set_nonblocking (const struct nl_sock *sk);

void nl_socket_disable_msg_peek (struct nl_sock *sk);

uint32_t nl_socket_get_local_port (const struct nl_sock *sk);

int nl_socket_add_memberships (struct nl_sock *sk, int group, ...);

int nl_connect (struct nl_sock *sk, int protocol);

int nl_recv (struct nl_sock *sk,
             struct sockaddr_nl *nla,
             unsigned char **buf,
             struct ucred *out_creds,
             gboolean *out_creds_has);

int nl_send (struct nl_sock *sk, struct nl_msg *msg);

int nl_send_auto (struct nl_sock *sk, struct nl_msg *msg);

/*****************************************************************************/

enum nl_cb_action {
	/* Proceed with wathever would come next */
	NL_OK,
	/* Skip this message */
	NL_SKIP,
	/* Stop parsing altogether and discard remaining messages */
	NL_STOP,
};

typedef int (*nl_recvmsg_msg_cb_t) (struct nl_msg *msg, void *arg);

typedef int (*nl_recvmsg_err_cb_t) (struct sockaddr_nl *nla,
                                    struct nlmsgerr *nlerr, void *arg);

struct nl_cb {
	nl_recvmsg_msg_cb_t     valid_cb;
	void *                  valid_arg;

	nl_recvmsg_msg_cb_t     finish_cb;
	void *                  finish_arg;

	nl_recvmsg_msg_cb_t     ack_cb;
	void *                  ack_arg;

	nl_recvmsg_err_cb_t     err_cb;
	void *                  err_arg;
};

int nl_sendmsg (struct nl_sock *sk, struct nl_msg *msg, struct msghdr *hdr);

int nl_send_iovec (struct nl_sock *sk, struct nl_msg *msg, struct iovec *iov, unsigned iovlen);

void nl_complete_msg (struct nl_sock *sk, struct nl_msg *msg);

int nl_recvmsgs (struct nl_sock *sk, const struct nl_cb *cb);

int nl_wait_for_ack (struct nl_sock *sk,
                     const struct nl_cb *cb);

int nl_socket_set_ext_ack (struct nl_sock *sk, gboolean enable);

/*****************************************************************************/

void *genlmsg_put (struct nl_msg *msg, uint32_t port, uint32_t seq, int family,
                   int hdrlen, int flags, uint8_t cmd, uint8_t version);
void *genlmsg_data (const struct genlmsghdr *gnlh);
void *genlmsg_user_hdr (const struct genlmsghdr *gnlh);
struct genlmsghdr *genlmsg_hdr (struct nlmsghdr *nlh);
void *genlmsg_user_data (const struct genlmsghdr *gnlh, const int hdrlen);
struct nlattr *genlmsg_attrdata (const struct genlmsghdr *gnlh, int hdrlen);
int genlmsg_len (const struct genlmsghdr *gnlh);
int genlmsg_attrlen (const struct genlmsghdr *gnlh, int hdrlen);
int genlmsg_valid_hdr (struct nlmsghdr *nlh, int hdrlen);

int genlmsg_parse (struct nlmsghdr *nlh,
                   int hdrlen,
                   struct nlattr *tb[],
                   int maxtype,
                   const struct nla_policy *policy);

#define genlmsg_parse_arr(nlh, hdrlen, tb, policy) \
	({ \
		_nl_static_assert_tb ((tb), (policy)); \
		G_STATIC_ASSERT_EXPR ((hdrlen) >= 0); \
		\
		genlmsg_parse ((nlh), (hdrlen), (tb), G_N_ELEMENTS (tb) - 1, (policy)); \
	})

int genl_ctrl_resolve (struct nl_sock *sk, const char *name);

/*****************************************************************************/

#endif /* __NM_NETLINK_H__ */