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 * 26fcb893a8SMike Smith * $Id: kern_module.c,v 1.18 1999/05/20 00:00:58 peter Exp $ 27cea6c86cSDoug Rabson */ 28cea6c86cSDoug Rabson 29cea6c86cSDoug Rabson #include <sys/param.h> 30cea6c86cSDoug Rabson #include <sys/kernel.h> 31cea6c86cSDoug Rabson #include <sys/systm.h> 32fcb893a8SMike Smith #include <sys/eventhandler.h> 33cea6c86cSDoug Rabson #include <sys/malloc.h> 34cea6c86cSDoug Rabson #include <sys/sysproto.h> 35cea6c86cSDoug Rabson #include <sys/sysent.h> 36cea6c86cSDoug Rabson #include <sys/module.h> 37cea6c86cSDoug Rabson #include <sys/linker.h> 38cb226aaaSPoul-Henning Kamp #include <sys/proc.h> 39cea6c86cSDoug Rabson 40cea6c86cSDoug Rabson #define M_MODULE M_TEMP /* XXX */ 41cea6c86cSDoug Rabson 42cea6c86cSDoug Rabson typedef TAILQ_HEAD(, module) modulelist_t; 43cea6c86cSDoug Rabson struct module { 44cea6c86cSDoug Rabson TAILQ_ENTRY(module) link; /* chain together all modules */ 45cea6c86cSDoug Rabson TAILQ_ENTRY(module) flink; /* all modules in a file */ 46cea6c86cSDoug Rabson struct linker_file* file; /* file which contains this module */ 47cea6c86cSDoug Rabson int refs; /* reference count */ 48cea6c86cSDoug Rabson int id; /* unique id number */ 49cea6c86cSDoug Rabson char *name; /* module name */ 50cea6c86cSDoug Rabson modeventhand_t handler; /* event handler */ 51cea6c86cSDoug Rabson void *arg; /* argument for handler */ 52a35261efSDoug Rabson modspecific_t data; /* module specific data */ 53cea6c86cSDoug Rabson }; 54cea6c86cSDoug Rabson 55cea6c86cSDoug Rabson #define MOD_EVENT(mod, type) (mod)->handler((mod), (type), (mod)->arg) 56cea6c86cSDoug Rabson 57cea6c86cSDoug Rabson static modulelist_t modules; 58cea6c86cSDoug Rabson static int nextid = 1; 59cea6c86cSDoug Rabson 60fcb893a8SMike Smith static void module_shutdown(void*, int); 61cea6c86cSDoug Rabson 62cea6c86cSDoug Rabson static void 63cea6c86cSDoug Rabson module_init(void* arg) 64cea6c86cSDoug Rabson { 65cea6c86cSDoug Rabson TAILQ_INIT(&modules); 66fcb893a8SMike Smith EVENTHANDLER_REGISTER(shutdown_post_sync, module_shutdown, NULL, 67fcb893a8SMike Smith SHUTDOWN_PRI_DEFAULT); 68cea6c86cSDoug Rabson } 69cea6c86cSDoug Rabson 70aa855a59SPeter Wemm SYSINIT(module, SI_SUB_KLD, SI_ORDER_FIRST, module_init, 0); 71cea6c86cSDoug Rabson 72cea6c86cSDoug Rabson static void 73fcb893a8SMike Smith module_shutdown(void* arg1, int arg2) 74cea6c86cSDoug Rabson { 75cea6c86cSDoug Rabson module_t mod; 76cea6c86cSDoug Rabson 77cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) 78cea6c86cSDoug Rabson MOD_EVENT(mod, MOD_SHUTDOWN); 79cea6c86cSDoug Rabson } 80cea6c86cSDoug Rabson 81cea6c86cSDoug Rabson void 823cfc69e6SMatthew Dillon module_register_init(const void *arg) 83cea6c86cSDoug Rabson { 843cfc69e6SMatthew Dillon const moduledata_t* data = (const moduledata_t*) arg; 85cea6c86cSDoug Rabson int error; 86b5b15c3fSPeter Wemm module_t mod; 87cea6c86cSDoug Rabson 88b5b15c3fSPeter Wemm mod = module_lookupbyname(data->name); 89b5b15c3fSPeter Wemm if (mod == NULL) { 90b5b15c3fSPeter Wemm #if 0 91b5b15c3fSPeter Wemm panic("module_register_init: module named %s not found\n", data->name); 92b5b15c3fSPeter Wemm #else 93b5b15c3fSPeter Wemm /* temporary kludge until kernel `file' attachment registers modules */ 94b5b15c3fSPeter Wemm error = module_register(data, linker_kernel_file); 95f3b0d442SPeter Wemm if (error) 96b5b15c3fSPeter Wemm panic("module_register_init: register of module failed! %d", error); 97b5b15c3fSPeter Wemm mod = module_lookupbyname(data->name); 98b5b15c3fSPeter Wemm if (mod == NULL) 99b5b15c3fSPeter Wemm panic("module_register_init: module STILL not found!"); 100b5b15c3fSPeter Wemm #endif 101b5b15c3fSPeter Wemm } 102b5b15c3fSPeter Wemm error = MOD_EVENT(mod, MOD_LOAD); 103b5b15c3fSPeter Wemm if (error) { 104b5b15c3fSPeter Wemm MOD_EVENT(mod, MOD_UNLOAD); 105b5b15c3fSPeter Wemm module_release(mod); 106b5b15c3fSPeter Wemm printf("module_register_init: MOD_LOAD (%s, %lx, %p) error %d\n", 10737889b39SBruce Evans data->name, (u_long)(uintfptr_t)data->evhand, data->priv, error); 108cea6c86cSDoug Rabson } 109b5b15c3fSPeter Wemm } 110cea6c86cSDoug Rabson 111cea6c86cSDoug Rabson int 112b5b15c3fSPeter Wemm module_register(const moduledata_t *data, linker_file_t container) 113cea6c86cSDoug Rabson { 114cea6c86cSDoug Rabson size_t namelen; 115cea6c86cSDoug Rabson module_t newmod; 116cea6c86cSDoug Rabson 117b5b15c3fSPeter Wemm newmod = module_lookupbyname(data->name); 118b5b15c3fSPeter Wemm if (newmod != NULL) { 119b5b15c3fSPeter Wemm printf("module_register: module %s already exists!\n", data->name); 120b5b15c3fSPeter Wemm return EEXIST; 121b5b15c3fSPeter Wemm } 122b5b15c3fSPeter Wemm namelen = strlen(data->name) + 1; 123cea6c86cSDoug Rabson newmod = (module_t) malloc(sizeof(struct module) + namelen, 124cea6c86cSDoug Rabson M_MODULE, M_WAITOK); 125cea6c86cSDoug Rabson if (newmod == 0) 126cea6c86cSDoug Rabson return ENOMEM; 127cea6c86cSDoug Rabson 128cea6c86cSDoug Rabson newmod->refs = 1; 129cea6c86cSDoug Rabson newmod->id = nextid++; 130cea6c86cSDoug Rabson newmod->name = (char *) (newmod + 1); 131b5b15c3fSPeter Wemm strcpy(newmod->name, data->name); 132b5b15c3fSPeter Wemm newmod->handler = data->evhand; 133b5b15c3fSPeter Wemm newmod->arg = data->priv; 134a35261efSDoug Rabson bzero(&newmod->data, sizeof(newmod->data)); 135cea6c86cSDoug Rabson TAILQ_INSERT_TAIL(&modules, newmod, link); 136cea6c86cSDoug Rabson 137f3b0d442SPeter Wemm if (container == NULL) 138f3b0d442SPeter Wemm container = linker_current_file; 139b5b15c3fSPeter Wemm if (container) 140f3b0d442SPeter Wemm TAILQ_INSERT_TAIL(&container->modules, newmod, flink); 1411d23cba9SPeter Wemm newmod->file = container; 142cea6c86cSDoug Rabson 143cea6c86cSDoug Rabson return 0; 144cea6c86cSDoug Rabson } 145cea6c86cSDoug Rabson 146cea6c86cSDoug Rabson void 147cea6c86cSDoug Rabson module_reference(module_t mod) 148cea6c86cSDoug Rabson { 149cea6c86cSDoug Rabson MOD_DPF(REFS, ("module_reference: before, refs=%d\n", mod->refs)); 150cea6c86cSDoug Rabson 151cea6c86cSDoug Rabson mod->refs++; 152cea6c86cSDoug Rabson } 153cea6c86cSDoug Rabson 154cea6c86cSDoug Rabson void 155cea6c86cSDoug Rabson module_release(module_t mod) 156cea6c86cSDoug Rabson { 157cea6c86cSDoug Rabson if (mod->refs <= 0) 158cea6c86cSDoug Rabson panic("module_release: bad reference count"); 159cea6c86cSDoug Rabson 160cea6c86cSDoug Rabson MOD_DPF(REFS, ("module_release: before, refs=%d\n", mod->refs)); 161cea6c86cSDoug Rabson 162cea6c86cSDoug Rabson mod->refs--; 163cea6c86cSDoug Rabson if (mod->refs == 0) { 164cea6c86cSDoug Rabson TAILQ_REMOVE(&modules, mod, link); 165cea6c86cSDoug Rabson if (mod->file) { 166cea6c86cSDoug Rabson TAILQ_REMOVE(&mod->file->modules, mod, flink); 167cea6c86cSDoug Rabson } 168cea6c86cSDoug Rabson free(mod, M_MODULE); 169cea6c86cSDoug Rabson } 170cea6c86cSDoug Rabson } 171cea6c86cSDoug Rabson 172cea6c86cSDoug Rabson module_t 173cea6c86cSDoug Rabson module_lookupbyname(const char* name) 174cea6c86cSDoug Rabson { 175cea6c86cSDoug Rabson module_t mod; 176cea6c86cSDoug Rabson 177cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) { 178cea6c86cSDoug Rabson if (!strcmp(mod->name, name)) 179cea6c86cSDoug Rabson return mod; 180cea6c86cSDoug Rabson } 181cea6c86cSDoug Rabson 182cea6c86cSDoug Rabson return 0; 183cea6c86cSDoug Rabson } 184cea6c86cSDoug Rabson 185cea6c86cSDoug Rabson module_t 186cea6c86cSDoug Rabson module_lookupbyid(int modid) 187cea6c86cSDoug Rabson { 188cea6c86cSDoug Rabson module_t mod; 189cea6c86cSDoug Rabson 190cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) { 191cea6c86cSDoug Rabson if (mod->id == modid) 192cea6c86cSDoug Rabson return mod; 193cea6c86cSDoug Rabson } 194cea6c86cSDoug Rabson 195cea6c86cSDoug Rabson return 0; 196cea6c86cSDoug Rabson } 197cea6c86cSDoug Rabson 198cea6c86cSDoug Rabson int 199cea6c86cSDoug Rabson module_unload(module_t mod) 200cea6c86cSDoug Rabson { 201cea6c86cSDoug Rabson return MOD_EVENT(mod, MOD_UNLOAD); 202cea6c86cSDoug Rabson } 203cea6c86cSDoug Rabson 204cea6c86cSDoug Rabson int 205cea6c86cSDoug Rabson module_getid(module_t mod) 206cea6c86cSDoug Rabson { 207cea6c86cSDoug Rabson return mod->id; 208cea6c86cSDoug Rabson } 209cea6c86cSDoug Rabson 210cea6c86cSDoug Rabson module_t 211cea6c86cSDoug Rabson module_getfnext(module_t mod) 212cea6c86cSDoug Rabson { 213cea6c86cSDoug Rabson return TAILQ_NEXT(mod, flink); 214cea6c86cSDoug Rabson } 215cea6c86cSDoug Rabson 216a35261efSDoug Rabson void 217a35261efSDoug Rabson module_setspecific(module_t mod, modspecific_t *datap) 218a35261efSDoug Rabson { 219a35261efSDoug Rabson mod->data = *datap; 220a35261efSDoug Rabson } 221a35261efSDoug Rabson 222cea6c86cSDoug Rabson /* 223cea6c86cSDoug Rabson * Syscalls. 224cea6c86cSDoug Rabson */ 225cea6c86cSDoug Rabson int 226cb226aaaSPoul-Henning Kamp modnext(struct proc* p, struct modnext_args* uap) 227cea6c86cSDoug Rabson { 228cea6c86cSDoug Rabson module_t mod; 229cea6c86cSDoug Rabson 230cb226aaaSPoul-Henning Kamp p->p_retval[0] = -1; 231cea6c86cSDoug Rabson if (SCARG(uap, modid) == 0) { 232cea6c86cSDoug Rabson mod = TAILQ_FIRST(&modules); 233cea6c86cSDoug Rabson if (mod) { 234cb226aaaSPoul-Henning Kamp p->p_retval[0] = mod->id; 235cea6c86cSDoug Rabson return 0; 236cea6c86cSDoug Rabson } else 237cea6c86cSDoug Rabson return ENOENT; 238cea6c86cSDoug Rabson } 239cea6c86cSDoug Rabson 240cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 241cea6c86cSDoug Rabson if (!mod) 242cea6c86cSDoug Rabson return ENOENT; 243cea6c86cSDoug Rabson 244cea6c86cSDoug Rabson if (TAILQ_NEXT(mod, link)) 245cb226aaaSPoul-Henning Kamp p->p_retval[0] = TAILQ_NEXT(mod, link)->id; 246cea6c86cSDoug Rabson else 247cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 248cea6c86cSDoug Rabson return 0; 249cea6c86cSDoug Rabson } 250cea6c86cSDoug Rabson 251cea6c86cSDoug Rabson int 252cb226aaaSPoul-Henning Kamp modfnext(struct proc* p, struct modfnext_args* uap) 253cea6c86cSDoug Rabson { 254cea6c86cSDoug Rabson module_t mod; 255cea6c86cSDoug Rabson 256cb226aaaSPoul-Henning Kamp p->p_retval[0] = -1; 257cea6c86cSDoug Rabson 258cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 259cea6c86cSDoug Rabson if (!mod) 260cea6c86cSDoug Rabson return ENOENT; 261cea6c86cSDoug Rabson 262cea6c86cSDoug Rabson if (TAILQ_NEXT(mod, flink)) 263cb226aaaSPoul-Henning Kamp p->p_retval[0] = TAILQ_NEXT(mod, flink)->id; 264cea6c86cSDoug Rabson else 265cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 266cea6c86cSDoug Rabson return 0; 267cea6c86cSDoug Rabson } 268cea6c86cSDoug Rabson 269a35261efSDoug Rabson struct module_stat_v1 { 270a35261efSDoug Rabson int version; /* set to sizeof(struct module_stat) */ 271a35261efSDoug Rabson char name[MAXMODNAME]; 272a35261efSDoug Rabson int refs; 273a35261efSDoug Rabson int id; 274a35261efSDoug Rabson }; 275a35261efSDoug Rabson 276cea6c86cSDoug Rabson int 277cb226aaaSPoul-Henning Kamp modstat(struct proc* p, struct modstat_args* uap) 278cea6c86cSDoug Rabson { 279cea6c86cSDoug Rabson module_t mod; 280cea6c86cSDoug Rabson int error = 0; 281cea6c86cSDoug Rabson int namelen; 282cea6c86cSDoug Rabson int version; 283cea6c86cSDoug Rabson struct module_stat* stat; 284cea6c86cSDoug Rabson 285cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 286cea6c86cSDoug Rabson if (!mod) 287cea6c86cSDoug Rabson return ENOENT; 288cea6c86cSDoug Rabson 289cea6c86cSDoug Rabson stat = SCARG(uap, stat); 290cea6c86cSDoug Rabson 291cea6c86cSDoug Rabson /* 292cea6c86cSDoug Rabson * Check the version of the user's structure. 293cea6c86cSDoug Rabson */ 294d254af07SMatthew Dillon if ((error = copyin(&stat->version, &version, sizeof(version))) != 0) 295cea6c86cSDoug Rabson goto out; 296a35261efSDoug Rabson if (version != sizeof(struct module_stat_v1) 297a35261efSDoug Rabson && version != sizeof(struct module_stat)) { 298cea6c86cSDoug Rabson error = EINVAL; 299cea6c86cSDoug Rabson goto out; 300cea6c86cSDoug Rabson } 301cea6c86cSDoug Rabson 302cea6c86cSDoug Rabson namelen = strlen(mod->name) + 1; 303cea6c86cSDoug Rabson if (namelen > MAXMODNAME) 304cea6c86cSDoug Rabson namelen = MAXMODNAME; 305d254af07SMatthew Dillon if ((error = copyout(mod->name, &stat->name[0], namelen)) != 0) 306cea6c86cSDoug Rabson goto out; 307cea6c86cSDoug Rabson 308d254af07SMatthew Dillon if ((error = copyout(&mod->refs, &stat->refs, sizeof(int))) != 0) 309cea6c86cSDoug Rabson goto out; 310d254af07SMatthew Dillon if ((error = copyout(&mod->id, &stat->id, sizeof(int))) != 0) 311cea6c86cSDoug Rabson goto out; 312cea6c86cSDoug Rabson 313a35261efSDoug Rabson /* 314a35261efSDoug Rabson * >v1 stat includes module data. 315a35261efSDoug Rabson */ 316a35261efSDoug Rabson if (version == sizeof(struct module_stat)) { 317d254af07SMatthew Dillon if ((error = copyout(&mod->data, &stat->data, sizeof(mod->data))) != 0) 318a35261efSDoug Rabson goto out; 319f8047d25SDoug Rabson } 320a35261efSDoug Rabson 321cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 322cea6c86cSDoug Rabson 323cea6c86cSDoug Rabson out: 324cea6c86cSDoug Rabson return error; 325cea6c86cSDoug Rabson } 326cea6c86cSDoug Rabson 327cea6c86cSDoug Rabson int 328cb226aaaSPoul-Henning Kamp modfind(struct proc* p, struct modfind_args* uap) 329cea6c86cSDoug Rabson { 330cea6c86cSDoug Rabson int error = 0; 331cea6c86cSDoug Rabson char name[MAXMODNAME]; 332cea6c86cSDoug Rabson module_t mod; 333cea6c86cSDoug Rabson 334d254af07SMatthew Dillon if ((error = copyinstr(SCARG(uap, name), name, sizeof name, 0)) != 0) 335cea6c86cSDoug Rabson goto out; 336cea6c86cSDoug Rabson 337cea6c86cSDoug Rabson mod = module_lookupbyname(name); 338cea6c86cSDoug Rabson if (!mod) 339cea6c86cSDoug Rabson error = ENOENT; 340cea6c86cSDoug Rabson else 341cb226aaaSPoul-Henning Kamp p->p_retval[0] = mod->id; 342cea6c86cSDoug Rabson 343cea6c86cSDoug Rabson out: 344cea6c86cSDoug Rabson return error; 345cea6c86cSDoug Rabson } 346