1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * drivers/base/power/wakeup.c - System wakeup events framework
   4 *
   5 * Copyright (c) 2010 Rafael J. Wysocki <rjw@sisk.pl>, Novell Inc.
 
 
   6 */
   7#define pr_fmt(fmt) "PM: " fmt
   8
   9#include <linux/device.h>
  10#include <linux/slab.h>
  11#include <linux/sched/signal.h>
  12#include <linux/capability.h>
  13#include <linux/export.h>
  14#include <linux/suspend.h>
  15#include <linux/seq_file.h>
  16#include <linux/debugfs.h>
  17#include <linux/pm_wakeirq.h>
  18#include <trace/events/power.h>
  19
  20#include "power.h"
  21
  22#ifndef CONFIG_SUSPEND
  23suspend_state_t pm_suspend_target_state;
  24#define pm_suspend_target_state	(PM_SUSPEND_ON)
  25#endif
  26
  27#define list_for_each_entry_rcu_locked(pos, head, member) \
  28	list_for_each_entry_rcu(pos, head, member, \
  29		srcu_read_lock_held(&wakeup_srcu))
  30/*
  31 * If set, the suspend/hibernate code will abort transitions to a sleep state
  32 * if wakeup events are registered during or immediately before the transition.
  33 */
  34bool events_check_enabled __read_mostly;
  35
  36/* First wakeup IRQ seen by the kernel in the last cycle. */
  37unsigned int pm_wakeup_irq __read_mostly;
  38
  39/* If greater than 0 and the system is suspending, terminate the suspend. */
  40static atomic_t pm_abort_suspend __read_mostly;
  41
  42/*
  43 * Combined counters of registered wakeup events and wakeup events in progress.
  44 * They need to be modified together atomically, so it's better to use one
  45 * atomic variable to hold them both.
  46 */
  47static atomic_t combined_event_count = ATOMIC_INIT(0);
  48
  49#define IN_PROGRESS_BITS	(sizeof(int) * 4)
  50#define MAX_IN_PROGRESS		((1 << IN_PROGRESS_BITS) - 1)
  51
  52static void split_counters(unsigned int *cnt, unsigned int *inpr)
  53{
  54	unsigned int comb = atomic_read(&combined_event_count);
  55
  56	*cnt = (comb >> IN_PROGRESS_BITS);
  57	*inpr = comb & MAX_IN_PROGRESS;
  58}
  59
  60/* A preserved old value of the events counter. */
  61static unsigned int saved_count;
  62
  63static DEFINE_RAW_SPINLOCK(events_lock);
  64
  65static void pm_wakeup_timer_fn(struct timer_list *t);
  66
  67static LIST_HEAD(wakeup_sources);
  68
  69static DECLARE_WAIT_QUEUE_HEAD(wakeup_count_wait_queue);
  70
  71DEFINE_STATIC_SRCU(wakeup_srcu);
  72
  73static struct wakeup_source deleted_ws = {
  74	.name = "deleted",
  75	.lock =  __SPIN_LOCK_UNLOCKED(deleted_ws.lock),
  76};
  77
  78static DEFINE_IDA(wakeup_ida);
  79
  80/**
  81 * wakeup_source_create - Create a struct wakeup_source object.
  82 * @name: Name of the new wakeup source.
  83 */
  84struct wakeup_source *wakeup_source_create(const char *name)
  85{
  86	struct wakeup_source *ws;
  87	const char *ws_name;
  88	int id;
  89
  90	ws = kzalloc(sizeof(*ws), GFP_KERNEL);
  91	if (!ws)
  92		goto err_ws;
  93
  94	ws_name = kstrdup_const(name, GFP_KERNEL);
  95	if (!ws_name)
  96		goto err_name;
  97	ws->name = ws_name;
  98
  99	id = ida_alloc(&wakeup_ida, GFP_KERNEL);
 100	if (id < 0)
 101		goto err_id;
 102	ws->id = id;
 103
 104	return ws;
 105
 106err_id:
 107	kfree_const(ws->name);
 108err_name:
 109	kfree(ws);
 110err_ws:
 111	return NULL;
 112}
 113EXPORT_SYMBOL_GPL(wakeup_source_create);
 114
 115/*
 116 * Record wakeup_source statistics being deleted into a dummy wakeup_source.
 117 */
 118static void wakeup_source_record(struct wakeup_source *ws)
 119{
 120	unsigned long flags;
 121
 122	spin_lock_irqsave(&deleted_ws.lock, flags);
 123
 124	if (ws->event_count) {
 125		deleted_ws.total_time =
 126			ktime_add(deleted_ws.total_time, ws->total_time);
 127		deleted_ws.prevent_sleep_time =
 128			ktime_add(deleted_ws.prevent_sleep_time,
 129				  ws->prevent_sleep_time);
 130		deleted_ws.max_time =
 131			ktime_compare(deleted_ws.max_time, ws->max_time) > 0 ?
 132				deleted_ws.max_time : ws->max_time;
 133		deleted_ws.event_count += ws->event_count;
 134		deleted_ws.active_count += ws->active_count;
 135		deleted_ws.relax_count += ws->relax_count;
 136		deleted_ws.expire_count += ws->expire_count;
 137		deleted_ws.wakeup_count += ws->wakeup_count;
 138	}
 139
 140	spin_unlock_irqrestore(&deleted_ws.lock, flags);
 141}
 142
 143static void wakeup_source_free(struct wakeup_source *ws)
 144{
 145	ida_free(&wakeup_ida, ws->id);
 146	kfree_const(ws->name);
 147	kfree(ws);
 148}
 149
 150/**
 151 * wakeup_source_destroy - Destroy a struct wakeup_source object.
 152 * @ws: Wakeup source to destroy.
 153 *
 154 * Use only for wakeup source objects created with wakeup_source_create().
 155 */
 156void wakeup_source_destroy(struct wakeup_source *ws)
 157{
 158	if (!ws)
 159		return;
 160
 161	__pm_relax(ws);
 162	wakeup_source_record(ws);
 163	wakeup_source_free(ws);
 
 
 
 
 
 
 
 
 
 164}
 165EXPORT_SYMBOL_GPL(wakeup_source_destroy);
 166
 167/**
 168 * wakeup_source_add - Add given object to the list of wakeup sources.
 169 * @ws: Wakeup source object to add to the list.
 170 */
 171void wakeup_source_add(struct wakeup_source *ws)
 172{
 173	unsigned long flags;
 174
 175	if (WARN_ON(!ws))
 176		return;
 177
 178	spin_lock_init(&ws->lock);
 179	timer_setup(&ws->timer, pm_wakeup_timer_fn, 0);
 180	ws->active = false;
 181
 182	raw_spin_lock_irqsave(&events_lock, flags);
 183	list_add_rcu(&ws->entry, &wakeup_sources);
 184	raw_spin_unlock_irqrestore(&events_lock, flags);
 185}
 186EXPORT_SYMBOL_GPL(wakeup_source_add);
 187
 188/**
 189 * wakeup_source_remove - Remove given object from the wakeup sources list.
 190 * @ws: Wakeup source object to remove from the list.
 191 */
 192void wakeup_source_remove(struct wakeup_source *ws)
 193{
 194	unsigned long flags;
 195
 196	if (WARN_ON(!ws))
 197		return;
 198
 199	raw_spin_lock_irqsave(&events_lock, flags);
 200	list_del_rcu(&ws->entry);
 201	raw_spin_unlock_irqrestore(&events_lock, flags);
 202	synchronize_srcu(&wakeup_srcu);
 203
 204	del_timer_sync(&ws->timer);
 205	/*
 206	 * Clear timer.function to make wakeup_source_not_registered() treat
 207	 * this wakeup source as not registered.
 208	 */
 209	ws->timer.function = NULL;
 210}
 211EXPORT_SYMBOL_GPL(wakeup_source_remove);
 212
 213/**
 214 * wakeup_source_register - Create wakeup source and add it to the list.
 215 * @dev: Device this wakeup source is associated with (or NULL if virtual).
 216 * @name: Name of the wakeup source to register.
 217 */
 218struct wakeup_source *wakeup_source_register(struct device *dev,
 219					     const char *name)
 220{
 221	struct wakeup_source *ws;
 222	int ret;
 223
 224	ws = wakeup_source_create(name);
 225	if (ws) {
 226		if (!dev || device_is_registered(dev)) {
 227			ret = wakeup_source_sysfs_add(dev, ws);
 228			if (ret) {
 229				wakeup_source_free(ws);
 230				return NULL;
 231			}
 232		}
 233		wakeup_source_add(ws);
 234	}
 235	return ws;
 236}
 237EXPORT_SYMBOL_GPL(wakeup_source_register);
 238
 239/**
 240 * wakeup_source_unregister - Remove wakeup source from the list and remove it.
 241 * @ws: Wakeup source object to unregister.
 242 */
 243void wakeup_source_unregister(struct wakeup_source *ws)
 244{
 245	if (ws) {
 246		wakeup_source_remove(ws);
 247		if (ws->dev)
 248			wakeup_source_sysfs_remove(ws);
 249
 250		wakeup_source_destroy(ws);
 251	}
 252}
 253EXPORT_SYMBOL_GPL(wakeup_source_unregister);
 254
 255/**
 256 * wakeup_sources_read_lock - Lock wakeup source list for read.
 257 *
 258 * Returns an index of srcu lock for struct wakeup_srcu.
 259 * This index must be passed to the matching wakeup_sources_read_unlock().
 260 */
 261int wakeup_sources_read_lock(void)
 262{
 263	return srcu_read_lock(&wakeup_srcu);
 264}
 265EXPORT_SYMBOL_GPL(wakeup_sources_read_lock);
 266
 267/**
 268 * wakeup_sources_read_unlock - Unlock wakeup source list.
 269 * @idx: return value from corresponding wakeup_sources_read_lock()
 270 */
 271void wakeup_sources_read_unlock(int idx)
 272{
 273	srcu_read_unlock(&wakeup_srcu, idx);
 274}
 275EXPORT_SYMBOL_GPL(wakeup_sources_read_unlock);
 276
 277/**
 278 * wakeup_sources_walk_start - Begin a walk on wakeup source list
 279 *
 280 * Returns first object of the list of wakeup sources.
 281 *
 282 * Note that to be safe, wakeup sources list needs to be locked by calling
 283 * wakeup_source_read_lock() for this.
 284 */
 285struct wakeup_source *wakeup_sources_walk_start(void)
 286{
 287	struct list_head *ws_head = &wakeup_sources;
 288
 289	return list_entry_rcu(ws_head->next, struct wakeup_source, entry);
 290}
 291EXPORT_SYMBOL_GPL(wakeup_sources_walk_start);
 292
 293/**
 294 * wakeup_sources_walk_next - Get next wakeup source from the list
 295 * @ws: Previous wakeup source object
 296 *
 297 * Note that to be safe, wakeup sources list needs to be locked by calling
 298 * wakeup_source_read_lock() for this.
 299 */
 300struct wakeup_source *wakeup_sources_walk_next(struct wakeup_source *ws)
 301{
 302	struct list_head *ws_head = &wakeup_sources;
 303
 304	return list_next_or_null_rcu(ws_head, &ws->entry,
 305				struct wakeup_source, entry);
 306}
 307EXPORT_SYMBOL_GPL(wakeup_sources_walk_next);
 308
 309/**
 310 * device_wakeup_attach - Attach a wakeup source object to a device object.
 311 * @dev: Device to handle.
 312 * @ws: Wakeup source object to attach to @dev.
 313 *
 314 * This causes @dev to be treated as a wakeup device.
 315 */
 316static int device_wakeup_attach(struct device *dev, struct wakeup_source *ws)
 317{
 318	spin_lock_irq(&dev->power.lock);
 319	if (dev->power.wakeup) {
 320		spin_unlock_irq(&dev->power.lock);
 321		return -EEXIST;
 322	}
 323	dev->power.wakeup = ws;
 324	if (dev->power.wakeirq)
 325		device_wakeup_attach_irq(dev, dev->power.wakeirq);
 326	spin_unlock_irq(&dev->power.lock);
 327	return 0;
 328}
 329
 330/**
 331 * device_wakeup_enable - Enable given device to be a wakeup source.
 332 * @dev: Device to handle.
 333 *
 334 * Create a wakeup source object, register it and attach it to @dev.
 335 */
 336int device_wakeup_enable(struct device *dev)
 337{
 338	struct wakeup_source *ws;
 339	int ret;
 340
 341	if (!dev || !dev->power.can_wakeup)
 342		return -EINVAL;
 343
 344	if (pm_suspend_target_state != PM_SUSPEND_ON)
 345		dev_dbg(dev, "Suspicious %s() during system transition!\n", __func__);
 346
 347	ws = wakeup_source_register(dev, dev_name(dev));
 348	if (!ws)
 349		return -ENOMEM;
 350
 351	ret = device_wakeup_attach(dev, ws);
 352	if (ret)
 353		wakeup_source_unregister(ws);
 354
 355	return ret;
 356}
 357EXPORT_SYMBOL_GPL(device_wakeup_enable);
 358
 359/**
 360 * device_wakeup_attach_irq - Attach a wakeirq to a wakeup source
 361 * @dev: Device to handle
 362 * @wakeirq: Device specific wakeirq entry
 363 *
 364 * Attach a device wakeirq to the wakeup source so the device
 365 * wake IRQ can be configured automatically for suspend and
 366 * resume.
 367 *
 368 * Call under the device's power.lock lock.
 369 */
 370void device_wakeup_attach_irq(struct device *dev,
 371			     struct wake_irq *wakeirq)
 372{
 373	struct wakeup_source *ws;
 374
 375	ws = dev->power.wakeup;
 376	if (!ws)
 377		return;
 378
 379	if (ws->wakeirq)
 380		dev_err(dev, "Leftover wakeup IRQ found, overriding\n");
 381
 382	ws->wakeirq = wakeirq;
 383}
 384
 385/**
 386 * device_wakeup_detach_irq - Detach a wakeirq from a wakeup source
 387 * @dev: Device to handle
 388 *
 389 * Removes a device wakeirq from the wakeup source.
 390 *
 391 * Call under the device's power.lock lock.
 392 */
 393void device_wakeup_detach_irq(struct device *dev)
 394{
 395	struct wakeup_source *ws;
 396
 397	ws = dev->power.wakeup;
 398	if (ws)
 399		ws->wakeirq = NULL;
 400}
 401
 402/**
 403 * device_wakeup_arm_wake_irqs -
 404 *
 405 * Iterates over the list of device wakeirqs to arm them.
 406 */
 407void device_wakeup_arm_wake_irqs(void)
 408{
 409	struct wakeup_source *ws;
 410	int srcuidx;
 411
 412	srcuidx = srcu_read_lock(&wakeup_srcu);
 413	list_for_each_entry_rcu_locked(ws, &wakeup_sources, entry)
 414		dev_pm_arm_wake_irq(ws->wakeirq);
 415	srcu_read_unlock(&wakeup_srcu, srcuidx);
 416}
 417
 418/**
 419 * device_wakeup_disarm_wake_irqs -
 420 *
 421 * Iterates over the list of device wakeirqs to disarm them.
 422 */
 423void device_wakeup_disarm_wake_irqs(void)
 424{
 425	struct wakeup_source *ws;
 426	int srcuidx;
 427
 428	srcuidx = srcu_read_lock(&wakeup_srcu);
 429	list_for_each_entry_rcu_locked(ws, &wakeup_sources, entry)
 430		dev_pm_disarm_wake_irq(ws->wakeirq);
 431	srcu_read_unlock(&wakeup_srcu, srcuidx);
 432}
 433
 434/**
 435 * device_wakeup_detach - Detach a device's wakeup source object from it.
 436 * @dev: Device to detach the wakeup source object from.
 437 *
 438 * After it returns, @dev will not be treated as a wakeup device any more.
 439 */
 440static struct wakeup_source *device_wakeup_detach(struct device *dev)
 441{
 442	struct wakeup_source *ws;
 443
 444	spin_lock_irq(&dev->power.lock);
 445	ws = dev->power.wakeup;
 446	dev->power.wakeup = NULL;
 447	spin_unlock_irq(&dev->power.lock);
 448	return ws;
 449}
 450
 451/**
 452 * device_wakeup_disable - Do not regard a device as a wakeup source any more.
 453 * @dev: Device to handle.
 454 *
 455 * Detach the @dev's wakeup source object from it, unregister this wakeup source
 456 * object and destroy it.
 457 */
 458int device_wakeup_disable(struct device *dev)
 459{
 460	struct wakeup_source *ws;
 461
 462	if (!dev || !dev->power.can_wakeup)
 463		return -EINVAL;
 464
 465	ws = device_wakeup_detach(dev);
 466	wakeup_source_unregister(ws);
 
 
 467	return 0;
 468}
 469EXPORT_SYMBOL_GPL(device_wakeup_disable);
 470
 471/**
 472 * device_set_wakeup_capable - Set/reset device wakeup capability flag.
 473 * @dev: Device to handle.
 474 * @capable: Whether or not @dev is capable of waking up the system from sleep.
 475 *
 476 * If @capable is set, set the @dev's power.can_wakeup flag and add its
 477 * wakeup-related attributes to sysfs.  Otherwise, unset the @dev's
 478 * power.can_wakeup flag and remove its wakeup-related attributes from sysfs.
 479 *
 480 * This function may sleep and it can't be called from any context where
 481 * sleeping is not allowed.
 482 */
 483void device_set_wakeup_capable(struct device *dev, bool capable)
 484{
 485	if (!!dev->power.can_wakeup == !!capable)
 486		return;
 487
 488	dev->power.can_wakeup = capable;
 489	if (device_is_registered(dev) && !list_empty(&dev->power.entry)) {
 490		if (capable) {
 491			int ret = wakeup_sysfs_add(dev);
 492
 493			if (ret)
 494				dev_info(dev, "Wakeup sysfs attributes not added\n");
 495		} else {
 496			wakeup_sysfs_remove(dev);
 497		}
 498	}
 
 499}
 500EXPORT_SYMBOL_GPL(device_set_wakeup_capable);
 501
 502/**
 503 * device_init_wakeup - Device wakeup initialization.
 504 * @dev: Device to handle.
 505 * @enable: Whether or not to enable @dev as a wakeup device.
 506 *
 507 * By default, most devices should leave wakeup disabled.  The exceptions are
 508 * devices that everyone expects to be wakeup sources: keyboards, power buttons,
 509 * possibly network interfaces, etc.  Also, devices that don't generate their
 510 * own wakeup requests but merely forward requests from one bus to another
 511 * (like PCI bridges) should have wakeup enabled by default.
 512 */
 513int device_init_wakeup(struct device *dev, bool enable)
 514{
 515	int ret = 0;
 516
 517	if (!dev)
 518		return -EINVAL;
 519
 520	if (enable) {
 521		device_set_wakeup_capable(dev, true);
 522		ret = device_wakeup_enable(dev);
 523	} else {
 524		device_wakeup_disable(dev);
 525		device_set_wakeup_capable(dev, false);
 526	}
 527
 528	return ret;
 529}
 530EXPORT_SYMBOL_GPL(device_init_wakeup);
 531
 532/**
 533 * device_set_wakeup_enable - Enable or disable a device to wake up the system.
 534 * @dev: Device to handle.
 535 * @enable: enable/disable flag
 536 */
 537int device_set_wakeup_enable(struct device *dev, bool enable)
 538{
 
 
 
 539	return enable ? device_wakeup_enable(dev) : device_wakeup_disable(dev);
 540}
 541EXPORT_SYMBOL_GPL(device_set_wakeup_enable);
 542
 543/**
 544 * wakeup_source_not_registered - validate the given wakeup source.
 545 * @ws: Wakeup source to be validated.
 546 */
 547static bool wakeup_source_not_registered(struct wakeup_source *ws)
 548{
 549	/*
 550	 * Use timer struct to check if the given source is initialized
 551	 * by wakeup_source_add.
 552	 */
 553	return ws->timer.function != pm_wakeup_timer_fn;
 554}
 555
 556/*
 557 * The functions below use the observation that each wakeup event starts a
 558 * period in which the system should not be suspended.  The moment this period
 559 * will end depends on how the wakeup event is going to be processed after being
 560 * detected and all of the possible cases can be divided into two distinct
 561 * groups.
 562 *
 563 * First, a wakeup event may be detected by the same functional unit that will
 564 * carry out the entire processing of it and possibly will pass it to user space
 565 * for further processing.  In that case the functional unit that has detected
 566 * the event may later "close" the "no suspend" period associated with it
 567 * directly as soon as it has been dealt with.  The pair of pm_stay_awake() and
 568 * pm_relax(), balanced with each other, is supposed to be used in such
 569 * situations.
 570 *
 571 * Second, a wakeup event may be detected by one functional unit and processed
 572 * by another one.  In that case the unit that has detected it cannot really
 573 * "close" the "no suspend" period associated with it, unless it knows in
 574 * advance what's going to happen to the event during processing.  This
 575 * knowledge, however, may not be available to it, so it can simply specify time
 576 * to wait before the system can be suspended and pass it as the second
 577 * argument of pm_wakeup_event().
 578 *
 579 * It is valid to call pm_relax() after pm_wakeup_event(), in which case the
 580 * "no suspend" period will be ended either by the pm_relax(), or by the timer
 581 * function executed when the timer expires, whichever comes first.
 582 */
 583
 584/**
 585 * wakeup_source_activate - Mark given wakeup source as active.
 586 * @ws: Wakeup source to handle.
 587 *
 588 * Update the @ws' statistics and, if @ws has just been activated, notify the PM
 589 * core of the event by incrementing the counter of of wakeup events being
 590 * processed.
 591 */
 592static void wakeup_source_activate(struct wakeup_source *ws)
 593{
 594	unsigned int cec;
 595
 596	if (WARN_ONCE(wakeup_source_not_registered(ws),
 597			"unregistered wakeup source\n"))
 598		return;
 599
 600	ws->active = true;
 601	ws->active_count++;
 
 602	ws->last_time = ktime_get();
 603	if (ws->autosleep_enabled)
 604		ws->start_prevent_time = ws->last_time;
 605
 606	/* Increment the counter of events in progress. */
 607	cec = atomic_inc_return(&combined_event_count);
 608
 609	trace_wakeup_source_activate(ws->name, cec);
 610}
 611
 612/**
 613 * wakeup_source_report_event - Report wakeup event using the given source.
 614 * @ws: Wakeup source to report the event for.
 615 * @hard: If set, abort suspends in progress and wake up from suspend-to-idle.
 616 */
 617static void wakeup_source_report_event(struct wakeup_source *ws, bool hard)
 618{
 619	ws->event_count++;
 620	/* This is racy, but the counter is approximate anyway. */
 621	if (events_check_enabled)
 622		ws->wakeup_count++;
 623
 624	if (!ws->active)
 625		wakeup_source_activate(ws);
 626
 627	if (hard)
 628		pm_system_wakeup();
 629}
 630
 631/**
 632 * __pm_stay_awake - Notify the PM core of a wakeup event.
 633 * @ws: Wakeup source object associated with the source of the event.
 634 *
 635 * It is safe to call this function from interrupt context.
 636 */
 637void __pm_stay_awake(struct wakeup_source *ws)
 638{
 639	unsigned long flags;
 640
 641	if (!ws)
 642		return;
 643
 644	spin_lock_irqsave(&ws->lock, flags);
 645
 646	wakeup_source_report_event(ws, false);
 647	del_timer(&ws->timer);
 648	ws->timer_expires = 0;
 649
 650	spin_unlock_irqrestore(&ws->lock, flags);
 651}
 652EXPORT_SYMBOL_GPL(__pm_stay_awake);
 653
 654/**
 655 * pm_stay_awake - Notify the PM core that a wakeup event is being processed.
 656 * @dev: Device the wakeup event is related to.
 657 *
 658 * Notify the PM core of a wakeup event (signaled by @dev) by calling
 659 * __pm_stay_awake for the @dev's wakeup source object.
 660 *
 661 * Call this function after detecting of a wakeup event if pm_relax() is going
 662 * to be called directly after processing the event (and possibly passing it to
 663 * user space for further processing).
 664 */
 665void pm_stay_awake(struct device *dev)
 666{
 667	unsigned long flags;
 668
 669	if (!dev)
 670		return;
 671
 672	spin_lock_irqsave(&dev->power.lock, flags);
 673	__pm_stay_awake(dev->power.wakeup);
 674	spin_unlock_irqrestore(&dev->power.lock, flags);
 675}
 676EXPORT_SYMBOL_GPL(pm_stay_awake);
 677
 678#ifdef CONFIG_PM_AUTOSLEEP
 679static void update_prevent_sleep_time(struct wakeup_source *ws, ktime_t now)
 680{
 681	ktime_t delta = ktime_sub(now, ws->start_prevent_time);
 682	ws->prevent_sleep_time = ktime_add(ws->prevent_sleep_time, delta);
 683}
 684#else
 685static inline void update_prevent_sleep_time(struct wakeup_source *ws,
 686					     ktime_t now) {}
 687#endif
 688
 689/**
 690 * wakeup_source_deactivate - Mark given wakeup source as inactive.
 691 * @ws: Wakeup source to handle.
 692 *
 693 * Update the @ws' statistics and notify the PM core that the wakeup source has
 694 * become inactive by decrementing the counter of wakeup events being processed
 695 * and incrementing the counter of registered wakeup events.
 696 */
 697static void wakeup_source_deactivate(struct wakeup_source *ws)
 698{
 699	unsigned int cnt, inpr, cec;
 700	ktime_t duration;
 701	ktime_t now;
 702
 703	ws->relax_count++;
 704	/*
 705	 * __pm_relax() may be called directly or from a timer function.
 706	 * If it is called directly right after the timer function has been
 707	 * started, but before the timer function calls __pm_relax(), it is
 708	 * possible that __pm_stay_awake() will be called in the meantime and
 709	 * will set ws->active.  Then, ws->active may be cleared immediately
 710	 * by the __pm_relax() called from the timer function, but in such a
 711	 * case ws->relax_count will be different from ws->active_count.
 712	 */
 713	if (ws->relax_count != ws->active_count) {
 714		ws->relax_count--;
 715		return;
 716	}
 717
 718	ws->active = false;
 719
 720	now = ktime_get();
 721	duration = ktime_sub(now, ws->last_time);
 722	ws->total_time = ktime_add(ws->total_time, duration);
 723	if (ktime_to_ns(duration) > ktime_to_ns(ws->max_time))
 724		ws->max_time = duration;
 725
 726	ws->last_time = now;
 727	del_timer(&ws->timer);
 728	ws->timer_expires = 0;
 729
 730	if (ws->autosleep_enabled)
 731		update_prevent_sleep_time(ws, now);
 732
 733	/*
 734	 * Increment the counter of registered wakeup events and decrement the
 735	 * couter of wakeup events in progress simultaneously.
 736	 */
 737	cec = atomic_add_return(MAX_IN_PROGRESS, &combined_event_count);
 738	trace_wakeup_source_deactivate(ws->name, cec);
 739
 740	split_counters(&cnt, &inpr);
 741	if (!inpr && waitqueue_active(&wakeup_count_wait_queue))
 742		wake_up(&wakeup_count_wait_queue);
 743}
 744
 745/**
 746 * __pm_relax - Notify the PM core that processing of a wakeup event has ended.
 747 * @ws: Wakeup source object associated with the source of the event.
 748 *
 749 * Call this function for wakeup events whose processing started with calling
 750 * __pm_stay_awake().
 751 *
 752 * It is safe to call it from interrupt context.
 753 */
 754void __pm_relax(struct wakeup_source *ws)
 755{
 756	unsigned long flags;
 757
 758	if (!ws)
 759		return;
 760
 761	spin_lock_irqsave(&ws->lock, flags);
 762	if (ws->active)
 763		wakeup_source_deactivate(ws);
 764	spin_unlock_irqrestore(&ws->lock, flags);
 765}
 766EXPORT_SYMBOL_GPL(__pm_relax);
 767
 768/**
 769 * pm_relax - Notify the PM core that processing of a wakeup event has ended.
 770 * @dev: Device that signaled the event.
 771 *
 772 * Execute __pm_relax() for the @dev's wakeup source object.
 773 */
 774void pm_relax(struct device *dev)
 775{
 776	unsigned long flags;
 777
 778	if (!dev)
 779		return;
 780
 781	spin_lock_irqsave(&dev->power.lock, flags);
 782	__pm_relax(dev->power.wakeup);
 783	spin_unlock_irqrestore(&dev->power.lock, flags);
 784}
 785EXPORT_SYMBOL_GPL(pm_relax);
 786
 787/**
 788 * pm_wakeup_timer_fn - Delayed finalization of a wakeup event.
 789 * @t: timer list
 790 *
 791 * Call wakeup_source_deactivate() for the wakeup source whose address is stored
 792 * in @data if it is currently active and its timer has not been canceled and
 793 * the expiration time of the timer is not in future.
 794 */
 795static void pm_wakeup_timer_fn(struct timer_list *t)
 796{
 797	struct wakeup_source *ws = from_timer(ws, t, timer);
 798	unsigned long flags;
 799
 800	spin_lock_irqsave(&ws->lock, flags);
 801
 802	if (ws->active && ws->timer_expires
 803	    && time_after_eq(jiffies, ws->timer_expires)) {
 804		wakeup_source_deactivate(ws);
 805		ws->expire_count++;
 806	}
 807
 808	spin_unlock_irqrestore(&ws->lock, flags);
 809}
 810
 811/**
 812 * pm_wakeup_ws_event - Notify the PM core of a wakeup event.
 813 * @ws: Wakeup source object associated with the event source.
 814 * @msec: Anticipated event processing time (in milliseconds).
 815 * @hard: If set, abort suspends in progress and wake up from suspend-to-idle.
 816 *
 817 * Notify the PM core of a wakeup event whose source is @ws that will take
 818 * approximately @msec milliseconds to be processed by the kernel.  If @ws is
 819 * not active, activate it.  If @msec is nonzero, set up the @ws' timer to
 820 * execute pm_wakeup_timer_fn() in future.
 821 *
 822 * It is safe to call this function from interrupt context.
 823 */
 824void pm_wakeup_ws_event(struct wakeup_source *ws, unsigned int msec, bool hard)
 825{
 826	unsigned long flags;
 827	unsigned long expires;
 828
 829	if (!ws)
 830		return;
 831
 832	spin_lock_irqsave(&ws->lock, flags);
 833
 834	wakeup_source_report_event(ws, hard);
 
 
 835
 836	if (!msec) {
 837		wakeup_source_deactivate(ws);
 838		goto unlock;
 839	}
 840
 841	expires = jiffies + msecs_to_jiffies(msec);
 842	if (!expires)
 843		expires = 1;
 844
 845	if (!ws->timer_expires || time_after(expires, ws->timer_expires)) {
 846		mod_timer(&ws->timer, expires);
 847		ws->timer_expires = expires;
 848	}
 849
 850 unlock:
 851	spin_unlock_irqrestore(&ws->lock, flags);
 852}
 853EXPORT_SYMBOL_GPL(pm_wakeup_ws_event);
 
 854
 855/**
 856 * pm_wakeup_dev_event - Notify the PM core of a wakeup event.
 857 * @dev: Device the wakeup event is related to.
 858 * @msec: Anticipated event processing time (in milliseconds).
 859 * @hard: If set, abort suspends in progress and wake up from suspend-to-idle.
 860 *
 861 * Call pm_wakeup_ws_event() for the @dev's wakeup source object.
 862 */
 863void pm_wakeup_dev_event(struct device *dev, unsigned int msec, bool hard)
 864{
 865	unsigned long flags;
 866
 867	if (!dev)
 868		return;
 869
 870	spin_lock_irqsave(&dev->power.lock, flags);
 871	pm_wakeup_ws_event(dev->power.wakeup, msec, hard);
 872	spin_unlock_irqrestore(&dev->power.lock, flags);
 873}
 874EXPORT_SYMBOL_GPL(pm_wakeup_dev_event);
 875
 876void pm_print_active_wakeup_sources(void)
 
 
 
 877{
 
 878	struct wakeup_source *ws;
 879	int srcuidx, active = 0;
 880	struct wakeup_source *last_activity_ws = NULL;
 881
 882	srcuidx = srcu_read_lock(&wakeup_srcu);
 883	list_for_each_entry_rcu_locked(ws, &wakeup_sources, entry) {
 884		if (ws->active) {
 885			pm_pr_dbg("active wakeup source: %s\n", ws->name);
 886			active = 1;
 887		} else if (!active &&
 888			   (!last_activity_ws ||
 889			    ktime_to_ns(ws->last_time) >
 890			    ktime_to_ns(last_activity_ws->last_time))) {
 891			last_activity_ws = ws;
 892		}
 893	}
 894
 895	if (!active && last_activity_ws)
 896		pm_pr_dbg("last active wakeup source: %s\n",
 897			last_activity_ws->name);
 898	srcu_read_unlock(&wakeup_srcu, srcuidx);
 899}
 900EXPORT_SYMBOL_GPL(pm_print_active_wakeup_sources);
 901
 902/**
 903 * pm_wakeup_pending - Check if power transition in progress should be aborted.
 904 *
 905 * Compare the current number of registered wakeup events with its preserved
 906 * value from the past and return true if new wakeup events have been registered
 907 * since the old value was stored.  Also return true if the current number of
 908 * wakeup events being processed is different from zero.
 909 */
 910bool pm_wakeup_pending(void)
 911{
 912	unsigned long flags;
 913	bool ret = false;
 914
 915	raw_spin_lock_irqsave(&events_lock, flags);
 916	if (events_check_enabled) {
 917		unsigned int cnt, inpr;
 918
 919		split_counters(&cnt, &inpr);
 920		ret = (cnt != saved_count || inpr > 0);
 921		events_check_enabled = !ret;
 922	}
 923	raw_spin_unlock_irqrestore(&events_lock, flags);
 924
 925	if (ret) {
 926		pm_pr_dbg("Wakeup pending, aborting suspend\n");
 927		pm_print_active_wakeup_sources();
 928	}
 929
 930	return ret || atomic_read(&pm_abort_suspend) > 0;
 931}
 932
 933void pm_system_wakeup(void)
 934{
 935	atomic_inc(&pm_abort_suspend);
 936	s2idle_wake();
 937}
 938EXPORT_SYMBOL_GPL(pm_system_wakeup);
 939
 940void pm_system_cancel_wakeup(void)
 941{
 942	atomic_dec_if_positive(&pm_abort_suspend);
 943}
 944
 945void pm_wakeup_clear(bool reset)
 946{
 947	pm_wakeup_irq = 0;
 948	if (reset)
 949		atomic_set(&pm_abort_suspend, 0);
 950}
 951
 952void pm_system_irq_wakeup(unsigned int irq_number)
 953{
 954	if (pm_wakeup_irq == 0) {
 955		pm_wakeup_irq = irq_number;
 956		pm_system_wakeup();
 957	}
 958}
 959
 960/**
 961 * pm_get_wakeup_count - Read the number of registered wakeup events.
 962 * @count: Address to store the value at.
 963 * @block: Whether or not to block.
 964 *
 965 * Store the number of registered wakeup events at the address in @count.  If
 966 * @block is set, block until the current number of wakeup events being
 967 * processed is zero.
 968 *
 969 * Return 'false' if the current number of wakeup events being processed is
 970 * nonzero.  Otherwise return 'true'.
 
 971 */
 972bool pm_get_wakeup_count(unsigned int *count, bool block)
 973{
 974	unsigned int cnt, inpr;
 975
 976	if (block) {
 977		DEFINE_WAIT(wait);
 978
 979		for (;;) {
 980			prepare_to_wait(&wakeup_count_wait_queue, &wait,
 981					TASK_INTERRUPTIBLE);
 982			split_counters(&cnt, &inpr);
 983			if (inpr == 0 || signal_pending(current))
 984				break;
 985			pm_print_active_wakeup_sources();
 986			schedule();
 987		}
 988		finish_wait(&wakeup_count_wait_queue, &wait);
 989	}
 990
 991	split_counters(&cnt, &inpr);
 992	*count = cnt;
 993	return !inpr;
 994}
 995
 996/**
 997 * pm_save_wakeup_count - Save the current number of registered wakeup events.
 998 * @count: Value to compare with the current number of registered wakeup events.
 999 *
1000 * If @count is equal to the current number of registered wakeup events and the
1001 * current number of wakeup events being processed is zero, store @count as the
1002 * old number of registered wakeup events for pm_check_wakeup_events(), enable
1003 * wakeup events detection and return 'true'.  Otherwise disable wakeup events
1004 * detection and return 'false'.
1005 */
1006bool pm_save_wakeup_count(unsigned int count)
1007{
1008	unsigned int cnt, inpr;
1009	unsigned long flags;
1010
1011	events_check_enabled = false;
1012	raw_spin_lock_irqsave(&events_lock, flags);
1013	split_counters(&cnt, &inpr);
1014	if (cnt == count && inpr == 0) {
1015		saved_count = count;
1016		events_check_enabled = true;
1017	}
1018	raw_spin_unlock_irqrestore(&events_lock, flags);
 
 
1019	return events_check_enabled;
1020}
1021
1022#ifdef CONFIG_PM_AUTOSLEEP
1023/**
1024 * pm_wakep_autosleep_enabled - Modify autosleep_enabled for all wakeup sources.
1025 * @set: Whether to set or to clear the autosleep_enabled flags.
1026 */
1027void pm_wakep_autosleep_enabled(bool set)
1028{
1029	struct wakeup_source *ws;
1030	ktime_t now = ktime_get();
1031	int srcuidx;
1032
1033	srcuidx = srcu_read_lock(&wakeup_srcu);
1034	list_for_each_entry_rcu_locked(ws, &wakeup_sources, entry) {
1035		spin_lock_irq(&ws->lock);
1036		if (ws->autosleep_enabled != set) {
1037			ws->autosleep_enabled = set;
1038			if (ws->active) {
1039				if (set)
1040					ws->start_prevent_time = now;
1041				else
1042					update_prevent_sleep_time(ws, now);
1043			}
1044		}
1045		spin_unlock_irq(&ws->lock);
1046	}
1047	srcu_read_unlock(&wakeup_srcu, srcuidx);
1048}
1049#endif /* CONFIG_PM_AUTOSLEEP */
1050
1051/**
1052 * print_wakeup_source_stats - Print wakeup source statistics information.
1053 * @m: seq_file to print the statistics into.
1054 * @ws: Wakeup source object to print the statistics for.
1055 */
1056static int print_wakeup_source_stats(struct seq_file *m,
1057				     struct wakeup_source *ws)
1058{
1059	unsigned long flags;
1060	ktime_t total_time;
1061	ktime_t max_time;
1062	unsigned long active_count;
1063	ktime_t active_time;
1064	ktime_t prevent_sleep_time;
1065
1066	spin_lock_irqsave(&ws->lock, flags);
1067
1068	total_time = ws->total_time;
1069	max_time = ws->max_time;
1070	prevent_sleep_time = ws->prevent_sleep_time;
1071	active_count = ws->active_count;
1072	if (ws->active) {
1073		ktime_t now = ktime_get();
1074
1075		active_time = ktime_sub(now, ws->last_time);
1076		total_time = ktime_add(total_time, active_time);
1077		if (active_time > max_time)
1078			max_time = active_time;
1079
1080		if (ws->autosleep_enabled)
1081			prevent_sleep_time = ktime_add(prevent_sleep_time,
1082				ktime_sub(now, ws->start_prevent_time));
1083	} else {
1084		active_time = 0;
1085	}
1086
1087	seq_printf(m, "%-12s\t%lu\t\t%lu\t\t%lu\t\t%lu\t\t%lld\t\t%lld\t\t%lld\t\t%lld\t\t%lld\n",
1088		   ws->name, active_count, ws->event_count,
1089		   ws->wakeup_count, ws->expire_count,
1090		   ktime_to_ms(active_time), ktime_to_ms(total_time),
1091		   ktime_to_ms(max_time), ktime_to_ms(ws->last_time),
1092		   ktime_to_ms(prevent_sleep_time));
1093
1094	spin_unlock_irqrestore(&ws->lock, flags);
1095
1096	return 0;
1097}
1098
1099static void *wakeup_sources_stats_seq_start(struct seq_file *m,
1100					loff_t *pos)
1101{
1102	struct wakeup_source *ws;
1103	loff_t n = *pos;
1104	int *srcuidx = m->private;
1105
1106	if (n == 0) {
1107		seq_puts(m, "name\t\tactive_count\tevent_count\twakeup_count\t"
1108			"expire_count\tactive_since\ttotal_time\tmax_time\t"
1109			"last_change\tprevent_suspend_time\n");
1110	}
1111
1112	*srcuidx = srcu_read_lock(&wakeup_srcu);
1113	list_for_each_entry_rcu_locked(ws, &wakeup_sources, entry) {
1114		if (n-- <= 0)
1115			return ws;
1116	}
1117
1118	return NULL;
1119}
1120
1121static void *wakeup_sources_stats_seq_next(struct seq_file *m,
1122					void *v, loff_t *pos)
1123{
1124	struct wakeup_source *ws = v;
1125	struct wakeup_source *next_ws = NULL;
1126
1127	++(*pos);
1128
1129	list_for_each_entry_continue_rcu(ws, &wakeup_sources, entry) {
1130		next_ws = ws;
1131		break;
1132	}
1133
1134	if (!next_ws)
1135		print_wakeup_source_stats(m, &deleted_ws);
1136
1137	return next_ws;
1138}
1139
1140static void wakeup_sources_stats_seq_stop(struct seq_file *m, void *v)
1141{
1142	int *srcuidx = m->private;
1143
1144	srcu_read_unlock(&wakeup_srcu, *srcuidx);
1145}
1146
1147/**
1148 * wakeup_sources_stats_seq_show - Print wakeup sources statistics information.
1149 * @m: seq_file to print the statistics into.
1150 * @v: wakeup_source of each iteration
1151 */
1152static int wakeup_sources_stats_seq_show(struct seq_file *m, void *v)
1153{
1154	struct wakeup_source *ws = v;
1155
1156	print_wakeup_source_stats(m, ws);
 
 
 
 
 
 
1157
1158	return 0;
1159}
1160
1161static const struct seq_operations wakeup_sources_stats_seq_ops = {
1162	.start = wakeup_sources_stats_seq_start,
1163	.next  = wakeup_sources_stats_seq_next,
1164	.stop  = wakeup_sources_stats_seq_stop,
1165	.show  = wakeup_sources_stats_seq_show,
1166};
1167
1168static int wakeup_sources_stats_open(struct inode *inode, struct file *file)
1169{
1170	return seq_open_private(file, &wakeup_sources_stats_seq_ops, sizeof(int));
1171}
1172
1173static const struct file_operations wakeup_sources_stats_fops = {
1174	.owner = THIS_MODULE,
1175	.open = wakeup_sources_stats_open,
1176	.read = seq_read,
1177	.llseek = seq_lseek,
1178	.release = seq_release_private,
1179};
1180
1181static int __init wakeup_sources_debugfs_init(void)
1182{
1183	debugfs_create_file("wakeup_sources", S_IRUGO, NULL, NULL,
1184			    &wakeup_sources_stats_fops);
1185	return 0;
1186}
1187
1188postcore_initcall(wakeup_sources_debugfs_init);