firmware_class.c 42.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 * firmware_class.c - Multi purpose firmware loading support
 *
4
 * Copyright (c) 2003 Manuel Estrada Sainz
L
Linus Torvalds 已提交
5 6 7 8 9
 *
 * Please see Documentation/firmware_class/ for more information.
 *
 */

10
#include <linux/capability.h>
L
Linus Torvalds 已提交
11 12 13 14 15 16 17
#include <linux/device.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/timer.h>
#include <linux/vmalloc.h>
#include <linux/interrupt.h>
#include <linux/bitops.h>
18
#include <linux/mutex.h>
19
#include <linux/workqueue.h>
20
#include <linux/highmem.h>
L
Linus Torvalds 已提交
21
#include <linux/firmware.h>
22
#include <linux/slab.h>
23
#include <linux/sched.h>
24
#include <linux/file.h>
25
#include <linux/list.h>
26
#include <linux/fs.h>
27 28
#include <linux/async.h>
#include <linux/pm.h>
29
#include <linux/suspend.h>
30
#include <linux/syscore_ops.h>
31
#include <linux/reboot.h>
32
#include <linux/security.h>
33
#include <linux/swait.h>
34

35 36
#include <generated/utsrelease.h>

37
#include "base.h"
L
Linus Torvalds 已提交
38

39
MODULE_AUTHOR("Manuel Estrada Sainz");
L
Linus Torvalds 已提交
40 41 42
MODULE_DESCRIPTION("Multi purpose firmware loading support");
MODULE_LICENSE("GPL");

43 44 45 46 47 48 49
/* Builtin firmware support */

#ifdef CONFIG_FW_LOADER

extern struct builtin_fw __start_builtin_fw[];
extern struct builtin_fw __end_builtin_fw[];

50 51
static bool fw_get_builtin_firmware(struct firmware *fw, const char *name,
				    void *buf, size_t size)
52 53 54 55 56 57 58
{
	struct builtin_fw *b_fw;

	for (b_fw = __start_builtin_fw; b_fw != __end_builtin_fw; b_fw++) {
		if (strcmp(name, b_fw->name) == 0) {
			fw->size = b_fw->size;
			fw->data = b_fw->data;
59 60 61

			if (buf && fw->size <= size)
				memcpy(buf, fw->data, fw->size);
62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81
			return true;
		}
	}

	return false;
}

static bool fw_is_builtin_firmware(const struct firmware *fw)
{
	struct builtin_fw *b_fw;

	for (b_fw = __start_builtin_fw; b_fw != __end_builtin_fw; b_fw++)
		if (fw->data == b_fw->data)
			return true;

	return false;
}

#else /* Module case - no builtin firmware support */

82 83 84
static inline bool fw_get_builtin_firmware(struct firmware *fw,
					   const char *name, void *buf,
					   size_t size)
85 86 87 88 89 90 91 92 93 94
{
	return false;
}

static inline bool fw_is_builtin_firmware(const struct firmware *fw)
{
	return false;
}
#endif

D
Daniel Wagner 已提交
95 96
enum fw_status {
	FW_STATUS_UNKNOWN,
L
Linus Torvalds 已提交
97 98
	FW_STATUS_LOADING,
	FW_STATUS_DONE,
D
Daniel Wagner 已提交
99
	FW_STATUS_ABORTED,
L
Linus Torvalds 已提交
100 101
};

102
static int loading_timeout = 60;	/* In seconds */
L
Linus Torvalds 已提交
103

104 105
static inline long firmware_loading_timeout(void)
{
106
	return loading_timeout > 0 ? loading_timeout * HZ : MAX_JIFFY_OFFSET;
107 108
}

D
Daniel Wagner 已提交
109 110 111 112 113 114
/*
 * Concurrent request_firmware() for the same firmware need to be
 * serialized.  struct fw_state is simple state machine which hold the
 * state of the firmware loading.
 */
struct fw_state {
115
	struct swait_queue_head wq;
116
	enum fw_status status;
D
Daniel Wagner 已提交
117 118 119 120
};

static void fw_state_init(struct fw_state *fw_st)
{
121
	init_swait_queue_head(&fw_st->wq);
D
Daniel Wagner 已提交
122 123 124
	fw_st->status = FW_STATUS_UNKNOWN;
}

125 126 127 128 129
static inline bool __fw_state_is_done(enum fw_status status)
{
	return status == FW_STATUS_DONE || status == FW_STATUS_ABORTED;
}

D
Daniel Wagner 已提交
130 131 132 133
static long __fw_state_wait_common(struct fw_state *fw_st, long timeout)
{
	long ret;

134 135 136 137
	ret = swait_event_interruptible_timeout(fw_st->wq,
				__fw_state_is_done(READ_ONCE(fw_st->status)),
				timeout);
	if (ret != 0 && fw_st->status == FW_STATUS_ABORTED)
D
Daniel Wagner 已提交
138 139 140 141 142 143 144 145
		return -ENOENT;

	return ret;
}

static void __fw_state_set(struct fw_state *fw_st,
			   enum fw_status status)
{
146
	WRITE_ONCE(fw_st->status, status);
D
Daniel Wagner 已提交
147

148
	if (status == FW_STATUS_DONE || status == FW_STATUS_ABORTED)
149
		swake_up(&fw_st->wq);
D
Daniel Wagner 已提交
150 151 152 153 154 155 156 157 158 159 160 161 162 163 164
}

#define fw_state_start(fw_st)					\
	__fw_state_set(fw_st, FW_STATUS_LOADING)
#define fw_state_done(fw_st)					\
	__fw_state_set(fw_st, FW_STATUS_DONE)
#define fw_state_wait(fw_st)					\
	__fw_state_wait_common(fw_st, MAX_SCHEDULE_TIMEOUT)

#ifndef CONFIG_FW_LOADER_USER_HELPER

#define fw_state_is_aborted(fw_st)	false

#else /* CONFIG_FW_LOADER_USER_HELPER */

165 166 167 168 169
static int __fw_state_check(struct fw_state *fw_st, enum fw_status status)
{
	return fw_st->status == status;
}

D
Daniel Wagner 已提交
170 171
#define fw_state_aborted(fw_st)					\
	__fw_state_set(fw_st, FW_STATUS_ABORTED)
172 173
#define fw_state_is_done(fw_st)					\
	__fw_state_check(fw_st, FW_STATUS_DONE)
D
Daniel Wagner 已提交
174 175 176 177 178 179 180 181 182
#define fw_state_is_loading(fw_st)				\
	__fw_state_check(fw_st, FW_STATUS_LOADING)
#define fw_state_is_aborted(fw_st)				\
	__fw_state_check(fw_st, FW_STATUS_ABORTED)
#define fw_state_wait_timeout(fw_st, timeout)			\
	__fw_state_wait_common(fw_st, timeout)

#endif /* CONFIG_FW_LOADER_USER_HELPER */

183 184 185
/* firmware behavior options */
#define FW_OPT_UEVENT	(1U << 0)
#define FW_OPT_NOWAIT	(1U << 1)
186
#ifdef CONFIG_FW_LOADER_USER_HELPER
187
#define FW_OPT_USERHELPER	(1U << 2)
188
#else
189 190 191 192 193 194
#define FW_OPT_USERHELPER	0
#endif
#ifdef CONFIG_FW_LOADER_USER_HELPER_FALLBACK
#define FW_OPT_FALLBACK		FW_OPT_USERHELPER
#else
#define FW_OPT_FALLBACK		0
195
#endif
196
#define FW_OPT_NO_WARN	(1U << 3)
197
#define FW_OPT_NOCACHE	(1U << 4)
198

199 200 201 202
struct firmware_cache {
	/* firmware_buf instance will be added into the below list */
	spinlock_t lock;
	struct list_head head;
203
	int state;
204

205
#ifdef CONFIG_PM_SLEEP
206 207 208 209 210 211 212 213 214 215
	/*
	 * Names of firmware images which have been cached successfully
	 * will be added into the below list so that device uncache
	 * helper can trace which firmware images have been cached
	 * before.
	 */
	spinlock_t name_lock;
	struct list_head fw_names;

	struct delayed_work work;
216 217

	struct notifier_block   pm_notify;
218
#endif
219
};
L
Linus Torvalds 已提交
220

221
struct firmware_buf {
222 223 224
	struct kref ref;
	struct list_head list;
	struct firmware_cache *fwc;
D
Daniel Wagner 已提交
225
	struct fw_state fw_st;
226 227
	void *data;
	size_t size;
228
	size_t allocated_size;
229
#ifdef CONFIG_FW_LOADER_USER_HELPER
230
	bool is_paged_buf;
231
	bool need_uevent;
232 233 234
	struct page **pages;
	int nr_pages;
	int page_array_size;
235
	struct list_head pending_list;
236
#endif
237
	const char *fw_id;
238 239
};

240 241
struct fw_cache_entry {
	struct list_head list;
242
	const char *name;
243 244
};

245 246
struct fw_name_devm {
	unsigned long magic;
247
	const char *name;
248 249
};

250 251
#define to_fwbuf(d) container_of(d, struct firmware_buf, ref)

252 253 254 255 256
#define	FW_LOADER_NO_CACHE	0
#define	FW_LOADER_START_CACHE	1

static int fw_cache_piggyback_on_request(const char *name);

257 258 259 260 261 262 263
/* fw_lock could be moved to 'struct firmware_priv' but since it is just
 * guarding for corner cases a global lock should be OK */
static DEFINE_MUTEX(fw_lock);

static struct firmware_cache fw_cache;

static struct firmware_buf *__allocate_fw_buf(const char *fw_name,
264 265
					      struct firmware_cache *fwc,
					      void *dbuf, size_t size)
266 267 268
{
	struct firmware_buf *buf;

269
	buf = kzalloc(sizeof(*buf), GFP_ATOMIC);
270
	if (!buf)
271 272 273 274 275 276 277
		return NULL;

	buf->fw_id = kstrdup_const(fw_name, GFP_ATOMIC);
	if (!buf->fw_id) {
		kfree(buf);
		return NULL;
	}
278 279 280

	kref_init(&buf->ref);
	buf->fwc = fwc;
281 282
	buf->data = dbuf;
	buf->allocated_size = size;
D
Daniel Wagner 已提交
283
	fw_state_init(&buf->fw_st);
284 285 286
#ifdef CONFIG_FW_LOADER_USER_HELPER
	INIT_LIST_HEAD(&buf->pending_list);
#endif
287 288 289 290 291 292

	pr_debug("%s: fw-%s buf=%p\n", __func__, fw_name, buf);

	return buf;
}

293 294 295 296 297 298 299 300 301 302 303
static struct firmware_buf *__fw_lookup_buf(const char *fw_name)
{
	struct firmware_buf *tmp;
	struct firmware_cache *fwc = &fw_cache;

	list_for_each_entry(tmp, &fwc->head, list)
		if (!strcmp(tmp->fw_id, fw_name))
			return tmp;
	return NULL;
}

304 305
static int fw_lookup_and_allocate_buf(const char *fw_name,
				      struct firmware_cache *fwc,
306 307
				      struct firmware_buf **buf, void *dbuf,
				      size_t size)
308 309 310 311
{
	struct firmware_buf *tmp;

	spin_lock(&fwc->lock);
312 313 314 315 316 317 318
	tmp = __fw_lookup_buf(fw_name);
	if (tmp) {
		kref_get(&tmp->ref);
		spin_unlock(&fwc->lock);
		*buf = tmp;
		return 1;
	}
319
	tmp = __allocate_fw_buf(fw_name, fwc, dbuf, size);
320 321 322 323 324 325 326 327 328 329
	if (tmp)
		list_add(&tmp->list, &fwc->head);
	spin_unlock(&fwc->lock);

	*buf = tmp;

	return tmp ? 0 : -ENOMEM;
}

static void __fw_free_buf(struct kref *ref)
330
	__releases(&fwc->lock)
331 332 333 334 335 336 337 338 339 340 341
{
	struct firmware_buf *buf = to_fwbuf(ref);
	struct firmware_cache *fwc = buf->fwc;

	pr_debug("%s: fw-%s buf=%p data=%p size=%u\n",
		 __func__, buf->fw_id, buf, buf->data,
		 (unsigned int)buf->size);

	list_del(&buf->list);
	spin_unlock(&fwc->lock);

342
#ifdef CONFIG_FW_LOADER_USER_HELPER
343
	if (buf->is_paged_buf) {
344
		int i;
345 346 347
		vunmap(buf->data);
		for (i = 0; i < buf->nr_pages; i++)
			__free_page(buf->pages[i]);
348
		vfree(buf->pages);
349
	} else
350
#endif
351
	if (!buf->allocated_size)
352
		vfree(buf->data);
353
	kfree_const(buf->fw_id);
354 355 356 357 358
	kfree(buf);
}

static void fw_free_buf(struct firmware_buf *buf)
{
359 360 361 362
	struct firmware_cache *fwc = buf->fwc;
	spin_lock(&fwc->lock);
	if (!kref_put(&buf->ref, __fw_free_buf))
		spin_unlock(&fwc->lock);
363 364
}

365
/* direct firmware loading support */
366 367 368
static char fw_path_para[256];
static const char * const fw_path[] = {
	fw_path_para,
369 370 371 372 373 374
	"/lib/firmware/updates/" UTS_RELEASE,
	"/lib/firmware/updates",
	"/lib/firmware/" UTS_RELEASE,
	"/lib/firmware"
};

375 376 377 378 379 380 381 382
/*
 * Typical usage is that passing 'firmware_class.path=$CUSTOMIZED_PATH'
 * from kernel command line because firmware_class is generally built in
 * kernel instead of module.
 */
module_param_string(path, fw_path_para, sizeof(fw_path_para), 0644);
MODULE_PARM_DESC(path, "customized firmware image search path with a higher priority than default path");

383 384
static int
fw_get_filesystem_firmware(struct device *device, struct firmware_buf *buf)
385
{
386
	loff_t size;
387
	int i, len;
388
	int rc = -ENOENT;
389
	char *path;
390 391 392 393 394 395 396 397
	enum kernel_read_file_id id = READING_FIRMWARE;
	size_t msize = INT_MAX;

	/* Already populated data member means we're loading into a buffer */
	if (buf->data) {
		id = READING_FIRMWARE_PREALLOC_BUFFER;
		msize = buf->allocated_size;
	}
398 399 400 401

	path = __getname();
	if (!path)
		return -ENOMEM;
402 403

	for (i = 0; i < ARRAY_SIZE(fw_path); i++) {
404 405 406 407
		/* skip the unset customized path */
		if (!fw_path[i][0])
			continue;

408 409 410 411 412 413
		len = snprintf(path, PATH_MAX, "%s/%s",
			       fw_path[i], buf->fw_id);
		if (len >= PATH_MAX) {
			rc = -ENAMETOOLONG;
			break;
		}
414

415
		buf->size = 0;
416 417
		rc = kernel_read_file_from_path(path, &buf->data, &size, msize,
						id);
418
		if (rc) {
419 420 421 422 423 424
			if (rc == -ENOENT)
				dev_dbg(device, "loading %s failed with error %d\n",
					 path, rc);
			else
				dev_warn(device, "loading %s failed with error %d\n",
					 path, rc);
425 426
			continue;
		}
427 428
		dev_dbg(device, "direct-loading %s\n", buf->fw_id);
		buf->size = size;
429
		fw_state_done(&buf->fw_st);
430
		break;
431
	}
432
	__putname(path);
433

434
	return rc;
435 436
}

437 438 439 440 441 442 443 444 445 446 447
/* firmware holds the ownership of pages */
static void firmware_free_data(const struct firmware *fw)
{
	/* Loaded directly? */
	if (!fw->priv) {
		vfree(fw->data);
		return;
	}
	fw_free_buf(fw->priv);
}

448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470
/* store the pages buffer info firmware from buf */
static void fw_set_page_data(struct firmware_buf *buf, struct firmware *fw)
{
	fw->priv = buf;
#ifdef CONFIG_FW_LOADER_USER_HELPER
	fw->pages = buf->pages;
#endif
	fw->size = buf->size;
	fw->data = buf->data;

	pr_debug("%s: fw-%s buf=%p data=%p size=%u\n",
		 __func__, buf->fw_id, buf, buf->data,
		 (unsigned int)buf->size);
}

#ifdef CONFIG_PM_SLEEP
static void fw_name_devm_release(struct device *dev, void *res)
{
	struct fw_name_devm *fwn = res;

	if (fwn->magic == (unsigned long)&fw_cache)
		pr_debug("%s: fw_name-%s devm-%p released\n",
				__func__, fwn->name, res);
471
	kfree_const(fwn->name);
472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
}

static int fw_devm_match(struct device *dev, void *res,
		void *match_data)
{
	struct fw_name_devm *fwn = res;

	return (fwn->magic == (unsigned long)&fw_cache) &&
		!strcmp(fwn->name, match_data);
}

static struct fw_name_devm *fw_find_devm_name(struct device *dev,
		const char *name)
{
	struct fw_name_devm *fwn;

	fwn = devres_find(dev, fw_name_devm_release,
			  fw_devm_match, (void *)name);
	return fwn;
}

/* add firmware name into devres list */
static int fw_add_devm_name(struct device *dev, const char *name)
{
	struct fw_name_devm *fwn;

	fwn = fw_find_devm_name(dev, name);
	if (fwn)
		return 1;

502 503
	fwn = devres_alloc(fw_name_devm_release, sizeof(struct fw_name_devm),
			   GFP_KERNEL);
504 505
	if (!fwn)
		return -ENOMEM;
506 507
	fwn->name = kstrdup_const(name, GFP_KERNEL);
	if (!fwn->name) {
508
		devres_free(fwn);
509 510
		return -ENOMEM;
	}
511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527

	fwn->magic = (unsigned long)&fw_cache;
	devres_add(dev, fwn);

	return 0;
}
#else
static int fw_add_devm_name(struct device *dev, const char *name)
{
	return 0;
}
#endif


/*
 * user-mode helper code
 */
528
#ifdef CONFIG_FW_LOADER_USER_HELPER
529 530 531 532 533 534
struct firmware_priv {
	bool nowait;
	struct device dev;
	struct firmware_buf *buf;
	struct firmware *fw;
};
535

536 537 538 539 540
static struct firmware_priv *to_firmware_priv(struct device *dev)
{
	return container_of(dev, struct firmware_priv, dev);
}

541
static void __fw_load_abort(struct firmware_buf *buf)
L
Linus Torvalds 已提交
542
{
543 544 545 546
	/*
	 * There is a small window in which user can write to 'loading'
	 * between loading done and disappearance of 'loading'
	 */
D
Daniel Wagner 已提交
547
	if (fw_state_is_done(&buf->fw_st))
548 549
		return;

550
	list_del_init(&buf->pending_list);
D
Daniel Wagner 已提交
551
	fw_state_aborted(&buf->fw_st);
L
Linus Torvalds 已提交
552 553
}

554 555 556 557 558
static void fw_load_abort(struct firmware_priv *fw_priv)
{
	struct firmware_buf *buf = fw_priv->buf;

	__fw_load_abort(buf);
559 560 561

	/* avoid user action after loading abort */
	fw_priv->buf = NULL;
L
Linus Torvalds 已提交
562 563
}

564 565 566 567 568 569 570 571
static LIST_HEAD(pending_fw_head);

/* reboot notifier for avoid deadlock with usermode_lock */
static int fw_shutdown_notify(struct notifier_block *unused1,
			      unsigned long unused2, void *unused3)
{
	mutex_lock(&fw_lock);
	while (!list_empty(&pending_fw_head))
572
		__fw_load_abort(list_first_entry(&pending_fw_head,
573 574 575 576 577 578 579 580 581 582
					       struct firmware_buf,
					       pending_list));
	mutex_unlock(&fw_lock);
	return NOTIFY_DONE;
}

static struct notifier_block fw_shutdown_nb = {
	.notifier_call = fw_shutdown_notify,
};

583 584
static ssize_t timeout_show(struct class *class, struct class_attribute *attr,
			    char *buf)
L
Linus Torvalds 已提交
585 586 587 588 589
{
	return sprintf(buf, "%d\n", loading_timeout);
}

/**
590 591
 * firmware_timeout_store - set number of seconds to wait for firmware
 * @class: device class pointer
592
 * @attr: device attribute pointer
593 594 595
 * @buf: buffer to scan for timeout value
 * @count: number of bytes in @buf
 *
L
Linus Torvalds 已提交
596
 *	Sets the number of seconds to wait for the firmware.  Once
597
 *	this expires an error will be returned to the driver and no
L
Linus Torvalds 已提交
598 599
 *	firmware will be provided.
 *
600
 *	Note: zero means 'wait forever'.
L
Linus Torvalds 已提交
601
 **/
602 603
static ssize_t timeout_store(struct class *class, struct class_attribute *attr,
			     const char *buf, size_t count)
L
Linus Torvalds 已提交
604 605
{
	loading_timeout = simple_strtol(buf, NULL, 10);
606 607
	if (loading_timeout < 0)
		loading_timeout = 0;
608

L
Linus Torvalds 已提交
609 610
	return count;
}
611
static CLASS_ATTR_RW(timeout);
L
Linus Torvalds 已提交
612

613 614 615
static struct attribute *firmware_class_attrs[] = {
	&class_attr_timeout.attr,
	NULL,
616
};
617
ATTRIBUTE_GROUPS(firmware_class);
L
Linus Torvalds 已提交
618

619 620 621
static void fw_dev_release(struct device *dev)
{
	struct firmware_priv *fw_priv = to_firmware_priv(dev);
622

623 624
	kfree(fw_priv);
}
L
Linus Torvalds 已提交
625

626
static int do_firmware_uevent(struct firmware_priv *fw_priv, struct kobj_uevent_env *env)
L
Linus Torvalds 已提交
627
{
628
	if (add_uevent_var(env, "FIRMWARE=%s", fw_priv->buf->fw_id))
L
Linus Torvalds 已提交
629
		return -ENOMEM;
630
	if (add_uevent_var(env, "TIMEOUT=%i", loading_timeout))
631
		return -ENOMEM;
632 633
	if (add_uevent_var(env, "ASYNC=%d", fw_priv->nowait))
		return -ENOMEM;
L
Linus Torvalds 已提交
634 635 636 637

	return 0;
}

638 639 640 641 642 643 644 645 646 647 648 649
static int firmware_uevent(struct device *dev, struct kobj_uevent_env *env)
{
	struct firmware_priv *fw_priv = to_firmware_priv(dev);
	int err = 0;

	mutex_lock(&fw_lock);
	if (fw_priv->buf)
		err = do_firmware_uevent(fw_priv, env);
	mutex_unlock(&fw_lock);
	return err;
}

650 651
static struct class firmware_class = {
	.name		= "firmware",
652
	.class_groups	= firmware_class_groups,
653 654
	.dev_uevent	= firmware_uevent,
	.dev_release	= fw_dev_release,
655 656
};

657 658
static ssize_t firmware_loading_show(struct device *dev,
				     struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
659
{
660
	struct firmware_priv *fw_priv = to_firmware_priv(dev);
661 662 663 664
	int loading = 0;

	mutex_lock(&fw_lock);
	if (fw_priv->buf)
D
Daniel Wagner 已提交
665
		loading = fw_state_is_loading(&fw_priv->buf->fw_st);
666
	mutex_unlock(&fw_lock);
667

L
Linus Torvalds 已提交
668 669 670
	return sprintf(buf, "%d\n", loading);
}

671 672 673 674
/* Some architectures don't have PAGE_KERNEL_RO */
#ifndef PAGE_KERNEL_RO
#define PAGE_KERNEL_RO PAGE_KERNEL
#endif
675 676 677 678

/* one pages buffer should be mapped/unmapped only once */
static int fw_map_pages_buf(struct firmware_buf *buf)
{
679
	if (!buf->is_paged_buf)
680 681
		return 0;

682
	vunmap(buf->data);
683 684 685 686 687 688
	buf->data = vmap(buf->pages, buf->nr_pages, 0, PAGE_KERNEL_RO);
	if (!buf->data)
		return -ENOMEM;
	return 0;
}

L
Linus Torvalds 已提交
689
/**
690
 * firmware_loading_store - set value in the 'loading' control file
691
 * @dev: device pointer
692
 * @attr: device attribute pointer
693 694 695
 * @buf: buffer to scan for loading control value
 * @count: number of bytes in @buf
 *
L
Linus Torvalds 已提交
696 697 698
 *	The relevant values are:
 *
 *	 1: Start a load, discarding any previous partial load.
699
 *	 0: Conclude the load and hand the data to the driver code.
L
Linus Torvalds 已提交
700 701
 *	-1: Conclude the load with an error and discard any written data.
 **/
702 703 704
static ssize_t firmware_loading_store(struct device *dev,
				      struct device_attribute *attr,
				      const char *buf, size_t count)
L
Linus Torvalds 已提交
705
{
706
	struct firmware_priv *fw_priv = to_firmware_priv(dev);
707
	struct firmware_buf *fw_buf;
708
	ssize_t written = count;
L
Linus Torvalds 已提交
709
	int loading = simple_strtol(buf, NULL, 10);
710
	int i;
L
Linus Torvalds 已提交
711

712
	mutex_lock(&fw_lock);
713
	fw_buf = fw_priv->buf;
714
	if (!fw_buf)
715 716
		goto out;

L
Linus Torvalds 已提交
717 718
	switch (loading) {
	case 1:
719
		/* discarding any previous partial load */
D
Daniel Wagner 已提交
720
		if (!fw_state_is_done(&fw_buf->fw_st)) {
721 722
			for (i = 0; i < fw_buf->nr_pages; i++)
				__free_page(fw_buf->pages[i]);
723
			vfree(fw_buf->pages);
724 725 726
			fw_buf->pages = NULL;
			fw_buf->page_array_size = 0;
			fw_buf->nr_pages = 0;
D
Daniel Wagner 已提交
727
			fw_state_start(&fw_buf->fw_st);
728
		}
L
Linus Torvalds 已提交
729 730
		break;
	case 0:
D
Daniel Wagner 已提交
731
		if (fw_state_is_loading(&fw_buf->fw_st)) {
732 733
			int rc;

734 735 736 737 738 739
			/*
			 * Several loading requests may be pending on
			 * one same firmware buf, so let all requests
			 * see the mapped 'buf->data' once the loading
			 * is completed.
			 * */
740 741
			rc = fw_map_pages_buf(fw_buf);
			if (rc)
742 743
				dev_err(dev, "%s: map pages failed\n",
					__func__);
744
			else
745 746 747
				rc = security_kernel_post_read_file(NULL,
						fw_buf->data, fw_buf->size,
						READING_FIRMWARE);
748 749 750 751 752

			/*
			 * Same logic as fw_load_abort, only the DONE bit
			 * is ignored and we set ABORT only on failure.
			 */
753
			list_del_init(&fw_buf->pending_list);
754
			if (rc) {
D
Daniel Wagner 已提交
755
				fw_state_aborted(&fw_buf->fw_st);
756
				written = rc;
D
Daniel Wagner 已提交
757 758
			} else {
				fw_state_done(&fw_buf->fw_st);
759
			}
L
Linus Torvalds 已提交
760 761 762 763
			break;
		}
		/* fallthrough */
	default:
764
		dev_err(dev, "%s: unexpected value (%d)\n", __func__, loading);
L
Linus Torvalds 已提交
765 766 767 768 769
		/* fallthrough */
	case -1:
		fw_load_abort(fw_priv);
		break;
	}
770 771
out:
	mutex_unlock(&fw_lock);
772
	return written;
L
Linus Torvalds 已提交
773 774
}

775
static DEVICE_ATTR(loading, 0644, firmware_loading_show, firmware_loading_store);
L
Linus Torvalds 已提交
776

777 778 779 780 781 782 783 784 785
static void firmware_rw_buf(struct firmware_buf *buf, char *buffer,
			   loff_t offset, size_t count, bool read)
{
	if (read)
		memcpy(buffer, buf->data + offset, count);
	else
		memcpy(buf->data + offset, buffer, count);
}

786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808
static void firmware_rw(struct firmware_buf *buf, char *buffer,
			loff_t offset, size_t count, bool read)
{
	while (count) {
		void *page_data;
		int page_nr = offset >> PAGE_SHIFT;
		int page_ofs = offset & (PAGE_SIZE-1);
		int page_cnt = min_t(size_t, PAGE_SIZE - page_ofs, count);

		page_data = kmap(buf->pages[page_nr]);

		if (read)
			memcpy(buffer, page_data + page_ofs, page_cnt);
		else
			memcpy(page_data + page_ofs, buffer, page_cnt);

		kunmap(buf->pages[page_nr]);
		buffer += page_cnt;
		offset += page_cnt;
		count -= page_cnt;
	}
}

809 810 811
static ssize_t firmware_data_read(struct file *filp, struct kobject *kobj,
				  struct bin_attribute *bin_attr,
				  char *buffer, loff_t offset, size_t count)
L
Linus Torvalds 已提交
812
{
813
	struct device *dev = kobj_to_dev(kobj);
814
	struct firmware_priv *fw_priv = to_firmware_priv(dev);
815
	struct firmware_buf *buf;
816
	ssize_t ret_count;
L
Linus Torvalds 已提交
817

818
	mutex_lock(&fw_lock);
819
	buf = fw_priv->buf;
D
Daniel Wagner 已提交
820
	if (!buf || fw_state_is_done(&buf->fw_st)) {
L
Linus Torvalds 已提交
821 822 823
		ret_count = -ENODEV;
		goto out;
	}
824
	if (offset > buf->size) {
825 826 827
		ret_count = 0;
		goto out;
	}
828 829
	if (count > buf->size - offset)
		count = buf->size - offset;
830 831 832

	ret_count = count;

833 834 835 836
	if (buf->data)
		firmware_rw_buf(buf, buffer, offset, count, true);
	else
		firmware_rw(buf, buffer, offset, count, true);
837

L
Linus Torvalds 已提交
838
out:
839
	mutex_unlock(&fw_lock);
L
Linus Torvalds 已提交
840 841
	return ret_count;
}
842

843
static int fw_realloc_buffer(struct firmware_priv *fw_priv, int min_size)
L
Linus Torvalds 已提交
844
{
845
	struct firmware_buf *buf = fw_priv->buf;
846
	int pages_needed = PAGE_ALIGN(min_size) >> PAGE_SHIFT;
847 848

	/* If the array of pages is too small, grow it... */
849
	if (buf->page_array_size < pages_needed) {
850
		int new_array_size = max(pages_needed,
851
					 buf->page_array_size * 2);
852 853
		struct page **new_pages;

854
		new_pages = vmalloc(new_array_size * sizeof(void *));
855 856 857 858
		if (!new_pages) {
			fw_load_abort(fw_priv);
			return -ENOMEM;
		}
859 860 861 862
		memcpy(new_pages, buf->pages,
		       buf->page_array_size * sizeof(void *));
		memset(&new_pages[buf->page_array_size], 0, sizeof(void *) *
		       (new_array_size - buf->page_array_size));
863
		vfree(buf->pages);
864 865
		buf->pages = new_pages;
		buf->page_array_size = new_array_size;
866
	}
L
Linus Torvalds 已提交
867

868 869
	while (buf->nr_pages < pages_needed) {
		buf->pages[buf->nr_pages] =
870
			alloc_page(GFP_KERNEL | __GFP_HIGHMEM);
L
Linus Torvalds 已提交
871

872
		if (!buf->pages[buf->nr_pages]) {
873 874 875
			fw_load_abort(fw_priv);
			return -ENOMEM;
		}
876
		buf->nr_pages++;
L
Linus Torvalds 已提交
877 878 879 880 881
	}
	return 0;
}

/**
882
 * firmware_data_write - write method for firmware
883
 * @filp: open sysfs file
884
 * @kobj: kobject for the device
885
 * @bin_attr: bin_attr structure
886 887 888
 * @buffer: buffer being written
 * @offset: buffer offset for write in total data store area
 * @count: buffer size
L
Linus Torvalds 已提交
889
 *
890
 *	Data written to the 'data' attribute will be later handed to
L
Linus Torvalds 已提交
891 892
 *	the driver as a firmware image.
 **/
893 894 895
static ssize_t firmware_data_write(struct file *filp, struct kobject *kobj,
				   struct bin_attribute *bin_attr,
				   char *buffer, loff_t offset, size_t count)
L
Linus Torvalds 已提交
896
{
897
	struct device *dev = kobj_to_dev(kobj);
898
	struct firmware_priv *fw_priv = to_firmware_priv(dev);
899
	struct firmware_buf *buf;
L
Linus Torvalds 已提交
900 901 902 903
	ssize_t retval;

	if (!capable(CAP_SYS_RAWIO))
		return -EPERM;
904

905
	mutex_lock(&fw_lock);
906
	buf = fw_priv->buf;
D
Daniel Wagner 已提交
907
	if (!buf || fw_state_is_done(&buf->fw_st)) {
L
Linus Torvalds 已提交
908 909 910
		retval = -ENODEV;
		goto out;
	}
911

912 913 914 915 916 917 918 919 920 921 922
	if (buf->data) {
		if (offset + count > buf->allocated_size) {
			retval = -ENOMEM;
			goto out;
		}
		firmware_rw_buf(buf, buffer, offset, count, false);
		retval = count;
	} else {
		retval = fw_realloc_buffer(fw_priv, offset + count);
		if (retval)
			goto out;
L
Linus Torvalds 已提交
923

924 925 926
		retval = count;
		firmware_rw(buf, buffer, offset, count, false);
	}
927

928
	buf->size = max_t(size_t, offset + count, buf->size);
L
Linus Torvalds 已提交
929
out:
930
	mutex_unlock(&fw_lock);
L
Linus Torvalds 已提交
931 932
	return retval;
}
933

934 935
static struct bin_attribute firmware_attr_data = {
	.attr = { .name = "data", .mode = 0644 },
L
Linus Torvalds 已提交
936 937 938 939 940
	.size = 0,
	.read = firmware_data_read,
	.write = firmware_data_write,
};

941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960
static struct attribute *fw_dev_attrs[] = {
	&dev_attr_loading.attr,
	NULL
};

static struct bin_attribute *fw_dev_bin_attrs[] = {
	&firmware_attr_data,
	NULL
};

static const struct attribute_group fw_dev_attr_group = {
	.attrs = fw_dev_attrs,
	.bin_attrs = fw_dev_bin_attrs,
};

static const struct attribute_group *fw_dev_attr_groups[] = {
	&fw_dev_attr_group,
	NULL
};

961
static struct firmware_priv *
962
fw_create_instance(struct firmware *firmware, const char *fw_name,
963
		   struct device *device, unsigned int opt_flags)
L
Linus Torvalds 已提交
964
{
965 966
	struct firmware_priv *fw_priv;
	struct device *f_dev;
L
Linus Torvalds 已提交
967

968
	fw_priv = kzalloc(sizeof(*fw_priv), GFP_KERNEL);
969
	if (!fw_priv) {
970 971 972 973
		fw_priv = ERR_PTR(-ENOMEM);
		goto exit;
	}

974
	fw_priv->nowait = !!(opt_flags & FW_OPT_NOWAIT);
975
	fw_priv->fw = firmware;
976 977 978
	f_dev = &fw_priv->dev;

	device_initialize(f_dev);
979
	dev_set_name(f_dev, "%s", fw_name);
980 981
	f_dev->parent = device;
	f_dev->class = &firmware_class;
982
	f_dev->groups = fw_dev_attr_groups;
983
exit:
984
	return fw_priv;
L
Linus Torvalds 已提交
985 986
}

987
/* load a firmware via user helper */
988 989
static int _request_firmware_load(struct firmware_priv *fw_priv,
				  unsigned int opt_flags, long timeout)
990
{
991 992 993
	int retval = 0;
	struct device *f_dev = &fw_priv->dev;
	struct firmware_buf *buf = fw_priv->buf;
994

995
	/* fall back on userspace loading */
996 997
	if (!buf->data)
		buf->is_paged_buf = true;
998

999
	dev_set_uevent_suppress(f_dev, true);
1000

1001 1002 1003 1004 1005
	retval = device_add(f_dev);
	if (retval) {
		dev_err(f_dev, "%s: device_register failed\n", __func__);
		goto err_put_dev;
	}
1006

1007 1008 1009 1010
	mutex_lock(&fw_lock);
	list_add(&buf->pending_list, &pending_fw_head);
	mutex_unlock(&fw_lock);

1011
	if (opt_flags & FW_OPT_UEVENT) {
1012
		buf->need_uevent = true;
1013 1014 1015
		dev_set_uevent_suppress(f_dev, false);
		dev_dbg(f_dev, "firmware: requesting %s\n", buf->fw_id);
		kobject_uevent(&fw_priv->dev.kobj, KOBJ_ADD);
1016 1017
	} else {
		timeout = MAX_JIFFY_OFFSET;
1018
	}
1019

D
Daniel Wagner 已提交
1020
	timeout = fw_state_wait_timeout(&buf->fw_st, timeout);
1021 1022
	if (timeout == -ERESTARTSYS || !timeout) {
		retval = timeout;
1023 1024 1025
		mutex_lock(&fw_lock);
		fw_load_abort(fw_priv);
		mutex_unlock(&fw_lock);
1026
	} else if (timeout > 0) {
1027
		retval = 0;
1028
	}
1029

D
Daniel Wagner 已提交
1030
	if (fw_state_is_aborted(&buf->fw_st))
1031
		retval = -EAGAIN;
1032
	else if (buf->is_paged_buf && !buf->data)
1033
		retval = -ENOMEM;
1034

1035 1036 1037 1038
	device_del(f_dev);
err_put_dev:
	put_device(f_dev);
	return retval;
1039
}
1040 1041 1042

static int fw_load_from_user_helper(struct firmware *firmware,
				    const char *name, struct device *device,
1043
				    unsigned int opt_flags, long timeout)
1044
{
1045 1046
	struct firmware_priv *fw_priv;

1047
	fw_priv = fw_create_instance(firmware, name, device, opt_flags);
1048 1049 1050 1051
	if (IS_ERR(fw_priv))
		return PTR_ERR(fw_priv);

	fw_priv->buf = firmware->priv;
1052
	return _request_firmware_load(fw_priv, opt_flags, timeout);
1053
}
1054

M
Ming Lei 已提交
1055
#ifdef CONFIG_PM_SLEEP
1056 1057 1058 1059 1060 1061 1062 1063 1064
/* kill pending requests without uevent to avoid blocking suspend */
static void kill_requests_without_uevent(void)
{
	struct firmware_buf *buf;
	struct firmware_buf *next;

	mutex_lock(&fw_lock);
	list_for_each_entry_safe(buf, next, &pending_fw_head, pending_list) {
		if (!buf->need_uevent)
1065
			 __fw_load_abort(buf);
1066 1067 1068
	}
	mutex_unlock(&fw_lock);
}
M
Ming Lei 已提交
1069
#endif
1070

1071 1072 1073
#else /* CONFIG_FW_LOADER_USER_HELPER */
static inline int
fw_load_from_user_helper(struct firmware *firmware, const char *name,
1074
			 struct device *device, unsigned int opt_flags,
1075 1076 1077 1078
			 long timeout)
{
	return -ENOENT;
}
1079

M
Ming Lei 已提交
1080
#ifdef CONFIG_PM_SLEEP
1081
static inline void kill_requests_without_uevent(void) { }
M
Ming Lei 已提交
1082
#endif
1083

1084 1085
#endif /* CONFIG_FW_LOADER_USER_HELPER */

1086 1087 1088 1089 1090 1091
/* prepare firmware and firmware_buf structs;
 * return 0 if a firmware is already assigned, 1 if need to load one,
 * or a negative error code
 */
static int
_request_firmware_prepare(struct firmware **firmware_p, const char *name,
1092
			  struct device *device, void *dbuf, size_t size)
L
Linus Torvalds 已提交
1093 1094
{
	struct firmware *firmware;
1095 1096
	struct firmware_buf *buf;
	int ret;
L
Linus Torvalds 已提交
1097

1098
	*firmware_p = firmware = kzalloc(sizeof(*firmware), GFP_KERNEL);
L
Linus Torvalds 已提交
1099
	if (!firmware) {
1100 1101
		dev_err(device, "%s: kmalloc(struct firmware) failed\n",
			__func__);
1102
		return -ENOMEM;
L
Linus Torvalds 已提交
1103 1104
	}

1105
	if (fw_get_builtin_firmware(firmware, name, dbuf, size)) {
1106
		dev_dbg(device, "using built-in %s\n", name);
1107
		return 0; /* assigned */
1108 1109
	}

1110
	ret = fw_lookup_and_allocate_buf(name, &fw_cache, &buf, dbuf, size);
1111 1112 1113 1114 1115 1116 1117 1118

	/*
	 * bind with 'buf' now to avoid warning in failure path
	 * of requesting firmware.
	 */
	firmware->priv = buf;

	if (ret > 0) {
1119
		ret = fw_state_wait(&buf->fw_st);
1120 1121 1122 1123
		if (!ret) {
			fw_set_page_data(buf, firmware);
			return 0; /* assigned */
		}
1124
	}
1125

1126 1127 1128 1129 1130
	if (ret < 0)
		return ret;
	return 1; /* need to load */
}

1131
static int assign_firmware_buf(struct firmware *fw, struct device *device,
1132
			       unsigned int opt_flags)
1133 1134 1135
{
	struct firmware_buf *buf = fw->priv;

1136
	mutex_lock(&fw_lock);
D
Daniel Wagner 已提交
1137
	if (!buf->size || fw_state_is_aborted(&buf->fw_st)) {
1138 1139
		mutex_unlock(&fw_lock);
		return -ENOENT;
1140
	}
1141

1142 1143 1144 1145 1146 1147 1148
	/*
	 * add firmware name into devres list so that we can auto cache
	 * and uncache firmware for device.
	 *
	 * device may has been deleted already, but the problem
	 * should be fixed in devres or driver core.
	 */
1149
	/* don't cache firmware handled without uevent */
1150 1151
	if (device && (opt_flags & FW_OPT_UEVENT) &&
	    !(opt_flags & FW_OPT_NOCACHE))
1152 1153 1154 1155 1156 1157
		fw_add_devm_name(device, buf->fw_id);

	/*
	 * After caching firmware image is started, let it piggyback
	 * on request firmware.
	 */
1158 1159
	if (!(opt_flags & FW_OPT_NOCACHE) &&
	    buf->fwc->state == FW_LOADER_START_CACHE) {
1160 1161 1162 1163 1164 1165
		if (fw_cache_piggyback_on_request(buf->fw_id))
			kref_get(&buf->ref);
	}

	/* pass the pages buffer to driver at the last minute */
	fw_set_page_data(buf, fw);
1166
	mutex_unlock(&fw_lock);
1167
	return 0;
1168 1169
}

1170 1171 1172
/* called from request_firmware() and request_firmware_work_func() */
static int
_request_firmware(const struct firmware **firmware_p, const char *name,
1173 1174
		  struct device *device, void *buf, size_t size,
		  unsigned int opt_flags)
1175
{
1176
	struct firmware *fw = NULL;
1177 1178 1179 1180 1181 1182
	long timeout;
	int ret;

	if (!firmware_p)
		return -EINVAL;

1183 1184 1185 1186
	if (!name || name[0] == '\0') {
		ret = -EINVAL;
		goto out;
	}
1187

1188
	ret = _request_firmware_prepare(&fw, name, device, buf, size);
1189 1190 1191 1192 1193
	if (ret <= 0) /* error or already assigned */
		goto out;

	ret = 0;
	timeout = firmware_loading_timeout();
1194
	if (opt_flags & FW_OPT_NOWAIT) {
1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210
		timeout = usermodehelper_read_lock_wait(timeout);
		if (!timeout) {
			dev_dbg(device, "firmware: %s loading timed out\n",
				name);
			ret = -EBUSY;
			goto out;
		}
	} else {
		ret = usermodehelper_read_trylock();
		if (WARN_ON(ret)) {
			dev_err(device, "firmware: %s will not be loaded\n",
				name);
			goto out;
		}
	}

1211 1212
	ret = fw_get_filesystem_firmware(device, fw->priv);
	if (ret) {
1213
		if (!(opt_flags & FW_OPT_NO_WARN))
1214
			dev_warn(device,
1215 1216 1217
				 "Direct firmware load for %s failed with error %d\n",
				 name, ret);
		if (opt_flags & FW_OPT_USERHELPER) {
1218 1219
			dev_warn(device, "Falling back to user helper\n");
			ret = fw_load_from_user_helper(fw, name, device,
1220
						       opt_flags, timeout);
1221
		}
1222
	}
1223

1224
	if (!ret)
1225
		ret = assign_firmware_buf(fw, device, opt_flags);
1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238

	usermodehelper_read_unlock();

 out:
	if (ret < 0) {
		release_firmware(fw);
		fw = NULL;
	}

	*firmware_p = fw;
	return ret;
}

1239
/**
1240
 * request_firmware: - send firmware request and wait for it
1241 1242 1243 1244 1245
 * @firmware_p: pointer to firmware image
 * @name: name of firmware file
 * @device: device for which firmware is being loaded
 *
 *      @firmware_p will be used to return a firmware image by the name
1246 1247 1248 1249
 *      of @name for device @device.
 *
 *      Should be called from user context where sleeping is allowed.
 *
1250
 *      @name will be used as $FIRMWARE in the uevent environment and
1251 1252
 *      should be distinctive enough not to be confused with any other
 *      firmware image for this or any other device.
M
Ming Lei 已提交
1253 1254
 *
 *	Caller must hold the reference count of @device.
1255 1256 1257
 *
 *	The function can be called safely inside device's suspend and
 *	resume callback.
1258 1259 1260
 **/
int
request_firmware(const struct firmware **firmware_p, const char *name,
1261
		 struct device *device)
1262
{
1263 1264 1265 1266
	int ret;

	/* Need to pin this module until return */
	__module_get(THIS_MODULE);
1267
	ret = _request_firmware(firmware_p, name, device, NULL, 0,
1268
				FW_OPT_UEVENT | FW_OPT_FALLBACK);
1269 1270
	module_put(THIS_MODULE);
	return ret;
1271
}
1272
EXPORT_SYMBOL(request_firmware);
1273

1274
/**
1275
 * request_firmware_direct: - load firmware directly without usermode helper
1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288
 * @firmware_p: pointer to firmware image
 * @name: name of firmware file
 * @device: device for which firmware is being loaded
 *
 * This function works pretty much like request_firmware(), but this doesn't
 * fall back to usermode helper even if the firmware couldn't be loaded
 * directly from fs.  Hence it's useful for loading optional firmwares, which
 * aren't always present, without extra long timeouts of udev.
 **/
int request_firmware_direct(const struct firmware **firmware_p,
			    const char *name, struct device *device)
{
	int ret;
1289

1290
	__module_get(THIS_MODULE);
1291
	ret = _request_firmware(firmware_p, name, device, NULL, 0,
1292
				FW_OPT_UEVENT | FW_OPT_NO_WARN);
1293 1294 1295 1296 1297
	module_put(THIS_MODULE);
	return ret;
}
EXPORT_SYMBOL_GPL(request_firmware_direct);

1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327
/**
 * request_firmware_into_buf - load firmware into a previously allocated buffer
 * @firmware_p: pointer to firmware image
 * @name: name of firmware file
 * @device: device for which firmware is being loaded and DMA region allocated
 * @buf: address of buffer to load firmware into
 * @size: size of buffer
 *
 * This function works pretty much like request_firmware(), but it doesn't
 * allocate a buffer to hold the firmware data. Instead, the firmware
 * is loaded directly into the buffer pointed to by @buf and the @firmware_p
 * data member is pointed at @buf.
 *
 * This function doesn't cache firmware either.
 */
int
request_firmware_into_buf(const struct firmware **firmware_p, const char *name,
			  struct device *device, void *buf, size_t size)
{
	int ret;

	__module_get(THIS_MODULE);
	ret = _request_firmware(firmware_p, name, device, buf, size,
				FW_OPT_UEVENT | FW_OPT_FALLBACK |
				FW_OPT_NOCACHE);
	module_put(THIS_MODULE);
	return ret;
}
EXPORT_SYMBOL(request_firmware_into_buf);

L
Linus Torvalds 已提交
1328 1329
/**
 * release_firmware: - release the resource associated with a firmware image
1330
 * @fw: firmware resource to release
L
Linus Torvalds 已提交
1331
 **/
1332
void release_firmware(const struct firmware *fw)
L
Linus Torvalds 已提交
1333 1334
{
	if (fw) {
1335 1336
		if (!fw_is_builtin_firmware(fw))
			firmware_free_data(fw);
L
Linus Torvalds 已提交
1337 1338 1339
		kfree(fw);
	}
}
1340
EXPORT_SYMBOL(release_firmware);
L
Linus Torvalds 已提交
1341 1342 1343 1344 1345 1346 1347 1348 1349

/* Async support */
struct firmware_work {
	struct work_struct work;
	struct module *module;
	const char *name;
	struct device *device;
	void *context;
	void (*cont)(const struct firmware *fw, void *context);
1350
	unsigned int opt_flags;
L
Linus Torvalds 已提交
1351 1352
};

1353
static void request_firmware_work_func(struct work_struct *work)
L
Linus Torvalds 已提交
1354
{
1355
	struct firmware_work *fw_work;
L
Linus Torvalds 已提交
1356
	const struct firmware *fw;
1357

1358
	fw_work = container_of(work, struct firmware_work, work);
1359

1360
	_request_firmware(&fw, fw_work->name, fw_work->device, NULL, 0,
1361
			  fw_work->opt_flags);
1362
	fw_work->cont(fw, fw_work->context);
1363
	put_device(fw_work->device); /* taken in request_firmware_nowait() */
1364

L
Linus Torvalds 已提交
1365
	module_put(fw_work->module);
1366
	kfree_const(fw_work->name);
L
Linus Torvalds 已提交
1367 1368 1369 1370
	kfree(fw_work);
}

/**
1371
 * request_firmware_nowait - asynchronous version of request_firmware
1372
 * @module: module requesting the firmware
1373
 * @uevent: sends uevent to copy the firmware image if this flag
1374 1375 1376
 *	is non-zero else the firmware copy must be done manually.
 * @name: name of firmware file
 * @device: device for which firmware is being loaded
1377
 * @gfp: allocation flags
1378 1379 1380 1381
 * @context: will be passed over to @cont, and
 *	@fw may be %NULL if firmware request fails.
 * @cont: function will be called asynchronously when the firmware
 *	request is over.
L
Linus Torvalds 已提交
1382
 *
M
Ming Lei 已提交
1383 1384
 *	Caller must hold the reference count of @device.
 *
1385 1386
 *	Asynchronous variant of request_firmware() for user contexts:
 *		- sleep for as small periods as possible since it may
1387 1388 1389
 *		  increase kernel boot time of built-in device drivers
 *		  requesting firmware in their ->probe() methods, if
 *		  @gfp is GFP_KERNEL.
1390 1391
 *
 *		- can't sleep at all if @gfp is GFP_ATOMIC.
L
Linus Torvalds 已提交
1392 1393 1394
 **/
int
request_firmware_nowait(
1395
	struct module *module, bool uevent,
1396
	const char *name, struct device *device, gfp_t gfp, void *context,
L
Linus Torvalds 已提交
1397 1398
	void (*cont)(const struct firmware *fw, void *context))
{
1399
	struct firmware_work *fw_work;
L
Linus Torvalds 已提交
1400

1401
	fw_work = kzalloc(sizeof(struct firmware_work), gfp);
L
Linus Torvalds 已提交
1402 1403
	if (!fw_work)
		return -ENOMEM;
1404 1405

	fw_work->module = module;
1406
	fw_work->name = kstrdup_const(name, gfp);
1407 1408
	if (!fw_work->name) {
		kfree(fw_work);
1409
		return -ENOMEM;
1410
	}
1411 1412 1413
	fw_work->device = device;
	fw_work->context = context;
	fw_work->cont = cont;
1414
	fw_work->opt_flags = FW_OPT_NOWAIT | FW_OPT_FALLBACK |
1415
		(uevent ? FW_OPT_UEVENT : FW_OPT_USERHELPER);
1416

L
Linus Torvalds 已提交
1417
	if (!try_module_get(module)) {
1418
		kfree_const(fw_work->name);
L
Linus Torvalds 已提交
1419 1420 1421 1422
		kfree(fw_work);
		return -EFAULT;
	}

M
Ming Lei 已提交
1423
	get_device(fw_work->device);
1424 1425
	INIT_WORK(&fw_work->work, request_firmware_work_func);
	schedule_work(&fw_work->work);
L
Linus Torvalds 已提交
1426 1427
	return 0;
}
1428
EXPORT_SYMBOL(request_firmware_nowait);
L
Linus Torvalds 已提交
1429

1430 1431 1432
#ifdef CONFIG_PM_SLEEP
static ASYNC_DOMAIN_EXCLUSIVE(fw_cache_domain);

1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446
/**
 * cache_firmware - cache one firmware image in kernel memory space
 * @fw_name: the firmware image name
 *
 * Cache firmware in kernel memory so that drivers can use it when
 * system isn't ready for them to request firmware image from userspace.
 * Once it returns successfully, driver can use request_firmware or its
 * nowait version to get the cached firmware without any interacting
 * with userspace
 *
 * Return 0 if the firmware image has been cached successfully
 * Return !0 otherwise
 *
 */
1447
static int cache_firmware(const char *fw_name)
1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462
{
	int ret;
	const struct firmware *fw;

	pr_debug("%s: %s\n", __func__, fw_name);

	ret = request_firmware(&fw, fw_name, NULL);
	if (!ret)
		kfree(fw);

	pr_debug("%s: %s ret=%d\n", __func__, fw_name, ret);

	return ret;
}

1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474
static struct firmware_buf *fw_lookup_buf(const char *fw_name)
{
	struct firmware_buf *tmp;
	struct firmware_cache *fwc = &fw_cache;

	spin_lock(&fwc->lock);
	tmp = __fw_lookup_buf(fw_name);
	spin_unlock(&fwc->lock);

	return tmp;
}

1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485
/**
 * uncache_firmware - remove one cached firmware image
 * @fw_name: the firmware image name
 *
 * Uncache one firmware image which has been cached successfully
 * before.
 *
 * Return 0 if the firmware cache has been removed successfully
 * Return !0 otherwise
 *
 */
1486
static int uncache_firmware(const char *fw_name)
1487 1488 1489 1490 1491 1492
{
	struct firmware_buf *buf;
	struct firmware fw;

	pr_debug("%s: %s\n", __func__, fw_name);

1493
	if (fw_get_builtin_firmware(&fw, fw_name, NULL, 0))
1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504
		return 0;

	buf = fw_lookup_buf(fw_name);
	if (buf) {
		fw_free_buf(buf);
		return 0;
	}

	return -EINVAL;
}

1505 1506 1507 1508
static struct fw_cache_entry *alloc_fw_cache_entry(const char *name)
{
	struct fw_cache_entry *fce;

1509
	fce = kzalloc(sizeof(*fce), GFP_ATOMIC);
1510 1511 1512
	if (!fce)
		goto exit;

1513 1514 1515 1516 1517 1518
	fce->name = kstrdup_const(name, GFP_ATOMIC);
	if (!fce->name) {
		kfree(fce);
		fce = NULL;
		goto exit;
	}
1519 1520 1521 1522
exit:
	return fce;
}

1523
static int __fw_entry_found(const char *name)
1524 1525 1526 1527 1528 1529
{
	struct firmware_cache *fwc = &fw_cache;
	struct fw_cache_entry *fce;

	list_for_each_entry(fce, &fwc->fw_names, list) {
		if (!strcmp(fce->name, name))
1530
			return 1;
1531
	}
1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543
	return 0;
}

static int fw_cache_piggyback_on_request(const char *name)
{
	struct firmware_cache *fwc = &fw_cache;
	struct fw_cache_entry *fce;
	int ret = 0;

	spin_lock(&fwc->name_lock);
	if (__fw_entry_found(name))
		goto found;
1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555

	fce = alloc_fw_cache_entry(name);
	if (fce) {
		ret = 1;
		list_add(&fce->list, &fwc->fw_names);
		pr_debug("%s: fw: %s\n", __func__, name);
	}
found:
	spin_unlock(&fwc->name_lock);
	return ret;
}

1556 1557
static void free_fw_cache_entry(struct fw_cache_entry *fce)
{
1558
	kfree_const(fce->name);
1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569
	kfree(fce);
}

static void __async_dev_cache_fw_image(void *fw_entry,
				       async_cookie_t cookie)
{
	struct fw_cache_entry *fce = fw_entry;
	struct firmware_cache *fwc = &fw_cache;
	int ret;

	ret = cache_firmware(fce->name);
1570 1571 1572 1573
	if (ret) {
		spin_lock(&fwc->name_lock);
		list_del(&fce->list);
		spin_unlock(&fwc->name_lock);
1574

1575 1576
		free_fw_cache_entry(fce);
	}
1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599
}

/* called with dev->devres_lock held */
static void dev_create_fw_entry(struct device *dev, void *res,
				void *data)
{
	struct fw_name_devm *fwn = res;
	const char *fw_name = fwn->name;
	struct list_head *head = data;
	struct fw_cache_entry *fce;

	fce = alloc_fw_cache_entry(fw_name);
	if (fce)
		list_add(&fce->list, head);
}

static int devm_name_match(struct device *dev, void *res,
			   void *match_data)
{
	struct fw_name_devm *fwn = res;
	return (fwn->magic == (unsigned long)match_data);
}

1600
static void dev_cache_fw_image(struct device *dev, void *data)
1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614
{
	LIST_HEAD(todo);
	struct fw_cache_entry *fce;
	struct fw_cache_entry *fce_next;
	struct firmware_cache *fwc = &fw_cache;

	devres_for_each_res(dev, fw_name_devm_release,
			    devm_name_match, &fw_cache,
			    dev_create_fw_entry, &todo);

	list_for_each_entry_safe(fce, fce_next, &todo, list) {
		list_del(&fce->list);

		spin_lock(&fwc->name_lock);
1615 1616 1617 1618 1619 1620 1621
		/* only one cache entry for one firmware */
		if (!__fw_entry_found(fce->name)) {
			list_add(&fce->list, &fwc->fw_names);
		} else {
			free_fw_cache_entry(fce);
			fce = NULL;
		}
1622 1623
		spin_unlock(&fwc->name_lock);

1624
		if (fce)
1625 1626 1627
			async_schedule_domain(__async_dev_cache_fw_image,
					      (void *)fce,
					      &fw_cache_domain);
1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663
	}
}

static void __device_uncache_fw_images(void)
{
	struct firmware_cache *fwc = &fw_cache;
	struct fw_cache_entry *fce;

	spin_lock(&fwc->name_lock);
	while (!list_empty(&fwc->fw_names)) {
		fce = list_entry(fwc->fw_names.next,
				struct fw_cache_entry, list);
		list_del(&fce->list);
		spin_unlock(&fwc->name_lock);

		uncache_firmware(fce->name);
		free_fw_cache_entry(fce);

		spin_lock(&fwc->name_lock);
	}
	spin_unlock(&fwc->name_lock);
}

/**
 * device_cache_fw_images - cache devices' firmware
 *
 * If one device called request_firmware or its nowait version
 * successfully before, the firmware names are recored into the
 * device's devres link list, so device_cache_fw_images can call
 * cache_firmware() to cache these firmwares for the device,
 * then the device driver can load its firmwares easily at
 * time when system is not ready to complete loading firmware.
 */
static void device_cache_fw_images(void)
{
	struct firmware_cache *fwc = &fw_cache;
1664
	int old_timeout;
1665 1666 1667 1668
	DEFINE_WAIT(wait);

	pr_debug("%s\n", __func__);

1669 1670 1671
	/* cancel uncache work */
	cancel_delayed_work_sync(&fwc->work);

1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682
	/*
	 * use small loading timeout for caching devices' firmware
	 * because all these firmware images have been loaded
	 * successfully at lease once, also system is ready for
	 * completing firmware loading now. The maximum size of
	 * firmware in current distributions is about 2M bytes,
	 * so 10 secs should be enough.
	 */
	old_timeout = loading_timeout;
	loading_timeout = 10;

1683 1684
	mutex_lock(&fw_lock);
	fwc->state = FW_LOADER_START_CACHE;
1685
	dpm_for_each_dev(NULL, dev_cache_fw_image);
1686
	mutex_unlock(&fw_lock);
1687 1688

	/* wait for completion of caching firmware for all devices */
1689
	async_synchronize_full_domain(&fw_cache_domain);
1690 1691

	loading_timeout = old_timeout;
1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719
}

/**
 * device_uncache_fw_images - uncache devices' firmware
 *
 * uncache all firmwares which have been cached successfully
 * by device_uncache_fw_images earlier
 */
static void device_uncache_fw_images(void)
{
	pr_debug("%s\n", __func__);
	__device_uncache_fw_images();
}

static void device_uncache_fw_images_work(struct work_struct *work)
{
	device_uncache_fw_images();
}

/**
 * device_uncache_fw_images_delay - uncache devices firmwares
 * @delay: number of milliseconds to delay uncache device firmwares
 *
 * uncache all devices's firmwares which has been cached successfully
 * by device_cache_fw_images after @delay milliseconds.
 */
static void device_uncache_fw_images_delay(unsigned long delay)
{
1720 1721
	queue_delayed_work(system_power_efficient_wq, &fw_cache.work,
			   msecs_to_jiffies(delay));
1722 1723
}

1724 1725 1726 1727 1728 1729
static int fw_pm_notify(struct notifier_block *notify_block,
			unsigned long mode, void *unused)
{
	switch (mode) {
	case PM_HIBERNATION_PREPARE:
	case PM_SUSPEND_PREPARE:
1730
	case PM_RESTORE_PREPARE:
1731
		kill_requests_without_uevent();
1732 1733 1734 1735 1736 1737
		device_cache_fw_images();
		break;

	case PM_POST_SUSPEND:
	case PM_POST_HIBERNATION:
	case PM_POST_RESTORE:
1738 1739 1740 1741 1742 1743 1744 1745
		/*
		 * In case that system sleep failed and syscore_suspend is
		 * not called.
		 */
		mutex_lock(&fw_lock);
		fw_cache.state = FW_LOADER_NO_CACHE;
		mutex_unlock(&fw_lock);

1746 1747 1748 1749 1750 1751 1752
		device_uncache_fw_images_delay(10 * MSEC_PER_SEC);
		break;
	}

	return 0;
}

1753 1754 1755 1756 1757 1758 1759 1760 1761 1762
/* stop caching firmware once syscore_suspend is reached */
static int fw_suspend(void)
{
	fw_cache.state = FW_LOADER_NO_CACHE;
	return 0;
}

static struct syscore_ops fw_syscore_ops = {
	.suspend = fw_suspend,
};
1763 1764 1765 1766 1767 1768
#else
static int fw_cache_piggyback_on_request(const char *name)
{
	return 0;
}
#endif
1769

1770 1771 1772 1773
static void __init fw_cache_init(void)
{
	spin_lock_init(&fw_cache.lock);
	INIT_LIST_HEAD(&fw_cache.head);
1774
	fw_cache.state = FW_LOADER_NO_CACHE;
1775

1776
#ifdef CONFIG_PM_SLEEP
1777 1778 1779 1780 1781
	spin_lock_init(&fw_cache.name_lock);
	INIT_LIST_HEAD(&fw_cache.fw_names);

	INIT_DELAYED_WORK(&fw_cache.work,
			  device_uncache_fw_images_work);
1782 1783 1784

	fw_cache.pm_notify.notifier_call = fw_pm_notify;
	register_pm_notifier(&fw_cache.pm_notify);
1785 1786

	register_syscore_ops(&fw_syscore_ops);
1787
#endif
1788 1789
}

1790
static int __init firmware_class_init(void)
L
Linus Torvalds 已提交
1791
{
1792
	fw_cache_init();
1793
#ifdef CONFIG_FW_LOADER_USER_HELPER
1794
	register_reboot_notifier(&fw_shutdown_nb);
1795
	return class_register(&firmware_class);
1796 1797 1798
#else
	return 0;
#endif
L
Linus Torvalds 已提交
1799
}
1800 1801

static void __exit firmware_class_exit(void)
L
Linus Torvalds 已提交
1802
{
1803
#ifdef CONFIG_PM_SLEEP
1804
	unregister_syscore_ops(&fw_syscore_ops);
1805
	unregister_pm_notifier(&fw_cache.pm_notify);
1806
#endif
1807
#ifdef CONFIG_FW_LOADER_USER_HELPER
1808
	unregister_reboot_notifier(&fw_shutdown_nb);
L
Linus Torvalds 已提交
1809
	class_unregister(&firmware_class);
1810
#endif
L
Linus Torvalds 已提交
1811 1812
}

1813
fs_initcall(firmware_class_init);
L
Linus Torvalds 已提交
1814
module_exit(firmware_class_exit);