| // SPDX-License-Identifier: GPL-2.0-only | |
| /* | |
| * Copyright (c) 2021, Microsoft Corporation. | |
| * | |
| * Authors: | |
| * Beau Belgrave <[email protected]> | |
| */ | |
| #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/debug/tracing/user_events_data"; | |
| const char *status_file = "/sys/kernel/debug/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; | |
| } |