00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012 #include <netlink-local.h>
00013 #include <netlink/netfilter/nfnl.h>
00014 #include <netlink/netfilter/netfilter.h>
00015 #include <netlink/netfilter/queue_msg.h>
00016 #include <linux/netfilter.h>
00017
00018
00019 #define QUEUE_MSG_ATTR_GROUP (1UL << 0)
00020 #define QUEUE_MSG_ATTR_FAMILY (1UL << 1)
00021 #define QUEUE_MSG_ATTR_PACKETID (1UL << 2)
00022 #define QUEUE_MSG_ATTR_HWPROTO (1UL << 3)
00023 #define QUEUE_MSG_ATTR_HOOK (1UL << 4)
00024 #define QUEUE_MSG_ATTR_MARK (1UL << 5)
00025 #define QUEUE_MSG_ATTR_TIMESTAMP (1UL << 6)
00026 #define QUEUE_MSG_ATTR_INDEV (1UL << 7)
00027 #define QUEUE_MSG_ATTR_OUTDEV (1UL << 8)
00028 #define QUEUE_MSG_ATTR_PHYSINDEV (1UL << 9)
00029 #define QUEUE_MSG_ATTR_PHYSOUTDEV (1UL << 10)
00030 #define QUEUE_MSG_ATTR_HWADDR (1UL << 11)
00031 #define QUEUE_MSG_ATTR_PAYLOAD (1UL << 12)
00032 #define QUEUE_MSG_ATTR_VERDICT (1UL << 13)
00033
00034
00035 static void nfnl_queue_msg_free_data(struct nl_object *c)
00036 {
00037 struct nfnl_queue_msg *msg = (struct nfnl_queue_msg *) c;
00038
00039 if (msg == NULL)
00040 return;
00041
00042 free(msg->queue_msg_payload);
00043 }
00044
00045 static int nfnl_queue_msg_clone(struct nl_object *_dst, struct nl_object *_src)
00046 {
00047 struct nfnl_queue_msg *dst = (struct nfnl_queue_msg *) _dst;
00048 struct nfnl_queue_msg *src = (struct nfnl_queue_msg *) _src;
00049 int err;
00050
00051 if (src->queue_msg_payload) {
00052 err = nfnl_queue_msg_set_payload(dst, src->queue_msg_payload,
00053 src->queue_msg_payload_len);
00054 if (err < 0)
00055 goto errout;
00056 }
00057
00058 return 0;
00059 errout:
00060 return err;
00061 }
00062
00063 static void nfnl_queue_msg_dump(struct nl_object *a, struct nl_dump_params *p)
00064 {
00065 struct nfnl_queue_msg *msg = (struct nfnl_queue_msg *) a;
00066 struct nl_cache *link_cache;
00067 char buf[64];
00068
00069 link_cache = nl_cache_mngt_require("route/link");
00070
00071 nl_new_line(p);
00072
00073 if (msg->ce_mask & QUEUE_MSG_ATTR_GROUP)
00074 nl_dump(p, "GROUP=%u ", msg->queue_msg_group);
00075
00076 if (msg->ce_mask & QUEUE_MSG_ATTR_INDEV) {
00077 if (link_cache)
00078 nl_dump(p, "IN=%s ",
00079 rtnl_link_i2name(link_cache,
00080 msg->queue_msg_indev,
00081 buf, sizeof(buf)));
00082 else
00083 nl_dump(p, "IN=%d ", msg->queue_msg_indev);
00084 }
00085
00086 if (msg->ce_mask & QUEUE_MSG_ATTR_PHYSINDEV) {
00087 if (link_cache)
00088 nl_dump(p, "PHYSIN=%s ",
00089 rtnl_link_i2name(link_cache,
00090 msg->queue_msg_physindev,
00091 buf, sizeof(buf)));
00092 else
00093 nl_dump(p, "IN=%d ", msg->queue_msg_physindev);
00094 }
00095
00096 if (msg->ce_mask & QUEUE_MSG_ATTR_OUTDEV) {
00097 if (link_cache)
00098 nl_dump(p, "OUT=%s ",
00099 rtnl_link_i2name(link_cache,
00100 msg->queue_msg_outdev,
00101 buf, sizeof(buf)));
00102 else
00103 nl_dump(p, "OUT=%d ", msg->queue_msg_outdev);
00104 }
00105
00106 if (msg->ce_mask & QUEUE_MSG_ATTR_PHYSOUTDEV) {
00107 if (link_cache)
00108 nl_dump(p, "PHYSOUT=%s ",
00109 rtnl_link_i2name(link_cache,
00110 msg->queue_msg_physoutdev,
00111 buf, sizeof(buf)));
00112 else
00113 nl_dump(p, "PHYSOUT=%d ", msg->queue_msg_physoutdev);
00114 }
00115
00116 if (msg->ce_mask & QUEUE_MSG_ATTR_HWADDR) {
00117 int i;
00118
00119 nl_dump(p, "MAC");
00120 for (i = 0; i < msg->queue_msg_hwaddr_len; i++)
00121 nl_dump(p, "%c%02x", i?':':'=',
00122 msg->queue_msg_hwaddr[i]);
00123 nl_dump(p, " ");
00124 }
00125
00126 if (msg->ce_mask & QUEUE_MSG_ATTR_FAMILY)
00127 nl_dump(p, "FAMILY=%s ",
00128 nl_af2str(msg->queue_msg_family, buf, sizeof(buf)));
00129
00130 if (msg->ce_mask & QUEUE_MSG_ATTR_HWPROTO)
00131 nl_dump(p, "HWPROTO=%s ",
00132 nl_ether_proto2str(ntohs(msg->queue_msg_hwproto),
00133 buf, sizeof(buf)));
00134
00135 if (msg->ce_mask & QUEUE_MSG_ATTR_HOOK)
00136 nl_dump(p, "HOOK=%s ",
00137 nfnl_inet_hook2str(msg->queue_msg_hook,
00138 buf, sizeof(buf)));
00139
00140 if (msg->ce_mask & QUEUE_MSG_ATTR_MARK)
00141 nl_dump(p, "MARK=%d ", msg->queue_msg_mark);
00142
00143 if (msg->ce_mask & QUEUE_MSG_ATTR_PAYLOAD)
00144 nl_dump(p, "PAYLOADLEN=%d ", msg->queue_msg_payload_len);
00145
00146 if (msg->ce_mask & QUEUE_MSG_ATTR_PACKETID)
00147 nl_dump(p, "PACKETID=%u ", msg->queue_msg_packetid);
00148
00149 if (msg->ce_mask & QUEUE_MSG_ATTR_VERDICT)
00150 nl_dump(p, "VERDICT=%s ",
00151 nfnl_verdict2str(msg->queue_msg_verdict,
00152 buf, sizeof(buf)));
00153
00154 nl_dump(p, "\n");
00155 }
00156
00157
00158
00159
00160
00161
00162 struct nfnl_queue_msg *nfnl_queue_msg_alloc(void)
00163 {
00164 return (struct nfnl_queue_msg *) nl_object_alloc(&queue_msg_obj_ops);
00165 }
00166
00167 void nfnl_queue_msg_get(struct nfnl_queue_msg *msg)
00168 {
00169 nl_object_get((struct nl_object *) msg);
00170 }
00171
00172 void nfnl_queue_msg_put(struct nfnl_queue_msg *msg)
00173 {
00174 nl_object_put((struct nl_object *) msg);
00175 }
00176
00177
00178
00179
00180
00181
00182
00183
00184 void nfnl_queue_msg_set_group(struct nfnl_queue_msg *msg, uint16_t group)
00185 {
00186 msg->queue_msg_group = group;
00187 msg->ce_mask |= QUEUE_MSG_ATTR_GROUP;
00188 }
00189
00190 int nfnl_queue_msg_test_group(const struct nfnl_queue_msg *msg)
00191 {
00192 return !!(msg->ce_mask & QUEUE_MSG_ATTR_GROUP);
00193 }
00194
00195 uint16_t nfnl_queue_msg_get_group(const struct nfnl_queue_msg *msg)
00196 {
00197 return msg->queue_msg_group;
00198 }
00199
00200 void nfnl_queue_msg_set_family(struct nfnl_queue_msg *msg, uint8_t family)
00201 {
00202 msg->queue_msg_family = family;
00203 msg->ce_mask |= QUEUE_MSG_ATTR_FAMILY;
00204 }
00205
00206 int nfnl_queue_msg_test_family(const struct nfnl_queue_msg *msg)
00207 {
00208 return !!(msg->ce_mask & QUEUE_MSG_ATTR_FAMILY);
00209 }
00210
00211 uint8_t nfnl_queue_msg_get_family(const struct nfnl_queue_msg *msg)
00212 {
00213 if (msg->ce_mask & QUEUE_MSG_ATTR_FAMILY)
00214 return msg->queue_msg_family;
00215 else
00216 return AF_UNSPEC;
00217 }
00218
00219 void nfnl_queue_msg_set_packetid(struct nfnl_queue_msg *msg, uint32_t packetid)
00220 {
00221 msg->queue_msg_packetid = packetid;
00222 msg->ce_mask |= QUEUE_MSG_ATTR_PACKETID;
00223 }
00224
00225 int nfnl_queue_msg_test_packetid(const struct nfnl_queue_msg *msg)
00226 {
00227 return !!(msg->ce_mask & QUEUE_MSG_ATTR_PACKETID);
00228 }
00229
00230 uint32_t nfnl_queue_msg_get_packetid(const struct nfnl_queue_msg *msg)
00231 {
00232 return msg->queue_msg_packetid;
00233 }
00234
00235 void nfnl_queue_msg_set_hwproto(struct nfnl_queue_msg *msg, uint16_t hwproto)
00236 {
00237 msg->queue_msg_hwproto = hwproto;
00238 msg->ce_mask |= QUEUE_MSG_ATTR_HWPROTO;
00239 }
00240
00241 int nfnl_queue_msg_test_hwproto(const struct nfnl_queue_msg *msg)
00242 {
00243 return !!(msg->ce_mask & QUEUE_MSG_ATTR_HWPROTO);
00244 }
00245
00246 uint16_t nfnl_queue_msg_get_hwproto(const struct nfnl_queue_msg *msg)
00247 {
00248 return msg->queue_msg_hwproto;
00249 }
00250
00251 void nfnl_queue_msg_set_hook(struct nfnl_queue_msg *msg, uint8_t hook)
00252 {
00253 msg->queue_msg_hook = hook;
00254 msg->ce_mask |= QUEUE_MSG_ATTR_HOOK;
00255 }
00256
00257 int nfnl_queue_msg_test_hook(const struct nfnl_queue_msg *msg)
00258 {
00259 return !!(msg->ce_mask & QUEUE_MSG_ATTR_HOOK);
00260 }
00261
00262 uint8_t nfnl_queue_msg_get_hook(const struct nfnl_queue_msg *msg)
00263 {
00264 return msg->queue_msg_hook;
00265 }
00266
00267 void nfnl_queue_msg_set_mark(struct nfnl_queue_msg *msg, uint32_t mark)
00268 {
00269 msg->queue_msg_mark = mark;
00270 msg->ce_mask |= QUEUE_MSG_ATTR_MARK;
00271 }
00272
00273 int nfnl_queue_msg_test_mark(const struct nfnl_queue_msg *msg)
00274 {
00275 return !!(msg->ce_mask & QUEUE_MSG_ATTR_MARK);
00276 }
00277
00278 uint32_t nfnl_queue_msg_get_mark(const struct nfnl_queue_msg *msg)
00279 {
00280 return msg->queue_msg_mark;
00281 }
00282
00283 void nfnl_queue_msg_set_timestamp(struct nfnl_queue_msg *msg,
00284 struct timeval *tv)
00285 {
00286 msg->queue_msg_timestamp.tv_sec = tv->tv_sec;
00287 msg->queue_msg_timestamp.tv_usec = tv->tv_usec;
00288 msg->ce_mask |= QUEUE_MSG_ATTR_TIMESTAMP;
00289 }
00290
00291 int nfnl_queue_msg_test_timestamp(const struct nfnl_queue_msg *msg)
00292 {
00293 return !!(msg->ce_mask & QUEUE_MSG_ATTR_TIMESTAMP);
00294 }
00295
00296 const struct timeval *nfnl_queue_msg_get_timestamp(const struct nfnl_queue_msg *msg)
00297 {
00298 if (!(msg->ce_mask & QUEUE_MSG_ATTR_TIMESTAMP))
00299 return NULL;
00300 return &msg->queue_msg_timestamp;
00301 }
00302
00303 void nfnl_queue_msg_set_indev(struct nfnl_queue_msg *msg, uint32_t indev)
00304 {
00305 msg->queue_msg_indev = indev;
00306 msg->ce_mask |= QUEUE_MSG_ATTR_INDEV;
00307 }
00308
00309 int nfnl_queue_msg_test_indev(const struct nfnl_queue_msg *msg)
00310 {
00311 return !!(msg->ce_mask & QUEUE_MSG_ATTR_INDEV);
00312 }
00313
00314 uint32_t nfnl_queue_msg_get_indev(const struct nfnl_queue_msg *msg)
00315 {
00316 return msg->queue_msg_indev;
00317 }
00318
00319 void nfnl_queue_msg_set_outdev(struct nfnl_queue_msg *msg, uint32_t outdev)
00320 {
00321 msg->queue_msg_outdev = outdev;
00322 msg->ce_mask |= QUEUE_MSG_ATTR_OUTDEV;
00323 }
00324
00325 int nfnl_queue_msg_test_outdev(const struct nfnl_queue_msg *msg)
00326 {
00327 return !!(msg->ce_mask & QUEUE_MSG_ATTR_OUTDEV);
00328 }
00329
00330 uint32_t nfnl_queue_msg_get_outdev(const struct nfnl_queue_msg *msg)
00331 {
00332 return msg->queue_msg_outdev;
00333 }
00334
00335 void nfnl_queue_msg_set_physindev(struct nfnl_queue_msg *msg,
00336 uint32_t physindev)
00337 {
00338 msg->queue_msg_physindev = physindev;
00339 msg->ce_mask |= QUEUE_MSG_ATTR_PHYSINDEV;
00340 }
00341
00342 int nfnl_queue_msg_test_physindev(const struct nfnl_queue_msg *msg)
00343 {
00344 return !!(msg->ce_mask & QUEUE_MSG_ATTR_PHYSINDEV);
00345 }
00346
00347 uint32_t nfnl_queue_msg_get_physindev(const struct nfnl_queue_msg *msg)
00348 {
00349 return msg->queue_msg_physindev;
00350 }
00351
00352 void nfnl_queue_msg_set_physoutdev(struct nfnl_queue_msg *msg,
00353 uint32_t physoutdev)
00354 {
00355 msg->queue_msg_physoutdev = physoutdev;
00356 msg->ce_mask |= QUEUE_MSG_ATTR_PHYSOUTDEV;
00357 }
00358
00359 int nfnl_queue_msg_test_physoutdev(const struct nfnl_queue_msg *msg)
00360 {
00361 return !!(msg->ce_mask & QUEUE_MSG_ATTR_PHYSOUTDEV);
00362 }
00363
00364 uint32_t nfnl_queue_msg_get_physoutdev(const struct nfnl_queue_msg *msg)
00365 {
00366 return msg->queue_msg_physoutdev;
00367 }
00368
00369 void nfnl_queue_msg_set_hwaddr(struct nfnl_queue_msg *msg, uint8_t *hwaddr,
00370 int len)
00371 {
00372 if (len > sizeof(msg->queue_msg_hwaddr))
00373 len = sizeof(msg->queue_msg_hwaddr);
00374
00375 msg->queue_msg_hwaddr_len = len;
00376 memcpy(msg->queue_msg_hwaddr, hwaddr, len);
00377 msg->ce_mask |= QUEUE_MSG_ATTR_HWADDR;
00378 }
00379
00380 int nfnl_queue_msg_test_hwaddr(const struct nfnl_queue_msg *msg)
00381 {
00382 return !!(msg->ce_mask & QUEUE_MSG_ATTR_HWADDR);
00383 }
00384
00385 const uint8_t *nfnl_queue_msg_get_hwaddr(const struct nfnl_queue_msg *msg,
00386 int *len)
00387 {
00388 if (!(msg->ce_mask & QUEUE_MSG_ATTR_HWADDR)) {
00389 *len = 0;
00390 return NULL;
00391 }
00392
00393 *len = msg->queue_msg_hwaddr_len;
00394 return msg->queue_msg_hwaddr;
00395 }
00396
00397 int nfnl_queue_msg_set_payload(struct nfnl_queue_msg *msg, uint8_t *payload,
00398 int len)
00399 {
00400 free(msg->queue_msg_payload);
00401 msg->queue_msg_payload = malloc(len);
00402 if (!msg->queue_msg_payload)
00403 return -NLE_NOMEM;
00404
00405 memcpy(msg->queue_msg_payload, payload, len);
00406 msg->queue_msg_payload_len = len;
00407 msg->ce_mask |= QUEUE_MSG_ATTR_PAYLOAD;
00408 return 0;
00409 }
00410
00411 int nfnl_queue_msg_test_payload(const struct nfnl_queue_msg *msg)
00412 {
00413 return !!(msg->ce_mask & QUEUE_MSG_ATTR_PAYLOAD);
00414 }
00415
00416 const void *nfnl_queue_msg_get_payload(const struct nfnl_queue_msg *msg, int *len)
00417 {
00418 if (!(msg->ce_mask & QUEUE_MSG_ATTR_PAYLOAD)) {
00419 *len = 0;
00420 return NULL;
00421 }
00422
00423 *len = msg->queue_msg_payload_len;
00424 return msg->queue_msg_payload;
00425 }
00426
00427 void nfnl_queue_msg_set_verdict(struct nfnl_queue_msg *msg,
00428 unsigned int verdict)
00429 {
00430 msg->queue_msg_verdict = verdict;
00431 msg->ce_mask |= QUEUE_MSG_ATTR_VERDICT;
00432 }
00433
00434 int nfnl_queue_msg_test_verdict(const struct nfnl_queue_msg *msg)
00435 {
00436 return !!(msg->ce_mask & QUEUE_MSG_ATTR_VERDICT);
00437 }
00438
00439 unsigned int nfnl_queue_msg_get_verdict(const struct nfnl_queue_msg *msg)
00440 {
00441 return msg->queue_msg_verdict;
00442 }
00443
00444 static struct trans_tbl nfnl_queue_msg_attrs[] = {
00445 __ADD(QUEUE_MSG_ATTR_GROUP, group)
00446 __ADD(QUEUE_MSG_ATTR_FAMILY, family)
00447 __ADD(QUEUE_MSG_ATTR_PACKETID, packetid)
00448 __ADD(QUEUE_MSG_ATTR_HWPROTO, hwproto)
00449 __ADD(QUEUE_MSG_ATTR_HOOK, hook)
00450 __ADD(QUEUE_MSG_ATTR_MARK, mark)
00451 __ADD(QUEUE_MSG_ATTR_TIMESTAMP, timestamp)
00452 __ADD(QUEUE_MSG_ATTR_INDEV, indev)
00453 __ADD(QUEUE_MSG_ATTR_OUTDEV, outdev)
00454 __ADD(QUEUE_MSG_ATTR_PHYSINDEV, physindev)
00455 __ADD(QUEUE_MSG_ATTR_PHYSOUTDEV, physoutdev)
00456 __ADD(QUEUE_MSG_ATTR_HWADDR, hwaddr)
00457 __ADD(QUEUE_MSG_ATTR_PAYLOAD, payload)
00458 __ADD(QUEUE_MSG_ATTR_VERDICT, verdict)
00459 };
00460
00461 static char *nfnl_queue_msg_attrs2str(int attrs, char *buf, size_t len)
00462 {
00463 return __flags2str(attrs, buf, len, nfnl_queue_msg_attrs,
00464 ARRAY_SIZE(nfnl_queue_msg_attrs));
00465 }
00466
00467
00468
00469 struct nl_object_ops queue_msg_obj_ops = {
00470 .oo_name = "netfilter/queuemsg",
00471 .oo_size = sizeof(struct nfnl_queue_msg),
00472 .oo_free_data = nfnl_queue_msg_free_data,
00473 .oo_clone = nfnl_queue_msg_clone,
00474 .oo_dump = {
00475 [NL_DUMP_LINE] = nfnl_queue_msg_dump,
00476 [NL_DUMP_DETAILS] = nfnl_queue_msg_dump,
00477 [NL_DUMP_STATS] = nfnl_queue_msg_dump,
00478 },
00479 .oo_attrs2str = nfnl_queue_msg_attrs2str,
00480 };
00481
00482