| #include "util.h" | |
| #include "debugfs.h" | |
| #include "cache.h" | |
| static int debugfs_premounted; | |
| static char debugfs_mountpoint[MAX_PATH+1]; | |
| static const char *debugfs_known_mountpoints[] = { | |
| "/sys/kernel/debug/", | |
| "/debug/", | |
| 0, | |
| }; | |
| /* use this to force a umount */ | |
| void debugfs_force_cleanup(void) | |
| { | |
| debugfs_find_mountpoint(); | |
| debugfs_premounted = 0; | |
| debugfs_umount(); | |
| } | |
| /* construct a full path to a debugfs element */ | |
| int debugfs_make_path(const char *element, char *buffer, int size) | |
| { | |
| int len; | |
| if (strlen(debugfs_mountpoint) == 0) { | |
| buffer[0] = '\0'; | |
| return -1; | |
| } | |
| len = strlen(debugfs_mountpoint) + strlen(element) + 1; | |
| if (len >= size) | |
| return len+1; | |
| snprintf(buffer, size-1, "%s/%s", debugfs_mountpoint, element); | |
| return 0; | |
| } | |
| static int debugfs_found; | |
| /* find the path to the mounted debugfs */ | |
| const char *debugfs_find_mountpoint(void) | |
| { | |
| const char **ptr; | |
| char type[100]; | |
| FILE *fp; | |
| if (debugfs_found) | |
| return (const char *) debugfs_mountpoint; | |
| ptr = debugfs_known_mountpoints; | |
| while (*ptr) { | |
| if (debugfs_valid_mountpoint(*ptr) == 0) { | |
| debugfs_found = 1; | |
| strcpy(debugfs_mountpoint, *ptr); | |
| return debugfs_mountpoint; | |
| } | |
| ptr++; | |
| } | |
| /* give up and parse /proc/mounts */ | |
| fp = fopen("/proc/mounts", "r"); | |
| if (fp == NULL) | |
| die("Can't open /proc/mounts for read"); | |
| while (fscanf(fp, "%*s %" | |
| STR(MAX_PATH) | |
| "s %99s %*s %*d %*d\n", | |
| debugfs_mountpoint, type) == 2) { | |
| if (strcmp(type, "debugfs") == 0) | |
| break; | |
| } | |
| fclose(fp); | |
| if (strcmp(type, "debugfs") != 0) | |
| return NULL; | |
| debugfs_found = 1; | |
| return debugfs_mountpoint; | |
| } | |
| /* verify that a mountpoint is actually a debugfs instance */ | |
| int debugfs_valid_mountpoint(const char *debugfs) | |
| { | |
| struct statfs st_fs; | |
| if (statfs(debugfs, &st_fs) < 0) | |
| return -ENOENT; | |
| else if (st_fs.f_type != (long) DEBUGFS_MAGIC) | |
| return -ENOENT; | |
| return 0; | |
| } | |
| int debugfs_valid_entry(const char *path) | |
| { | |
| struct stat st; | |
| if (stat(path, &st)) | |
| return -errno; | |
| return 0; | |
| } | |
| /* mount the debugfs somewhere if it's not mounted */ | |
| char *debugfs_mount(const char *mountpoint) | |
| { | |
| /* see if it's already mounted */ | |
| if (debugfs_find_mountpoint()) { | |
| debugfs_premounted = 1; | |
| return debugfs_mountpoint; | |
| } | |
| /* if not mounted and no argument */ | |
| if (mountpoint == NULL) { | |
| /* see if environment variable set */ | |
| mountpoint = getenv(PERF_DEBUGFS_ENVIRONMENT); | |
| /* if no environment variable, use default */ | |
| if (mountpoint == NULL) | |
| mountpoint = "/sys/kernel/debug"; | |
| } | |
| if (mount(NULL, mountpoint, "debugfs", 0, NULL) < 0) | |
| return NULL; | |
| /* save the mountpoint */ | |
| strncpy(debugfs_mountpoint, mountpoint, sizeof(debugfs_mountpoint)); | |
| debugfs_found = 1; | |
| return debugfs_mountpoint; | |
| } | |
| /* umount the debugfs */ | |
| int debugfs_umount(void) | |
| { | |
| char umountcmd[128]; | |
| int ret; | |
| /* if it was already mounted, leave it */ | |
| if (debugfs_premounted) | |
| return 0; | |
| /* make sure it's a valid mount point */ | |
| ret = debugfs_valid_mountpoint(debugfs_mountpoint); | |
| if (ret) | |
| return ret; | |
| snprintf(umountcmd, sizeof(umountcmd), | |
| "/bin/umount %s", debugfs_mountpoint); | |
| return system(umountcmd); | |
| } | |
| int debugfs_write(const char *entry, const char *value) | |
| { | |
| char path[MAX_PATH+1]; | |
| int ret, count; | |
| int fd; | |
| /* construct the path */ | |
| snprintf(path, sizeof(path), "%s/%s", debugfs_mountpoint, entry); | |
| /* verify that it exists */ | |
| ret = debugfs_valid_entry(path); | |
| if (ret) | |
| return ret; | |
| /* get how many chars we're going to write */ | |
| count = strlen(value); | |
| /* open the debugfs entry */ | |
| fd = open(path, O_RDWR); | |
| if (fd < 0) | |
| return -errno; | |
| while (count > 0) { | |
| /* write it */ | |
| ret = write(fd, value, count); | |
| if (ret <= 0) { | |
| if (ret == EAGAIN) | |
| continue; | |
| close(fd); | |
| return -errno; | |
| } | |
| count -= ret; | |
| } | |
| /* close it */ | |
| close(fd); | |
| /* return success */ | |
| return 0; | |
| } | |
| /* | |
| * read a debugfs entry | |
| * returns the number of chars read or a negative errno | |
| */ | |
| int debugfs_read(const char *entry, char *buffer, size_t size) | |
| { | |
| char path[MAX_PATH+1]; | |
| int ret; | |
| int fd; | |
| /* construct the path */ | |
| snprintf(path, sizeof(path), "%s/%s", debugfs_mountpoint, entry); | |
| /* verify that it exists */ | |
| ret = debugfs_valid_entry(path); | |
| if (ret) | |
| return ret; | |
| /* open the debugfs entry */ | |
| fd = open(path, O_RDONLY); | |
| if (fd < 0) | |
| return -errno; | |
| do { | |
| /* read it */ | |
| ret = read(fd, buffer, size); | |
| if (ret == 0) { | |
| close(fd); | |
| return EOF; | |
| } | |
| } while (ret < 0 && errno == EAGAIN); | |
| /* close it */ | |
| close(fd); | |
| /* make *sure* there's a null character at the end */ | |
| buffer[ret] = '\0'; | |
| /* return the number of chars read */ | |
| return ret; | |
| } |