autosleep.c (2692B)
1// SPDX-License-Identifier: GPL-2.0 2/* 3 * kernel/power/autosleep.c 4 * 5 * Opportunistic sleep support. 6 * 7 * Copyright (C) 2012 Rafael J. Wysocki <rjw@sisk.pl> 8 */ 9 10#include <linux/device.h> 11#include <linux/mutex.h> 12#include <linux/pm_wakeup.h> 13 14#include "power.h" 15 16static suspend_state_t autosleep_state; 17static struct workqueue_struct *autosleep_wq; 18/* 19 * Note: it is only safe to mutex_lock(&autosleep_lock) if a wakeup_source 20 * is active, otherwise a deadlock with try_to_suspend() is possible. 21 * Alternatively mutex_lock_interruptible() can be used. This will then fail 22 * if an auto_sleep cycle tries to freeze processes. 23 */ 24static DEFINE_MUTEX(autosleep_lock); 25static struct wakeup_source *autosleep_ws; 26 27static void try_to_suspend(struct work_struct *work) 28{ 29 unsigned int initial_count, final_count; 30 31 if (!pm_get_wakeup_count(&initial_count, true)) 32 goto out; 33 34 mutex_lock(&autosleep_lock); 35 36 if (!pm_save_wakeup_count(initial_count) || 37 system_state != SYSTEM_RUNNING) { 38 mutex_unlock(&autosleep_lock); 39 goto out; 40 } 41 42 if (autosleep_state == PM_SUSPEND_ON) { 43 mutex_unlock(&autosleep_lock); 44 return; 45 } 46 if (autosleep_state >= PM_SUSPEND_MAX) 47 hibernate(); 48 else 49 pm_suspend(autosleep_state); 50 51 mutex_unlock(&autosleep_lock); 52 53 if (!pm_get_wakeup_count(&final_count, false)) 54 goto out; 55 56 /* 57 * If the wakeup occurred for an unknown reason, wait to prevent the 58 * system from trying to suspend and waking up in a tight loop. 59 */ 60 if (final_count == initial_count) 61 schedule_timeout_uninterruptible(HZ / 2); 62 63 out: 64 queue_up_suspend_work(); 65} 66 67static DECLARE_WORK(suspend_work, try_to_suspend); 68 69void queue_up_suspend_work(void) 70{ 71 if (autosleep_state > PM_SUSPEND_ON) 72 queue_work(autosleep_wq, &suspend_work); 73} 74 75suspend_state_t pm_autosleep_state(void) 76{ 77 return autosleep_state; 78} 79 80int pm_autosleep_lock(void) 81{ 82 return mutex_lock_interruptible(&autosleep_lock); 83} 84 85void pm_autosleep_unlock(void) 86{ 87 mutex_unlock(&autosleep_lock); 88} 89 90int pm_autosleep_set_state(suspend_state_t state) 91{ 92 93#ifndef CONFIG_HIBERNATION 94 if (state >= PM_SUSPEND_MAX) 95 return -EINVAL; 96#endif 97 98 __pm_stay_awake(autosleep_ws); 99 100 mutex_lock(&autosleep_lock); 101 102 autosleep_state = state; 103 104 __pm_relax(autosleep_ws); 105 106 if (state > PM_SUSPEND_ON) { 107 pm_wakep_autosleep_enabled(true); 108 queue_up_suspend_work(); 109 } else { 110 pm_wakep_autosleep_enabled(false); 111 } 112 113 mutex_unlock(&autosleep_lock); 114 return 0; 115} 116 117int __init pm_autosleep_init(void) 118{ 119 autosleep_ws = wakeup_source_register(NULL, "autosleep"); 120 if (!autosleep_ws) 121 return -ENOMEM; 122 123 autosleep_wq = alloc_ordered_workqueue("autosleep", 0); 124 if (autosleep_wq) 125 return 0; 126 127 wakeup_source_unregister(autosleep_ws); 128 return -ENOMEM; 129}