1cea6c86cSDoug Rabson /*- 2cea6c86cSDoug Rabson * Copyright (c) 1997 Doug Rabson 3cea6c86cSDoug Rabson * All rights reserved. 4cea6c86cSDoug Rabson * 5cea6c86cSDoug Rabson * Redistribution and use in source and binary forms, with or without 6cea6c86cSDoug Rabson * modification, are permitted provided that the following conditions 7cea6c86cSDoug Rabson * are met: 8cea6c86cSDoug Rabson * 1. Redistributions of source code must retain the above copyright 9cea6c86cSDoug Rabson * notice, this list of conditions and the following disclaimer. 10cea6c86cSDoug Rabson * 2. Redistributions in binary form must reproduce the above copyright 11cea6c86cSDoug Rabson * notice, this list of conditions and the following disclaimer in the 12cea6c86cSDoug Rabson * documentation and/or other materials provided with the distribution. 13cea6c86cSDoug Rabson * 14cea6c86cSDoug Rabson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15cea6c86cSDoug Rabson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16cea6c86cSDoug Rabson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17cea6c86cSDoug Rabson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18cea6c86cSDoug Rabson * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19cea6c86cSDoug Rabson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20cea6c86cSDoug Rabson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21cea6c86cSDoug Rabson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22cea6c86cSDoug Rabson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23cea6c86cSDoug Rabson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24cea6c86cSDoug Rabson * SUCH DAMAGE. 25cea6c86cSDoug Rabson * 263cfc69e6SMatthew Dillon * $Id: kern_module.c,v 1.15 1999/01/27 21:49:56 dillon Exp $ 27cea6c86cSDoug Rabson */ 28cea6c86cSDoug Rabson 29cea6c86cSDoug Rabson #include <sys/param.h> 30cea6c86cSDoug Rabson #include <sys/kernel.h> 31cea6c86cSDoug Rabson #include <sys/systm.h> 32cea6c86cSDoug Rabson #include <sys/malloc.h> 33cea6c86cSDoug Rabson #include <sys/sysproto.h> 34cea6c86cSDoug Rabson #include <sys/sysent.h> 35cea6c86cSDoug Rabson #include <sys/module.h> 36cea6c86cSDoug Rabson #include <sys/linker.h> 37cb226aaaSPoul-Henning Kamp #include <sys/proc.h> 38cea6c86cSDoug Rabson 39cea6c86cSDoug Rabson #define M_MODULE M_TEMP /* XXX */ 40cea6c86cSDoug Rabson 41cea6c86cSDoug Rabson typedef TAILQ_HEAD(, module) modulelist_t; 42cea6c86cSDoug Rabson struct module { 43cea6c86cSDoug Rabson TAILQ_ENTRY(module) link; /* chain together all modules */ 44cea6c86cSDoug Rabson TAILQ_ENTRY(module) flink; /* all modules in a file */ 45cea6c86cSDoug Rabson struct linker_file* file; /* file which contains this module */ 46cea6c86cSDoug Rabson int refs; /* reference count */ 47cea6c86cSDoug Rabson int id; /* unique id number */ 48cea6c86cSDoug Rabson char *name; /* module name */ 49cea6c86cSDoug Rabson modeventhand_t handler; /* event handler */ 50cea6c86cSDoug Rabson void *arg; /* argument for handler */ 51a35261efSDoug Rabson modspecific_t data; /* module specific data */ 52cea6c86cSDoug Rabson }; 53cea6c86cSDoug Rabson 54cea6c86cSDoug Rabson #define MOD_EVENT(mod, type) (mod)->handler((mod), (type), (mod)->arg) 55cea6c86cSDoug Rabson 56cea6c86cSDoug Rabson static modulelist_t modules; 57cea6c86cSDoug Rabson static int nextid = 1; 58cea6c86cSDoug Rabson 59cea6c86cSDoug Rabson static void module_shutdown(int, void*); 60cea6c86cSDoug Rabson 61cea6c86cSDoug Rabson static void 62cea6c86cSDoug Rabson module_init(void* arg) 63cea6c86cSDoug Rabson { 64cea6c86cSDoug Rabson TAILQ_INIT(&modules); 65cea6c86cSDoug Rabson at_shutdown(module_shutdown, 0, SHUTDOWN_POST_SYNC); 66cea6c86cSDoug Rabson } 67cea6c86cSDoug Rabson 68aa855a59SPeter Wemm SYSINIT(module, SI_SUB_KLD, SI_ORDER_FIRST, module_init, 0); 69cea6c86cSDoug Rabson 70cea6c86cSDoug Rabson static void 71cea6c86cSDoug Rabson module_shutdown(int arg1, void* arg2) 72cea6c86cSDoug Rabson { 73cea6c86cSDoug Rabson module_t mod; 74cea6c86cSDoug Rabson 75cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) 76cea6c86cSDoug Rabson MOD_EVENT(mod, MOD_SHUTDOWN); 77cea6c86cSDoug Rabson } 78cea6c86cSDoug Rabson 79cea6c86cSDoug Rabson void 803cfc69e6SMatthew Dillon module_register_init(const void *arg) 81cea6c86cSDoug Rabson { 823cfc69e6SMatthew Dillon const moduledata_t* data = (const moduledata_t*) arg; 83cea6c86cSDoug Rabson int error; 84cea6c86cSDoug Rabson 85f3b0d442SPeter Wemm error = module_register(data->name, data->evhand, data->priv, data->_file); 86f3b0d442SPeter Wemm if (error) 87f9d919e9SPeter Wemm printf("module_register_init: module_register(%s, %lx, %p) error %d\n", 8837889b39SBruce Evans data->name, (u_long)(uintfptr_t)data->evhand, data->priv, error); 89cea6c86cSDoug Rabson } 90cea6c86cSDoug Rabson 91cea6c86cSDoug Rabson int 92f3b0d442SPeter Wemm module_register(const char* name, modeventhand_t handler, void* arg, void *file) 93cea6c86cSDoug Rabson { 94cea6c86cSDoug Rabson size_t namelen; 95cea6c86cSDoug Rabson module_t newmod; 96cea6c86cSDoug Rabson int error; 97f3b0d442SPeter Wemm linker_file_t container = file; 98cea6c86cSDoug Rabson 99cea6c86cSDoug Rabson namelen = strlen(name) + 1; 100cea6c86cSDoug Rabson newmod = (module_t) malloc(sizeof(struct module) + namelen, 101cea6c86cSDoug Rabson M_MODULE, M_WAITOK); 102cea6c86cSDoug Rabson if (newmod == 0) 103cea6c86cSDoug Rabson return ENOMEM; 104cea6c86cSDoug Rabson 105cea6c86cSDoug Rabson newmod->refs = 1; 106cea6c86cSDoug Rabson newmod->id = nextid++; 107cea6c86cSDoug Rabson newmod->name = (char *) (newmod + 1); 108cea6c86cSDoug Rabson strcpy(newmod->name, name); 109cea6c86cSDoug Rabson newmod->handler = handler; 110cea6c86cSDoug Rabson newmod->arg = arg; 111a35261efSDoug Rabson bzero(&newmod->data, sizeof(newmod->data)); 112cea6c86cSDoug Rabson TAILQ_INSERT_TAIL(&modules, newmod, link); 113cea6c86cSDoug Rabson 114f3b0d442SPeter Wemm if (container == NULL) 115f3b0d442SPeter Wemm container = linker_current_file; 116f3b0d442SPeter Wemm if (container) { 117f3b0d442SPeter Wemm TAILQ_INSERT_TAIL(&container->modules, newmod, flink); 118f3b0d442SPeter Wemm newmod->file = container; 119cea6c86cSDoug Rabson } else 120cea6c86cSDoug Rabson newmod->file = 0; 121cea6c86cSDoug Rabson 122d254af07SMatthew Dillon if ((error = MOD_EVENT(newmod, MOD_LOAD)) != 0) { 123780330eeSDoug Rabson MOD_EVENT(newmod, MOD_UNLOAD); 124cea6c86cSDoug Rabson module_release(newmod); 125cea6c86cSDoug Rabson return error; 126cea6c86cSDoug Rabson } 127cea6c86cSDoug Rabson 128cea6c86cSDoug Rabson return 0; 129cea6c86cSDoug Rabson } 130cea6c86cSDoug Rabson 131cea6c86cSDoug Rabson void 132cea6c86cSDoug Rabson module_reference(module_t mod) 133cea6c86cSDoug Rabson { 134cea6c86cSDoug Rabson MOD_DPF(REFS, ("module_reference: before, refs=%d\n", mod->refs)); 135cea6c86cSDoug Rabson 136cea6c86cSDoug Rabson mod->refs++; 137cea6c86cSDoug Rabson } 138cea6c86cSDoug Rabson 139cea6c86cSDoug Rabson void 140cea6c86cSDoug Rabson module_release(module_t mod) 141cea6c86cSDoug Rabson { 142cea6c86cSDoug Rabson if (mod->refs <= 0) 143cea6c86cSDoug Rabson panic("module_release: bad reference count"); 144cea6c86cSDoug Rabson 145cea6c86cSDoug Rabson MOD_DPF(REFS, ("module_release: before, refs=%d\n", mod->refs)); 146cea6c86cSDoug Rabson 147cea6c86cSDoug Rabson mod->refs--; 148cea6c86cSDoug Rabson if (mod->refs == 0) { 149cea6c86cSDoug Rabson TAILQ_REMOVE(&modules, mod, link); 150cea6c86cSDoug Rabson if (mod->file) { 151cea6c86cSDoug Rabson TAILQ_REMOVE(&mod->file->modules, mod, flink); 152cea6c86cSDoug Rabson } 153cea6c86cSDoug Rabson free(mod, M_MODULE); 154cea6c86cSDoug Rabson } 155cea6c86cSDoug Rabson } 156cea6c86cSDoug Rabson 157cea6c86cSDoug Rabson module_t 158cea6c86cSDoug Rabson module_lookupbyname(const char* name) 159cea6c86cSDoug Rabson { 160cea6c86cSDoug Rabson module_t mod; 161cea6c86cSDoug Rabson 162cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) { 163cea6c86cSDoug Rabson if (!strcmp(mod->name, name)) 164cea6c86cSDoug Rabson return mod; 165cea6c86cSDoug Rabson } 166cea6c86cSDoug Rabson 167cea6c86cSDoug Rabson return 0; 168cea6c86cSDoug Rabson } 169cea6c86cSDoug Rabson 170cea6c86cSDoug Rabson module_t 171cea6c86cSDoug Rabson module_lookupbyid(int modid) 172cea6c86cSDoug Rabson { 173cea6c86cSDoug Rabson module_t mod; 174cea6c86cSDoug Rabson 175cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) { 176cea6c86cSDoug Rabson if (mod->id == modid) 177cea6c86cSDoug Rabson return mod; 178cea6c86cSDoug Rabson } 179cea6c86cSDoug Rabson 180cea6c86cSDoug Rabson return 0; 181cea6c86cSDoug Rabson } 182cea6c86cSDoug Rabson 183cea6c86cSDoug Rabson int 184cea6c86cSDoug Rabson module_unload(module_t mod) 185cea6c86cSDoug Rabson { 186cea6c86cSDoug Rabson return MOD_EVENT(mod, MOD_UNLOAD); 187cea6c86cSDoug Rabson } 188cea6c86cSDoug Rabson 189cea6c86cSDoug Rabson int 190cea6c86cSDoug Rabson module_getid(module_t mod) 191cea6c86cSDoug Rabson { 192cea6c86cSDoug Rabson return mod->id; 193cea6c86cSDoug Rabson } 194cea6c86cSDoug Rabson 195cea6c86cSDoug Rabson module_t 196cea6c86cSDoug Rabson module_getfnext(module_t mod) 197cea6c86cSDoug Rabson { 198cea6c86cSDoug Rabson return TAILQ_NEXT(mod, flink); 199cea6c86cSDoug Rabson } 200cea6c86cSDoug Rabson 201a35261efSDoug Rabson void 202a35261efSDoug Rabson module_setspecific(module_t mod, modspecific_t *datap) 203a35261efSDoug Rabson { 204a35261efSDoug Rabson mod->data = *datap; 205a35261efSDoug Rabson } 206a35261efSDoug Rabson 207cea6c86cSDoug Rabson /* 208cea6c86cSDoug Rabson * Syscalls. 209cea6c86cSDoug Rabson */ 210cea6c86cSDoug Rabson int 211cb226aaaSPoul-Henning Kamp modnext(struct proc* p, struct modnext_args* uap) 212cea6c86cSDoug Rabson { 213cea6c86cSDoug Rabson module_t mod; 214cea6c86cSDoug Rabson 215cb226aaaSPoul-Henning Kamp p->p_retval[0] = -1; 216cea6c86cSDoug Rabson if (SCARG(uap, modid) == 0) { 217cea6c86cSDoug Rabson mod = TAILQ_FIRST(&modules); 218cea6c86cSDoug Rabson if (mod) { 219cb226aaaSPoul-Henning Kamp p->p_retval[0] = mod->id; 220cea6c86cSDoug Rabson return 0; 221cea6c86cSDoug Rabson } else 222cea6c86cSDoug Rabson return ENOENT; 223cea6c86cSDoug Rabson } 224cea6c86cSDoug Rabson 225cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 226cea6c86cSDoug Rabson if (!mod) 227cea6c86cSDoug Rabson return ENOENT; 228cea6c86cSDoug Rabson 229cea6c86cSDoug Rabson if (TAILQ_NEXT(mod, link)) 230cb226aaaSPoul-Henning Kamp p->p_retval[0] = TAILQ_NEXT(mod, link)->id; 231cea6c86cSDoug Rabson else 232cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 233cea6c86cSDoug Rabson return 0; 234cea6c86cSDoug Rabson } 235cea6c86cSDoug Rabson 236cea6c86cSDoug Rabson int 237cb226aaaSPoul-Henning Kamp modfnext(struct proc* p, struct modfnext_args* uap) 238cea6c86cSDoug Rabson { 239cea6c86cSDoug Rabson module_t mod; 240cea6c86cSDoug Rabson 241cb226aaaSPoul-Henning Kamp p->p_retval[0] = -1; 242cea6c86cSDoug Rabson 243cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 244cea6c86cSDoug Rabson if (!mod) 245cea6c86cSDoug Rabson return ENOENT; 246cea6c86cSDoug Rabson 247cea6c86cSDoug Rabson if (TAILQ_NEXT(mod, flink)) 248cb226aaaSPoul-Henning Kamp p->p_retval[0] = TAILQ_NEXT(mod, flink)->id; 249cea6c86cSDoug Rabson else 250cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 251cea6c86cSDoug Rabson return 0; 252cea6c86cSDoug Rabson } 253cea6c86cSDoug Rabson 254a35261efSDoug Rabson struct module_stat_v1 { 255a35261efSDoug Rabson int version; /* set to sizeof(struct module_stat) */ 256a35261efSDoug Rabson char name[MAXMODNAME]; 257a35261efSDoug Rabson int refs; 258a35261efSDoug Rabson int id; 259a35261efSDoug Rabson }; 260a35261efSDoug Rabson 261cea6c86cSDoug Rabson int 262cb226aaaSPoul-Henning Kamp modstat(struct proc* p, struct modstat_args* uap) 263cea6c86cSDoug Rabson { 264cea6c86cSDoug Rabson module_t mod; 265cea6c86cSDoug Rabson int error = 0; 266cea6c86cSDoug Rabson int namelen; 267cea6c86cSDoug Rabson int version; 268cea6c86cSDoug Rabson struct module_stat* stat; 269cea6c86cSDoug Rabson 270cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 271cea6c86cSDoug Rabson if (!mod) 272cea6c86cSDoug Rabson return ENOENT; 273cea6c86cSDoug Rabson 274cea6c86cSDoug Rabson stat = SCARG(uap, stat); 275cea6c86cSDoug Rabson 276cea6c86cSDoug Rabson /* 277cea6c86cSDoug Rabson * Check the version of the user's structure. 278cea6c86cSDoug Rabson */ 279d254af07SMatthew Dillon if ((error = copyin(&stat->version, &version, sizeof(version))) != 0) 280cea6c86cSDoug Rabson goto out; 281a35261efSDoug Rabson if (version != sizeof(struct module_stat_v1) 282a35261efSDoug Rabson && version != sizeof(struct module_stat)) { 283cea6c86cSDoug Rabson error = EINVAL; 284cea6c86cSDoug Rabson goto out; 285cea6c86cSDoug Rabson } 286cea6c86cSDoug Rabson 287cea6c86cSDoug Rabson namelen = strlen(mod->name) + 1; 288cea6c86cSDoug Rabson if (namelen > MAXMODNAME) 289cea6c86cSDoug Rabson namelen = MAXMODNAME; 290d254af07SMatthew Dillon if ((error = copyout(mod->name, &stat->name[0], namelen)) != 0) 291cea6c86cSDoug Rabson goto out; 292cea6c86cSDoug Rabson 293d254af07SMatthew Dillon if ((error = copyout(&mod->refs, &stat->refs, sizeof(int))) != 0) 294cea6c86cSDoug Rabson goto out; 295d254af07SMatthew Dillon if ((error = copyout(&mod->id, &stat->id, sizeof(int))) != 0) 296cea6c86cSDoug Rabson goto out; 297cea6c86cSDoug Rabson 298a35261efSDoug Rabson /* 299a35261efSDoug Rabson * >v1 stat includes module data. 300a35261efSDoug Rabson */ 301a35261efSDoug Rabson if (version == sizeof(struct module_stat)) { 302d254af07SMatthew Dillon if ((error = copyout(&mod->data, &stat->data, sizeof(mod->data))) != 0) 303a35261efSDoug Rabson goto out; 304f8047d25SDoug Rabson } 305a35261efSDoug Rabson 306cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 307cea6c86cSDoug Rabson 308cea6c86cSDoug Rabson out: 309cea6c86cSDoug Rabson return error; 310cea6c86cSDoug Rabson } 311cea6c86cSDoug Rabson 312cea6c86cSDoug Rabson int 313cb226aaaSPoul-Henning Kamp modfind(struct proc* p, struct modfind_args* uap) 314cea6c86cSDoug Rabson { 315cea6c86cSDoug Rabson int error = 0; 316cea6c86cSDoug Rabson char name[MAXMODNAME]; 317cea6c86cSDoug Rabson module_t mod; 318cea6c86cSDoug Rabson 319d254af07SMatthew Dillon if ((error = copyinstr(SCARG(uap, name), name, sizeof name, 0)) != 0) 320cea6c86cSDoug Rabson goto out; 321cea6c86cSDoug Rabson 322cea6c86cSDoug Rabson mod = module_lookupbyname(name); 323cea6c86cSDoug Rabson if (!mod) 324cea6c86cSDoug Rabson error = ENOENT; 325cea6c86cSDoug Rabson else 326cb226aaaSPoul-Henning Kamp p->p_retval[0] = mod->id; 327cea6c86cSDoug Rabson 328cea6c86cSDoug Rabson out: 329cea6c86cSDoug Rabson return error; 330cea6c86cSDoug Rabson } 331