247 строки
6.8 KiB
C
247 строки
6.8 KiB
C
/*
|
|
* pm.c - Power management interface
|
|
*
|
|
* Copyright (C) 2000 Andrew Henroid
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*/
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/pm_legacy.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/mutex.h>
|
|
|
|
int pm_active;
|
|
|
|
/*
|
|
* Locking notes:
|
|
* pm_devs_lock can be a semaphore providing pm ops are not called
|
|
* from an interrupt handler (already a bad idea so no change here). Each
|
|
* change must be protected so that an unlink of an entry doesn't clash
|
|
* with a pm send - which is permitted to sleep in the current architecture
|
|
*
|
|
* Module unloads clashing with pm events now work out safely, the module
|
|
* unload path will block until the event has been sent. It may well block
|
|
* until a resume but that will be fine.
|
|
*/
|
|
|
|
static DEFINE_MUTEX(pm_devs_lock);
|
|
static LIST_HEAD(pm_devs);
|
|
|
|
/**
|
|
* pm_register - register a device with power management
|
|
* @type: device type
|
|
* @id: device ID
|
|
* @callback: callback function
|
|
*
|
|
* Add a device to the list of devices that wish to be notified about
|
|
* power management events. A &pm_dev structure is returned on success,
|
|
* on failure the return is %NULL.
|
|
*
|
|
* The callback function will be called in process context and
|
|
* it may sleep.
|
|
*/
|
|
|
|
struct pm_dev *pm_register(pm_dev_t type,
|
|
unsigned long id,
|
|
pm_callback callback)
|
|
{
|
|
struct pm_dev *dev = kzalloc(sizeof(struct pm_dev), GFP_KERNEL);
|
|
if (dev) {
|
|
dev->type = type;
|
|
dev->id = id;
|
|
dev->callback = callback;
|
|
|
|
mutex_lock(&pm_devs_lock);
|
|
list_add(&dev->entry, &pm_devs);
|
|
mutex_unlock(&pm_devs_lock);
|
|
}
|
|
return dev;
|
|
}
|
|
|
|
static void __pm_unregister(struct pm_dev *dev)
|
|
{
|
|
if (dev) {
|
|
list_del(&dev->entry);
|
|
kfree(dev);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* pm_unregister_all - unregister all devices with matching callback
|
|
* @callback: callback function pointer
|
|
*
|
|
* Unregister every device that would call the callback passed. This
|
|
* is primarily meant as a helper function for loadable modules. It
|
|
* enables a module to give up all its managed devices without keeping
|
|
* its own private list.
|
|
*/
|
|
|
|
void pm_unregister_all(pm_callback callback)
|
|
{
|
|
struct list_head *entry;
|
|
|
|
if (!callback)
|
|
return;
|
|
|
|
mutex_lock(&pm_devs_lock);
|
|
entry = pm_devs.next;
|
|
while (entry != &pm_devs) {
|
|
struct pm_dev *dev = list_entry(entry, struct pm_dev, entry);
|
|
entry = entry->next;
|
|
if (dev->callback == callback)
|
|
__pm_unregister(dev);
|
|
}
|
|
mutex_unlock(&pm_devs_lock);
|
|
}
|
|
|
|
/**
|
|
* pm_send - send request to a single device
|
|
* @dev: device to send to
|
|
* @rqst: power management request
|
|
* @data: data for the callback
|
|
*
|
|
* Issue a power management request to a given device. The
|
|
* %PM_SUSPEND and %PM_RESUME events are handled specially. The
|
|
* data field must hold the intended next state. No call is made
|
|
* if the state matches.
|
|
*
|
|
* BUGS: what stops two power management requests occurring in parallel
|
|
* and conflicting.
|
|
*
|
|
* WARNING: Calling pm_send directly is not generally recommended, in
|
|
* particular there is no locking against the pm_dev going away. The
|
|
* caller must maintain all needed locking or have 'inside knowledge'
|
|
* on the safety. Also remember that this function is not locked against
|
|
* pm_unregister. This means that you must handle SMP races on callback
|
|
* execution and unload yourself.
|
|
*/
|
|
|
|
static int pm_send(struct pm_dev *dev, pm_request_t rqst, void *data)
|
|
{
|
|
int status = 0;
|
|
unsigned long prev_state, next_state;
|
|
|
|
if (in_interrupt())
|
|
BUG();
|
|
|
|
switch (rqst) {
|
|
case PM_SUSPEND:
|
|
case PM_RESUME:
|
|
prev_state = dev->state;
|
|
next_state = (unsigned long) data;
|
|
if (prev_state != next_state) {
|
|
if (dev->callback)
|
|
status = (*dev->callback)(dev, rqst, data);
|
|
if (!status) {
|
|
dev->state = next_state;
|
|
dev->prev_state = prev_state;
|
|
}
|
|
}
|
|
else {
|
|
dev->prev_state = prev_state;
|
|
}
|
|
break;
|
|
default:
|
|
if (dev->callback)
|
|
status = (*dev->callback)(dev, rqst, data);
|
|
break;
|
|
}
|
|
return status;
|
|
}
|
|
|
|
/*
|
|
* Undo incomplete request
|
|
*/
|
|
static void pm_undo_all(struct pm_dev *last)
|
|
{
|
|
struct list_head *entry = last->entry.prev;
|
|
while (entry != &pm_devs) {
|
|
struct pm_dev *dev = list_entry(entry, struct pm_dev, entry);
|
|
if (dev->state != dev->prev_state) {
|
|
/* previous state was zero (running) resume or
|
|
* previous state was non-zero (suspended) suspend
|
|
*/
|
|
pm_request_t undo = (dev->prev_state
|
|
? PM_SUSPEND:PM_RESUME);
|
|
pm_send(dev, undo, (void*) dev->prev_state);
|
|
}
|
|
entry = entry->prev;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* pm_send_all - send request to all managed devices
|
|
* @rqst: power management request
|
|
* @data: data for the callback
|
|
*
|
|
* Issue a power management request to a all devices. The
|
|
* %PM_SUSPEND events are handled specially. Any device is
|
|
* permitted to fail a suspend by returning a non zero (error)
|
|
* value from its callback function. If any device vetoes a
|
|
* suspend request then all other devices that have suspended
|
|
* during the processing of this request are restored to their
|
|
* previous state.
|
|
*
|
|
* WARNING: This function takes the pm_devs_lock. The lock is not dropped until
|
|
* the callbacks have completed. This prevents races against pm locking
|
|
* functions, races against module unload pm_unregister code. It does
|
|
* mean however that you must not issue pm_ functions within the callback
|
|
* or you will deadlock and users will hate you.
|
|
*
|
|
* Zero is returned on success. If a suspend fails then the status
|
|
* from the device that vetoes the suspend is returned.
|
|
*
|
|
* BUGS: what stops two power management requests occurring in parallel
|
|
* and conflicting.
|
|
*/
|
|
|
|
int pm_send_all(pm_request_t rqst, void *data)
|
|
{
|
|
struct list_head *entry;
|
|
|
|
mutex_lock(&pm_devs_lock);
|
|
entry = pm_devs.next;
|
|
while (entry != &pm_devs) {
|
|
struct pm_dev *dev = list_entry(entry, struct pm_dev, entry);
|
|
if (dev->callback) {
|
|
int status = pm_send(dev, rqst, data);
|
|
if (status) {
|
|
/* return devices to previous state on
|
|
* failed suspend request
|
|
*/
|
|
if (rqst == PM_SUSPEND)
|
|
pm_undo_all(dev);
|
|
mutex_unlock(&pm_devs_lock);
|
|
return status;
|
|
}
|
|
}
|
|
entry = entry->next;
|
|
}
|
|
mutex_unlock(&pm_devs_lock);
|
|
return 0;
|
|
}
|
|
|
|
EXPORT_SYMBOL(pm_register);
|
|
EXPORT_SYMBOL(pm_unregister_all);
|
|
EXPORT_SYMBOL(pm_send_all);
|
|
EXPORT_SYMBOL(pm_active);
|
|
|
|
|