|
Packit |
d3f73b |
/*
|
|
Packit |
d3f73b |
* q_etf.c Earliest TxTime First (ETF).
|
|
Packit |
d3f73b |
*
|
|
Packit |
d3f73b |
* This program is free software; you can redistribute it and/or
|
|
Packit |
d3f73b |
* modify it under the terms of the GNU General Public License
|
|
Packit |
d3f73b |
* as published by the Free Software Foundation; either version
|
|
Packit |
d3f73b |
* 2 of the License, or (at your option) any later version.
|
|
Packit |
d3f73b |
*
|
|
Packit |
d3f73b |
* Authors: Vinicius Costa Gomes <vinicius.gomes@intel.com>
|
|
Packit |
d3f73b |
* Jesus Sanchez-Palencia <jesus.sanchez-palencia@intel.com>
|
|
Packit |
d3f73b |
*
|
|
Packit |
d3f73b |
*/
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
#include <stdio.h>
|
|
Packit |
d3f73b |
#include <stdlib.h>
|
|
Packit |
d3f73b |
#include <unistd.h>
|
|
Packit |
d3f73b |
#include <fcntl.h>
|
|
Packit |
d3f73b |
#include <sys/ioctl.h>
|
|
Packit |
d3f73b |
#include <sys/socket.h>
|
|
Packit |
d3f73b |
#include <netinet/in.h>
|
|
Packit |
d3f73b |
#include <arpa/inet.h>
|
|
Packit |
d3f73b |
#include <string.h>
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
#include "utils.h"
|
|
Packit |
d3f73b |
#include "tc_util.h"
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
#define CLOCKID_INVALID (-1)
|
|
Packit |
d3f73b |
static const struct static_clockid {
|
|
Packit |
d3f73b |
const char *name;
|
|
Packit |
d3f73b |
clockid_t clockid;
|
|
Packit |
d3f73b |
} clockids_sysv[] = {
|
|
Packit |
d3f73b |
{ "REALTIME", CLOCK_REALTIME },
|
|
Packit |
d3f73b |
{ "TAI", CLOCK_TAI },
|
|
Packit |
d3f73b |
{ "BOOTTIME", CLOCK_BOOTTIME },
|
|
Packit |
d3f73b |
{ "MONOTONIC", CLOCK_MONOTONIC },
|
|
Packit |
d3f73b |
{ NULL }
|
|
Packit |
d3f73b |
};
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static void explain(void)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
fprintf(stderr,
|
|
Packit |
d3f73b |
"Usage: ... etf delta NANOS clockid CLOCKID [offload] [deadline_mode]\n"
|
|
Packit |
d3f73b |
"CLOCKID must be a valid SYS-V id (i.e. CLOCK_TAI)\n");
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static void explain1(const char *arg, const char *val)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
fprintf(stderr, "etf: illegal value for \"%s\": \"%s\"\n", arg, val);
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static void explain_clockid(const char *val)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
fprintf(stderr,
|
|
Packit |
d3f73b |
"etf: illegal value for \"clockid\": \"%s\".\n"
|
|
Packit |
d3f73b |
"It must be a valid SYS-V id (i.e. CLOCK_TAI)\n",
|
|
Packit |
d3f73b |
val);
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static int get_clockid(__s32 *val, const char *arg)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
const struct static_clockid *c;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
/* Drop the CLOCK_ prefix if that is being used. */
|
|
Packit |
d3f73b |
if (strcasestr(arg, "CLOCK_") != NULL)
|
|
Packit |
d3f73b |
arg += sizeof("CLOCK_") - 1;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
for (c = clockids_sysv; c->name; c++) {
|
|
Packit |
d3f73b |
if (strcasecmp(c->name, arg) == 0) {
|
|
Packit |
d3f73b |
*val = c->clockid;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
return 0;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static const char* get_clock_name(clockid_t clockid)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
const struct static_clockid *c;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
for (c = clockids_sysv; c->name; c++) {
|
|
Packit |
d3f73b |
if (clockid == c->clockid)
|
|
Packit |
d3f73b |
return c->name;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
return "invalid";
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static int etf_parse_opt(struct qdisc_util *qu, int argc,
|
|
Packit |
d3f73b |
char **argv, struct nlmsghdr *n, const char *dev)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
struct tc_etf_qopt opt = {
|
|
Packit |
d3f73b |
.clockid = CLOCKID_INVALID,
|
|
Packit |
d3f73b |
};
|
|
Packit |
d3f73b |
struct rtattr *tail;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
while (argc > 0) {
|
|
Packit |
d3f73b |
if (matches(*argv, "offload") == 0) {
|
|
Packit |
d3f73b |
if (opt.flags & TC_ETF_OFFLOAD_ON) {
|
|
Packit |
d3f73b |
fprintf(stderr, "etf: duplicate \"offload\" specification\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
opt.flags |= TC_ETF_OFFLOAD_ON;
|
|
Packit |
d3f73b |
} else if (matches(*argv, "deadline_mode") == 0) {
|
|
Packit |
d3f73b |
if (opt.flags & TC_ETF_DEADLINE_MODE_ON) {
|
|
Packit |
d3f73b |
fprintf(stderr, "etf: duplicate \"deadline_mode\" specification\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
opt.flags |= TC_ETF_DEADLINE_MODE_ON;
|
|
Packit |
d3f73b |
} else if (matches(*argv, "delta") == 0) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (opt.delta) {
|
|
Packit |
d3f73b |
fprintf(stderr, "etf: duplicate \"delta\" specification\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
if (get_s32(&opt.delta, *argv, 0)) {
|
|
Packit |
d3f73b |
explain1("delta", *argv);
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
} else if (matches(*argv, "clockid") == 0) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (opt.clockid != CLOCKID_INVALID) {
|
|
Packit |
d3f73b |
fprintf(stderr, "etf: duplicate \"clockid\" specification\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
if (get_clockid(&opt.clockid, *argv)) {
|
|
Packit |
d3f73b |
explain_clockid(*argv);
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
} else if (strcmp(*argv, "help") == 0) {
|
|
Packit |
d3f73b |
explain();
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
} else {
|
|
Packit |
d3f73b |
fprintf(stderr, "etf: unknown parameter \"%s\"\n", *argv);
|
|
Packit |
d3f73b |
explain();
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
argc--; argv++;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
tail = NLMSG_TAIL(n);
|
|
Packit |
d3f73b |
addattr_l(n, 1024, TCA_OPTIONS, NULL, 0);
|
|
Packit |
d3f73b |
addattr_l(n, 2024, TCA_ETF_PARMS, &opt, sizeof(opt));
|
|
Packit |
d3f73b |
tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
|
|
Packit |
d3f73b |
return 0;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static int etf_print_opt(struct qdisc_util *qu, FILE *f, struct rtattr *opt)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
struct rtattr *tb[TCA_ETF_MAX+1];
|
|
Packit |
d3f73b |
struct tc_etf_qopt *qopt;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (opt == NULL)
|
|
Packit |
d3f73b |
return 0;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
parse_rtattr_nested(tb, TCA_ETF_MAX, opt);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (tb[TCA_ETF_PARMS] == NULL)
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
qopt = RTA_DATA(tb[TCA_ETF_PARMS]);
|
|
Packit |
d3f73b |
if (RTA_PAYLOAD(tb[TCA_ETF_PARMS]) < sizeof(*qopt))
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
print_string(PRINT_ANY, "clockid", "clockid %s ",
|
|
Packit |
d3f73b |
get_clock_name(qopt->clockid));
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
print_uint(PRINT_ANY, "delta", "delta %d ", qopt->delta);
|
|
Packit |
d3f73b |
print_string(PRINT_ANY, "offload", "offload %s ",
|
|
Packit |
d3f73b |
(qopt->flags & TC_ETF_OFFLOAD_ON) ? "on" : "off");
|
|
Packit |
d3f73b |
print_string(PRINT_ANY, "deadline_mode", "deadline_mode %s",
|
|
Packit |
d3f73b |
(qopt->flags & TC_ETF_DEADLINE_MODE_ON) ? "on" : "off");
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
return 0;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
struct qdisc_util etf_qdisc_util = {
|
|
Packit |
d3f73b |
.id = "etf",
|
|
Packit |
d3f73b |
.parse_qopt = etf_parse_opt,
|
|
Packit |
d3f73b |
.print_qopt = etf_print_opt,
|
|
Packit |
d3f73b |
};
|