validate: fix indentation
[project/ubox.git] / kmodloader.c
index 623a169..633570f 100644 (file)
@@ -55,6 +55,7 @@ struct module {
 
        char *name;
        char *depends;
+       char *opts;
 
        int size;
        int usage;
@@ -111,8 +112,7 @@ static char* get_module_name(char *path)
        return name;
 }
 
-#if __WORDSIZE == 64
-static int elf_find_section(char *map, const char *section, unsigned int *offset, unsigned int *size)
+static int elf64_find_section(char *map, const char *section, unsigned int *offset, unsigned int *size)
 {
        const char *secnames;
        Elf64_Ehdr *e;
@@ -133,8 +133,8 @@ static int elf_find_section(char *map, const char *section, unsigned int *offset
 
        return -1;
 }
-#else
-static int elf_find_section(char *map, const char *section, unsigned int *offset, unsigned int *size)
+
+static int elf32_find_section(char *map, const char *section, unsigned int *offset, unsigned int *size)
 {
        const char *secnames;
        Elf32_Ehdr *e;
@@ -155,7 +155,20 @@ static int elf_find_section(char *map, const char *section, unsigned int *offset
 
        return -1;
 }
-#endif
+
+static int elf_find_section(char *map, const char *section, unsigned int *offset, unsigned int *size)
+{
+       int clazz = map[EI_CLASS];
+
+       if (clazz == ELFCLASS32)
+               return elf32_find_section(map, section, offset, size);
+       else if (clazz == ELFCLASS64)
+               return elf64_find_section(map, section, offset, size);
+
+       LOG("unknown elf format %d\n", clazz);
+
+       return -1;
+}
 
 static struct module *
 alloc_module(const char *name, const char *depends, int size)
@@ -170,6 +183,7 @@ alloc_module(const char *name, const char *depends, int size)
                return NULL;
 
        m->avl.key = m->name = strcpy(_name, name);
+       m->opts = 0;
 
        if (depends) {
                m->depends = strcpy(_dep, depends);
@@ -284,8 +298,8 @@ static int scan_module_folder(void)
        int j;
 
        uname(&ver);
-       path = alloca(sizeof(DEF_MOD_PATH "*.ko") + strlen(ver.release) + 1);
-       sprintf(path, DEF_MOD_PATH "*.ko", ver.release);
+       path = alloca(sizeof(DEF_MOD_PATH "*.ko") + strlen(prefix) + strlen(ver.release) + 1);
+       sprintf(path, "%s" DEF_MOD_PATH "*.ko", prefix, ver.release);
 
        if (glob(path, gl_flags, NULL, &gl) < 0)
                return -1;
@@ -406,7 +420,7 @@ static int insert_module(char *path, const char *options)
 
        data = malloc(s.st_size);
        if (read(fd, data, s.st_size) == s.st_size)
-               ret = syscall(__NR_init_module, data, s.st_size, options);
+               ret = syscall(__NR_init_module, data, (unsigned long) s.st_size, options);
        else
                LOG("failed to read full module %s\n", path);
 
@@ -455,7 +469,7 @@ static int load_modprobe(void)
                todo = 0;
                avl_for_each_element(&modules, m, avl) {
                        if ((m->state == PROBE) && (!deps_available(m, 0))) {
-                               if (!insert_module(get_module_path(m->name), "")) {
+                               if (!insert_module(get_module_path(m->name), (m->opts) ? (m->opts) : (""))) {
                                        m->state = LOADED;
                                        m->error = 0;
                                        loaded++;
@@ -526,6 +540,13 @@ static int main_insmod(int argc, char **argv)
                cur += sprintf(cur, "%s", argv[i]);
        }
 
+       if (get_module_path(argv[1])) {
+               name = argv[1];
+       } else if (!get_module_path(name)) {
+               fprintf(stderr, "Failed to find %s. Maybe it is a built in module ?\n", name);
+               return -1;
+       }
+
        ret = insert_module(get_module_path(name), options);
        free(options);
 
@@ -709,6 +730,8 @@ static int main_loader(int argc, char **argv)
                        if (!m || (m->state == LOADED))
                                continue;
 
+                       if (opts)
+                               m->opts = strdup(opts);
                        m->state = PROBE;
                        if (basename(gl.gl_pathv[j])[0] - '0' <= 9)
                                load_modprobe();