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 * 26c3aac50fSPeter Wemm * $FreeBSD$ 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 4054823af2SPeter Wemm MALLOC_DEFINE(M_MODULE, "module", "module data structures"); 41cea6c86cSDoug Rabson 42e3975643SJake Burkholder typedef TAILQ_HEAD(, module) modulelist_t; 43cea6c86cSDoug Rabson struct module { 44e3975643SJake Burkholder TAILQ_ENTRY(module) link; /* chain together all modules */ 45e3975643SJake Burkholder 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 62845ccef4SPeter Wemm static int 63845ccef4SPeter Wemm modevent_nop(module_t mod, int what, void* arg) 64845ccef4SPeter Wemm { 65845ccef4SPeter Wemm return 0; 66845ccef4SPeter Wemm } 67845ccef4SPeter Wemm 68845ccef4SPeter Wemm 69cea6c86cSDoug Rabson static void 70cea6c86cSDoug Rabson module_init(void* arg) 71cea6c86cSDoug Rabson { 72cea6c86cSDoug Rabson TAILQ_INIT(&modules); 73fcb893a8SMike Smith EVENTHANDLER_REGISTER(shutdown_post_sync, module_shutdown, NULL, 74fcb893a8SMike Smith SHUTDOWN_PRI_DEFAULT); 75cea6c86cSDoug Rabson } 76cea6c86cSDoug Rabson 77aa855a59SPeter Wemm SYSINIT(module, SI_SUB_KLD, SI_ORDER_FIRST, module_init, 0); 78cea6c86cSDoug Rabson 79cea6c86cSDoug Rabson static void 80fcb893a8SMike Smith module_shutdown(void* arg1, int arg2) 81cea6c86cSDoug Rabson { 82cea6c86cSDoug Rabson module_t mod; 83cea6c86cSDoug Rabson 84cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) 85cea6c86cSDoug Rabson MOD_EVENT(mod, MOD_SHUTDOWN); 86cea6c86cSDoug Rabson } 87cea6c86cSDoug Rabson 88cea6c86cSDoug Rabson void 893cfc69e6SMatthew Dillon module_register_init(const void *arg) 90cea6c86cSDoug Rabson { 913cfc69e6SMatthew Dillon const moduledata_t* data = (const moduledata_t*) arg; 92cea6c86cSDoug Rabson int error; 93b5b15c3fSPeter Wemm module_t mod; 94cea6c86cSDoug Rabson 95b5b15c3fSPeter Wemm mod = module_lookupbyname(data->name); 96b5b15c3fSPeter Wemm if (mod == NULL) 9754823af2SPeter Wemm panic("module_register_init: module named %s not found\n", data->name); 98b5b15c3fSPeter Wemm error = MOD_EVENT(mod, MOD_LOAD); 99b5b15c3fSPeter Wemm if (error) { 100b5b15c3fSPeter Wemm MOD_EVENT(mod, MOD_UNLOAD); 101b5b15c3fSPeter Wemm module_release(mod); 102b5b15c3fSPeter Wemm printf("module_register_init: MOD_LOAD (%s, %lx, %p) error %d\n", 10337889b39SBruce Evans data->name, (u_long)(uintfptr_t)data->evhand, data->priv, error); 104cea6c86cSDoug Rabson } 105b5b15c3fSPeter Wemm } 106cea6c86cSDoug Rabson 107cea6c86cSDoug Rabson int 108b5b15c3fSPeter Wemm module_register(const moduledata_t *data, linker_file_t container) 109cea6c86cSDoug Rabson { 110cea6c86cSDoug Rabson size_t namelen; 111cea6c86cSDoug Rabson module_t newmod; 112cea6c86cSDoug Rabson 113b5b15c3fSPeter Wemm newmod = module_lookupbyname(data->name); 114b5b15c3fSPeter Wemm if (newmod != NULL) { 115b5b15c3fSPeter Wemm printf("module_register: module %s already exists!\n", data->name); 116b5b15c3fSPeter Wemm return EEXIST; 117b5b15c3fSPeter Wemm } 118b5b15c3fSPeter Wemm namelen = strlen(data->name) + 1; 119cea6c86cSDoug Rabson newmod = (module_t) malloc(sizeof(struct module) + namelen, 120cea6c86cSDoug Rabson M_MODULE, M_WAITOK); 121cea6c86cSDoug Rabson if (newmod == 0) 122cea6c86cSDoug Rabson return ENOMEM; 123cea6c86cSDoug Rabson 124cea6c86cSDoug Rabson newmod->refs = 1; 125cea6c86cSDoug Rabson newmod->id = nextid++; 126cea6c86cSDoug Rabson newmod->name = (char *) (newmod + 1); 127b5b15c3fSPeter Wemm strcpy(newmod->name, data->name); 128845ccef4SPeter Wemm newmod->handler = data->evhand ? data->evhand : modevent_nop; 129b5b15c3fSPeter Wemm newmod->arg = data->priv; 130a35261efSDoug Rabson bzero(&newmod->data, sizeof(newmod->data)); 131cea6c86cSDoug Rabson TAILQ_INSERT_TAIL(&modules, newmod, link); 132cea6c86cSDoug Rabson 133b5b15c3fSPeter Wemm if (container) 134f3b0d442SPeter Wemm TAILQ_INSERT_TAIL(&container->modules, newmod, flink); 1351d23cba9SPeter Wemm newmod->file = container; 136cea6c86cSDoug Rabson 137cea6c86cSDoug Rabson return 0; 138cea6c86cSDoug Rabson } 139cea6c86cSDoug Rabson 140cea6c86cSDoug Rabson void 141cea6c86cSDoug Rabson module_reference(module_t mod) 142cea6c86cSDoug Rabson { 143cea6c86cSDoug Rabson MOD_DPF(REFS, ("module_reference: before, refs=%d\n", mod->refs)); 144cea6c86cSDoug Rabson 145cea6c86cSDoug Rabson mod->refs++; 146cea6c86cSDoug Rabson } 147cea6c86cSDoug Rabson 148cea6c86cSDoug Rabson void 149cea6c86cSDoug Rabson module_release(module_t mod) 150cea6c86cSDoug Rabson { 151cea6c86cSDoug Rabson if (mod->refs <= 0) 152cea6c86cSDoug Rabson panic("module_release: bad reference count"); 153cea6c86cSDoug Rabson 154cea6c86cSDoug Rabson MOD_DPF(REFS, ("module_release: before, refs=%d\n", mod->refs)); 155cea6c86cSDoug Rabson 156cea6c86cSDoug Rabson mod->refs--; 157cea6c86cSDoug Rabson if (mod->refs == 0) { 158cea6c86cSDoug Rabson TAILQ_REMOVE(&modules, mod, link); 159cea6c86cSDoug Rabson if (mod->file) { 160cea6c86cSDoug Rabson TAILQ_REMOVE(&mod->file->modules, mod, flink); 161cea6c86cSDoug Rabson } 162cea6c86cSDoug Rabson free(mod, M_MODULE); 163cea6c86cSDoug Rabson } 164cea6c86cSDoug Rabson } 165cea6c86cSDoug Rabson 166cea6c86cSDoug Rabson module_t 167cea6c86cSDoug Rabson module_lookupbyname(const char* name) 168cea6c86cSDoug Rabson { 169cea6c86cSDoug Rabson module_t mod; 170cea6c86cSDoug Rabson 171cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) { 172cea6c86cSDoug Rabson if (!strcmp(mod->name, name)) 173cea6c86cSDoug Rabson return mod; 174cea6c86cSDoug Rabson } 175cea6c86cSDoug Rabson 176cea6c86cSDoug Rabson return 0; 177cea6c86cSDoug Rabson } 178cea6c86cSDoug Rabson 179cea6c86cSDoug Rabson module_t 180cea6c86cSDoug Rabson module_lookupbyid(int modid) 181cea6c86cSDoug Rabson { 182cea6c86cSDoug Rabson module_t mod; 183cea6c86cSDoug Rabson 184cea6c86cSDoug Rabson for (mod = TAILQ_FIRST(&modules); mod; mod = TAILQ_NEXT(mod, link)) { 185cea6c86cSDoug Rabson if (mod->id == modid) 186cea6c86cSDoug Rabson return mod; 187cea6c86cSDoug Rabson } 188cea6c86cSDoug Rabson 189cea6c86cSDoug Rabson return 0; 190cea6c86cSDoug Rabson } 191cea6c86cSDoug Rabson 192cea6c86cSDoug Rabson int 193cea6c86cSDoug Rabson module_unload(module_t mod) 194cea6c86cSDoug Rabson { 195cea6c86cSDoug Rabson return MOD_EVENT(mod, MOD_UNLOAD); 196cea6c86cSDoug Rabson } 197cea6c86cSDoug Rabson 198cea6c86cSDoug Rabson int 199cea6c86cSDoug Rabson module_getid(module_t mod) 200cea6c86cSDoug Rabson { 201cea6c86cSDoug Rabson return mod->id; 202cea6c86cSDoug Rabson } 203cea6c86cSDoug Rabson 204cea6c86cSDoug Rabson module_t 205cea6c86cSDoug Rabson module_getfnext(module_t mod) 206cea6c86cSDoug Rabson { 207cea6c86cSDoug Rabson return TAILQ_NEXT(mod, flink); 208cea6c86cSDoug Rabson } 209cea6c86cSDoug Rabson 210a35261efSDoug Rabson void 211a35261efSDoug Rabson module_setspecific(module_t mod, modspecific_t *datap) 212a35261efSDoug Rabson { 213a35261efSDoug Rabson mod->data = *datap; 214a35261efSDoug Rabson } 215a35261efSDoug Rabson 216cea6c86cSDoug Rabson /* 217cea6c86cSDoug Rabson * Syscalls. 218cea6c86cSDoug Rabson */ 219cea6c86cSDoug Rabson int 220cb226aaaSPoul-Henning Kamp modnext(struct proc* p, struct modnext_args* uap) 221cea6c86cSDoug Rabson { 222cea6c86cSDoug Rabson module_t mod; 223cea6c86cSDoug Rabson 224cb226aaaSPoul-Henning Kamp p->p_retval[0] = -1; 225cea6c86cSDoug Rabson if (SCARG(uap, modid) == 0) { 226cea6c86cSDoug Rabson mod = TAILQ_FIRST(&modules); 227cea6c86cSDoug Rabson if (mod) { 228cb226aaaSPoul-Henning Kamp p->p_retval[0] = mod->id; 229cea6c86cSDoug Rabson return 0; 230cea6c86cSDoug Rabson } else 231cea6c86cSDoug Rabson return ENOENT; 232cea6c86cSDoug Rabson } 233cea6c86cSDoug Rabson 234cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 235cea6c86cSDoug Rabson if (!mod) 236cea6c86cSDoug Rabson return ENOENT; 237cea6c86cSDoug Rabson 238cea6c86cSDoug Rabson if (TAILQ_NEXT(mod, link)) 239cb226aaaSPoul-Henning Kamp p->p_retval[0] = TAILQ_NEXT(mod, link)->id; 240cea6c86cSDoug Rabson else 241cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 242cea6c86cSDoug Rabson return 0; 243cea6c86cSDoug Rabson } 244cea6c86cSDoug Rabson 245cea6c86cSDoug Rabson int 246cb226aaaSPoul-Henning Kamp modfnext(struct proc* p, struct modfnext_args* uap) 247cea6c86cSDoug Rabson { 248cea6c86cSDoug Rabson module_t mod; 249cea6c86cSDoug Rabson 250cb226aaaSPoul-Henning Kamp p->p_retval[0] = -1; 251cea6c86cSDoug Rabson 252cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 253cea6c86cSDoug Rabson if (!mod) 254cea6c86cSDoug Rabson return ENOENT; 255cea6c86cSDoug Rabson 256cea6c86cSDoug Rabson if (TAILQ_NEXT(mod, flink)) 257cb226aaaSPoul-Henning Kamp p->p_retval[0] = TAILQ_NEXT(mod, flink)->id; 258cea6c86cSDoug Rabson else 259cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 260cea6c86cSDoug Rabson return 0; 261cea6c86cSDoug Rabson } 262cea6c86cSDoug Rabson 263a35261efSDoug Rabson struct module_stat_v1 { 264a35261efSDoug Rabson int version; /* set to sizeof(struct module_stat) */ 265a35261efSDoug Rabson char name[MAXMODNAME]; 266a35261efSDoug Rabson int refs; 267a35261efSDoug Rabson int id; 268a35261efSDoug Rabson }; 269a35261efSDoug Rabson 270cea6c86cSDoug Rabson int 271cb226aaaSPoul-Henning Kamp modstat(struct proc* p, struct modstat_args* uap) 272cea6c86cSDoug Rabson { 273cea6c86cSDoug Rabson module_t mod; 274cea6c86cSDoug Rabson int error = 0; 275cea6c86cSDoug Rabson int namelen; 276cea6c86cSDoug Rabson int version; 277cea6c86cSDoug Rabson struct module_stat* stat; 278cea6c86cSDoug Rabson 279cea6c86cSDoug Rabson mod = module_lookupbyid(SCARG(uap, modid)); 280cea6c86cSDoug Rabson if (!mod) 281cea6c86cSDoug Rabson return ENOENT; 282cea6c86cSDoug Rabson 283cea6c86cSDoug Rabson stat = SCARG(uap, stat); 284cea6c86cSDoug Rabson 285cea6c86cSDoug Rabson /* 286cea6c86cSDoug Rabson * Check the version of the user's structure. 287cea6c86cSDoug Rabson */ 288d254af07SMatthew Dillon if ((error = copyin(&stat->version, &version, sizeof(version))) != 0) 289cea6c86cSDoug Rabson goto out; 290a35261efSDoug Rabson if (version != sizeof(struct module_stat_v1) 291a35261efSDoug Rabson && version != sizeof(struct module_stat)) { 292cea6c86cSDoug Rabson error = EINVAL; 293cea6c86cSDoug Rabson goto out; 294cea6c86cSDoug Rabson } 295cea6c86cSDoug Rabson 296cea6c86cSDoug Rabson namelen = strlen(mod->name) + 1; 297cea6c86cSDoug Rabson if (namelen > MAXMODNAME) 298cea6c86cSDoug Rabson namelen = MAXMODNAME; 299d254af07SMatthew Dillon if ((error = copyout(mod->name, &stat->name[0], namelen)) != 0) 300cea6c86cSDoug Rabson goto out; 301cea6c86cSDoug Rabson 302d254af07SMatthew Dillon if ((error = copyout(&mod->refs, &stat->refs, sizeof(int))) != 0) 303cea6c86cSDoug Rabson goto out; 304d254af07SMatthew Dillon if ((error = copyout(&mod->id, &stat->id, sizeof(int))) != 0) 305cea6c86cSDoug Rabson goto out; 306cea6c86cSDoug Rabson 307a35261efSDoug Rabson /* 308a35261efSDoug Rabson * >v1 stat includes module data. 309a35261efSDoug Rabson */ 310a35261efSDoug Rabson if (version == sizeof(struct module_stat)) { 311d254af07SMatthew Dillon if ((error = copyout(&mod->data, &stat->data, sizeof(mod->data))) != 0) 312a35261efSDoug Rabson goto out; 313f8047d25SDoug Rabson } 314a35261efSDoug Rabson 315cb226aaaSPoul-Henning Kamp p->p_retval[0] = 0; 316cea6c86cSDoug Rabson 317cea6c86cSDoug Rabson out: 318cea6c86cSDoug Rabson return error; 319cea6c86cSDoug Rabson } 320cea6c86cSDoug Rabson 321cea6c86cSDoug Rabson int 322cb226aaaSPoul-Henning Kamp modfind(struct proc* p, struct modfind_args* uap) 323cea6c86cSDoug Rabson { 324cea6c86cSDoug Rabson int error = 0; 325cea6c86cSDoug Rabson char name[MAXMODNAME]; 326cea6c86cSDoug Rabson module_t mod; 327cea6c86cSDoug Rabson 328d254af07SMatthew Dillon if ((error = copyinstr(SCARG(uap, name), name, sizeof name, 0)) != 0) 329cea6c86cSDoug Rabson goto out; 330cea6c86cSDoug Rabson 331cea6c86cSDoug Rabson mod = module_lookupbyname(name); 332cea6c86cSDoug Rabson if (!mod) 333cea6c86cSDoug Rabson error = ENOENT; 334cea6c86cSDoug Rabson else 335cb226aaaSPoul-Henning Kamp p->p_retval[0] = mod->id; 336cea6c86cSDoug Rabson 337cea6c86cSDoug Rabson out: 338cea6c86cSDoug Rabson return error; 339cea6c86cSDoug Rabson } 340