#include <unistd.h>

#include <fcntl.h>

#include <errno.h>

#include <string.h>

#include <sys/stat.h>

#include <limits.h>

#include <dirent.h>

#include <getopt.h>

#include <libkmod.h>

#include "log.h"

#include "util.h"

#include "strv.h"

#include "conf-files.h"

#include "virt.h"

#include "fileio.h"

static char **arg_proc_cmdline_modules = NULL;

static const char conf_file_dirs[] =

"/etc/modules-load.d\0"

"/run/modules-load.d\0"

"/usr/local/lib/modules-load.d\0"

"/usr/lib/modules-load.d\0"

#ifdef HAVE_SPLIT_USR

"/lib/modules-load.d\0"

#endif

;

#pragma GCC diagnostic push

#pragma GCC diagnostic ignored "-Wformat-nonliteral"

static void systemd_kmod_log(void *data, int priority, const char *file, int line,

const char *fn, const char *format, va_list args)

{

log_metav(priority, file, line, fn, format, args);

}

#pragma GCC diagnostic pop

static int add_modules(const char *p) {

char **t;

_cleanup_strv_free_ char **k = NULL;

k = strv_split(p, ",");

if (!k)

return log_oom();

t = strv_merge(arg_proc_cmdline_modules, k);

if (!t)

return log_oom();

strv_free(arg_proc_cmdline_modules);

arg_proc_cmdline_modules = t;

return 0;

}

static int parse_proc_cmdline(void) {

_cleanup_free_ char *line = NULL;

char *w, *state;

int r;

size_t l;

if (detect_container(NULL) > 0)

return 0;

r = read_one_line_file("/proc/cmdline", &line);

if (r < 0) {

log_warning("Failed to read /proc/cmdline, ignoring: %s", strerror(-r));

return 0;

}

FOREACH_WORD_QUOTED(w, l, line, state) {

_cleanup_free_ char *word;

word = strndup(w, l);

if (!word)

return log_oom();

if (startswith(word, "modules-load=")) {

r = add_modules(word + 13);

if (r < 0)

return r;

} else if (startswith(word, "rd.modules-load=")) {

if (in_initrd()) {

r = add_modules(word + 16);

if (r < 0)

return r;

}

}

}

return 0;

}

static int load_module(struct kmod_ctx *ctx, const char *m) {

const int probe_flags = KMOD_PROBE_APPLY_BLACKLIST;

struct kmod_list *itr, *modlist = NULL;

int r = 0;

log_debug("load: %s\n", m);

r = kmod_module_new_from_lookup(ctx, m, &modlist);

if (r < 0) {

log_error("Failed to lookup alias '%s': %s", m, strerror(-r));

return r;

}

if (!modlist) {

log_error("Failed to find module '%s'", m);

return -ENOENT;

}

kmod_list_foreach(itr, modlist) {

struct kmod_module *mod;

int state, err;

mod = kmod_module_get_module(itr);

state = kmod_module_get_initstate(mod);

switch (state) {

case KMOD_MODULE_BUILTIN:

log_info("Module '%s' is builtin", kmod_module_get_name(mod));

break;

case KMOD_MODULE_LIVE:

log_debug("Module '%s' is already loaded", kmod_module_get_name(mod));

break;

default:

err = kmod_module_probe_insert_module(mod, probe_flags,

NULL, NULL, NULL, NULL);

if (err == 0)

log_info("Inserted module '%s'", kmod_module_get_name(mod));

else if (err == KMOD_PROBE_APPLY_BLACKLIST)

log_info("Module '%s' is blacklisted", kmod_module_get_name(mod));

else {

log_error("Failed to insert '%s': %s", kmod_module_get_name(mod),

strerror(-err));

r = err;

}

}

kmod_module_unref(mod);

}

kmod_module_unref_list(modlist);

return r;

}

static int apply_file(struct kmod_ctx *ctx, const char *path, bool ignore_enoent) {

_cleanup_fclose_ FILE *f = NULL;

int r;

assert(ctx);

assert(path);

r = search_and_fopen_nulstr(path, "re", conf_file_dirs, &f);

if (r < 0) {

if (ignore_enoent && r == -ENOENT)

return 0;

log_error("Failed to open %s, ignoring: %s", path, strerror(-r));

return r;

}

log_debug("apply: %s\n", path);

for (;;) {

char line[LINE_MAX], *l;

int k;

if (!fgets(line, sizeof(line), f)) {

if (feof(f))

break;

log_error("Failed to read file '%s', ignoring: %m", path);

return -errno;

}

l = strstrip(line);

if (!*l)

continue;

if (strchr(COMMENTS "\n", *l))

continue;

k = load_module(ctx, l);

if (k < 0 && r == 0)

r = k;

}

return r;

}

static int help(void) {

printf("%s [OPTIONS...] [CONFIGURATION FILE...]\n\n"

"Loads statically configured kernel modules.\n\n"

" -h --help Show this help\n",

program_invocation_short_name);

return 0;

}

static int parse_argv(int argc, char *argv[]) {

static const struct option options[] = {

{ "help", no_argument, NULL, 'h' },

{ NULL, 0, NULL, 0 }

};

int c;

assert(argc >= 0);

assert(argv);

while ((c = getopt_long(argc, argv, "h", options, NULL)) >= 0) {

switch (c) {

case 'h':

help();

return 0;

case '?':

return -EINVAL;

default:

log_error("Unknown option code %c", c);

return -EINVAL;

}

}

return 1;

}

int main(int argc, char *argv[]) {

int r, k;

struct kmod_ctx *ctx;

r = parse_argv(argc, argv);

if (r <= 0)

return r < 0 ? EXIT_FAILURE : EXIT_SUCCESS;

log_set_target(LOG_TARGET_AUTO);

log_parse_environment();

log_open();

umask(0022);

if (parse_proc_cmdline() < 0)

return EXIT_FAILURE;

ctx = kmod_new(NULL, NULL);

if (!ctx) {

log_error("Failed to allocate memory for kmod.");

goto finish;

}

kmod_load_resources(ctx);

kmod_set_log_fn(ctx, systemd_kmod_log, NULL);

r = 0;

if (argc > optind) {

int i;

for (i = optind; i < argc; i++) {

k = apply_file(ctx, argv[i], false);

if (k < 0 && r == 0)

r = k;

}

} else {

_cleanup_free_ char **files = NULL;

char **fn, **i;

STRV_FOREACH(i, arg_proc_cmdline_modules) {

k = load_module(ctx, *i);

if (k < 0 && r == 0)

r = k;

}

r = conf_files_list_nulstr(&files, ".conf", NULL, conf_file_dirs);

if (r < 0) {

log_error("Failed to enumerate modules-load.d files: %s", strerror(-r));

goto finish;

}

STRV_FOREACH(fn, files) {

k = apply_file(ctx, *fn, true);

if (k < 0 && r == 0)

r = k;

}

}

finish:

kmod_unref(ctx);

strv_free(arg_proc_cmdline_modules);

return r < 0 ? EXIT_FAILURE : EXIT_SUCCESS;

}