Blame tc/p_ip6.c

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
};