| // 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/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; |
| } |