1
2
3
4
5
6
7
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/module.h>
16#include <linux/init.h>
17#include <linux/timer.h>
18#include <linux/vmalloc.h>
19#include <linux/interrupt.h>
20#include <linux/bitops.h>
21#include <linux/mutex.h>
22#include <linux/workqueue.h>
23#include <linux/highmem.h>
24#include <linux/firmware.h>
25#include <linux/slab.h>
26#include <linux/sched.h>
27#include <linux/file.h>
28#include <linux/list.h>
29#include <linux/fs.h>
30#include <linux/async.h>
31#include <linux/pm.h>
32#include <linux/suspend.h>
33#include <linux/syscore_ops.h>
34#include <linux/reboot.h>
35#include <linux/security.h>
36#include <linux/xz.h>
37
38#include <generated/utsrelease.h>
39
40#include "../base.h"
41#include "firmware.h"
42#include "fallback.h"
43
44MODULE_AUTHOR("Manuel Estrada Sainz");
45MODULE_DESCRIPTION("Multi purpose firmware loading support");
46MODULE_LICENSE("GPL");
47
48struct firmware_cache {
49
50 spinlock_t lock;
51 struct list_head head;
52 int state;
53
54#ifdef CONFIG_PM_SLEEP
55
56
57
58
59
60
61 spinlock_t name_lock;
62 struct list_head fw_names;
63
64 struct delayed_work work;
65
66 struct notifier_block pm_notify;
67#endif
68};
69
70struct fw_cache_entry {
71 struct list_head list;
72 const char *name;
73};
74
75struct fw_name_devm {
76 unsigned long magic;
77 const char *name;
78};
79
80static inline struct fw_priv *to_fw_priv(struct kref *ref)
81{
82 return container_of(ref, struct fw_priv, ref);
83}
84
85#define FW_LOADER_NO_CACHE 0
86#define FW_LOADER_START_CACHE 1
87
88
89
90DEFINE_MUTEX(fw_lock);
91
92static struct firmware_cache fw_cache;
93
94
95
96#ifdef CONFIG_FW_LOADER
97
98extern struct builtin_fw __start_builtin_fw[];
99extern struct builtin_fw __end_builtin_fw[];
100
101static void fw_copy_to_prealloc_buf(struct firmware *fw,
102 void *buf, size_t size)
103{
104 if (!buf || size < fw->size)
105 return;
106 memcpy(buf, fw->data, fw->size);
107}
108
109static bool fw_get_builtin_firmware(struct firmware *fw, const char *name,
110 void *buf, size_t size)
111{
112 struct builtin_fw *b_fw;
113
114 for (b_fw = __start_builtin_fw; b_fw != __end_builtin_fw; b_fw++) {
115 if (strcmp(name, b_fw->name) == 0) {
116 fw->size = b_fw->size;
117 fw->data = b_fw->data;
118 fw_copy_to_prealloc_buf(fw, buf, size);
119
120 return true;
121 }
122 }
123
124 return false;
125}
126
127static bool fw_is_builtin_firmware(const struct firmware *fw)
128{
129 struct builtin_fw *b_fw;
130
131 for (b_fw = __start_builtin_fw; b_fw != __end_builtin_fw; b_fw++)
132 if (fw->data == b_fw->data)
133 return true;
134
135 return false;
136}
137
138#else
139
140static inline bool fw_get_builtin_firmware(struct firmware *fw,
141 const char *name, void *buf,
142 size_t size)
143{
144 return false;
145}
146
147static inline bool fw_is_builtin_firmware(const struct firmware *fw)
148{
149 return false;
150}
151#endif
152
153static void fw_state_init(struct fw_priv *fw_priv)
154{
155 struct fw_state *fw_st = &fw_priv->fw_st;
156
157 init_completion(&fw_st->completion);
158 fw_st->status = FW_STATUS_UNKNOWN;
159}
160
161static inline int fw_state_wait(struct fw_priv *fw_priv)
162{
163 return __fw_state_wait_common(fw_priv, MAX_SCHEDULE_TIMEOUT);
164}
165
166static int fw_cache_piggyback_on_request(const char *name);
167
168static struct fw_priv *__allocate_fw_priv(const char *fw_name,
169 struct firmware_cache *fwc,
170 void *dbuf, size_t size)
171{
172 struct fw_priv *fw_priv;
173
174 fw_priv = kzalloc(sizeof(*fw_priv), GFP_ATOMIC);
175 if (!fw_priv)
176 return NULL;
177
178 fw_priv->fw_name = kstrdup_const(fw_name, GFP_ATOMIC);
179 if (!fw_priv->fw_name) {
180 kfree(fw_priv);
181 return NULL;
182 }
183
184 kref_init(&fw_priv->ref);
185 fw_priv->fwc = fwc;
186 fw_priv->data = dbuf;
187 fw_priv->allocated_size = size;
188 fw_state_init(fw_priv);
189#ifdef CONFIG_FW_LOADER_USER_HELPER
190 INIT_LIST_HEAD(&fw_priv->pending_list);
191#endif
192
193 pr_debug("%s: fw-%s fw_priv=%p\n", __func__, fw_name, fw_priv);
194
195 return fw_priv;
196}
197
198static struct fw_priv *__lookup_fw_priv(const char *fw_name)
199{
200 struct fw_priv *tmp;
201 struct firmware_cache *fwc = &fw_cache;
202
203 list_for_each_entry(tmp, &fwc->head, list)
204 if (!strcmp(tmp->fw_name, fw_name))
205 return tmp;
206 return NULL;
207}
208
209
210static int alloc_lookup_fw_priv(const char *fw_name,
211 struct firmware_cache *fwc,
212 struct fw_priv **fw_priv, void *dbuf,
213 size_t size, enum fw_opt opt_flags)
214{
215 struct fw_priv *tmp;
216
217 spin_lock(&fwc->lock);
218 if (!(opt_flags & FW_OPT_NOCACHE)) {
219 tmp = __lookup_fw_priv(fw_name);
220 if (tmp) {
221 kref_get(&tmp->ref);
222 spin_unlock(&fwc->lock);
223 *fw_priv = tmp;
224 pr_debug("batched request - sharing the same struct fw_priv and lookup for multiple requests\n");
225 return 1;
226 }
227 }
228
229 tmp = __allocate_fw_priv(fw_name, fwc, dbuf, size);
230 if (tmp) {
231 INIT_LIST_HEAD(&tmp->list);
232 if (!(opt_flags & FW_OPT_NOCACHE))
233 list_add(&tmp->list, &fwc->head);
234 }
235 spin_unlock(&fwc->lock);
236
237 *fw_priv = tmp;
238
239 return tmp ? 0 : -ENOMEM;
240}
241
242static void __free_fw_priv(struct kref *ref)
243 __releases(&fwc->lock)
244{
245 struct fw_priv *fw_priv = to_fw_priv(ref);
246 struct firmware_cache *fwc = fw_priv->fwc;
247
248 pr_debug("%s: fw-%s fw_priv=%p data=%p size=%u\n",
249 __func__, fw_priv->fw_name, fw_priv, fw_priv->data,
250 (unsigned int)fw_priv->size);
251
252 list_del(&fw_priv->list);
253 spin_unlock(&fwc->lock);
254
255 fw_free_paged_buf(fw_priv);
256 if (!fw_priv->allocated_size)
257 vfree(fw_priv->data);
258 kfree_const(fw_priv->fw_name);
259 kfree(fw_priv);
260}
261
262static void free_fw_priv(struct fw_priv *fw_priv)
263{
264 struct firmware_cache *fwc = fw_priv->fwc;
265 spin_lock(&fwc->lock);
266 if (!kref_put(&fw_priv->ref, __free_fw_priv))
267 spin_unlock(&fwc->lock);
268}
269
270#ifdef CONFIG_FW_LOADER_PAGED_BUF
271void fw_free_paged_buf(struct fw_priv *fw_priv)
272{
273 int i;
274
275 if (!fw_priv->pages)
276 return;
277
278 for (i = 0; i < fw_priv->nr_pages; i++)
279 __free_page(fw_priv->pages[i]);
280 kvfree(fw_priv->pages);
281 fw_priv->pages = NULL;
282 fw_priv->page_array_size = 0;
283 fw_priv->nr_pages = 0;
284}
285
286int fw_grow_paged_buf(struct fw_priv *fw_priv, int pages_needed)
287{
288
289 if (fw_priv->page_array_size < pages_needed) {
290 int new_array_size = max(pages_needed,
291 fw_priv->page_array_size * 2);
292 struct page **new_pages;
293
294 new_pages = kvmalloc_array(new_array_size, sizeof(void *),
295 GFP_KERNEL);
296 if (!new_pages)
297 return -ENOMEM;
298 memcpy(new_pages, fw_priv->pages,
299 fw_priv->page_array_size * sizeof(void *));
300 memset(&new_pages[fw_priv->page_array_size], 0, sizeof(void *) *
301 (new_array_size - fw_priv->page_array_size));
302 kvfree(fw_priv->pages);
303 fw_priv->pages = new_pages;
304 fw_priv->page_array_size = new_array_size;
305 }
306
307 while (fw_priv->nr_pages < pages_needed) {
308 fw_priv->pages[fw_priv->nr_pages] =
309 alloc_page(GFP_KERNEL | __GFP_HIGHMEM);
310
311 if (!fw_priv->pages[fw_priv->nr_pages])
312 return -ENOMEM;
313 fw_priv->nr_pages++;
314 }
315
316 return 0;
317}
318
319int fw_map_paged_buf(struct fw_priv *fw_priv)
320{
321
322 if (!fw_priv->pages)
323 return 0;
324
325 vunmap(fw_priv->data);
326 fw_priv->data = vmap(fw_priv->pages, fw_priv->nr_pages, 0,
327 PAGE_KERNEL_RO);
328 if (!fw_priv->data)
329 return -ENOMEM;
330
331
332 kvfree(fw_priv->pages);
333 fw_priv->pages = NULL;
334
335 return 0;
336}
337#endif
338
339
340
341
342#ifdef CONFIG_FW_LOADER_COMPRESS
343
344static int fw_decompress_xz_error(struct device *dev, enum xz_ret xz_ret)
345{
346 if (xz_ret != XZ_STREAM_END) {
347 dev_warn(dev, "xz decompression failed (xz_ret=%d)\n", xz_ret);
348 return xz_ret == XZ_MEM_ERROR ? -ENOMEM : -EINVAL;
349 }
350 return 0;
351}
352
353
354static int fw_decompress_xz_single(struct device *dev, struct fw_priv *fw_priv,
355 size_t in_size, const void *in_buffer)
356{
357 struct xz_dec *xz_dec;
358 struct xz_buf xz_buf;
359 enum xz_ret xz_ret;
360
361 xz_dec = xz_dec_init(XZ_SINGLE, (u32)-1);
362 if (!xz_dec)
363 return -ENOMEM;
364
365 xz_buf.in_size = in_size;
366 xz_buf.in = in_buffer;
367 xz_buf.in_pos = 0;
368 xz_buf.out_size = fw_priv->allocated_size;
369 xz_buf.out = fw_priv->data;
370 xz_buf.out_pos = 0;
371
372 xz_ret = xz_dec_run(xz_dec, &xz_buf);
373 xz_dec_end(xz_dec);
374
375 fw_priv->size = xz_buf.out_pos;
376 return fw_decompress_xz_error(dev, xz_ret);
377}
378
379
380static int fw_decompress_xz_pages(struct device *dev, struct fw_priv *fw_priv,
381 size_t in_size, const void *in_buffer)
382{
383 struct xz_dec *xz_dec;
384 struct xz_buf xz_buf;
385 enum xz_ret xz_ret;
386 struct page *page;
387 int err = 0;
388
389 xz_dec = xz_dec_init(XZ_DYNALLOC, (u32)-1);
390 if (!xz_dec)
391 return -ENOMEM;
392
393 xz_buf.in_size = in_size;
394 xz_buf.in = in_buffer;
395 xz_buf.in_pos = 0;
396
397 fw_priv->is_paged_buf = true;
398 fw_priv->size = 0;
399 do {
400 if (fw_grow_paged_buf(fw_priv, fw_priv->nr_pages + 1)) {
401 err = -ENOMEM;
402 goto out;
403 }
404
405
406 page = fw_priv->pages[fw_priv->nr_pages - 1];
407 xz_buf.out = kmap(page);
408 xz_buf.out_pos = 0;
409 xz_buf.out_size = PAGE_SIZE;
410 xz_ret = xz_dec_run(xz_dec, &xz_buf);
411 kunmap(page);
412 fw_priv->size += xz_buf.out_pos;
413
414 if (xz_buf.out_pos != PAGE_SIZE)
415 break;
416 } while (xz_ret == XZ_OK);
417
418 err = fw_decompress_xz_error(dev, xz_ret);
419 if (!err)
420 err = fw_map_paged_buf(fw_priv);
421
422 out:
423 xz_dec_end(xz_dec);
424 return err;
425}
426
427static int fw_decompress_xz(struct device *dev, struct fw_priv *fw_priv,
428 size_t in_size, const void *in_buffer)
429{
430
431 if (fw_priv->data)
432 return fw_decompress_xz_single(dev, fw_priv, in_size, in_buffer);
433 else
434 return fw_decompress_xz_pages(dev, fw_priv, in_size, in_buffer);
435}
436#endif
437
438
439static char fw_path_para[256];
440static const char * const fw_path[] = {
441 fw_path_para,
442 "/lib/firmware/updates/" UTS_RELEASE,
443 "/lib/firmware/updates",
444 "/lib/firmware/" UTS_RELEASE,
445 "/lib/firmware"
446};
447
448
449
450
451
452
453module_param_string(path, fw_path_para, sizeof(fw_path_para), 0644);
454MODULE_PARM_DESC(path, "customized firmware image search path with a higher priority than default path");
455
456static int
457fw_get_filesystem_firmware(struct device *device, struct fw_priv *fw_priv,
458 const char *suffix,
459 int (*decompress)(struct device *dev,
460 struct fw_priv *fw_priv,
461 size_t in_size,
462 const void *in_buffer))
463{
464 loff_t size;
465 int i, len;
466 int rc = -ENOENT;
467 char *path;
468 enum kernel_read_file_id id = READING_FIRMWARE;
469 size_t msize = INT_MAX;
470 void *buffer = NULL;
471
472
473 if (!decompress && fw_priv->data) {
474 buffer = fw_priv->data;
475 id = READING_FIRMWARE_PREALLOC_BUFFER;
476 msize = fw_priv->allocated_size;
477 }
478
479 path = __getname();
480 if (!path)
481 return -ENOMEM;
482
483 for (i = 0; i < ARRAY_SIZE(fw_path); i++) {
484
485 if (!fw_path[i][0])
486 continue;
487
488 len = snprintf(path, PATH_MAX, "%s/%s%s",
489 fw_path[i], fw_priv->fw_name, suffix);
490 if (len >= PATH_MAX) {
491 rc = -ENAMETOOLONG;
492 break;
493 }
494
495 fw_priv->size = 0;
496 rc = kernel_read_file_from_path(path, &buffer, &size,
497 msize, id);
498 if (rc) {
499 if (rc != -ENOENT)
500 dev_warn(device, "loading %s failed with error %d\n",
501 path, rc);
502 else
503 dev_dbg(device, "loading %s failed for no such file or directory.\n",
504 path);
505 continue;
506 }
507 if (decompress) {
508 dev_dbg(device, "f/w decompressing %s\n",
509 fw_priv->fw_name);
510 rc = decompress(device, fw_priv, size, buffer);
511
512 vfree(buffer);
513 buffer = NULL;
514 if (rc) {
515 fw_free_paged_buf(fw_priv);
516 continue;
517 }
518 } else {
519 dev_dbg(device, "direct-loading %s\n",
520 fw_priv->fw_name);
521 if (!fw_priv->data)
522 fw_priv->data = buffer;
523 fw_priv->size = size;
524 }
525 fw_state_done(fw_priv);
526 break;
527 }
528 __putname(path);
529
530 return rc;
531}
532
533
534static void firmware_free_data(const struct firmware *fw)
535{
536
537 if (!fw->priv) {
538 vfree(fw->data);
539 return;
540 }
541 free_fw_priv(fw->priv);
542}
543
544
545static void fw_set_page_data(struct fw_priv *fw_priv, struct firmware *fw)
546{
547 fw->priv = fw_priv;
548#ifdef CONFIG_FW_LOADER_USER_HELPER
549 fw->pages = fw_priv->pages;
550#endif
551 fw->size = fw_priv->size;
552 fw->data = fw_priv->data;
553
554 pr_debug("%s: fw-%s fw_priv=%p data=%p size=%u\n",
555 __func__, fw_priv->fw_name, fw_priv, fw_priv->data,
556 (unsigned int)fw_priv->size);
557}
558
559#ifdef CONFIG_PM_SLEEP
560static void fw_name_devm_release(struct device *dev, void *res)
561{
562 struct fw_name_devm *fwn = res;
563
564 if (fwn->magic == (unsigned long)&fw_cache)
565 pr_debug("%s: fw_name-%s devm-%p released\n",
566 __func__, fwn->name, res);
567 kfree_const(fwn->name);
568}
569
570static int fw_devm_match(struct device *dev, void *res,
571 void *match_data)
572{
573 struct fw_name_devm *fwn = res;
574
575 return (fwn->magic == (unsigned long)&fw_cache) &&
576 !strcmp(fwn->name, match_data);
577}
578
579static struct fw_name_devm *fw_find_devm_name(struct device *dev,
580 const char *name)
581{
582 struct fw_name_devm *fwn;
583
584 fwn = devres_find(dev, fw_name_devm_release,
585 fw_devm_match, (void *)name);
586 return fwn;
587}
588
589static bool fw_cache_is_setup(struct device *dev, const char *name)
590{
591 struct fw_name_devm *fwn;
592
593 fwn = fw_find_devm_name(dev, name);
594 if (fwn)
595 return true;
596
597 return false;
598}
599
600
601static int fw_add_devm_name(struct device *dev, const char *name)
602{
603 struct fw_name_devm *fwn;
604
605 if (fw_cache_is_setup(dev, name))
606 return 0;
607
608 fwn = devres_alloc(fw_name_devm_release, sizeof(struct fw_name_devm),
609 GFP_KERNEL);
610 if (!fwn)
611 return -ENOMEM;
612 fwn->name = kstrdup_const(name, GFP_KERNEL);
613 if (!fwn->name) {
614 devres_free(fwn);
615 return -ENOMEM;
616 }
617
618 fwn->magic = (unsigned long)&fw_cache;
619 devres_add(dev, fwn);
620
621 return 0;
622}
623#else
624static bool fw_cache_is_setup(struct device *dev, const char *name)
625{
626 return false;
627}
628
629static int fw_add_devm_name(struct device *dev, const char *name)
630{
631 return 0;
632}
633#endif
634
635int assign_fw(struct firmware *fw, struct device *device,
636 enum fw_opt opt_flags)
637{
638 struct fw_priv *fw_priv = fw->priv;
639 int ret;
640
641 mutex_lock(&fw_lock);
642 if (!fw_priv->size || fw_state_is_aborted(fw_priv)) {
643 mutex_unlock(&fw_lock);
644 return -ENOENT;
645 }
646
647
648
649
650
651
652
653
654
655 if (device && (opt_flags & FW_OPT_UEVENT) &&
656 !(opt_flags & FW_OPT_NOCACHE)) {
657 ret = fw_add_devm_name(device, fw_priv->fw_name);
658 if (ret) {
659 mutex_unlock(&fw_lock);
660 return ret;
661 }
662 }
663
664
665
666
667
668 if (!(opt_flags & FW_OPT_NOCACHE) &&
669 fw_priv->fwc->state == FW_LOADER_START_CACHE) {
670 if (fw_cache_piggyback_on_request(fw_priv->fw_name))
671 kref_get(&fw_priv->ref);
672 }
673
674
675 fw_set_page_data(fw_priv, fw);
676 mutex_unlock(&fw_lock);
677 return 0;
678}
679
680
681
682
683
684static int
685_request_firmware_prepare(struct firmware **firmware_p, const char *name,
686 struct device *device, void *dbuf, size_t size,
687 enum fw_opt opt_flags)
688{
689 struct firmware *firmware;
690 struct fw_priv *fw_priv;
691 int ret;
692
693 *firmware_p = firmware = kzalloc(sizeof(*firmware), GFP_KERNEL);
694 if (!firmware) {
695 dev_err(device, "%s: kmalloc(struct firmware) failed\n",
696 __func__);
697 return -ENOMEM;
698 }
699
700 if (fw_get_builtin_firmware(firmware, name, dbuf, size)) {
701 dev_dbg(device, "using built-in %s\n", name);
702 return 0;
703 }
704
705 ret = alloc_lookup_fw_priv(name, &fw_cache, &fw_priv, dbuf, size,
706 opt_flags);
707
708
709
710
711
712 firmware->priv = fw_priv;
713
714 if (ret > 0) {
715 ret = fw_state_wait(fw_priv);
716 if (!ret) {
717 fw_set_page_data(fw_priv, firmware);
718 return 0;
719 }
720 }
721
722 if (ret < 0)
723 return ret;
724 return 1;
725}
726
727
728
729
730
731
732
733
734
735
736static void fw_abort_batch_reqs(struct firmware *fw)
737{
738 struct fw_priv *fw_priv;
739
740
741 if (!fw || !fw->priv)
742 return;
743
744 fw_priv = fw->priv;
745 if (!fw_state_is_aborted(fw_priv))
746 fw_state_aborted(fw_priv);
747}
748
749
750static int
751_request_firmware(const struct firmware **firmware_p, const char *name,
752 struct device *device, void *buf, size_t size,
753 enum fw_opt opt_flags)
754{
755 struct firmware *fw = NULL;
756 int ret;
757
758 if (!firmware_p)
759 return -EINVAL;
760
761 if (!name || name[0] == '\0') {
762 ret = -EINVAL;
763 goto out;
764 }
765
766 ret = _request_firmware_prepare(&fw, name, device, buf, size,
767 opt_flags);
768 if (ret <= 0)
769 goto out;
770
771 ret = fw_get_filesystem_firmware(device, fw->priv, "", NULL);
772#ifdef CONFIG_FW_LOADER_COMPRESS
773 if (ret == -ENOENT)
774 ret = fw_get_filesystem_firmware(device, fw->priv, ".xz",
775 fw_decompress_xz);
776#endif
777
778 if (ret) {
779 if (!(opt_flags & FW_OPT_NO_WARN))
780 dev_warn(device,
781 "Direct firmware load for %s failed with error %d\n",
782 name, ret);
783 ret = firmware_fallback_sysfs(fw, name, device, opt_flags, ret);
784 } else
785 ret = assign_fw(fw, device, opt_flags);
786
787 out:
788 if (ret < 0) {
789 fw_abort_batch_reqs(fw);
790 release_firmware(fw);
791 fw = NULL;
792 }
793
794 *firmware_p = fw;
795 return ret;
796}
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818int
819request_firmware(const struct firmware **firmware_p, const char *name,
820 struct device *device)
821{
822 int ret;
823
824
825 __module_get(THIS_MODULE);
826 ret = _request_firmware(firmware_p, name, device, NULL, 0,
827 FW_OPT_UEVENT);
828 module_put(THIS_MODULE);
829 return ret;
830}
831EXPORT_SYMBOL(request_firmware);
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846int firmware_request_nowarn(const struct firmware **firmware, const char *name,
847 struct device *device)
848{
849 int ret;
850
851
852 __module_get(THIS_MODULE);
853 ret = _request_firmware(firmware, name, device, NULL, 0,
854 FW_OPT_UEVENT | FW_OPT_NO_WARN);
855 module_put(THIS_MODULE);
856 return ret;
857}
858EXPORT_SYMBOL_GPL(firmware_request_nowarn);
859
860
861
862
863
864
865
866
867
868
869
870
871int request_firmware_direct(const struct firmware **firmware_p,
872 const char *name, struct device *device)
873{
874 int ret;
875
876 __module_get(THIS_MODULE);
877 ret = _request_firmware(firmware_p, name, device, NULL, 0,
878 FW_OPT_UEVENT | FW_OPT_NO_WARN |
879 FW_OPT_NOFALLBACK);
880 module_put(THIS_MODULE);
881 return ret;
882}
883EXPORT_SYMBOL_GPL(request_firmware_direct);
884
885
886
887
888
889
890
891
892
893
894
895
896
897int firmware_request_cache(struct device *device, const char *name)
898{
899 int ret;
900
901 mutex_lock(&fw_lock);
902 ret = fw_add_devm_name(device, name);
903 mutex_unlock(&fw_lock);
904
905 return ret;
906}
907EXPORT_SYMBOL_GPL(firmware_request_cache);
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924int
925request_firmware_into_buf(const struct firmware **firmware_p, const char *name,
926 struct device *device, void *buf, size_t size)
927{
928 int ret;
929
930 if (fw_cache_is_setup(device, name))
931 return -EOPNOTSUPP;
932
933 __module_get(THIS_MODULE);
934 ret = _request_firmware(firmware_p, name, device, buf, size,
935 FW_OPT_UEVENT | FW_OPT_NOCACHE);
936 module_put(THIS_MODULE);
937 return ret;
938}
939EXPORT_SYMBOL(request_firmware_into_buf);
940
941
942
943
944
945void release_firmware(const struct firmware *fw)
946{
947 if (fw) {
948 if (!fw_is_builtin_firmware(fw))
949 firmware_free_data(fw);
950 kfree(fw);
951 }
952}
953EXPORT_SYMBOL(release_firmware);
954
955
956struct firmware_work {
957 struct work_struct work;
958 struct module *module;
959 const char *name;
960 struct device *device;
961 void *context;
962 void (*cont)(const struct firmware *fw, void *context);
963 enum fw_opt opt_flags;
964};
965
966static void request_firmware_work_func(struct work_struct *work)
967{
968 struct firmware_work *fw_work;
969 const struct firmware *fw;
970
971 fw_work = container_of(work, struct firmware_work, work);
972
973 _request_firmware(&fw, fw_work->name, fw_work->device, NULL, 0,
974 fw_work->opt_flags);
975 fw_work->cont(fw, fw_work->context);
976 put_device(fw_work->device);
977
978 module_put(fw_work->module);
979 kfree_const(fw_work->name);
980 kfree(fw_work);
981}
982
983
984
985
986
987
988
989
990
991
992
993
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006int
1007request_firmware_nowait(
1008 struct module *module, bool uevent,
1009 const char *name, struct device *device, gfp_t gfp, void *context,
1010 void (*cont)(const struct firmware *fw, void *context))
1011{
1012 struct firmware_work *fw_work;
1013
1014 fw_work = kzalloc(sizeof(struct firmware_work), gfp);
1015 if (!fw_work)
1016 return -ENOMEM;
1017
1018 fw_work->module = module;
1019 fw_work->name = kstrdup_const(name, gfp);
1020 if (!fw_work->name) {
1021 kfree(fw_work);
1022 return -ENOMEM;
1023 }
1024 fw_work->device = device;
1025 fw_work->context = context;
1026 fw_work->cont = cont;
1027 fw_work->opt_flags = FW_OPT_NOWAIT |
1028 (uevent ? FW_OPT_UEVENT : FW_OPT_USERHELPER);
1029
1030 if (!uevent && fw_cache_is_setup(device, name)) {
1031 kfree_const(fw_work->name);
1032 kfree(fw_work);
1033 return -EOPNOTSUPP;
1034 }
1035
1036 if (!try_module_get(module)) {
1037 kfree_const(fw_work->name);
1038 kfree(fw_work);
1039 return -EFAULT;
1040 }
1041
1042 get_device(fw_work->device);
1043 INIT_WORK(&fw_work->work, request_firmware_work_func);
1044 schedule_work(&fw_work->work);
1045 return 0;
1046}
1047EXPORT_SYMBOL(request_firmware_nowait);
1048
1049#ifdef CONFIG_PM_SLEEP
1050static ASYNC_DOMAIN_EXCLUSIVE(fw_cache_domain);
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066static int cache_firmware(const char *fw_name)
1067{
1068 int ret;
1069 const struct firmware *fw;
1070
1071 pr_debug("%s: %s\n", __func__, fw_name);
1072
1073 ret = request_firmware(&fw, fw_name, NULL);
1074 if (!ret)
1075 kfree(fw);
1076
1077 pr_debug("%s: %s ret=%d\n", __func__, fw_name, ret);
1078
1079 return ret;
1080}
1081
1082static struct fw_priv *lookup_fw_priv(const char *fw_name)
1083{
1084 struct fw_priv *tmp;
1085 struct firmware_cache *fwc = &fw_cache;
1086
1087 spin_lock(&fwc->lock);
1088 tmp = __lookup_fw_priv(fw_name);
1089 spin_unlock(&fwc->lock);
1090
1091 return tmp;
1092}
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105static int uncache_firmware(const char *fw_name)
1106{
1107 struct fw_priv *fw_priv;
1108 struct firmware fw;
1109
1110 pr_debug("%s: %s\n", __func__, fw_name);
1111
1112 if (fw_get_builtin_firmware(&fw, fw_name, NULL, 0))
1113 return 0;
1114
1115 fw_priv = lookup_fw_priv(fw_name);
1116 if (fw_priv) {
1117 free_fw_priv(fw_priv);
1118 return 0;
1119 }
1120
1121 return -EINVAL;
1122}
1123
1124static struct fw_cache_entry *alloc_fw_cache_entry(const char *name)
1125{
1126 struct fw_cache_entry *fce;
1127
1128 fce = kzalloc(sizeof(*fce), GFP_ATOMIC);
1129 if (!fce)
1130 goto exit;
1131
1132 fce->name = kstrdup_const(name, GFP_ATOMIC);
1133 if (!fce->name) {
1134 kfree(fce);
1135 fce = NULL;
1136 goto exit;
1137 }
1138exit:
1139 return fce;
1140}
1141
1142static int __fw_entry_found(const char *name)
1143{
1144 struct firmware_cache *fwc = &fw_cache;
1145 struct fw_cache_entry *fce;
1146
1147 list_for_each_entry(fce, &fwc->fw_names, list) {
1148 if (!strcmp(fce->name, name))
1149 return 1;
1150 }
1151 return 0;
1152}
1153
1154static int fw_cache_piggyback_on_request(const char *name)
1155{
1156 struct firmware_cache *fwc = &fw_cache;
1157 struct fw_cache_entry *fce;
1158 int ret = 0;
1159
1160 spin_lock(&fwc->name_lock);
1161 if (__fw_entry_found(name))
1162 goto found;
1163
1164 fce = alloc_fw_cache_entry(name);
1165 if (fce) {
1166 ret = 1;
1167 list_add(&fce->list, &fwc->fw_names);
1168 pr_debug("%s: fw: %s\n", __func__, name);
1169 }
1170found:
1171 spin_unlock(&fwc->name_lock);
1172 return ret;
1173}
1174
1175static void free_fw_cache_entry(struct fw_cache_entry *fce)
1176{
1177 kfree_const(fce->name);
1178 kfree(fce);
1179}
1180
1181static void __async_dev_cache_fw_image(void *fw_entry,
1182 async_cookie_t cookie)
1183{
1184 struct fw_cache_entry *fce = fw_entry;
1185 struct firmware_cache *fwc = &fw_cache;
1186 int ret;
1187
1188 ret = cache_firmware(fce->name);
1189 if (ret) {
1190 spin_lock(&fwc->name_lock);
1191 list_del(&fce->list);
1192 spin_unlock(&fwc->name_lock);
1193
1194 free_fw_cache_entry(fce);
1195 }
1196}
1197
1198
1199static void dev_create_fw_entry(struct device *dev, void *res,
1200 void *data)
1201{
1202 struct fw_name_devm *fwn = res;
1203 const char *fw_name = fwn->name;
1204 struct list_head *head = data;
1205 struct fw_cache_entry *fce;
1206
1207 fce = alloc_fw_cache_entry(fw_name);
1208 if (fce)
1209 list_add(&fce->list, head);
1210}
1211
1212static int devm_name_match(struct device *dev, void *res,
1213 void *match_data)
1214{
1215 struct fw_name_devm *fwn = res;
1216 return (fwn->magic == (unsigned long)match_data);
1217}
1218
1219static void dev_cache_fw_image(struct device *dev, void *data)
1220{
1221 LIST_HEAD(todo);
1222 struct fw_cache_entry *fce;
1223 struct fw_cache_entry *fce_next;
1224 struct firmware_cache *fwc = &fw_cache;
1225
1226 devres_for_each_res(dev, fw_name_devm_release,
1227 devm_name_match, &fw_cache,
1228 dev_create_fw_entry, &todo);
1229
1230 list_for_each_entry_safe(fce, fce_next, &todo, list) {
1231 list_del(&fce->list);
1232
1233 spin_lock(&fwc->name_lock);
1234
1235 if (!__fw_entry_found(fce->name)) {
1236 list_add(&fce->list, &fwc->fw_names);
1237 } else {
1238 free_fw_cache_entry(fce);
1239 fce = NULL;
1240 }
1241 spin_unlock(&fwc->name_lock);
1242
1243 if (fce)
1244 async_schedule_domain(__async_dev_cache_fw_image,
1245 (void *)fce,
1246 &fw_cache_domain);
1247 }
1248}
1249
1250static void __device_uncache_fw_images(void)
1251{
1252 struct firmware_cache *fwc = &fw_cache;
1253 struct fw_cache_entry *fce;
1254
1255 spin_lock(&fwc->name_lock);
1256 while (!list_empty(&fwc->fw_names)) {
1257 fce = list_entry(fwc->fw_names.next,
1258 struct fw_cache_entry, list);
1259 list_del(&fce->list);
1260 spin_unlock(&fwc->name_lock);
1261
1262 uncache_firmware(fce->name);
1263 free_fw_cache_entry(fce);
1264
1265 spin_lock(&fwc->name_lock);
1266 }
1267 spin_unlock(&fwc->name_lock);
1268}
1269
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279
1280static void device_cache_fw_images(void)
1281{
1282 struct firmware_cache *fwc = &fw_cache;
1283 DEFINE_WAIT(wait);
1284
1285 pr_debug("%s\n", __func__);
1286
1287
1288 cancel_delayed_work_sync(&fwc->work);
1289
1290 fw_fallback_set_cache_timeout();
1291
1292 mutex_lock(&fw_lock);
1293 fwc->state = FW_LOADER_START_CACHE;
1294 dpm_for_each_dev(NULL, dev_cache_fw_image);
1295 mutex_unlock(&fw_lock);
1296
1297
1298 async_synchronize_full_domain(&fw_cache_domain);
1299
1300 fw_fallback_set_default_timeout();
1301}
1302
1303
1304
1305
1306
1307
1308
1309static void device_uncache_fw_images(void)
1310{
1311 pr_debug("%s\n", __func__);
1312 __device_uncache_fw_images();
1313}
1314
1315static void device_uncache_fw_images_work(struct work_struct *work)
1316{
1317 device_uncache_fw_images();
1318}
1319
1320
1321
1322
1323
1324
1325
1326
1327static void device_uncache_fw_images_delay(unsigned long delay)
1328{
1329 queue_delayed_work(system_power_efficient_wq, &fw_cache.work,
1330 msecs_to_jiffies(delay));
1331}
1332
1333static int fw_pm_notify(struct notifier_block *notify_block,
1334 unsigned long mode, void *unused)
1335{
1336 switch (mode) {
1337 case PM_HIBERNATION_PREPARE:
1338 case PM_SUSPEND_PREPARE:
1339 case PM_RESTORE_PREPARE:
1340
1341
1342
1343
1344 kill_pending_fw_fallback_reqs(true);
1345 device_cache_fw_images();
1346 break;
1347
1348 case PM_POST_SUSPEND:
1349 case PM_POST_HIBERNATION:
1350 case PM_POST_RESTORE:
1351
1352
1353
1354
1355 mutex_lock(&fw_lock);
1356 fw_cache.state = FW_LOADER_NO_CACHE;
1357 mutex_unlock(&fw_lock);
1358
1359 device_uncache_fw_images_delay(10 * MSEC_PER_SEC);
1360 break;
1361 }
1362
1363 return 0;
1364}
1365
1366
1367static int fw_suspend(void)
1368{
1369 fw_cache.state = FW_LOADER_NO_CACHE;
1370 return 0;
1371}
1372
1373static struct syscore_ops fw_syscore_ops = {
1374 .suspend = fw_suspend,
1375};
1376
1377static int __init register_fw_pm_ops(void)
1378{
1379 int ret;
1380
1381 spin_lock_init(&fw_cache.name_lock);
1382 INIT_LIST_HEAD(&fw_cache.fw_names);
1383
1384 INIT_DELAYED_WORK(&fw_cache.work,
1385 device_uncache_fw_images_work);
1386
1387 fw_cache.pm_notify.notifier_call = fw_pm_notify;
1388 ret = register_pm_notifier(&fw_cache.pm_notify);
1389 if (ret)
1390 return ret;
1391
1392 register_syscore_ops(&fw_syscore_ops);
1393
1394 return ret;
1395}
1396
1397static inline void unregister_fw_pm_ops(void)
1398{
1399 unregister_syscore_ops(&fw_syscore_ops);
1400 unregister_pm_notifier(&fw_cache.pm_notify);
1401}
1402#else
1403static int fw_cache_piggyback_on_request(const char *name)
1404{
1405 return 0;
1406}
1407static inline int register_fw_pm_ops(void)
1408{
1409 return 0;
1410}
1411static inline void unregister_fw_pm_ops(void)
1412{
1413}
1414#endif
1415
1416static void __init fw_cache_init(void)
1417{
1418 spin_lock_init(&fw_cache.lock);
1419 INIT_LIST_HEAD(&fw_cache.head);
1420 fw_cache.state = FW_LOADER_NO_CACHE;
1421}
1422
1423static int fw_shutdown_notify(struct notifier_block *unused1,
1424 unsigned long unused2, void *unused3)
1425{
1426
1427
1428
1429
1430 kill_pending_fw_fallback_reqs(false);
1431
1432 return NOTIFY_DONE;
1433}
1434
1435static struct notifier_block fw_shutdown_nb = {
1436 .notifier_call = fw_shutdown_notify,
1437};
1438
1439static int __init firmware_class_init(void)
1440{
1441 int ret;
1442
1443
1444 fw_cache_init();
1445
1446 ret = register_fw_pm_ops();
1447 if (ret)
1448 return ret;
1449
1450 ret = register_reboot_notifier(&fw_shutdown_nb);
1451 if (ret)
1452 goto out;
1453
1454 return register_sysfs_loader();
1455
1456out:
1457 unregister_fw_pm_ops();
1458 return ret;
1459}
1460
1461static void __exit firmware_class_exit(void)
1462{
1463 unregister_fw_pm_ops();
1464 unregister_reboot_notifier(&fw_shutdown_nb);
1465 unregister_sysfs_loader();
1466}
1467
1468fs_initcall(firmware_class_init);
1469module_exit(firmware_class_exit);
1470