1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * main.c - Multi purpose firmware loading support
4 *
5 * Copyright (c) 2003 Manuel Estrada Sainz
6 *
7 * Please see Documentation/driver-api/firmware/ for more information.
8 *
9 */
10
11 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
12
13 #include <linux/capability.h>
14 #include <linux/device.h>
15 #include <linux/kernel_read_file.h>
16 #include <linux/module.h>
17 #include <linux/init.h>
18 #include <linux/timer.h>
19 #include <linux/vmalloc.h>
20 #include <linux/interrupt.h>
21 #include <linux/bitops.h>
22 #include <linux/mutex.h>
23 #include <linux/workqueue.h>
24 #include <linux/highmem.h>
25 #include <linux/firmware.h>
26 #include <linux/slab.h>
27 #include <linux/sched.h>
28 #include <linux/file.h>
29 #include <linux/list.h>
30 #include <linux/fs.h>
31 #include <linux/async.h>
32 #include <linux/pm.h>
33 #include <linux/suspend.h>
34 #include <linux/syscore_ops.h>
35 #include <linux/reboot.h>
36 #include <linux/security.h>
37 #include <linux/xz.h>
38
39 #include <generated/utsrelease.h>
40
41 #include "../base.h"
42 #include "firmware.h"
43 #include "fallback.h"
44
45 MODULE_AUTHOR("Manuel Estrada Sainz");
46 MODULE_DESCRIPTION("Multi purpose firmware loading support");
47 MODULE_LICENSE("GPL");
48
49 struct firmware_cache {
50 /* firmware_buf instance will be added into the below list */
51 spinlock_t lock;
52 struct list_head head;
53 int state;
54
55 #ifdef CONFIG_FW_CACHE
56 /*
57 * Names of firmware images which have been cached successfully
58 * will be added into the below list so that device uncache
59 * helper can trace which firmware images have been cached
60 * before.
61 */
62 spinlock_t name_lock;
63 struct list_head fw_names;
64
65 struct delayed_work work;
66
67 struct notifier_block pm_notify;
68 #endif
69 };
70
71 struct fw_cache_entry {
72 struct list_head list;
73 const char *name;
74 };
75
76 struct fw_name_devm {
77 unsigned long magic;
78 const char *name;
79 };
80
to_fw_priv(struct kref * ref)81 static inline struct fw_priv *to_fw_priv(struct kref *ref)
82 {
83 return container_of(ref, struct fw_priv, ref);
84 }
85
86 #define FW_LOADER_NO_CACHE 0
87 #define FW_LOADER_START_CACHE 1
88
89 /* fw_lock could be moved to 'struct fw_sysfs' but since it is just
90 * guarding for corner cases a global lock should be OK */
91 DEFINE_MUTEX(fw_lock);
92
93 static struct firmware_cache fw_cache;
94
95 /* Builtin firmware support */
96
97 #ifdef CONFIG_FW_LOADER
98
99 extern struct builtin_fw __start_builtin_fw[];
100 extern struct builtin_fw __end_builtin_fw[];
101
fw_copy_to_prealloc_buf(struct firmware * fw,void * buf,size_t size)102 static bool fw_copy_to_prealloc_buf(struct firmware *fw,
103 void *buf, size_t size)
104 {
105 if (!buf)
106 return true;
107 if (size < fw->size)
108 return false;
109 memcpy(buf, fw->data, fw->size);
110 return true;
111 }
112
fw_get_builtin_firmware(struct firmware * fw,const char * name,void * buf,size_t size)113 static bool fw_get_builtin_firmware(struct firmware *fw, const char *name,
114 void *buf, size_t size)
115 {
116 struct builtin_fw *b_fw;
117
118 for (b_fw = __start_builtin_fw; b_fw != __end_builtin_fw; b_fw++) {
119 if (strcmp(name, b_fw->name) == 0) {
120 fw->size = b_fw->size;
121 fw->data = b_fw->data;
122 return fw_copy_to_prealloc_buf(fw, buf, size);
123 }
124 }
125
126 return false;
127 }
128
fw_is_builtin_firmware(const struct firmware * fw)129 static bool fw_is_builtin_firmware(const struct firmware *fw)
130 {
131 struct builtin_fw *b_fw;
132
133 for (b_fw = __start_builtin_fw; b_fw != __end_builtin_fw; b_fw++)
134 if (fw->data == b_fw->data)
135 return true;
136
137 return false;
138 }
139
140 #else /* Module case - no builtin firmware support */
141
fw_get_builtin_firmware(struct firmware * fw,const char * name,void * buf,size_t size)142 static inline bool fw_get_builtin_firmware(struct firmware *fw,
143 const char *name, void *buf,
144 size_t size)
145 {
146 return false;
147 }
148
fw_is_builtin_firmware(const struct firmware * fw)149 static inline bool fw_is_builtin_firmware(const struct firmware *fw)
150 {
151 return false;
152 }
153 #endif
154
fw_state_init(struct fw_priv * fw_priv)155 static void fw_state_init(struct fw_priv *fw_priv)
156 {
157 struct fw_state *fw_st = &fw_priv->fw_st;
158
159 init_completion(&fw_st->completion);
160 fw_st->status = FW_STATUS_UNKNOWN;
161 }
162
fw_state_wait(struct fw_priv * fw_priv)163 static inline int fw_state_wait(struct fw_priv *fw_priv)
164 {
165 return __fw_state_wait_common(fw_priv, MAX_SCHEDULE_TIMEOUT);
166 }
167
168 static void fw_cache_piggyback_on_request(struct fw_priv *fw_priv);
169
__allocate_fw_priv(const char * fw_name,struct firmware_cache * fwc,void * dbuf,size_t size,size_t offset,u32 opt_flags)170 static struct fw_priv *__allocate_fw_priv(const char *fw_name,
171 struct firmware_cache *fwc,
172 void *dbuf,
173 size_t size,
174 size_t offset,
175 u32 opt_flags)
176 {
177 struct fw_priv *fw_priv;
178
179 /* For a partial read, the buffer must be preallocated. */
180 if ((opt_flags & FW_OPT_PARTIAL) && !dbuf)
181 return NULL;
182
183 /* Only partial reads are allowed to use an offset. */
184 if (offset != 0 && !(opt_flags & FW_OPT_PARTIAL))
185 return NULL;
186
187 fw_priv = kzalloc(sizeof(*fw_priv), GFP_ATOMIC);
188 if (!fw_priv)
189 return NULL;
190
191 fw_priv->fw_name = kstrdup_const(fw_name, GFP_ATOMIC);
192 if (!fw_priv->fw_name) {
193 kfree(fw_priv);
194 return NULL;
195 }
196
197 kref_init(&fw_priv->ref);
198 fw_priv->fwc = fwc;
199 fw_priv->data = dbuf;
200 fw_priv->allocated_size = size;
201 fw_priv->offset = offset;
202 fw_priv->opt_flags = opt_flags;
203 fw_state_init(fw_priv);
204 #ifdef CONFIG_FW_LOADER_USER_HELPER
205 INIT_LIST_HEAD(&fw_priv->pending_list);
206 #endif
207
208 pr_debug("%s: fw-%s fw_priv=%p\n", __func__, fw_name, fw_priv);
209
210 return fw_priv;
211 }
212
__lookup_fw_priv(const char * fw_name)213 static struct fw_priv *__lookup_fw_priv(const char *fw_name)
214 {
215 struct fw_priv *tmp;
216 struct firmware_cache *fwc = &fw_cache;
217
218 list_for_each_entry(tmp, &fwc->head, list)
219 if (!strcmp(tmp->fw_name, fw_name))
220 return tmp;
221 return NULL;
222 }
223
224 /* Returns 1 for batching firmware requests with the same name */
alloc_lookup_fw_priv(const char * fw_name,struct firmware_cache * fwc,struct fw_priv ** fw_priv,void * dbuf,size_t size,size_t offset,u32 opt_flags)225 static int alloc_lookup_fw_priv(const char *fw_name,
226 struct firmware_cache *fwc,
227 struct fw_priv **fw_priv,
228 void *dbuf,
229 size_t size,
230 size_t offset,
231 u32 opt_flags)
232 {
233 struct fw_priv *tmp;
234
235 spin_lock(&fwc->lock);
236 /*
237 * Do not merge requests that are marked to be non-cached or
238 * are performing partial reads.
239 */
240 if (!(opt_flags & (FW_OPT_NOCACHE | FW_OPT_PARTIAL))) {
241 tmp = __lookup_fw_priv(fw_name);
242 if (tmp) {
243 kref_get(&tmp->ref);
244 spin_unlock(&fwc->lock);
245 *fw_priv = tmp;
246 pr_debug("batched request - sharing the same struct fw_priv and lookup for multiple requests\n");
247 return 1;
248 }
249 }
250
251 tmp = __allocate_fw_priv(fw_name, fwc, dbuf, size, offset, opt_flags);
252 if (tmp) {
253 INIT_LIST_HEAD(&tmp->list);
254 if (!(opt_flags & FW_OPT_NOCACHE))
255 list_add(&tmp->list, &fwc->head);
256 }
257 spin_unlock(&fwc->lock);
258
259 *fw_priv = tmp;
260
261 return tmp ? 0 : -ENOMEM;
262 }
263
__free_fw_priv(struct kref * ref)264 static void __free_fw_priv(struct kref *ref)
265 __releases(&fwc->lock)
266 {
267 struct fw_priv *fw_priv = to_fw_priv(ref);
268 struct firmware_cache *fwc = fw_priv->fwc;
269
270 pr_debug("%s: fw-%s fw_priv=%p data=%p size=%u\n",
271 __func__, fw_priv->fw_name, fw_priv, fw_priv->data,
272 (unsigned int)fw_priv->size);
273
274 list_del(&fw_priv->list);
275 spin_unlock(&fwc->lock);
276
277 if (fw_is_paged_buf(fw_priv))
278 fw_free_paged_buf(fw_priv);
279 else if (!fw_priv->allocated_size)
280 vfree(fw_priv->data);
281
282 kfree_const(fw_priv->fw_name);
283 kfree(fw_priv);
284 }
285
free_fw_priv(struct fw_priv * fw_priv)286 static void free_fw_priv(struct fw_priv *fw_priv)
287 {
288 struct firmware_cache *fwc = fw_priv->fwc;
289 spin_lock(&fwc->lock);
290 if (!kref_put(&fw_priv->ref, __free_fw_priv))
291 spin_unlock(&fwc->lock);
292 }
293
294 #ifdef CONFIG_FW_LOADER_PAGED_BUF
fw_is_paged_buf(struct fw_priv * fw_priv)295 bool fw_is_paged_buf(struct fw_priv *fw_priv)
296 {
297 return fw_priv->is_paged_buf;
298 }
299
fw_free_paged_buf(struct fw_priv * fw_priv)300 void fw_free_paged_buf(struct fw_priv *fw_priv)
301 {
302 int i;
303
304 if (!fw_priv->pages)
305 return;
306
307 vunmap(fw_priv->data);
308
309 for (i = 0; i < fw_priv->nr_pages; i++)
310 __free_page(fw_priv->pages[i]);
311 kvfree(fw_priv->pages);
312 fw_priv->pages = NULL;
313 fw_priv->page_array_size = 0;
314 fw_priv->nr_pages = 0;
315 }
316
fw_grow_paged_buf(struct fw_priv * fw_priv,int pages_needed)317 int fw_grow_paged_buf(struct fw_priv *fw_priv, int pages_needed)
318 {
319 /* If the array of pages is too small, grow it */
320 if (fw_priv->page_array_size < pages_needed) {
321 int new_array_size = max(pages_needed,
322 fw_priv->page_array_size * 2);
323 struct page **new_pages;
324
325 new_pages = kvmalloc_array(new_array_size, sizeof(void *),
326 GFP_KERNEL);
327 if (!new_pages)
328 return -ENOMEM;
329 memcpy(new_pages, fw_priv->pages,
330 fw_priv->page_array_size * sizeof(void *));
331 memset(&new_pages[fw_priv->page_array_size], 0, sizeof(void *) *
332 (new_array_size - fw_priv->page_array_size));
333 kvfree(fw_priv->pages);
334 fw_priv->pages = new_pages;
335 fw_priv->page_array_size = new_array_size;
336 }
337
338 while (fw_priv->nr_pages < pages_needed) {
339 fw_priv->pages[fw_priv->nr_pages] =
340 alloc_page(GFP_KERNEL | __GFP_HIGHMEM);
341
342 if (!fw_priv->pages[fw_priv->nr_pages])
343 return -ENOMEM;
344 fw_priv->nr_pages++;
345 }
346
347 return 0;
348 }
349
fw_map_paged_buf(struct fw_priv * fw_priv)350 int fw_map_paged_buf(struct fw_priv *fw_priv)
351 {
352 /* one pages buffer should be mapped/unmapped only once */
353 if (!fw_priv->pages)
354 return 0;
355
356 vunmap(fw_priv->data);
357 fw_priv->data = vmap(fw_priv->pages, fw_priv->nr_pages, 0,
358 PAGE_KERNEL_RO);
359 if (!fw_priv->data)
360 return -ENOMEM;
361
362 return 0;
363 }
364 #endif
365
366 /*
367 * XZ-compressed firmware support
368 */
369 #ifdef CONFIG_FW_LOADER_COMPRESS
370 /* show an error and return the standard error code */
fw_decompress_xz_error(struct device * dev,enum xz_ret xz_ret)371 static int fw_decompress_xz_error(struct device *dev, enum xz_ret xz_ret)
372 {
373 if (xz_ret != XZ_STREAM_END) {
374 dev_warn(dev, "xz decompression failed (xz_ret=%d)\n", xz_ret);
375 return xz_ret == XZ_MEM_ERROR ? -ENOMEM : -EINVAL;
376 }
377 return 0;
378 }
379
380 /* single-shot decompression onto the pre-allocated buffer */
fw_decompress_xz_single(struct device * dev,struct fw_priv * fw_priv,size_t in_size,const void * in_buffer)381 static int fw_decompress_xz_single(struct device *dev, struct fw_priv *fw_priv,
382 size_t in_size, const void *in_buffer)
383 {
384 struct xz_dec *xz_dec;
385 struct xz_buf xz_buf;
386 enum xz_ret xz_ret;
387
388 xz_dec = xz_dec_init(XZ_SINGLE, (u32)-1);
389 if (!xz_dec)
390 return -ENOMEM;
391
392 xz_buf.in_size = in_size;
393 xz_buf.in = in_buffer;
394 xz_buf.in_pos = 0;
395 xz_buf.out_size = fw_priv->allocated_size;
396 xz_buf.out = fw_priv->data;
397 xz_buf.out_pos = 0;
398
399 xz_ret = xz_dec_run(xz_dec, &xz_buf);
400 xz_dec_end(xz_dec);
401
402 fw_priv->size = xz_buf.out_pos;
403 return fw_decompress_xz_error(dev, xz_ret);
404 }
405
406 /* decompression on paged buffer and map it */
fw_decompress_xz_pages(struct device * dev,struct fw_priv * fw_priv,size_t in_size,const void * in_buffer)407 static int fw_decompress_xz_pages(struct device *dev, struct fw_priv *fw_priv,
408 size_t in_size, const void *in_buffer)
409 {
410 struct xz_dec *xz_dec;
411 struct xz_buf xz_buf;
412 enum xz_ret xz_ret;
413 struct page *page;
414 int err = 0;
415
416 xz_dec = xz_dec_init(XZ_DYNALLOC, (u32)-1);
417 if (!xz_dec)
418 return -ENOMEM;
419
420 xz_buf.in_size = in_size;
421 xz_buf.in = in_buffer;
422 xz_buf.in_pos = 0;
423
424 fw_priv->is_paged_buf = true;
425 fw_priv->size = 0;
426 do {
427 if (fw_grow_paged_buf(fw_priv, fw_priv->nr_pages + 1)) {
428 err = -ENOMEM;
429 goto out;
430 }
431
432 /* decompress onto the new allocated page */
433 page = fw_priv->pages[fw_priv->nr_pages - 1];
434 xz_buf.out = kmap(page);
435 xz_buf.out_pos = 0;
436 xz_buf.out_size = PAGE_SIZE;
437 xz_ret = xz_dec_run(xz_dec, &xz_buf);
438 kunmap(page);
439 fw_priv->size += xz_buf.out_pos;
440 /* partial decompression means either end or error */
441 if (xz_buf.out_pos != PAGE_SIZE)
442 break;
443 } while (xz_ret == XZ_OK);
444
445 err = fw_decompress_xz_error(dev, xz_ret);
446 if (!err)
447 err = fw_map_paged_buf(fw_priv);
448
449 out:
450 xz_dec_end(xz_dec);
451 return err;
452 }
453
fw_decompress_xz(struct device * dev,struct fw_priv * fw_priv,size_t in_size,const void * in_buffer)454 static int fw_decompress_xz(struct device *dev, struct fw_priv *fw_priv,
455 size_t in_size, const void *in_buffer)
456 {
457 /* if the buffer is pre-allocated, we can perform in single-shot mode */
458 if (fw_priv->data)
459 return fw_decompress_xz_single(dev, fw_priv, in_size, in_buffer);
460 else
461 return fw_decompress_xz_pages(dev, fw_priv, in_size, in_buffer);
462 }
463 #endif /* CONFIG_FW_LOADER_COMPRESS */
464
465 /* direct firmware loading support */
466 static char fw_path_para[256];
467 static const char * const fw_path[] = {
468 fw_path_para,
469 "/lib/firmware/updates/" UTS_RELEASE,
470 "/lib/firmware/updates",
471 "/lib/firmware/" UTS_RELEASE,
472 "/lib/firmware"
473 };
474
475 /*
476 * Typical usage is that passing 'firmware_class.path=$CUSTOMIZED_PATH'
477 * from kernel command line because firmware_class is generally built in
478 * kernel instead of module.
479 */
480 module_param_string(path, fw_path_para, sizeof(fw_path_para), 0644);
481 MODULE_PARM_DESC(path, "customized firmware image search path with a higher priority than default path");
482
483 static int
fw_get_filesystem_firmware(struct device * device,struct fw_priv * fw_priv,const char * suffix,int (* decompress)(struct device * dev,struct fw_priv * fw_priv,size_t in_size,const void * in_buffer))484 fw_get_filesystem_firmware(struct device *device, struct fw_priv *fw_priv,
485 const char *suffix,
486 int (*decompress)(struct device *dev,
487 struct fw_priv *fw_priv,
488 size_t in_size,
489 const void *in_buffer))
490 {
491 size_t size;
492 int i, len;
493 int rc = -ENOENT;
494 char *path;
495 size_t msize = INT_MAX;
496 void *buffer = NULL;
497
498 /* Already populated data member means we're loading into a buffer */
499 if (!decompress && fw_priv->data) {
500 buffer = fw_priv->data;
501 msize = fw_priv->allocated_size;
502 }
503
504 path = __getname();
505 if (!path)
506 return -ENOMEM;
507
508 for (i = 0; i < ARRAY_SIZE(fw_path); i++) {
509 size_t file_size = 0;
510 size_t *file_size_ptr = NULL;
511
512 /* skip the unset customized path */
513 if (!fw_path[i][0])
514 continue;
515
516 len = snprintf(path, PATH_MAX, "%s/%s%s",
517 fw_path[i], fw_priv->fw_name, suffix);
518 if (len >= PATH_MAX) {
519 rc = -ENAMETOOLONG;
520 break;
521 }
522
523 fw_priv->size = 0;
524
525 /*
526 * The total file size is only examined when doing a partial
527 * read; the "full read" case needs to fail if the whole
528 * firmware was not completely loaded.
529 */
530 if ((fw_priv->opt_flags & FW_OPT_PARTIAL) && buffer)
531 file_size_ptr = &file_size;
532
533 /* load firmware files from the mount namespace of init */
534 rc = kernel_read_file_from_path_initns(path, fw_priv->offset,
535 &buffer, msize,
536 file_size_ptr,
537 READING_FIRMWARE);
538 if (rc < 0) {
539 if (rc != -ENOENT)
540 dev_warn(device, "loading %s failed with error %d\n",
541 path, rc);
542 else
543 dev_dbg(device, "loading %s failed for no such file or directory.\n",
544 path);
545 continue;
546 }
547 size = rc;
548 rc = 0;
549
550 dev_dbg(device, "Loading firmware from %s\n", path);
551 if (decompress) {
552 dev_dbg(device, "f/w decompressing %s\n",
553 fw_priv->fw_name);
554 rc = decompress(device, fw_priv, size, buffer);
555 /* discard the superfluous original content */
556 vfree(buffer);
557 buffer = NULL;
558 if (rc) {
559 fw_free_paged_buf(fw_priv);
560 continue;
561 }
562 } else {
563 dev_dbg(device, "direct-loading %s\n",
564 fw_priv->fw_name);
565 if (!fw_priv->data)
566 fw_priv->data = buffer;
567 fw_priv->size = size;
568 }
569 fw_state_done(fw_priv);
570 break;
571 }
572 __putname(path);
573
574 return rc;
575 }
576
577 /* firmware holds the ownership of pages */
firmware_free_data(const struct firmware * fw)578 static void firmware_free_data(const struct firmware *fw)
579 {
580 /* Loaded directly? */
581 if (!fw->priv) {
582 vfree(fw->data);
583 return;
584 }
585 free_fw_priv(fw->priv);
586 }
587
588 /* store the pages buffer info firmware from buf */
fw_set_page_data(struct fw_priv * fw_priv,struct firmware * fw)589 static void fw_set_page_data(struct fw_priv *fw_priv, struct firmware *fw)
590 {
591 fw->priv = fw_priv;
592 fw->size = fw_priv->size;
593 fw->data = fw_priv->data;
594
595 pr_debug("%s: fw-%s fw_priv=%p data=%p size=%u\n",
596 __func__, fw_priv->fw_name, fw_priv, fw_priv->data,
597 (unsigned int)fw_priv->size);
598 }
599
600 #ifdef CONFIG_FW_CACHE
fw_name_devm_release(struct device * dev,void * res)601 static void fw_name_devm_release(struct device *dev, void *res)
602 {
603 struct fw_name_devm *fwn = res;
604
605 if (fwn->magic == (unsigned long)&fw_cache)
606 pr_debug("%s: fw_name-%s devm-%p released\n",
607 __func__, fwn->name, res);
608 kfree_const(fwn->name);
609 }
610
fw_devm_match(struct device * dev,void * res,void * match_data)611 static int fw_devm_match(struct device *dev, void *res,
612 void *match_data)
613 {
614 struct fw_name_devm *fwn = res;
615
616 return (fwn->magic == (unsigned long)&fw_cache) &&
617 !strcmp(fwn->name, match_data);
618 }
619
fw_find_devm_name(struct device * dev,const char * name)620 static struct fw_name_devm *fw_find_devm_name(struct device *dev,
621 const char *name)
622 {
623 struct fw_name_devm *fwn;
624
625 fwn = devres_find(dev, fw_name_devm_release,
626 fw_devm_match, (void *)name);
627 return fwn;
628 }
629
fw_cache_is_setup(struct device * dev,const char * name)630 static bool fw_cache_is_setup(struct device *dev, const char *name)
631 {
632 struct fw_name_devm *fwn;
633
634 fwn = fw_find_devm_name(dev, name);
635 if (fwn)
636 return true;
637
638 return false;
639 }
640
641 /* add firmware name into devres list */
fw_add_devm_name(struct device * dev,const char * name)642 static int fw_add_devm_name(struct device *dev, const char *name)
643 {
644 struct fw_name_devm *fwn;
645
646 if (fw_cache_is_setup(dev, name))
647 return 0;
648
649 fwn = devres_alloc(fw_name_devm_release, sizeof(struct fw_name_devm),
650 GFP_KERNEL);
651 if (!fwn)
652 return -ENOMEM;
653 fwn->name = kstrdup_const(name, GFP_KERNEL);
654 if (!fwn->name) {
655 devres_free(fwn);
656 return -ENOMEM;
657 }
658
659 fwn->magic = (unsigned long)&fw_cache;
660 devres_add(dev, fwn);
661
662 return 0;
663 }
664 #else
fw_cache_is_setup(struct device * dev,const char * name)665 static bool fw_cache_is_setup(struct device *dev, const char *name)
666 {
667 return false;
668 }
669
fw_add_devm_name(struct device * dev,const char * name)670 static int fw_add_devm_name(struct device *dev, const char *name)
671 {
672 return 0;
673 }
674 #endif
675
assign_fw(struct firmware * fw,struct device * device)676 int assign_fw(struct firmware *fw, struct device *device)
677 {
678 struct fw_priv *fw_priv = fw->priv;
679 int ret;
680
681 mutex_lock(&fw_lock);
682 if (!fw_priv->size || fw_state_is_aborted(fw_priv)) {
683 mutex_unlock(&fw_lock);
684 return -ENOENT;
685 }
686
687 /*
688 * add firmware name into devres list so that we can auto cache
689 * and uncache firmware for device.
690 *
691 * device may has been deleted already, but the problem
692 * should be fixed in devres or driver core.
693 */
694 /* don't cache firmware handled without uevent */
695 if (device && (fw_priv->opt_flags & FW_OPT_UEVENT) &&
696 !(fw_priv->opt_flags & FW_OPT_NOCACHE)) {
697 ret = fw_add_devm_name(device, fw_priv->fw_name);
698 if (ret) {
699 mutex_unlock(&fw_lock);
700 return ret;
701 }
702 }
703
704 /*
705 * After caching firmware image is started, let it piggyback
706 * on request firmware.
707 */
708 if (!(fw_priv->opt_flags & FW_OPT_NOCACHE) &&
709 fw_priv->fwc->state == FW_LOADER_START_CACHE)
710 fw_cache_piggyback_on_request(fw_priv);
711
712 /* pass the pages buffer to driver at the last minute */
713 fw_set_page_data(fw_priv, fw);
714 mutex_unlock(&fw_lock);
715 return 0;
716 }
717
718 /* prepare firmware and firmware_buf structs;
719 * return 0 if a firmware is already assigned, 1 if need to load one,
720 * or a negative error code
721 */
722 static int
_request_firmware_prepare(struct firmware ** firmware_p,const char * name,struct device * device,void * dbuf,size_t size,size_t offset,u32 opt_flags)723 _request_firmware_prepare(struct firmware **firmware_p, const char *name,
724 struct device *device, void *dbuf, size_t size,
725 size_t offset, u32 opt_flags)
726 {
727 struct firmware *firmware;
728 struct fw_priv *fw_priv;
729 int ret;
730
731 *firmware_p = firmware = kzalloc(sizeof(*firmware), GFP_KERNEL);
732 if (!firmware) {
733 dev_err(device, "%s: kmalloc(struct firmware) failed\n",
734 __func__);
735 return -ENOMEM;
736 }
737
738 if (fw_get_builtin_firmware(firmware, name, dbuf, size)) {
739 dev_dbg(device, "using built-in %s\n", name);
740 return 0; /* assigned */
741 }
742
743 ret = alloc_lookup_fw_priv(name, &fw_cache, &fw_priv, dbuf, size,
744 offset, opt_flags);
745
746 /*
747 * bind with 'priv' now to avoid warning in failure path
748 * of requesting firmware.
749 */
750 firmware->priv = fw_priv;
751
752 if (ret > 0) {
753 ret = fw_state_wait(fw_priv);
754 if (!ret) {
755 fw_set_page_data(fw_priv, firmware);
756 return 0; /* assigned */
757 }
758 }
759
760 if (ret < 0)
761 return ret;
762 return 1; /* need to load */
763 }
764
765 /*
766 * Batched requests need only one wake, we need to do this step last due to the
767 * fallback mechanism. The buf is protected with kref_get(), and it won't be
768 * released until the last user calls release_firmware().
769 *
770 * Failed batched requests are possible as well, in such cases we just share
771 * the struct fw_priv and won't release it until all requests are woken
772 * and have gone through this same path.
773 */
fw_abort_batch_reqs(struct firmware * fw)774 static void fw_abort_batch_reqs(struct firmware *fw)
775 {
776 struct fw_priv *fw_priv;
777
778 /* Loaded directly? */
779 if (!fw || !fw->priv)
780 return;
781
782 fw_priv = fw->priv;
783 mutex_lock(&fw_lock);
784 if (!fw_state_is_aborted(fw_priv))
785 fw_state_aborted(fw_priv);
786 mutex_unlock(&fw_lock);
787 }
788
789 /*
790 * Reject firmware file names with ".." path components.
791 * There are drivers that construct firmware file names from device-supplied
792 * strings, and we don't want some device to be able to tell us "I would like to
793 * be sent my firmware from ../../../etc/shadow, please".
794 *
795 * Search for ".." surrounded by either '/' or start/end of string.
796 *
797 * This intentionally only looks at the firmware name, not at the firmware base
798 * directory or at symlink contents.
799 */
name_contains_dotdot(const char * name)800 static bool name_contains_dotdot(const char *name)
801 {
802 size_t name_len = strlen(name);
803
804 return strcmp(name, "..") == 0 || strncmp(name, "../", 3) == 0 ||
805 strstr(name, "/../") != NULL ||
806 (name_len >= 3 && strcmp(name+name_len-3, "/..") == 0);
807 }
808
809 /* called from request_firmware() and request_firmware_work_func() */
810 static int
_request_firmware(const struct firmware ** firmware_p,const char * name,struct device * device,void * buf,size_t size,size_t offset,u32 opt_flags)811 _request_firmware(const struct firmware **firmware_p, const char *name,
812 struct device *device, void *buf, size_t size,
813 size_t offset, u32 opt_flags)
814 {
815 struct firmware *fw = NULL;
816 struct cred *kern_cred = NULL;
817 const struct cred *old_cred;
818 bool nondirect = false;
819 int ret;
820
821 if (!firmware_p)
822 return -EINVAL;
823
824 if (!name || name[0] == '\0') {
825 ret = -EINVAL;
826 goto out;
827 }
828
829 if (name_contains_dotdot(name)) {
830 dev_warn(device,
831 "Firmware load for '%s' refused, path contains '..' component\n",
832 name);
833 ret = -EINVAL;
834 goto out;
835 }
836
837 ret = _request_firmware_prepare(&fw, name, device, buf, size,
838 offset, opt_flags);
839 if (ret <= 0) /* error or already assigned */
840 goto out;
841
842 /*
843 * We are about to try to access the firmware file. Because we may have been
844 * called by a driver when serving an unrelated request from userland, we use
845 * the kernel credentials to read the file.
846 */
847 kern_cred = prepare_kernel_cred(NULL);
848 if (!kern_cred) {
849 ret = -ENOMEM;
850 goto out;
851 }
852 old_cred = override_creds(kern_cred);
853
854 ret = fw_get_filesystem_firmware(device, fw->priv, "", NULL);
855
856 /* Only full reads can support decompression, platform, and sysfs. */
857 if (!(opt_flags & FW_OPT_PARTIAL))
858 nondirect = true;
859
860 #ifdef CONFIG_FW_LOADER_COMPRESS
861 if (ret == -ENOENT && nondirect)
862 ret = fw_get_filesystem_firmware(device, fw->priv, ".xz",
863 fw_decompress_xz);
864 #endif
865 if (ret == -ENOENT && nondirect)
866 ret = firmware_fallback_platform(fw->priv);
867
868 if (ret) {
869 if (!(opt_flags & FW_OPT_NO_WARN))
870 dev_warn(device,
871 "Direct firmware load for %s failed with error %d\n",
872 name, ret);
873 if (nondirect)
874 ret = firmware_fallback_sysfs(fw, name, device,
875 opt_flags, ret);
876 } else
877 ret = assign_fw(fw, device);
878
879 revert_creds(old_cred);
880 put_cred(kern_cred);
881
882 out:
883 if (ret < 0) {
884 fw_abort_batch_reqs(fw);
885 release_firmware(fw);
886 fw = NULL;
887 }
888
889 *firmware_p = fw;
890 return ret;
891 }
892
893 /**
894 * request_firmware() - send firmware request and wait for it
895 * @firmware_p: pointer to firmware image
896 * @name: name of firmware file
897 * @device: device for which firmware is being loaded
898 *
899 * @firmware_p will be used to return a firmware image by the name
900 * of @name for device @device.
901 *
902 * Should be called from user context where sleeping is allowed.
903 *
904 * @name will be used as $FIRMWARE in the uevent environment and
905 * should be distinctive enough not to be confused with any other
906 * firmware image for this or any other device.
907 * It must not contain any ".." path components - "foo/bar..bin" is
908 * allowed, but "foo/../bar.bin" is not.
909 *
910 * Caller must hold the reference count of @device.
911 *
912 * The function can be called safely inside device's suspend and
913 * resume callback.
914 **/
915 int
request_firmware(const struct firmware ** firmware_p,const char * name,struct device * device)916 request_firmware(const struct firmware **firmware_p, const char *name,
917 struct device *device)
918 {
919 int ret;
920
921 /* Need to pin this module until return */
922 __module_get(THIS_MODULE);
923 ret = _request_firmware(firmware_p, name, device, NULL, 0, 0,
924 FW_OPT_UEVENT);
925 module_put(THIS_MODULE);
926 return ret;
927 }
928 EXPORT_SYMBOL(request_firmware);
929
930 /**
931 * firmware_request_nowarn() - request for an optional fw module
932 * @firmware: pointer to firmware image
933 * @name: name of firmware file
934 * @device: device for which firmware is being loaded
935 *
936 * This function is similar in behaviour to request_firmware(), except it
937 * doesn't produce warning messages when the file is not found. The sysfs
938 * fallback mechanism is enabled if direct filesystem lookup fails. However,
939 * failures to find the firmware file with it are still suppressed. It is
940 * therefore up to the driver to check for the return value of this call and to
941 * decide when to inform the users of errors.
942 **/
firmware_request_nowarn(const struct firmware ** firmware,const char * name,struct device * device)943 int firmware_request_nowarn(const struct firmware **firmware, const char *name,
944 struct device *device)
945 {
946 int ret;
947
948 /* Need to pin this module until return */
949 __module_get(THIS_MODULE);
950 ret = _request_firmware(firmware, name, device, NULL, 0, 0,
951 FW_OPT_UEVENT | FW_OPT_NO_WARN);
952 module_put(THIS_MODULE);
953 return ret;
954 }
955 EXPORT_SYMBOL_GPL(firmware_request_nowarn);
956
957 /**
958 * request_firmware_direct() - load firmware directly without usermode helper
959 * @firmware_p: pointer to firmware image
960 * @name: name of firmware file
961 * @device: device for which firmware is being loaded
962 *
963 * This function works pretty much like request_firmware(), but this doesn't
964 * fall back to usermode helper even if the firmware couldn't be loaded
965 * directly from fs. Hence it's useful for loading optional firmwares, which
966 * aren't always present, without extra long timeouts of udev.
967 **/
request_firmware_direct(const struct firmware ** firmware_p,const char * name,struct device * device)968 int request_firmware_direct(const struct firmware **firmware_p,
969 const char *name, struct device *device)
970 {
971 int ret;
972
973 __module_get(THIS_MODULE);
974 ret = _request_firmware(firmware_p, name, device, NULL, 0, 0,
975 FW_OPT_UEVENT | FW_OPT_NO_WARN |
976 FW_OPT_NOFALLBACK_SYSFS);
977 module_put(THIS_MODULE);
978 return ret;
979 }
980 EXPORT_SYMBOL_GPL(request_firmware_direct);
981
982 /**
983 * firmware_request_platform() - request firmware with platform-fw fallback
984 * @firmware: pointer to firmware image
985 * @name: name of firmware file
986 * @device: device for which firmware is being loaded
987 *
988 * This function is similar in behaviour to request_firmware, except that if
989 * direct filesystem lookup fails, it will fallback to looking for a copy of the
990 * requested firmware embedded in the platform's main (e.g. UEFI) firmware.
991 **/
firmware_request_platform(const struct firmware ** firmware,const char * name,struct device * device)992 int firmware_request_platform(const struct firmware **firmware,
993 const char *name, struct device *device)
994 {
995 int ret;
996
997 /* Need to pin this module until return */
998 __module_get(THIS_MODULE);
999 ret = _request_firmware(firmware, name, device, NULL, 0, 0,
1000 FW_OPT_UEVENT | FW_OPT_FALLBACK_PLATFORM);
1001 module_put(THIS_MODULE);
1002 return ret;
1003 }
1004 EXPORT_SYMBOL_GPL(firmware_request_platform);
1005
1006 /**
1007 * firmware_request_cache() - cache firmware for suspend so resume can use it
1008 * @name: name of firmware file
1009 * @device: device for which firmware should be cached for
1010 *
1011 * There are some devices with an optimization that enables the device to not
1012 * require loading firmware on system reboot. This optimization may still
1013 * require the firmware present on resume from suspend. This routine can be
1014 * used to ensure the firmware is present on resume from suspend in these
1015 * situations. This helper is not compatible with drivers which use
1016 * request_firmware_into_buf() or request_firmware_nowait() with no uevent set.
1017 **/
firmware_request_cache(struct device * device,const char * name)1018 int firmware_request_cache(struct device *device, const char *name)
1019 {
1020 int ret;
1021
1022 mutex_lock(&fw_lock);
1023 ret = fw_add_devm_name(device, name);
1024 mutex_unlock(&fw_lock);
1025
1026 return ret;
1027 }
1028 EXPORT_SYMBOL_GPL(firmware_request_cache);
1029
1030 /**
1031 * request_firmware_into_buf() - load firmware into a previously allocated buffer
1032 * @firmware_p: pointer to firmware image
1033 * @name: name of firmware file
1034 * @device: device for which firmware is being loaded and DMA region allocated
1035 * @buf: address of buffer to load firmware into
1036 * @size: size of buffer
1037 *
1038 * This function works pretty much like request_firmware(), but it doesn't
1039 * allocate a buffer to hold the firmware data. Instead, the firmware
1040 * is loaded directly into the buffer pointed to by @buf and the @firmware_p
1041 * data member is pointed at @buf.
1042 *
1043 * This function doesn't cache firmware either.
1044 */
1045 int
request_firmware_into_buf(const struct firmware ** firmware_p,const char * name,struct device * device,void * buf,size_t size)1046 request_firmware_into_buf(const struct firmware **firmware_p, const char *name,
1047 struct device *device, void *buf, size_t size)
1048 {
1049 int ret;
1050
1051 if (fw_cache_is_setup(device, name))
1052 return -EOPNOTSUPP;
1053
1054 __module_get(THIS_MODULE);
1055 ret = _request_firmware(firmware_p, name, device, buf, size, 0,
1056 FW_OPT_UEVENT | FW_OPT_NOCACHE);
1057 module_put(THIS_MODULE);
1058 return ret;
1059 }
1060 EXPORT_SYMBOL(request_firmware_into_buf);
1061
1062 /**
1063 * request_partial_firmware_into_buf() - load partial firmware into a previously allocated buffer
1064 * @firmware_p: pointer to firmware image
1065 * @name: name of firmware file
1066 * @device: device for which firmware is being loaded and DMA region allocated
1067 * @buf: address of buffer to load firmware into
1068 * @size: size of buffer
1069 * @offset: offset into file to read
1070 *
1071 * This function works pretty much like request_firmware_into_buf except
1072 * it allows a partial read of the file.
1073 */
1074 int
request_partial_firmware_into_buf(const struct firmware ** firmware_p,const char * name,struct device * device,void * buf,size_t size,size_t offset)1075 request_partial_firmware_into_buf(const struct firmware **firmware_p,
1076 const char *name, struct device *device,
1077 void *buf, size_t size, size_t offset)
1078 {
1079 int ret;
1080
1081 if (fw_cache_is_setup(device, name))
1082 return -EOPNOTSUPP;
1083
1084 __module_get(THIS_MODULE);
1085 ret = _request_firmware(firmware_p, name, device, buf, size, offset,
1086 FW_OPT_UEVENT | FW_OPT_NOCACHE |
1087 FW_OPT_PARTIAL);
1088 module_put(THIS_MODULE);
1089 return ret;
1090 }
1091 EXPORT_SYMBOL(request_partial_firmware_into_buf);
1092
1093 /**
1094 * release_firmware() - release the resource associated with a firmware image
1095 * @fw: firmware resource to release
1096 **/
release_firmware(const struct firmware * fw)1097 void release_firmware(const struct firmware *fw)
1098 {
1099 if (fw) {
1100 if (!fw_is_builtin_firmware(fw))
1101 firmware_free_data(fw);
1102 kfree(fw);
1103 }
1104 }
1105 EXPORT_SYMBOL(release_firmware);
1106
1107 /* Async support */
1108 struct firmware_work {
1109 struct work_struct work;
1110 struct module *module;
1111 const char *name;
1112 struct device *device;
1113 void *context;
1114 void (*cont)(const struct firmware *fw, void *context);
1115 u32 opt_flags;
1116 };
1117
request_firmware_work_func(struct work_struct * work)1118 static void request_firmware_work_func(struct work_struct *work)
1119 {
1120 struct firmware_work *fw_work;
1121 const struct firmware *fw;
1122
1123 fw_work = container_of(work, struct firmware_work, work);
1124
1125 _request_firmware(&fw, fw_work->name, fw_work->device, NULL, 0, 0,
1126 fw_work->opt_flags);
1127 fw_work->cont(fw, fw_work->context);
1128 put_device(fw_work->device); /* taken in request_firmware_nowait() */
1129
1130 module_put(fw_work->module);
1131 kfree_const(fw_work->name);
1132 kfree(fw_work);
1133 }
1134
1135 /**
1136 * request_firmware_nowait() - asynchronous version of request_firmware
1137 * @module: module requesting the firmware
1138 * @uevent: sends uevent to copy the firmware image if this flag
1139 * is non-zero else the firmware copy must be done manually.
1140 * @name: name of firmware file
1141 * @device: device for which firmware is being loaded
1142 * @gfp: allocation flags
1143 * @context: will be passed over to @cont, and
1144 * @fw may be %NULL if firmware request fails.
1145 * @cont: function will be called asynchronously when the firmware
1146 * request is over.
1147 *
1148 * Caller must hold the reference count of @device.
1149 *
1150 * Asynchronous variant of request_firmware() for user contexts:
1151 * - sleep for as small periods as possible since it may
1152 * increase kernel boot time of built-in device drivers
1153 * requesting firmware in their ->probe() methods, if
1154 * @gfp is GFP_KERNEL.
1155 *
1156 * - can't sleep at all if @gfp is GFP_ATOMIC.
1157 **/
1158 int
request_firmware_nowait(struct module * module,bool uevent,const char * name,struct device * device,gfp_t gfp,void * context,void (* cont)(const struct firmware * fw,void * context))1159 request_firmware_nowait(
1160 struct module *module, bool uevent,
1161 const char *name, struct device *device, gfp_t gfp, void *context,
1162 void (*cont)(const struct firmware *fw, void *context))
1163 {
1164 struct firmware_work *fw_work;
1165
1166 fw_work = kzalloc(sizeof(struct firmware_work), gfp);
1167 if (!fw_work)
1168 return -ENOMEM;
1169
1170 fw_work->module = module;
1171 fw_work->name = kstrdup_const(name, gfp);
1172 if (!fw_work->name) {
1173 kfree(fw_work);
1174 return -ENOMEM;
1175 }
1176 fw_work->device = device;
1177 fw_work->context = context;
1178 fw_work->cont = cont;
1179 fw_work->opt_flags = FW_OPT_NOWAIT |
1180 (uevent ? FW_OPT_UEVENT : FW_OPT_USERHELPER);
1181
1182 if (!uevent && fw_cache_is_setup(device, name)) {
1183 kfree_const(fw_work->name);
1184 kfree(fw_work);
1185 return -EOPNOTSUPP;
1186 }
1187
1188 if (!try_module_get(module)) {
1189 kfree_const(fw_work->name);
1190 kfree(fw_work);
1191 return -EFAULT;
1192 }
1193
1194 get_device(fw_work->device);
1195 INIT_WORK(&fw_work->work, request_firmware_work_func);
1196 schedule_work(&fw_work->work);
1197 return 0;
1198 }
1199 EXPORT_SYMBOL(request_firmware_nowait);
1200
1201 #ifdef CONFIG_FW_CACHE
1202 static ASYNC_DOMAIN_EXCLUSIVE(fw_cache_domain);
1203
1204 /**
1205 * cache_firmware() - cache one firmware image in kernel memory space
1206 * @fw_name: the firmware image name
1207 *
1208 * Cache firmware in kernel memory so that drivers can use it when
1209 * system isn't ready for them to request firmware image from userspace.
1210 * Once it returns successfully, driver can use request_firmware or its
1211 * nowait version to get the cached firmware without any interacting
1212 * with userspace
1213 *
1214 * Return 0 if the firmware image has been cached successfully
1215 * Return !0 otherwise
1216 *
1217 */
cache_firmware(const char * fw_name)1218 static int cache_firmware(const char *fw_name)
1219 {
1220 int ret;
1221 const struct firmware *fw;
1222
1223 pr_debug("%s: %s\n", __func__, fw_name);
1224
1225 ret = request_firmware(&fw, fw_name, NULL);
1226 if (!ret)
1227 kfree(fw);
1228
1229 pr_debug("%s: %s ret=%d\n", __func__, fw_name, ret);
1230
1231 return ret;
1232 }
1233
lookup_fw_priv(const char * fw_name)1234 static struct fw_priv *lookup_fw_priv(const char *fw_name)
1235 {
1236 struct fw_priv *tmp;
1237 struct firmware_cache *fwc = &fw_cache;
1238
1239 spin_lock(&fwc->lock);
1240 tmp = __lookup_fw_priv(fw_name);
1241 spin_unlock(&fwc->lock);
1242
1243 return tmp;
1244 }
1245
1246 /**
1247 * uncache_firmware() - remove one cached firmware image
1248 * @fw_name: the firmware image name
1249 *
1250 * Uncache one firmware image which has been cached successfully
1251 * before.
1252 *
1253 * Return 0 if the firmware cache has been removed successfully
1254 * Return !0 otherwise
1255 *
1256 */
uncache_firmware(const char * fw_name)1257 static int uncache_firmware(const char *fw_name)
1258 {
1259 struct fw_priv *fw_priv;
1260 struct firmware fw;
1261
1262 pr_debug("%s: %s\n", __func__, fw_name);
1263
1264 if (fw_get_builtin_firmware(&fw, fw_name, NULL, 0))
1265 return 0;
1266
1267 fw_priv = lookup_fw_priv(fw_name);
1268 if (fw_priv) {
1269 free_fw_priv(fw_priv);
1270 return 0;
1271 }
1272
1273 return -EINVAL;
1274 }
1275
alloc_fw_cache_entry(const char * name)1276 static struct fw_cache_entry *alloc_fw_cache_entry(const char *name)
1277 {
1278 struct fw_cache_entry *fce;
1279
1280 fce = kzalloc(sizeof(*fce), GFP_ATOMIC);
1281 if (!fce)
1282 goto exit;
1283
1284 fce->name = kstrdup_const(name, GFP_ATOMIC);
1285 if (!fce->name) {
1286 kfree(fce);
1287 fce = NULL;
1288 goto exit;
1289 }
1290 exit:
1291 return fce;
1292 }
1293
__fw_entry_found(const char * name)1294 static int __fw_entry_found(const char *name)
1295 {
1296 struct firmware_cache *fwc = &fw_cache;
1297 struct fw_cache_entry *fce;
1298
1299 list_for_each_entry(fce, &fwc->fw_names, list) {
1300 if (!strcmp(fce->name, name))
1301 return 1;
1302 }
1303 return 0;
1304 }
1305
fw_cache_piggyback_on_request(struct fw_priv * fw_priv)1306 static void fw_cache_piggyback_on_request(struct fw_priv *fw_priv)
1307 {
1308 const char *name = fw_priv->fw_name;
1309 struct firmware_cache *fwc = fw_priv->fwc;
1310 struct fw_cache_entry *fce;
1311
1312 spin_lock(&fwc->name_lock);
1313 if (__fw_entry_found(name))
1314 goto found;
1315
1316 fce = alloc_fw_cache_entry(name);
1317 if (fce) {
1318 list_add(&fce->list, &fwc->fw_names);
1319 kref_get(&fw_priv->ref);
1320 pr_debug("%s: fw: %s\n", __func__, name);
1321 }
1322 found:
1323 spin_unlock(&fwc->name_lock);
1324 }
1325
free_fw_cache_entry(struct fw_cache_entry * fce)1326 static void free_fw_cache_entry(struct fw_cache_entry *fce)
1327 {
1328 kfree_const(fce->name);
1329 kfree(fce);
1330 }
1331
__async_dev_cache_fw_image(void * fw_entry,async_cookie_t cookie)1332 static void __async_dev_cache_fw_image(void *fw_entry,
1333 async_cookie_t cookie)
1334 {
1335 struct fw_cache_entry *fce = fw_entry;
1336 struct firmware_cache *fwc = &fw_cache;
1337 int ret;
1338
1339 ret = cache_firmware(fce->name);
1340 if (ret) {
1341 spin_lock(&fwc->name_lock);
1342 list_del(&fce->list);
1343 spin_unlock(&fwc->name_lock);
1344
1345 free_fw_cache_entry(fce);
1346 }
1347 }
1348
1349 /* called with dev->devres_lock held */
dev_create_fw_entry(struct device * dev,void * res,void * data)1350 static void dev_create_fw_entry(struct device *dev, void *res,
1351 void *data)
1352 {
1353 struct fw_name_devm *fwn = res;
1354 const char *fw_name = fwn->name;
1355 struct list_head *head = data;
1356 struct fw_cache_entry *fce;
1357
1358 fce = alloc_fw_cache_entry(fw_name);
1359 if (fce)
1360 list_add(&fce->list, head);
1361 }
1362
devm_name_match(struct device * dev,void * res,void * match_data)1363 static int devm_name_match(struct device *dev, void *res,
1364 void *match_data)
1365 {
1366 struct fw_name_devm *fwn = res;
1367 return (fwn->magic == (unsigned long)match_data);
1368 }
1369
dev_cache_fw_image(struct device * dev,void * data)1370 static void dev_cache_fw_image(struct device *dev, void *data)
1371 {
1372 LIST_HEAD(todo);
1373 struct fw_cache_entry *fce;
1374 struct fw_cache_entry *fce_next;
1375 struct firmware_cache *fwc = &fw_cache;
1376
1377 devres_for_each_res(dev, fw_name_devm_release,
1378 devm_name_match, &fw_cache,
1379 dev_create_fw_entry, &todo);
1380
1381 list_for_each_entry_safe(fce, fce_next, &todo, list) {
1382 list_del(&fce->list);
1383
1384 spin_lock(&fwc->name_lock);
1385 /* only one cache entry for one firmware */
1386 if (!__fw_entry_found(fce->name)) {
1387 list_add(&fce->list, &fwc->fw_names);
1388 } else {
1389 free_fw_cache_entry(fce);
1390 fce = NULL;
1391 }
1392 spin_unlock(&fwc->name_lock);
1393
1394 if (fce)
1395 async_schedule_domain(__async_dev_cache_fw_image,
1396 (void *)fce,
1397 &fw_cache_domain);
1398 }
1399 }
1400
__device_uncache_fw_images(void)1401 static void __device_uncache_fw_images(void)
1402 {
1403 struct firmware_cache *fwc = &fw_cache;
1404 struct fw_cache_entry *fce;
1405
1406 spin_lock(&fwc->name_lock);
1407 while (!list_empty(&fwc->fw_names)) {
1408 fce = list_entry(fwc->fw_names.next,
1409 struct fw_cache_entry, list);
1410 list_del(&fce->list);
1411 spin_unlock(&fwc->name_lock);
1412
1413 uncache_firmware(fce->name);
1414 free_fw_cache_entry(fce);
1415
1416 spin_lock(&fwc->name_lock);
1417 }
1418 spin_unlock(&fwc->name_lock);
1419 }
1420
1421 /**
1422 * device_cache_fw_images() - cache devices' firmware
1423 *
1424 * If one device called request_firmware or its nowait version
1425 * successfully before, the firmware names are recored into the
1426 * device's devres link list, so device_cache_fw_images can call
1427 * cache_firmware() to cache these firmwares for the device,
1428 * then the device driver can load its firmwares easily at
1429 * time when system is not ready to complete loading firmware.
1430 */
device_cache_fw_images(void)1431 static void device_cache_fw_images(void)
1432 {
1433 struct firmware_cache *fwc = &fw_cache;
1434 DEFINE_WAIT(wait);
1435
1436 pr_debug("%s\n", __func__);
1437
1438 /* cancel uncache work */
1439 cancel_delayed_work_sync(&fwc->work);
1440
1441 fw_fallback_set_cache_timeout();
1442
1443 mutex_lock(&fw_lock);
1444 fwc->state = FW_LOADER_START_CACHE;
1445 dpm_for_each_dev(NULL, dev_cache_fw_image);
1446 mutex_unlock(&fw_lock);
1447
1448 /* wait for completion of caching firmware for all devices */
1449 async_synchronize_full_domain(&fw_cache_domain);
1450
1451 fw_fallback_set_default_timeout();
1452 }
1453
1454 /**
1455 * device_uncache_fw_images() - uncache devices' firmware
1456 *
1457 * uncache all firmwares which have been cached successfully
1458 * by device_uncache_fw_images earlier
1459 */
device_uncache_fw_images(void)1460 static void device_uncache_fw_images(void)
1461 {
1462 pr_debug("%s\n", __func__);
1463 __device_uncache_fw_images();
1464 }
1465
device_uncache_fw_images_work(struct work_struct * work)1466 static void device_uncache_fw_images_work(struct work_struct *work)
1467 {
1468 device_uncache_fw_images();
1469 }
1470
1471 /**
1472 * device_uncache_fw_images_delay() - uncache devices firmwares
1473 * @delay: number of milliseconds to delay uncache device firmwares
1474 *
1475 * uncache all devices's firmwares which has been cached successfully
1476 * by device_cache_fw_images after @delay milliseconds.
1477 */
device_uncache_fw_images_delay(unsigned long delay)1478 static void device_uncache_fw_images_delay(unsigned long delay)
1479 {
1480 queue_delayed_work(system_power_efficient_wq, &fw_cache.work,
1481 msecs_to_jiffies(delay));
1482 }
1483
fw_pm_notify(struct notifier_block * notify_block,unsigned long mode,void * unused)1484 static int fw_pm_notify(struct notifier_block *notify_block,
1485 unsigned long mode, void *unused)
1486 {
1487 switch (mode) {
1488 case PM_HIBERNATION_PREPARE:
1489 case PM_SUSPEND_PREPARE:
1490 case PM_RESTORE_PREPARE:
1491 /*
1492 * kill pending fallback requests with a custom fallback
1493 * to avoid stalling suspend.
1494 */
1495 kill_pending_fw_fallback_reqs(true);
1496 device_cache_fw_images();
1497 break;
1498
1499 case PM_POST_SUSPEND:
1500 case PM_POST_HIBERNATION:
1501 case PM_POST_RESTORE:
1502 /*
1503 * In case that system sleep failed and syscore_suspend is
1504 * not called.
1505 */
1506 mutex_lock(&fw_lock);
1507 fw_cache.state = FW_LOADER_NO_CACHE;
1508 mutex_unlock(&fw_lock);
1509
1510 device_uncache_fw_images_delay(10 * MSEC_PER_SEC);
1511 break;
1512 }
1513
1514 return 0;
1515 }
1516
1517 /* stop caching firmware once syscore_suspend is reached */
fw_suspend(void)1518 static int fw_suspend(void)
1519 {
1520 fw_cache.state = FW_LOADER_NO_CACHE;
1521 return 0;
1522 }
1523
1524 static struct syscore_ops fw_syscore_ops = {
1525 .suspend = fw_suspend,
1526 };
1527
register_fw_pm_ops(void)1528 static int __init register_fw_pm_ops(void)
1529 {
1530 int ret;
1531
1532 spin_lock_init(&fw_cache.name_lock);
1533 INIT_LIST_HEAD(&fw_cache.fw_names);
1534
1535 INIT_DELAYED_WORK(&fw_cache.work,
1536 device_uncache_fw_images_work);
1537
1538 fw_cache.pm_notify.notifier_call = fw_pm_notify;
1539 ret = register_pm_notifier(&fw_cache.pm_notify);
1540 if (ret)
1541 return ret;
1542
1543 register_syscore_ops(&fw_syscore_ops);
1544
1545 return ret;
1546 }
1547
unregister_fw_pm_ops(void)1548 static inline void unregister_fw_pm_ops(void)
1549 {
1550 unregister_syscore_ops(&fw_syscore_ops);
1551 unregister_pm_notifier(&fw_cache.pm_notify);
1552 }
1553 #else
fw_cache_piggyback_on_request(struct fw_priv * fw_priv)1554 static void fw_cache_piggyback_on_request(struct fw_priv *fw_priv)
1555 {
1556 }
register_fw_pm_ops(void)1557 static inline int register_fw_pm_ops(void)
1558 {
1559 return 0;
1560 }
unregister_fw_pm_ops(void)1561 static inline void unregister_fw_pm_ops(void)
1562 {
1563 }
1564 #endif
1565
fw_cache_init(void)1566 static void __init fw_cache_init(void)
1567 {
1568 spin_lock_init(&fw_cache.lock);
1569 INIT_LIST_HEAD(&fw_cache.head);
1570 fw_cache.state = FW_LOADER_NO_CACHE;
1571 }
1572
fw_shutdown_notify(struct notifier_block * unused1,unsigned long unused2,void * unused3)1573 static int fw_shutdown_notify(struct notifier_block *unused1,
1574 unsigned long unused2, void *unused3)
1575 {
1576 /*
1577 * Kill all pending fallback requests to avoid both stalling shutdown,
1578 * and avoid a deadlock with the usermode_lock.
1579 */
1580 kill_pending_fw_fallback_reqs(false);
1581
1582 return NOTIFY_DONE;
1583 }
1584
1585 static struct notifier_block fw_shutdown_nb = {
1586 .notifier_call = fw_shutdown_notify,
1587 };
1588
firmware_class_init(void)1589 static int __init firmware_class_init(void)
1590 {
1591 int ret;
1592
1593 /* No need to unfold these on exit */
1594 fw_cache_init();
1595
1596 ret = register_fw_pm_ops();
1597 if (ret)
1598 return ret;
1599
1600 ret = register_reboot_notifier(&fw_shutdown_nb);
1601 if (ret)
1602 goto out;
1603
1604 return register_sysfs_loader();
1605
1606 out:
1607 unregister_fw_pm_ops();
1608 return ret;
1609 }
1610
firmware_class_exit(void)1611 static void __exit firmware_class_exit(void)
1612 {
1613 unregister_fw_pm_ops();
1614 unregister_reboot_notifier(&fw_shutdown_nb);
1615 unregister_sysfs_loader();
1616 }
1617
1618 fs_initcall(firmware_class_init);
1619 module_exit(firmware_class_exit);
1620