|
Packit Service |
3880ab |
/*
|
|
Packit Service |
3880ab |
* p_ip6.c packet editor: IPV6 header
|
|
Packit Service |
3880ab |
*
|
|
Packit Service |
3880ab |
* This program is free software; you can distribute 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: Amir Vadai <amir@vadai.me>
|
|
Packit Service |
3880ab |
*
|
|
Packit Service |
3880ab |
*/
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
#include <stdio.h>
|
|
Packit Service |
3880ab |
#include <stdlib.h>
|
|
Packit Service |
3880ab |
#include <unistd.h>
|
|
Packit Service |
3880ab |
#include <fcntl.h>
|
|
Packit Service |
3880ab |
#include <sys/socket.h>
|
|
Packit Service |
3880ab |
#include <netinet/in.h>
|
|
Packit Service |
3880ab |
#include <arpa/inet.h>
|
|
Packit Service |
3880ab |
#include <string.h>
|
|
Packit Service |
3880ab |
#include "utils.h"
|
|
Packit Service |
3880ab |
#include "tc_util.h"
|
|
Packit Service |
3880ab |
#include "m_pedit.h"
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
static int
|
|
Packit Service |
3880ab |
parse_ip6(int *argc_p, char ***argv_p,
|
|
Packit Service |
3880ab |
struct m_pedit_sel *sel, struct m_pedit_key *tkey)
|
|
Packit Service |
3880ab |
{
|
|
Packit Service |
3880ab |
int res = -1;
|
|
Packit Service |
3880ab |
int argc = *argc_p;
|
|
Packit Service |
3880ab |
char **argv = *argv_p;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (argc < 2)
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (!sel->extended)
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
tkey->htype = TCA_PEDIT_KEY_EX_HDR_TYPE_IP6;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
if (strcmp(*argv, "src") == 0) {
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
tkey->off = 8;
|
|
Packit Service |
3880ab |
res = parse_cmd(&argc, &argv, 16, TIPV6, RU32, sel, tkey);
|
|
Packit Service |
3880ab |
goto done;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (strcmp(*argv, "dst") == 0) {
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
tkey->off = 24;
|
|
Packit Service |
3880ab |
res = parse_cmd(&argc, &argv, 16, TIPV6, RU32, sel, tkey);
|
|
Packit Service |
3880ab |
goto done;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (strcmp(*argv, "flow_lbl") == 0) {
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
tkey->off = 0;
|
|
Packit Service |
3880ab |
res = parse_cmd(&argc, &argv, 4, TU32, 0x0007ffff, sel, tkey);
|
|
Packit Service |
3880ab |
goto done;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (strcmp(*argv, "payload_len") == 0) {
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
tkey->off = 4;
|
|
Packit Service |
3880ab |
res = parse_cmd(&argc, &argv, 2, TU32, RU16, sel, tkey);
|
|
Packit Service |
3880ab |
goto done;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (strcmp(*argv, "nexthdr") == 0) {
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
tkey->off = 6;
|
|
Packit Service |
3880ab |
res = parse_cmd(&argc, &argv, 1, TU32, RU8, sel, tkey);
|
|
Packit Service |
3880ab |
goto done;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (strcmp(*argv, "hoplimit") == 0) {
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
tkey->off = 7;
|
|
Packit Service |
3880ab |
res = parse_cmd(&argc, &argv, 1, TU32, RU8, sel, tkey);
|
|
Packit Service |
3880ab |
goto done;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
if (strcmp(*argv, "traffic_class") == 0) {
|
|
Packit Service |
3880ab |
NEXT_ARG();
|
|
Packit Service |
3880ab |
tkey->off = 1;
|
|
Packit Service |
3880ab |
res = parse_cmd(&argc, &argv, 1, TU32, RU8, sel, tkey);
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
/* Shift the field by 4 bits on success. */
|
|
Packit Service |
3880ab |
if (!res) {
|
|
Packit Service |
3880ab |
int nkeys = sel->sel.nkeys;
|
|
Packit Service |
3880ab |
struct tc_pedit_key *key = &sel->sel.keys[nkeys - 1];
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
key->mask = htonl(ntohl(key->mask) << 4 | 0xf);
|
|
Packit Service |
3880ab |
key->val = htonl(ntohl(key->val) << 4);
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
goto done;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
return -1;
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
done:
|
|
Packit Service |
3880ab |
*argc_p = argc;
|
|
Packit Service |
3880ab |
*argv_p = argv;
|
|
Packit Service |
3880ab |
return res;
|
|
Packit Service |
3880ab |
}
|
|
Packit Service |
3880ab |
|
|
Packit Service |
3880ab |
struct m_pedit_util p_pedit_ip6 = {
|
|
Packit Service |
3880ab |
.id = "ip6",
|
|
Packit Service |
3880ab |
.parse_peopt = parse_ip6,
|
|
Packit Service |
3880ab |
};
|