forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
268 lines
5.1 KiB
268 lines
5.1 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
/* |
|
* Guest agent for virtio-trace |
|
* |
|
* Copyright (C) 2012 Hitachi, Ltd. |
|
* Created by Yoshihiro Yunomae <[email protected]> |
|
* Masami Hiramatsu <[email protected]> |
|
*/ |
|
|
|
#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; |
|
}
|
|
|