2 * Copyright (c) 2005, Sam Leffler <sam@errno.com>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice unmodified, this list of conditions, and the following
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
30 #include <sys/param.h>
31 #include <sys/kernel.h>
32 #include <sys/malloc.h>
33 #include <sys/queue.h>
34 #include <sys/taskqueue.h>
35 #include <sys/systm.h>
37 #include <sys/mutex.h>
38 #include <sys/errno.h>
39 #include <sys/linker.h>
40 #include <sys/firmware.h>
42 #include <sys/module.h>
44 #define FIRMWARE_MAX 30
45 static struct firmware firmware_table[FIRMWARE_MAX];
46 struct task firmware_task;
47 struct mtx firmware_mtx;
48 MTX_SYSINIT(firmware, &firmware_mtx, "firmware table", MTX_DEF);
51 * Register a firmware image with the specified name. The
52 * image name must not already be registered. If this is a
53 * subimage then parent refers to a previously registered
54 * image that this should be associated with.
57 firmware_register(const char *imagename, const void *data, size_t datasize,
58 unsigned int version, struct firmware *parent)
60 struct firmware *frp = NULL;
63 mtx_lock(&firmware_mtx);
64 for (i = 0; i < FIRMWARE_MAX; i++) {
65 struct firmware *fp = &firmware_table[i];
67 if (fp->name == NULL) {
72 if (strcasecmp(imagename, fp->name) == 0) {
73 mtx_unlock(&firmware_mtx);
74 printf("%s: image %s already registered!\n",
80 mtx_unlock(&firmware_mtx);
81 printf("%s: cannot register image %s, firmware table full!\n",
85 frp->name = imagename;
87 frp->datasize = datasize;
88 frp->version = version;
95 mtx_unlock(&firmware_mtx);
100 clearentry(struct firmware *fp)
102 KASSERT(fp->refcnt == 0, ("image %s refcnt %u", fp->name, fp->refcnt));
109 if (fp->parent != NULL) { /* release parent reference */
110 fp->parent->refcnt--;
115 static struct firmware *
116 lookup(const char *name)
120 for (i = 0; i < FIRMWARE_MAX; i++) {
121 struct firmware * fp = &firmware_table[i];
122 if (fp->name != NULL && strcasecmp(name, fp->name) == 0)
129 * Unregister/remove a firmware image. If there are outstanding
130 * references an error is returned and the image is not removed
134 firmware_unregister(const char *imagename)
139 mtx_lock(&firmware_mtx);
141 * NB: it is ok for the lookup to fail; this can happen
142 * when a module is unloaded on last reference and the
143 * module unload handler unregister's each of it's
146 fp = lookup(imagename);
152 mtx_unlock(&firmware_mtx);
153 return (refcnt != 0 ? EBUSY : 0);
157 * Lookup and potentially load the specified firmware image.
158 * If the firmware is not found in the registry attempt to
159 * load a kernel module with the image name. If the firmware
160 * is located a reference is returned. The caller must release
161 * this reference for the image to be eligible for removal/unload.
164 firmware_get(const char *imagename)
168 linker_file_t result;
169 int requested_load = 0;
172 mtx_lock(&firmware_mtx);
173 fp = lookup(imagename);
178 mtx_unlock(&firmware_mtx);
182 * Image not present, try to load the module holding it
183 * or if we already tried give up.
185 mtx_unlock(&firmware_mtx);
186 if (requested_load) {
187 printf("%s: failed to load firmware image %s\n",
188 __func__, imagename);
192 if (suser(td) != 0 || securelevel_gt(td->td_ucred, 0) != 0) {
193 printf("%s: insufficient privileges to "
194 "load firmware image %s\n", __func__, imagename);
197 mtx_lock(&Giant); /* XXX */
198 (void) linker_reference_module(imagename, NULL, &result);
199 mtx_unlock(&Giant); /* XXX */
201 goto again; /* sort of an Algol-style for loop */
205 unloadentry(void *unused1, int unused2)
211 mtx_lock(&firmware_mtx);
213 /* Look for an unwanted entry that we explicitly loaded. */
214 for (i = 0; i < FIRMWARE_MAX; i++) {
215 fp = &firmware_table[i];
216 if (fp->name != NULL && fp->file != NULL &&
218 (fp->flags & FIRMWAREFLAG_KEEPKLDREF) == 0)
225 /* No longer explicitly loaded. */
227 mtx_unlock(&firmware_mtx);
229 linker_file_unload(file, LINKER_UNLOAD_NORMAL);
231 mtx_lock(&firmware_mtx);
233 mtx_unlock(&firmware_mtx);
237 * Release a reference to a firmware image returned by
238 * firmware_get. The reference is released and if this is
239 * the last reference to the firmware image the associated
240 * module may be released/unloaded.
243 firmware_put(struct firmware *fp, int flags)
245 mtx_lock(&firmware_mtx);
247 if (fp->refcnt == 0) {
248 if ((flags & FIRMWARE_UNLOAD) == 0)
249 fp->flags |= FIRMWAREFLAG_KEEPKLDREF;
252 taskqueue_enqueue(taskqueue_thread, &firmware_task);
253 mtx_unlock(&firmware_mtx);
260 firmware_modevent(module_t mod, int type, void *unused)
266 TASK_INIT(&firmware_task, 0, unloadentry, NULL);
269 for (i = 0; i < FIRMWARE_MAX; i++) {
270 struct firmware *fp = &firmware_table[i];
271 fp->flags &= ~FIRMWAREFLAG_KEEPKLDREF;
273 taskqueue_enqueue(taskqueue_thread, &firmware_task);
274 taskqueue_drain(taskqueue_thread, &firmware_task);
280 static moduledata_t firmware_mod = {
285 DECLARE_MODULE(firmware, firmware_mod, SI_SUB_DRIVERS, SI_ORDER_FIRST);
286 MODULE_VERSION(firmware, 1);