/* * libkmod - interface to kernel module operations * * Copyright (C) 2011 ProFUSION embedded systems * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License as published by the Free Software Foundation version 2.1. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this library; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "libkmod.h" #include "libkmod-private.h" /** * kmod_module: * * Opaque object representing a module. */ struct kmod_module { struct kmod_ctx *ctx; const char *path; struct kmod_list *dep; int refcount; struct { bool dep : 1; } init; char name[]; }; static char *path_to_modname(const char *path, char buf[NAME_MAX], size_t *len) { char *modname; char *c; size_t s; modname = basename(path); if (modname == NULL || modname[0] == '\0') return NULL; if (buf) { buf[NAME_MAX] = '\0'; modname = strncpy(buf, modname, NAME_MAX - 1); } for (c = modname, s = 0; *c != '\0' && *c != '.'; c++) { if (*c == '-') *c = '_'; s++; } if (len) *len = s; *c = '\0'; return modname; } int kmod_module_parse_dep(struct kmod_module *mod, char *line) { struct kmod_ctx *ctx = mod->ctx; struct kmod_list *list = NULL; char *p, *saveptr; int err, n = 0; assert(!mod->init.dep && mod->dep == NULL); mod->init.dep = true; p = strchr(line, ':'); if (p == NULL) return 0; p++; for (p = strtok_r(p, " \t", &saveptr); p != NULL; p = strtok_r(NULL, " \t", &saveptr)) { const char *modname = path_to_modname(p, NULL, NULL); struct kmod_module *depmod; err = kmod_module_new_from_name(ctx, modname, &depmod); if (err < 0) { ERR(ctx, "ctx=%p modname=%s error=%s\n", ctx, modname, strerror(-err)); goto fail; } DBG(ctx, "add dep: %s\n", modname); list = kmod_list_append(list, depmod); n++; } DBG(ctx, "%d dependencies for %s\n", n, mod->name); mod->dep = list; return n; fail: kmod_module_unref_list(list); mod->init.dep = false; return err; } KMOD_EXPORT int kmod_module_new_from_name(struct kmod_ctx *ctx, const char *name, struct kmod_module **mod) { struct kmod_module *m; size_t namelen; if (ctx == NULL || name == NULL) return -ENOENT; namelen = strlen(name) + 1; m = calloc(1, sizeof(*m) + namelen); if (m == NULL) { free(m); return -ENOMEM; } m->ctx = kmod_ref(ctx); memcpy(m->name, name, namelen); m->refcount = 1; *mod = m; return 0; } KMOD_EXPORT int kmod_module_new_from_path(struct kmod_ctx *ctx, const char *path, struct kmod_module **mod) { struct kmod_module *m; int err; struct stat st; char name[NAME_MAX]; size_t namelen; if (ctx == NULL || path == NULL) return -ENOENT; err = stat(path, &st); if (err < 0) return -errno; path_to_modname(path, name, &namelen); m = calloc(1, sizeof(*m) + namelen + 1); if (m == NULL) return -errno; m->path = strdup(path); if (m->path == NULL) { err = -errno; free(m); return err; } m->ctx = kmod_ref(ctx); memcpy(m->name, name, namelen); m->refcount = 1; *mod = m; return 0; } KMOD_EXPORT struct kmod_module *kmod_module_unref(struct kmod_module *mod) { if (mod == NULL) return NULL; if (--mod->refcount > 0) return mod; DBG(mod->ctx, "kmod_module %p released\n", mod); kmod_module_unref_list(mod->dep); kmod_unref(mod->ctx); free((char *) mod->path); free(mod); return NULL; } KMOD_EXPORT struct kmod_module *kmod_module_ref(struct kmod_module *mod) { if (mod == NULL) return NULL; mod->refcount++; return mod; } #define CHECK_ERR_AND_FINISH(_err, _label_err, _list, label_finish) \ do { \ if ((_err) < 0) \ goto _label_err; \ if (*(_list) != NULL) \ goto finish; \ } while (0) KMOD_EXPORT int kmod_module_new_from_lookup(struct kmod_ctx *ctx, const char *alias, struct kmod_list **list) { int err; if (ctx == NULL || alias == NULL) return -ENOENT; if (list == NULL || *list != NULL) { ERR(ctx, "An empty list is needed to create lookup\n"); return -ENOSYS; } /* Aliases from config file override all the others */ err = kmod_lookup_alias_from_config(ctx, alias, list); CHECK_ERR_AND_FINISH(err, fail, list, finish); err = kmod_lookup_alias_from_moddep_file(ctx, alias, list); CHECK_ERR_AND_FINISH(err, fail, list, finish); err = kmod_lookup_alias_from_symbols_file(ctx, alias, list); CHECK_ERR_AND_FINISH(err, fail, list, finish); err = kmod_lookup_alias_from_aliases_file(ctx, alias, list); CHECK_ERR_AND_FINISH(err, fail, list, finish); finish: return err; fail: kmod_module_unref_list(*list); *list = NULL; return err; } #undef CHECK_ERR_AND_FINISH KMOD_EXPORT int kmod_module_unref_list(struct kmod_list *list) { for (; list != NULL; list = kmod_list_remove(list)) kmod_module_unref(list->data); return 0; } /* * We don't increase the refcount. Maybe we should. */ KMOD_EXPORT struct kmod_list *kmod_module_get_dependency(const struct kmod_module *mod) { // FIXME calculate dependency if it's not initialized return mod->dep; } KMOD_EXPORT struct kmod_module *kmod_module_get_module(const struct kmod_list *entry) { if (entry == NULL) return NULL; return kmod_module_ref(entry->data); } KMOD_EXPORT long kmod_module_get_size(const struct kmod_module *mod) { // FIXME TODO: this should be available from /sys/module/foo FILE *fp; char line[4096]; int lineno = 0; long size = -ENOENT; if (mod == NULL) return -ENOENT; fp = fopen("/proc/modules", "r"); if (fp == NULL) { int err = -errno; ERR(mod->ctx, "could not open /proc/modules: %s\n", strerror(errno)); return err; } while (fgets(line, sizeof(line), fp)) { char *saveptr, *endptr, *tok = strtok_r(line, " \t", &saveptr); long value; lineno++; if (tok == NULL || strcmp(tok, mod->name) != 0) continue; tok = strtok_r(NULL, " \t", &saveptr); if (tok == NULL) { ERR(mod->ctx, "invalid line format at /proc/modules:%d\n", lineno); break; } value = strtol(tok, &endptr, 10); if (endptr == tok || *endptr != '\0') { ERR(mod->ctx, "invalid line format at /proc/modules:%d\n", lineno); break; } size = value; break; } fclose(fp); return size; } KMOD_EXPORT const char *kmod_module_get_name(const struct kmod_module *mod) { return mod->name; } KMOD_EXPORT const char *kmod_module_get_path(const struct kmod_module *mod) { // FIXME calculate path if path == NULL return mod->path; } extern long delete_module(const char *name, unsigned int flags); KMOD_EXPORT int kmod_module_remove_module(struct kmod_module *mod, unsigned int flags) { int err; if (mod == NULL) return -ENOENT; /* Filter out other flags */ flags &= (KMOD_REMOVE_FORCE | KMOD_REMOVE_NOWAIT); err = delete_module(mod->name, flags); if (err != 0) { ERR(mod->ctx, "Removing '%s': %s\n", mod->name, strerror(-err)); return err; } return 0; } extern long init_module(void *mem, unsigned long len, const char *args); KMOD_EXPORT int kmod_module_insert_module(struct kmod_module *mod, unsigned int flags) { int err; void *mmaped_file; struct stat st; int fd; const char *args = ""; if (mod == NULL) return -ENOENT; if (mod->path == NULL) { ERR(mod->ctx, "Not supported to load a module by name yet\n"); return -ENOSYS; } if (flags != 0) INFO(mod->ctx, "Flags are not implemented yet\n"); if ((fd = open(mod->path, O_RDONLY)) < 0) { err = -errno; return err; } fstat(fd, &st); if ((mmaped_file = mmap(0, st.st_size, PROT_READ, MAP_PRIVATE, fd, 0)) == MAP_FAILED) { close(fd); return -errno; } err = init_module(mmaped_file, st.st_size, args); if (err < 0) ERR(mod->ctx, "Failed to insert module '%s'\n", mod->path); munmap(mmaped_file, st.st_size); close(fd); return err; } KMOD_EXPORT const char *kmod_module_initstate_str(enum kmod_module_initstate state) { switch (state) { case KMOD_MODULE_BUILTIN: return "builtin"; case KMOD_MODULE_LIVE: return "live"; case KMOD_MODULE_COMING: return "coming"; case KMOD_MODULE_GOING: return "going"; default: return NULL; } } KMOD_EXPORT int kmod_module_get_initstate(const struct kmod_module *mod) { char path[PATH_MAX], buf[32]; int fd, err, pathlen; pathlen = snprintf(path, sizeof(path), "/sys/module/%s/initstate", mod->name); fd = open(path, O_RDONLY); if (fd < 0) { err = -errno; if (pathlen > (int)sizeof("/initstate") - 1) { struct stat st; path[pathlen - (sizeof("/initstate") - 1)] = '\0'; if (stat(path, &st) == 0 && S_ISDIR(st.st_mode)) return KMOD_MODULE_BUILTIN; } ERR(mod->ctx, "could not open '%s': %s\n", path, strerror(-err)); return err; } err = read_str_safe(fd, buf, sizeof(buf)); close(fd); if (err < 0) { ERR(mod->ctx, "could not read from '%s': %s\n", path, strerror(-err)); return err; } if (strcmp(buf, "live\n") == 0) return KMOD_MODULE_LIVE; else if (strcmp(buf, "coming\n") == 0) return KMOD_MODULE_COMING; else if (strcmp(buf, "going\n") == 0) return KMOD_MODULE_GOING; ERR(mod->ctx, "unknown %s: '%s'\n", path, buf); return -EINVAL; } KMOD_EXPORT int kmod_module_get_refcnt(const struct kmod_module *mod) { char path[PATH_MAX]; long refcnt; int fd, err; snprintf(path, sizeof(path), "/sys/module/%s/refcnt", mod->name); fd = open(path, O_RDONLY); if (fd < 0) { err = -errno; ERR(mod->ctx, "could not open '%s': %s\n", path, strerror(errno)); return err; } err = read_str_long(fd, &refcnt, 10); close(fd); if (err < 0) { ERR(mod->ctx, "could not read integer from '%s': '%s'\n", path, strerror(-err)); return err; } return (int)refcnt; } KMOD_EXPORT struct kmod_list *kmod_module_get_holders(const struct kmod_module *mod) { char dname[PATH_MAX]; struct kmod_list *list = NULL; DIR *d; if (mod == NULL) return NULL; snprintf(dname, sizeof(dname), "/sys/module/%s/holders", mod->name); d = opendir(dname); if (d == NULL) { ERR(mod->ctx, "could not open '%s': %s\n", dname, strerror(errno)); return NULL; } for (;;) { struct dirent de, *entp; struct kmod_module *holder; struct kmod_list *l; int err; err = readdir_r(d, &de, &entp); if (err != 0) { ERR(mod->ctx, "could not iterate for module '%s': %s\n", mod->name, strerror(-err)); goto fail; } if (entp == NULL) break; if (de.d_name[0] == '.') { if (de.d_name[1] == '\0' || (de.d_name[1] == '.' && de.d_name[2] == '\0')) continue; } err = kmod_module_new_from_name(mod->ctx, de.d_name, &holder); if (err < 0) { ERR(mod->ctx, "could not create module for '%s': %s\n", de.d_name, strerror(-err)); goto fail; } l = kmod_list_append(list, holder); if (l != NULL) { list = l; } else { ERR(mod->ctx, "out of memory\n"); kmod_module_unref(holder); goto fail; } } closedir(d); return list; fail: closedir(d); kmod_module_unref_list(list); return NULL; } struct kmod_module_section { unsigned long address; char name[]; }; static void kmod_module_section_free(struct kmod_module_section *section) { free(section); } KMOD_EXPORT struct kmod_list *kmod_module_get_sections(const struct kmod_module *mod) { char dname[PATH_MAX]; struct kmod_list *list = NULL; DIR *d; int dfd; if (mod == NULL) return NULL; snprintf(dname, sizeof(dname), "/sys/module/%s/sections", mod->name); d = opendir(dname); if (d == NULL) { ERR(mod->ctx, "could not open '%s': %s\n", dname, strerror(errno)); return NULL; } dfd = dirfd(d); for (;;) { struct dirent de, *entp; struct kmod_module_section *section; struct kmod_list *l; unsigned long address; size_t namesz; int fd, err; err = readdir_r(d, &de, &entp); if (err != 0) { ERR(mod->ctx, "could not iterate for module '%s': %s\n", mod->name, strerror(-err)); goto fail; } if (de.d_name[0] == '.') { if (de.d_name[1] == '\0' || (de.d_name[1] == '.' && de.d_name[2] == '\0')) continue; } fd = openat(dfd, de.d_name, O_RDONLY); if (fd < 0) { ERR(mod->ctx, "could not open '%s/%s': %m\n", dname, de.d_name); goto fail; } err = read_str_ulong(fd, &address, 16); close(fd); if (err < 0) { ERR(mod->ctx, "could not read long from '%s/%s': %m\n", dname, de.d_name); goto fail; } namesz = strlen(de.d_name) + 1; section = malloc(sizeof(*section) + namesz); if (section == NULL) { ERR(mod->ctx, "out of memory\n"); goto fail; } section->address = address; memcpy(section->name, de.d_name, namesz); l = kmod_list_append(list, section); if (l != NULL) { list = l; } else { ERR(mod->ctx, "out of memory\n"); free(section); goto fail; } } closedir(d); return list; fail: closedir(d); kmod_module_unref_list(list); return NULL; } KMOD_EXPORT const char *kmod_module_section_get_name(const struct kmod_list *entry) { struct kmod_module_section *section; if (entry == NULL) return NULL; section = entry->data; return section->name; } KMOD_EXPORT unsigned long kmod_module_section_get_address(const struct kmod_list *entry) { struct kmod_module_section *section; if (entry == NULL) return (unsigned long)-1; section = entry->data; return section->address; } KMOD_EXPORT void kmod_module_section_free_list(struct kmod_list *list) { while (list) { kmod_module_section_free(list->data); list = kmod_list_remove(list); } }