mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-25 10:19:47 +00:00
![Thomas Gleixner](/assets/img/avatar_default.png)
Based on 1 normalized pattern(s): licensed under gpl version 2 only extracted by the scancode license scanner the SPDX license identifier GPL-2.0-only has been chosen to replace the boilerplate/reference in 3 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Armijn Hemel <armijn@tjaldur.nl> Reviewed-by: Kate Stewart <kstewart@linuxfoundation.org> Reviewed-by: Richard Fontana <rfontana@redhat.com> Reviewed-by: Allison Randal <allison@lohutok.net> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070033.838202816@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
268 lines
5.1 KiB
C
268 lines
5.1 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Guest agent for virtio-trace
|
|
*
|
|
* Copyright (C) 2012 Hitachi, Ltd.
|
|
* Created by Yoshihiro Yunomae <yoshihiro.yunomae.ez@hitachi.com>
|
|
* Masami Hiramatsu <masami.hiramatsu.pt@hitachi.com>
|
|
*/
|
|
|
|
#define _GNU_SOURCE
|
|
#include <limits.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include "trace-agent.h"
|
|
|
|
#define PAGE_SIZE (sysconf(_SC_PAGE_SIZE))
|
|
#define PIPE_DEF_BUFS 16
|
|
#define PIPE_MIN_SIZE (PAGE_SIZE*PIPE_DEF_BUFS)
|
|
#define PIPE_MAX_SIZE (1024*1024)
|
|
#define READ_PATH_FMT \
|
|
"/sys/kernel/debug/tracing/per_cpu/cpu%d/trace_pipe_raw"
|
|
#define WRITE_PATH_FMT "/dev/virtio-ports/trace-path-cpu%d"
|
|
#define CTL_PATH "/dev/virtio-ports/agent-ctl-path"
|
|
|
|
pthread_mutex_t mutex_notify = PTHREAD_MUTEX_INITIALIZER;
|
|
pthread_cond_t cond_wakeup = PTHREAD_COND_INITIALIZER;
|
|
|
|
static int get_total_cpus(void)
|
|
{
|
|
int nr_cpus = (int)sysconf(_SC_NPROCESSORS_CONF);
|
|
|
|
if (nr_cpus <= 0) {
|
|
pr_err("Could not read cpus\n");
|
|
goto error;
|
|
} else if (nr_cpus > MAX_CPUS) {
|
|
pr_err("Exceed max cpus(%d)\n", (int)MAX_CPUS);
|
|
goto error;
|
|
}
|
|
|
|
return nr_cpus;
|
|
|
|
error:
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
static void *agent_info_new(void)
|
|
{
|
|
struct agent_info *s;
|
|
int i;
|
|
|
|
s = zalloc(sizeof(struct agent_info));
|
|
if (s == NULL) {
|
|
pr_err("agent_info zalloc error\n");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
s->pipe_size = PIPE_INIT;
|
|
s->use_stdout = false;
|
|
s->cpus = get_total_cpus();
|
|
s->ctl_fd = -1;
|
|
|
|
/* read/write threads init */
|
|
for (i = 0; i < s->cpus; i++)
|
|
s->rw_ti[i] = rw_thread_info_new();
|
|
|
|
return s;
|
|
}
|
|
|
|
static unsigned long parse_size(const char *arg)
|
|
{
|
|
unsigned long value, round;
|
|
char *ptr;
|
|
|
|
value = strtoul(arg, &ptr, 10);
|
|
switch (*ptr) {
|
|
case 'K': case 'k':
|
|
value <<= 10;
|
|
break;
|
|
case 'M': case 'm':
|
|
value <<= 20;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
if (value > PIPE_MAX_SIZE) {
|
|
pr_err("Pipe size must be less than 1MB\n");
|
|
goto error;
|
|
} else if (value < PIPE_MIN_SIZE) {
|
|
pr_err("Pipe size must be over 64KB\n");
|
|
goto error;
|
|
}
|
|
|
|
/* Align buffer size with page unit */
|
|
round = value & (PAGE_SIZE - 1);
|
|
value = value - round;
|
|
|
|
return value;
|
|
error:
|
|
return 0;
|
|
}
|
|
|
|
static void usage(char const *prg)
|
|
{
|
|
pr_err("usage: %s [-h] [-o] [-s <size of pipe>]\n", prg);
|
|
}
|
|
|
|
static const char *make_path(int cpu_num, bool this_is_write_path)
|
|
{
|
|
int ret;
|
|
char *buf;
|
|
|
|
buf = zalloc(PATH_MAX);
|
|
if (buf == NULL) {
|
|
pr_err("Could not allocate buffer\n");
|
|
goto error;
|
|
}
|
|
|
|
if (this_is_write_path)
|
|
/* write(output) path */
|
|
ret = snprintf(buf, PATH_MAX, WRITE_PATH_FMT, cpu_num);
|
|
else
|
|
/* read(input) path */
|
|
ret = snprintf(buf, PATH_MAX, READ_PATH_FMT, cpu_num);
|
|
|
|
if (ret <= 0) {
|
|
pr_err("Failed to generate %s path(CPU#%d):%d\n",
|
|
this_is_write_path ? "read" : "write", cpu_num, ret);
|
|
goto error;
|
|
}
|
|
|
|
return buf;
|
|
|
|
error:
|
|
free(buf);
|
|
return NULL;
|
|
}
|
|
|
|
static const char *make_input_path(int cpu_num)
|
|
{
|
|
return make_path(cpu_num, false);
|
|
}
|
|
|
|
static const char *make_output_path(int cpu_num)
|
|
{
|
|
return make_path(cpu_num, true);
|
|
}
|
|
|
|
static void *agent_info_init(struct agent_info *s)
|
|
{
|
|
int cpu;
|
|
const char *in_path = NULL;
|
|
const char *out_path = NULL;
|
|
|
|
/* init read/write threads */
|
|
for (cpu = 0; cpu < s->cpus; cpu++) {
|
|
/* set read(input) path per read/write thread */
|
|
in_path = make_input_path(cpu);
|
|
if (in_path == NULL)
|
|
goto error;
|
|
|
|
/* set write(output) path per read/write thread*/
|
|
if (!s->use_stdout) {
|
|
out_path = make_output_path(cpu);
|
|
if (out_path == NULL)
|
|
goto error;
|
|
} else
|
|
/* stdout mode */
|
|
pr_debug("stdout mode\n");
|
|
|
|
rw_thread_init(cpu, in_path, out_path, s->use_stdout,
|
|
s->pipe_size, s->rw_ti[cpu]);
|
|
}
|
|
|
|
/* init controller of read/write threads */
|
|
s->ctl_fd = rw_ctl_init((const char *)CTL_PATH);
|
|
|
|
return NULL;
|
|
|
|
error:
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
static void *parse_args(int argc, char *argv[], struct agent_info *s)
|
|
{
|
|
int cmd;
|
|
unsigned long size;
|
|
|
|
while ((cmd = getopt(argc, argv, "hos:")) != -1) {
|
|
switch (cmd) {
|
|
/* stdout mode */
|
|
case 'o':
|
|
s->use_stdout = true;
|
|
break;
|
|
/* size of pipe */
|
|
case 's':
|
|
size = parse_size(optarg);
|
|
if (size == 0)
|
|
goto error;
|
|
s->pipe_size = size;
|
|
break;
|
|
case 'h':
|
|
default:
|
|
usage(argv[0]);
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
agent_info_init(s);
|
|
|
|
return NULL;
|
|
|
|
error:
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
static void agent_main_loop(struct agent_info *s)
|
|
{
|
|
int cpu;
|
|
pthread_t rw_thread_per_cpu[MAX_CPUS];
|
|
|
|
/* Start all read/write threads */
|
|
for (cpu = 0; cpu < s->cpus; cpu++)
|
|
rw_thread_per_cpu[cpu] = rw_thread_run(s->rw_ti[cpu]);
|
|
|
|
rw_ctl_loop(s->ctl_fd);
|
|
|
|
/* Finish all read/write threads */
|
|
for (cpu = 0; cpu < s->cpus; cpu++) {
|
|
int ret;
|
|
|
|
ret = pthread_join(rw_thread_per_cpu[cpu], NULL);
|
|
if (ret != 0) {
|
|
pr_err("pthread_join() error:%d (cpu %d)\n", ret, cpu);
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void agent_info_free(struct agent_info *s)
|
|
{
|
|
int i;
|
|
|
|
close(s->ctl_fd);
|
|
for (i = 0; i < s->cpus; i++) {
|
|
close(s->rw_ti[i]->in_fd);
|
|
close(s->rw_ti[i]->out_fd);
|
|
close(s->rw_ti[i]->read_pipe);
|
|
close(s->rw_ti[i]->write_pipe);
|
|
free(s->rw_ti[i]);
|
|
}
|
|
free(s);
|
|
}
|
|
|
|
int main(int argc, char *argv[])
|
|
{
|
|
struct agent_info *s = NULL;
|
|
|
|
s = agent_info_new();
|
|
parse_args(argc, argv, s);
|
|
|
|
agent_main_loop(s);
|
|
|
|
agent_info_free(s);
|
|
|
|
return 0;
|
|
}
|