2007-09-14 23:28:01 +00:00
|
|
|
/*
|
|
|
|
* netlink-local.h Local Netlink Interface
|
|
|
|
*
|
|
|
|
* This library is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
|
|
* License as published by the Free Software Foundation version 2.1
|
|
|
|
* of the License.
|
|
|
|
*
|
|
|
|
* Copyright (c) 2003-2006 Thomas Graf <tgraf@suug.ch>
|
|
|
|
*/
|
|
|
|
|
|
|
|
#ifndef NETLINK_LOCAL_H_
|
|
|
|
#define NETLINK_LOCAL_H_
|
|
|
|
|
|
|
|
#include <stdio.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <unistd.h>
|
|
|
|
#include <fcntl.h>
|
|
|
|
#include <math.h>
|
|
|
|
#include <time.h>
|
|
|
|
#include <stdarg.h>
|
|
|
|
#include <ctype.h>
|
|
|
|
#include <sys/types.h>
|
|
|
|
#include <sys/socket.h>
|
|
|
|
#include <inttypes.h>
|
|
|
|
#include <assert.h>
|
|
|
|
|
|
|
|
#include <arpa/inet.h>
|
|
|
|
#include <netdb.h>
|
|
|
|
|
|
|
|
#ifndef SOL_NETLINK
|
|
|
|
#define SOL_NETLINK 270
|
|
|
|
#endif
|
|
|
|
|
2007-09-18 01:53:04 +00:00
|
|
|
#include <linux/types.h>
|
2007-09-14 23:28:01 +00:00
|
|
|
|
|
|
|
/* local header copies */
|
|
|
|
#include <linux/if.h>
|
|
|
|
#include <linux/if_arp.h>
|
|
|
|
#include <linux/if_ether.h>
|
|
|
|
#include <linux/pkt_sched.h>
|
|
|
|
#include <linux/pkt_cls.h>
|
|
|
|
#include <linux/gen_stats.h>
|
2007-12-18 11:30:09 +00:00
|
|
|
#include <linux/ip_mp_alg.h>
|
2007-09-14 23:28:01 +00:00
|
|
|
|
|
|
|
#include <netlink/netlink.h>
|
|
|
|
#include <netlink/handlers.h>
|
|
|
|
#include <netlink/cache.h>
|
|
|
|
#include <netlink/route/tc.h>
|
2007-09-15 17:55:38 +00:00
|
|
|
#include <netlink/object-api.h>
|
2007-09-17 11:36:16 +00:00
|
|
|
#include <netlink/cache-api.h>
|
2007-09-14 23:28:01 +00:00
|
|
|
#include <netlink-types.h>
|
|
|
|
|
|
|
|
struct trans_tbl {
|
|
|
|
int i;
|
|
|
|
const char *a;
|
|
|
|
};
|
|
|
|
|
|
|
|
#define __ADD(id, name) { .i = id, .a = #name },
|
|
|
|
|
|
|
|
struct trans_list {
|
|
|
|
int i;
|
|
|
|
char *a;
|
|
|
|
struct nl_list_head list;
|
|
|
|
};
|
|
|
|
|
|
|
|
#define NL_DEBUG 1
|
|
|
|
|
|
|
|
#define NL_DBG(LVL,FMT,ARG...) \
|
|
|
|
do { \
|
|
|
|
if (LVL <= nl_debug) \
|
|
|
|
fprintf(stderr, "DBG<" #LVL ">: " FMT, ##ARG); \
|
|
|
|
} while (0)
|
|
|
|
|
|
|
|
#define BUG() \
|
|
|
|
do { \
|
|
|
|
fprintf(stderr, "BUG: %s:%d\n", \
|
|
|
|
__FILE__, __LINE__); \
|
|
|
|
assert(0); \
|
|
|
|
} while (0)
|
|
|
|
|
|
|
|
#define RET_ERR(R, E) \
|
|
|
|
do { \
|
|
|
|
errno = E; \
|
|
|
|
return -R; \
|
|
|
|
} while (0)
|
|
|
|
|
|
|
|
extern int __nl_error(int, const char *, unsigned int,
|
|
|
|
const char *, const char *, ...);
|
|
|
|
|
|
|
|
extern int __nl_read_num_str_file(const char *path,
|
|
|
|
int (*cb)(long, const char *));
|
|
|
|
|
|
|
|
#ifdef NL_ERROR_ASSERT
|
|
|
|
#include <assert.h>
|
|
|
|
static inline int __assert_error(const char *file, int line, char *func,
|
|
|
|
const char *fmt, ...)
|
|
|
|
{
|
|
|
|
va_list args;
|
|
|
|
fprintf(stderr, "%s:%d:%s: ", file, line, func);
|
|
|
|
va_start(args, fmt);
|
|
|
|
vfprintf(stderr, fmt, args);
|
|
|
|
va_end(args);
|
|
|
|
fprintf(stderr, "\n");
|
|
|
|
assert(0);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
#define nl_error(E, FMT,ARG...) \
|
|
|
|
__assert_error(__FILE__, __LINE__, __FUNCTION__, FMT, ##ARG)
|
|
|
|
|
|
|
|
#else
|
|
|
|
#define nl_error(E, FMT,ARG...) \
|
|
|
|
__nl_error(E, __FILE__, __LINE__, __FUNCTION__, FMT, ##ARG)
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#define nl_errno(E) nl_error(E, NULL)
|
|
|
|
|
2007-09-15 17:55:38 +00:00
|
|
|
/* backwards compat */
|
|
|
|
#define dp_new_line(params, line) nl_new_line(params, line)
|
|
|
|
#define dp_dump(params, fmt, arg...) nl_dump(params, fmt, ##arg)
|
|
|
|
|
2007-09-14 23:28:01 +00:00
|
|
|
static inline int __trans_list_add(int i, const char *a,
|
|
|
|
struct nl_list_head *head)
|
|
|
|
{
|
|
|
|
struct trans_list *tl;
|
|
|
|
|
|
|
|
tl = calloc(1, sizeof(*tl));
|
|
|
|
if (!tl)
|
|
|
|
return nl_errno(ENOMEM);
|
|
|
|
|
|
|
|
tl->i = i;
|
|
|
|
tl->a = strdup(a);
|
|
|
|
|
|
|
|
nl_list_add_tail(&tl->list, head);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void __trans_list_clear(struct nl_list_head *head)
|
|
|
|
{
|
|
|
|
struct trans_list *tl, *next;
|
|
|
|
|
|
|
|
nl_list_for_each_entry_safe(tl, next, head, list) {
|
|
|
|
free(tl->a);
|
|
|
|
free(tl);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline char *__type2str(int type, char *buf, size_t len,
|
|
|
|
struct trans_tbl *tbl, size_t tbl_len)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < tbl_len; i++) {
|
|
|
|
if (tbl[i].i == type) {
|
|
|
|
snprintf(buf, len, "%s", tbl[i].a);
|
|
|
|
return buf;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
snprintf(buf, len, "0x%x", type);
|
|
|
|
return buf;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline char *__list_type2str(int type, char *buf, size_t len,
|
|
|
|
struct nl_list_head *head)
|
|
|
|
{
|
|
|
|
struct trans_list *tl;
|
|
|
|
|
|
|
|
nl_list_for_each_entry(tl, head, list) {
|
|
|
|
if (tl->i == type) {
|
|
|
|
snprintf(buf, len, "%s", tl->a);
|
|
|
|
return buf;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
snprintf(buf, len, "0x%x", type);
|
|
|
|
return buf;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline char *__flags2str(int flags, char *buf, size_t len,
|
|
|
|
struct trans_tbl *tbl, size_t tbl_len)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
int tmp = flags;
|
|
|
|
|
|
|
|
memset(buf, 0, len);
|
|
|
|
|
|
|
|
for (i = 0; i < tbl_len; i++) {
|
|
|
|
if (tbl[i].i & tmp) {
|
|
|
|
tmp &= ~tbl[i].i;
|
|
|
|
strncat(buf, tbl[i].a, len - strlen(buf) - 1);
|
|
|
|
if ((tmp & flags))
|
|
|
|
strncat(buf, ",", len - strlen(buf) - 1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return buf;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int __str2type(const char *buf, struct trans_tbl *tbl,
|
|
|
|
size_t tbl_len)
|
|
|
|
{
|
|
|
|
unsigned long l;
|
|
|
|
char *end;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
if (*buf == '\0')
|
|
|
|
return -1;
|
|
|
|
|
|
|
|
for (i = 0; i < tbl_len; i++)
|
|
|
|
if (!strcasecmp(tbl[i].a, buf))
|
|
|
|
return tbl[i].i;
|
|
|
|
|
|
|
|
l = strtoul(buf, &end, 0);
|
|
|
|
if (l == ULONG_MAX || *end != '\0')
|
|
|
|
return -1;
|
|
|
|
|
|
|
|
return (int) l;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int __list_str2type(const char *buf, struct nl_list_head *head)
|
|
|
|
{
|
|
|
|
struct trans_list *tl;
|
|
|
|
unsigned long l;
|
|
|
|
char *end;
|
|
|
|
|
|
|
|
if (*buf == '\0')
|
|
|
|
return -1;
|
|
|
|
|
|
|
|
nl_list_for_each_entry(tl, head, list) {
|
|
|
|
if (!strcasecmp(tl->a, buf))
|
|
|
|
return tl->i;
|
|
|
|
}
|
|
|
|
|
|
|
|
l = strtoul(buf, &end, 0);
|
|
|
|
if (l == ULONG_MAX || *end != '\0')
|
|
|
|
return -1;
|
|
|
|
|
|
|
|
return (int) l;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int __str2flags(const char *buf, struct trans_tbl *tbl,
|
|
|
|
size_t tbl_len)
|
|
|
|
{
|
|
|
|
int i, flags = 0, len;
|
|
|
|
char *p = (char *) buf, *t;
|
|
|
|
|
|
|
|
for (;;) {
|
|
|
|
if (*p == ' ')
|
|
|
|
p++;
|
|
|
|
|
|
|
|
t = strchr(p, ',');
|
|
|
|
len = t ? t - p : strlen(p);
|
|
|
|
for (i = 0; i < tbl_len; i++)
|
|
|
|
if (!strncasecmp(tbl[i].a, p, len))
|
|
|
|
flags |= tbl[i].i;
|
|
|
|
|
|
|
|
if (!t)
|
|
|
|
return flags;
|
|
|
|
|
|
|
|
p = ++t;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void __dp_dump(struct nl_dump_params *parms, const char *fmt,
|
|
|
|
va_list args)
|
|
|
|
{
|
|
|
|
if (parms->dp_fd)
|
|
|
|
vfprintf(parms->dp_fd, fmt, args);
|
|
|
|
else if (parms->dp_buf || parms->dp_cb) {
|
|
|
|
char *buf = NULL;
|
|
|
|
vasprintf(&buf, fmt, args);
|
|
|
|
if (parms->dp_cb)
|
|
|
|
parms->dp_cb(parms, buf);
|
|
|
|
else
|
|
|
|
strncat(parms->dp_buf, buf,
|
|
|
|
parms->dp_buflen - strlen(parms->dp_buf) - 1);
|
|
|
|
free(buf);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void dp_dump_line(struct nl_dump_params *parms, int line,
|
|
|
|
const char *fmt, ...)
|
|
|
|
{
|
|
|
|
va_list args;
|
|
|
|
|
2007-09-15 17:55:38 +00:00
|
|
|
nl_new_line(parms, line);
|
2007-09-14 23:28:01 +00:00
|
|
|
|
|
|
|
va_start(args, fmt);
|
|
|
|
__dp_dump(parms, fmt, args);
|
|
|
|
va_end(args);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void dump_from_ops(struct nl_object *obj,
|
|
|
|
struct nl_dump_params *params)
|
|
|
|
{
|
|
|
|
int type = params->dp_type;
|
|
|
|
|
|
|
|
if (type < 0 || type > NL_DUMP_MAX)
|
|
|
|
BUG();
|
|
|
|
|
|
|
|
if (params->dp_dump_msgtype) {
|
|
|
|
#if 0
|
|
|
|
/* XXX */
|
|
|
|
char buf[64];
|
|
|
|
|
|
|
|
dp_dump_line(params, 0, "%s ",
|
|
|
|
nl_cache_mngt_type2name(obj->ce_ops,
|
|
|
|
obj->ce_ops->co_protocol,
|
|
|
|
obj->ce_msgtype,
|
|
|
|
buf, sizeof(buf)));
|
|
|
|
#endif
|
|
|
|
params->dp_pre_dump = 1;
|
|
|
|
} else
|
|
|
|
dp_new_line(params, 0);
|
|
|
|
|
|
|
|
if (obj->ce_ops->oo_dump[type])
|
|
|
|
obj->ce_ops->oo_dump[type](obj, params);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline struct nl_cache *dp_cache(struct nl_object *obj)
|
|
|
|
{
|
|
|
|
if (obj->ce_cache == NULL)
|
|
|
|
return nl_cache_mngt_require(obj->ce_ops->oo_name);
|
|
|
|
|
|
|
|
return obj->ce_cache;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int nl_cb_call(struct nl_cb *cb, int type, struct nl_msg *msg)
|
|
|
|
{
|
|
|
|
return cb->cb_set[type](msg, cb->cb_args[type]);
|
|
|
|
}
|
|
|
|
|
|
|
|
#define ARRAY_SIZE(X) (sizeof(X) / sizeof((X)[0]))
|
|
|
|
#define offsetof(TYPE, MEMBER) ((size_t) &((TYPE *)0)->MEMBER)
|
|
|
|
|
|
|
|
#define __init __attribute__ ((constructor))
|
|
|
|
#define __exit __attribute__ ((destructor))
|
|
|
|
|
|
|
|
#define P_ACCEPT 0
|
|
|
|
#define P_IGNORE 0
|
|
|
|
|
|
|
|
#define min(x,y) ({ \
|
|
|
|
typeof(x) _x = (x); \
|
|
|
|
typeof(y) _y = (y); \
|
|
|
|
(void) (&_x == &_y); \
|
|
|
|
_x < _y ? _x : _y; })
|
|
|
|
|
|
|
|
#define max(x,y) ({ \
|
|
|
|
typeof(x) _x = (x); \
|
|
|
|
typeof(y) _y = (y); \
|
|
|
|
(void) (&_x == &_y); \
|
|
|
|
_x > _y ? _x : _y; })
|
|
|
|
|
|
|
|
#define min_t(type,x,y) \
|
|
|
|
({ type __x = (x); type __y = (y); __x < __y ? __x: __y; })
|
|
|
|
#define max_t(type,x,y) \
|
|
|
|
({ type __x = (x); type __y = (y); __x > __y ? __x: __y; })
|
|
|
|
|
|
|
|
extern int nl_cache_parse(struct nl_cache_ops *, struct sockaddr_nl *,
|
|
|
|
struct nlmsghdr *, struct nl_parser_param *);
|
|
|
|
|
|
|
|
|
|
|
|
static inline void rtnl_copy_ratespec(struct rtnl_ratespec *dst,
|
|
|
|
struct tc_ratespec *src)
|
|
|
|
{
|
|
|
|
dst->rs_cell_log = src->cell_log;
|
|
|
|
dst->rs_feature = src->feature;
|
|
|
|
dst->rs_addend = src->addend;
|
|
|
|
dst->rs_mpu = src->mpu;
|
|
|
|
dst->rs_rate = src->rate;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void rtnl_rcopy_ratespec(struct tc_ratespec *dst,
|
|
|
|
struct rtnl_ratespec *src)
|
|
|
|
{
|
|
|
|
dst->cell_log = src->rs_cell_log;
|
|
|
|
dst->feature = src->rs_feature;
|
|
|
|
dst->addend = src->rs_addend;
|
|
|
|
dst->mpu = src->rs_mpu;
|
|
|
|
dst->rate = src->rs_rate;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline char *nl_cache_name(struct nl_cache *cache)
|
|
|
|
{
|
|
|
|
return cache->c_ops ? cache->c_ops->co_name : "unknown";
|
|
|
|
}
|
|
|
|
|
|
|
|
#define GENL_FAMILY(id, name) \
|
|
|
|
{ \
|
|
|
|
{ id, NL_ACT_UNSPEC, name }, \
|
|
|
|
END_OF_MSGTYPES_LIST, \
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|