103 lines
2.0 KiB
C
103 lines
2.0 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-only
|
||
|
|
/*
|
||
|
|
* Copyright (c) 2021, Microsoft Corporation.
|
||
|
|
*
|
||
|
|
* Authors:
|
||
|
|
* Beau Belgrave <beaub@linux.microsoft.com>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <errno.h>
|
||
|
|
#include <sys/ioctl.h>
|
||
|
|
#include <sys/mman.h>
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
#include <asm/bitsperlong.h>
|
||
|
|
#include <endian.h>
|
||
|
|
#include <linux/user_events.h>
|
||
|
|
|
||
|
|
#if __BITS_PER_LONG == 64
|
||
|
|
#define endian_swap(x) htole64(x)
|
||
|
|
#else
|
||
|
|
#define endian_swap(x) htole32(x)
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/* Assumes debugfs is mounted */
|
||
|
|
const char *data_file = "/sys/kernel/tracing/user_events_data";
|
||
|
|
const char *status_file = "/sys/kernel/tracing/user_events_status";
|
||
|
|
|
||
|
|
static int event_status(long **status)
|
||
|
|
{
|
||
|
|
int fd = open(status_file, O_RDONLY);
|
||
|
|
|
||
|
|
*status = mmap(NULL, sysconf(_SC_PAGESIZE), PROT_READ,
|
||
|
|
MAP_SHARED, fd, 0);
|
||
|
|
|
||
|
|
close(fd);
|
||
|
|
|
||
|
|
if (*status == MAP_FAILED)
|
||
|
|
return -1;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int event_reg(int fd, const char *command, long *index, long *mask,
|
||
|
|
int *write)
|
||
|
|
{
|
||
|
|
struct user_reg reg = {0};
|
||
|
|
|
||
|
|
reg.size = sizeof(reg);
|
||
|
|
reg.name_args = (__u64)command;
|
||
|
|
|
||
|
|
if (ioctl(fd, DIAG_IOCSREG, ®) == -1)
|
||
|
|
return -1;
|
||
|
|
|
||
|
|
*index = reg.status_bit / __BITS_PER_LONG;
|
||
|
|
*mask = endian_swap(1L << (reg.status_bit % __BITS_PER_LONG));
|
||
|
|
*write = reg.write_index;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int main(int argc, char **argv)
|
||
|
|
{
|
||
|
|
int data_fd, write;
|
||
|
|
long index, mask;
|
||
|
|
long *status_page;
|
||
|
|
struct iovec io[2];
|
||
|
|
__u32 count = 0;
|
||
|
|
|
||
|
|
if (event_status(&status_page) == -1)
|
||
|
|
return errno;
|
||
|
|
|
||
|
|
data_fd = open(data_file, O_RDWR);
|
||
|
|
|
||
|
|
if (event_reg(data_fd, "test u32 count", &index, &mask, &write) == -1)
|
||
|
|
return errno;
|
||
|
|
|
||
|
|
/* Setup iovec */
|
||
|
|
io[0].iov_base = &write;
|
||
|
|
io[0].iov_len = sizeof(write);
|
||
|
|
io[1].iov_base = &count;
|
||
|
|
io[1].iov_len = sizeof(count);
|
||
|
|
|
||
|
|
ask:
|
||
|
|
printf("Press enter to check status...\n");
|
||
|
|
getchar();
|
||
|
|
|
||
|
|
/* Check if anyone is listening */
|
||
|
|
if (status_page[index] & mask) {
|
||
|
|
/* Yep, trace out our data */
|
||
|
|
writev(data_fd, (const struct iovec *)io, 2);
|
||
|
|
|
||
|
|
/* Increase the count */
|
||
|
|
count++;
|
||
|
|
|
||
|
|
printf("Something was attached, wrote data\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
goto ask;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|