12 #include <netlink-private/netlink.h>
13 #include <netlink/netfilter/nfnl.h>
14 #include <netlink/netfilter/netfilter.h>
15 #include <netlink/netfilter/queue_msg.h>
16 #include <linux/netfilter.h>
19 #define QUEUE_MSG_ATTR_GROUP (1UL << 0)
20 #define QUEUE_MSG_ATTR_FAMILY (1UL << 1)
21 #define QUEUE_MSG_ATTR_PACKETID (1UL << 2)
22 #define QUEUE_MSG_ATTR_HWPROTO (1UL << 3)
23 #define QUEUE_MSG_ATTR_HOOK (1UL << 4)
24 #define QUEUE_MSG_ATTR_MARK (1UL << 5)
25 #define QUEUE_MSG_ATTR_TIMESTAMP (1UL << 6)
26 #define QUEUE_MSG_ATTR_INDEV (1UL << 7)
27 #define QUEUE_MSG_ATTR_OUTDEV (1UL << 8)
28 #define QUEUE_MSG_ATTR_PHYSINDEV (1UL << 9)
29 #define QUEUE_MSG_ATTR_PHYSOUTDEV (1UL << 10)
30 #define QUEUE_MSG_ATTR_HWADDR (1UL << 11)
31 #define QUEUE_MSG_ATTR_PAYLOAD (1UL << 12)
32 #define QUEUE_MSG_ATTR_VERDICT (1UL << 13)
35 static void nfnl_queue_msg_free_data(
struct nl_object *c)
37 struct nfnl_queue_msg *msg = (
struct nfnl_queue_msg *) c;
42 free(msg->queue_msg_payload);
45 static int nfnl_queue_msg_clone(
struct nl_object *_dst,
struct nl_object *_src)
47 struct nfnl_queue_msg *dst = (
struct nfnl_queue_msg *) _dst;
48 struct nfnl_queue_msg *src = (
struct nfnl_queue_msg *) _src;
51 if (src->queue_msg_payload) {
52 err = nfnl_queue_msg_set_payload(dst, src->queue_msg_payload,
53 src->queue_msg_payload_len);
63 static void nfnl_queue_msg_dump(
struct nl_object *a,
struct nl_dump_params *p)
65 struct nfnl_queue_msg *msg = (
struct nfnl_queue_msg *) a;
66 struct nl_cache *link_cache;
73 if (msg->ce_mask & QUEUE_MSG_ATTR_GROUP)
74 nl_dump(p,
"GROUP=%u ", msg->queue_msg_group);
76 if (msg->ce_mask & QUEUE_MSG_ATTR_INDEV) {
83 nl_dump(p,
"IN=%d ", msg->queue_msg_indev);
86 if (msg->ce_mask & QUEUE_MSG_ATTR_PHYSINDEV) {
90 msg->queue_msg_physindev,
93 nl_dump(p,
"IN=%d ", msg->queue_msg_physindev);
96 if (msg->ce_mask & QUEUE_MSG_ATTR_OUTDEV) {
100 msg->queue_msg_outdev,
103 nl_dump(p,
"OUT=%d ", msg->queue_msg_outdev);
106 if (msg->ce_mask & QUEUE_MSG_ATTR_PHYSOUTDEV) {
110 msg->queue_msg_physoutdev,
113 nl_dump(p,
"PHYSOUT=%d ", msg->queue_msg_physoutdev);
116 if (msg->ce_mask & QUEUE_MSG_ATTR_HWADDR) {
120 for (i = 0; i < msg->queue_msg_hwaddr_len; i++)
121 nl_dump(p,
"%c%02x", i?
':':
'=',
122 msg->queue_msg_hwaddr[i]);
126 if (msg->ce_mask & QUEUE_MSG_ATTR_FAMILY)
128 nl_af2str(msg->queue_msg_family, buf,
sizeof(buf)));
130 if (msg->ce_mask & QUEUE_MSG_ATTR_HWPROTO)
132 nl_ether_proto2str(ntohs(msg->queue_msg_hwproto),
135 if (msg->ce_mask & QUEUE_MSG_ATTR_HOOK)
137 nfnl_inet_hook2str(msg->queue_msg_hook,
140 if (msg->ce_mask & QUEUE_MSG_ATTR_MARK)
141 nl_dump(p,
"MARK=%d ", msg->queue_msg_mark);
143 if (msg->ce_mask & QUEUE_MSG_ATTR_PAYLOAD)
144 nl_dump(p,
"PAYLOADLEN=%d ", msg->queue_msg_payload_len);
146 if (msg->ce_mask & QUEUE_MSG_ATTR_PACKETID)
147 nl_dump(p,
"PACKETID=%u ", msg->queue_msg_packetid);
149 if (msg->ce_mask & QUEUE_MSG_ATTR_VERDICT)
151 nfnl_verdict2str(msg->queue_msg_verdict,
157 nl_cache_put(link_cache);
165 struct nfnl_queue_msg *nfnl_queue_msg_alloc(
void)
170 void nfnl_queue_msg_get(
struct nfnl_queue_msg *msg)
175 void nfnl_queue_msg_put(
struct nfnl_queue_msg *msg)
187 void nfnl_queue_msg_set_group(
struct nfnl_queue_msg *msg, uint16_t group)
189 msg->queue_msg_group = group;
190 msg->ce_mask |= QUEUE_MSG_ATTR_GROUP;
193 int nfnl_queue_msg_test_group(
const struct nfnl_queue_msg *msg)
195 return !!(msg->ce_mask & QUEUE_MSG_ATTR_GROUP);
198 uint16_t nfnl_queue_msg_get_group(
const struct nfnl_queue_msg *msg)
200 return msg->queue_msg_group;
208 void nfnl_queue_msg_set_family(
struct nfnl_queue_msg *msg, uint8_t family)
210 msg->queue_msg_family = family;
211 msg->ce_mask |= QUEUE_MSG_ATTR_FAMILY;
214 int nfnl_queue_msg_test_family(
const struct nfnl_queue_msg *msg)
216 return !!(msg->ce_mask & QUEUE_MSG_ATTR_FAMILY);
219 uint8_t nfnl_queue_msg_get_family(
const struct nfnl_queue_msg *msg)
221 if (msg->ce_mask & QUEUE_MSG_ATTR_FAMILY)
222 return msg->queue_msg_family;
227 void nfnl_queue_msg_set_packetid(
struct nfnl_queue_msg *msg, uint32_t packetid)
229 msg->queue_msg_packetid = packetid;
230 msg->ce_mask |= QUEUE_MSG_ATTR_PACKETID;
233 int nfnl_queue_msg_test_packetid(
const struct nfnl_queue_msg *msg)
235 return !!(msg->ce_mask & QUEUE_MSG_ATTR_PACKETID);
238 uint32_t nfnl_queue_msg_get_packetid(
const struct nfnl_queue_msg *msg)
240 return msg->queue_msg_packetid;
243 void nfnl_queue_msg_set_hwproto(
struct nfnl_queue_msg *msg, uint16_t hwproto)
245 msg->queue_msg_hwproto = hwproto;
246 msg->ce_mask |= QUEUE_MSG_ATTR_HWPROTO;
249 int nfnl_queue_msg_test_hwproto(
const struct nfnl_queue_msg *msg)
251 return !!(msg->ce_mask & QUEUE_MSG_ATTR_HWPROTO);
254 uint16_t nfnl_queue_msg_get_hwproto(
const struct nfnl_queue_msg *msg)
256 return msg->queue_msg_hwproto;
259 void nfnl_queue_msg_set_hook(
struct nfnl_queue_msg *msg, uint8_t hook)
261 msg->queue_msg_hook = hook;
262 msg->ce_mask |= QUEUE_MSG_ATTR_HOOK;
265 int nfnl_queue_msg_test_hook(
const struct nfnl_queue_msg *msg)
267 return !!(msg->ce_mask & QUEUE_MSG_ATTR_HOOK);
270 uint8_t nfnl_queue_msg_get_hook(
const struct nfnl_queue_msg *msg)
272 return msg->queue_msg_hook;
275 void nfnl_queue_msg_set_mark(
struct nfnl_queue_msg *msg, uint32_t mark)
277 msg->queue_msg_mark = mark;
278 msg->ce_mask |= QUEUE_MSG_ATTR_MARK;
281 int nfnl_queue_msg_test_mark(
const struct nfnl_queue_msg *msg)
283 return !!(msg->ce_mask & QUEUE_MSG_ATTR_MARK);
286 uint32_t nfnl_queue_msg_get_mark(
const struct nfnl_queue_msg *msg)
288 return msg->queue_msg_mark;
291 void nfnl_queue_msg_set_timestamp(
struct nfnl_queue_msg *msg,
294 msg->queue_msg_timestamp.tv_sec = tv->tv_sec;
295 msg->queue_msg_timestamp.tv_usec = tv->tv_usec;
296 msg->ce_mask |= QUEUE_MSG_ATTR_TIMESTAMP;
299 int nfnl_queue_msg_test_timestamp(
const struct nfnl_queue_msg *msg)
301 return !!(msg->ce_mask & QUEUE_MSG_ATTR_TIMESTAMP);
304 const struct timeval *nfnl_queue_msg_get_timestamp(
const struct nfnl_queue_msg *msg)
306 if (!(msg->ce_mask & QUEUE_MSG_ATTR_TIMESTAMP))
308 return &msg->queue_msg_timestamp;
311 void nfnl_queue_msg_set_indev(
struct nfnl_queue_msg *msg, uint32_t indev)
313 msg->queue_msg_indev = indev;
314 msg->ce_mask |= QUEUE_MSG_ATTR_INDEV;
317 int nfnl_queue_msg_test_indev(
const struct nfnl_queue_msg *msg)
319 return !!(msg->ce_mask & QUEUE_MSG_ATTR_INDEV);
322 uint32_t nfnl_queue_msg_get_indev(
const struct nfnl_queue_msg *msg)
324 return msg->queue_msg_indev;
327 void nfnl_queue_msg_set_outdev(
struct nfnl_queue_msg *msg, uint32_t outdev)
329 msg->queue_msg_outdev = outdev;
330 msg->ce_mask |= QUEUE_MSG_ATTR_OUTDEV;
333 int nfnl_queue_msg_test_outdev(
const struct nfnl_queue_msg *msg)
335 return !!(msg->ce_mask & QUEUE_MSG_ATTR_OUTDEV);
338 uint32_t nfnl_queue_msg_get_outdev(
const struct nfnl_queue_msg *msg)
340 return msg->queue_msg_outdev;
343 void nfnl_queue_msg_set_physindev(
struct nfnl_queue_msg *msg,
346 msg->queue_msg_physindev = physindev;
347 msg->ce_mask |= QUEUE_MSG_ATTR_PHYSINDEV;
350 int nfnl_queue_msg_test_physindev(
const struct nfnl_queue_msg *msg)
352 return !!(msg->ce_mask & QUEUE_MSG_ATTR_PHYSINDEV);
355 uint32_t nfnl_queue_msg_get_physindev(
const struct nfnl_queue_msg *msg)
357 return msg->queue_msg_physindev;
360 void nfnl_queue_msg_set_physoutdev(
struct nfnl_queue_msg *msg,
363 msg->queue_msg_physoutdev = physoutdev;
364 msg->ce_mask |= QUEUE_MSG_ATTR_PHYSOUTDEV;
367 int nfnl_queue_msg_test_physoutdev(
const struct nfnl_queue_msg *msg)
369 return !!(msg->ce_mask & QUEUE_MSG_ATTR_PHYSOUTDEV);
372 uint32_t nfnl_queue_msg_get_physoutdev(
const struct nfnl_queue_msg *msg)
374 return msg->queue_msg_physoutdev;
377 void nfnl_queue_msg_set_hwaddr(
struct nfnl_queue_msg *msg, uint8_t *hwaddr,
380 if (len >
sizeof(msg->queue_msg_hwaddr))
381 len =
sizeof(msg->queue_msg_hwaddr);
383 msg->queue_msg_hwaddr_len = len;
384 memcpy(msg->queue_msg_hwaddr, hwaddr, len);
385 msg->ce_mask |= QUEUE_MSG_ATTR_HWADDR;
388 int nfnl_queue_msg_test_hwaddr(
const struct nfnl_queue_msg *msg)
390 return !!(msg->ce_mask & QUEUE_MSG_ATTR_HWADDR);
393 const uint8_t *nfnl_queue_msg_get_hwaddr(
const struct nfnl_queue_msg *msg,
396 if (!(msg->ce_mask & QUEUE_MSG_ATTR_HWADDR)) {
401 *len = msg->queue_msg_hwaddr_len;
402 return msg->queue_msg_hwaddr;
405 int nfnl_queue_msg_set_payload(
struct nfnl_queue_msg *msg, uint8_t *payload,
408 free(msg->queue_msg_payload);
409 msg->queue_msg_payload = malloc(len);
410 if (!msg->queue_msg_payload)
413 memcpy(msg->queue_msg_payload, payload, len);
414 msg->queue_msg_payload_len = len;
415 msg->ce_mask |= QUEUE_MSG_ATTR_PAYLOAD;
419 int nfnl_queue_msg_test_payload(
const struct nfnl_queue_msg *msg)
421 return !!(msg->ce_mask & QUEUE_MSG_ATTR_PAYLOAD);
424 const void *nfnl_queue_msg_get_payload(
const struct nfnl_queue_msg *msg,
int *len)
426 if (!(msg->ce_mask & QUEUE_MSG_ATTR_PAYLOAD)) {
431 *len = msg->queue_msg_payload_len;
432 return msg->queue_msg_payload;
440 void nfnl_queue_msg_set_verdict(
struct nfnl_queue_msg *msg,
441 unsigned int verdict)
443 msg->queue_msg_verdict = verdict;
444 msg->ce_mask |= QUEUE_MSG_ATTR_VERDICT;
447 int nfnl_queue_msg_test_verdict(
const struct nfnl_queue_msg *msg)
449 return !!(msg->ce_mask & QUEUE_MSG_ATTR_VERDICT);
452 unsigned int nfnl_queue_msg_get_verdict(
const struct nfnl_queue_msg *msg)
454 return msg->queue_msg_verdict;
457 static const struct trans_tbl nfnl_queue_msg_attrs[] = {
458 __ADD(QUEUE_MSG_ATTR_GROUP, group)
459 __ADD(QUEUE_MSG_ATTR_FAMILY, family)
460 __ADD(QUEUE_MSG_ATTR_PACKETID, packetid)
461 __ADD(QUEUE_MSG_ATTR_HWPROTO, hwproto)
462 __ADD(QUEUE_MSG_ATTR_HOOK, hook)
463 __ADD(QUEUE_MSG_ATTR_MARK, mark)
464 __ADD(QUEUE_MSG_ATTR_TIMESTAMP, timestamp)
465 __ADD(QUEUE_MSG_ATTR_INDEV, indev)
466 __ADD(QUEUE_MSG_ATTR_OUTDEV, outdev)
467 __ADD(QUEUE_MSG_ATTR_PHYSINDEV, physindev)
468 __ADD(QUEUE_MSG_ATTR_PHYSOUTDEV, physoutdev)
469 __ADD(QUEUE_MSG_ATTR_HWADDR, hwaddr)
470 __ADD(QUEUE_MSG_ATTR_PAYLOAD, payload)
471 __ADD(QUEUE_MSG_ATTR_VERDICT, verdict)
474 static
char *nfnl_queue_msg_attrs2str(
int attrs,
char *buf,
size_t len)
476 return __flags2str(attrs, buf, len, nfnl_queue_msg_attrs,
477 ARRAY_SIZE(nfnl_queue_msg_attrs));
482 struct nl_object_ops queue_msg_obj_ops = {
483 .oo_name =
"netfilter/queuemsg",
484 .oo_size =
sizeof(
struct nfnl_queue_msg),
485 .oo_free_data = nfnl_queue_msg_free_data,
486 .oo_clone = nfnl_queue_msg_clone,
492 .oo_attrs2str = nfnl_queue_msg_attrs2str,