f89cbc399e
Driver core: add suspend() and resume() to struct device_type In cases when there are devices of different types in the same class we can't use class's implementation of suspend and resume methods and we need to add them to struct device_type instead. Also fix error handling in resume code (we should not try to call class's resume method iof bus's resume method for the device failed. Signed-off-by: Dmitry Torokhov <dtor@mail.ru> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
158 lines
3 KiB
C
158 lines
3 KiB
C
/*
|
|
* resume.c - Functions for waking devices up.
|
|
*
|
|
* Copyright (c) 2003 Patrick Mochel
|
|
* Copyright (c) 2003 Open Source Development Labs
|
|
*
|
|
* This file is released under the GPLv2
|
|
*
|
|
*/
|
|
|
|
#include <linux/device.h>
|
|
#include <linux/resume-trace.h>
|
|
#include "../base.h"
|
|
#include "power.h"
|
|
|
|
|
|
/**
|
|
* resume_device - Restore state for one device.
|
|
* @dev: Device.
|
|
*
|
|
*/
|
|
|
|
int resume_device(struct device * dev)
|
|
{
|
|
int error = 0;
|
|
|
|
TRACE_DEVICE(dev);
|
|
TRACE_RESUME(0);
|
|
|
|
down(&dev->sem);
|
|
|
|
if (dev->power.pm_parent
|
|
&& dev->power.pm_parent->power.power_state.event) {
|
|
dev_err(dev, "PM: resume from %d, parent %s still %d\n",
|
|
dev->power.power_state.event,
|
|
dev->power.pm_parent->bus_id,
|
|
dev->power.pm_parent->power.power_state.event);
|
|
}
|
|
|
|
if (dev->bus && dev->bus->resume) {
|
|
dev_dbg(dev,"resuming\n");
|
|
error = dev->bus->resume(dev);
|
|
}
|
|
|
|
if (!error && dev->type && dev->type->resume) {
|
|
dev_dbg(dev,"resuming\n");
|
|
error = dev->type->resume(dev);
|
|
}
|
|
|
|
if (!error && dev->class && dev->class->resume) {
|
|
dev_dbg(dev,"class resume\n");
|
|
error = dev->class->resume(dev);
|
|
}
|
|
|
|
up(&dev->sem);
|
|
|
|
TRACE_RESUME(error);
|
|
return error;
|
|
}
|
|
|
|
|
|
static int resume_device_early(struct device * dev)
|
|
{
|
|
int error = 0;
|
|
|
|
TRACE_DEVICE(dev);
|
|
TRACE_RESUME(0);
|
|
if (dev->bus && dev->bus->resume_early) {
|
|
dev_dbg(dev,"EARLY resume\n");
|
|
error = dev->bus->resume_early(dev);
|
|
}
|
|
TRACE_RESUME(error);
|
|
return error;
|
|
}
|
|
|
|
/*
|
|
* Resume the devices that have either not gone through
|
|
* the late suspend, or that did go through it but also
|
|
* went through the early resume
|
|
*/
|
|
void dpm_resume(void)
|
|
{
|
|
down(&dpm_list_sem);
|
|
while(!list_empty(&dpm_off)) {
|
|
struct list_head * entry = dpm_off.next;
|
|
struct device * dev = to_device(entry);
|
|
|
|
get_device(dev);
|
|
list_move_tail(entry, &dpm_active);
|
|
|
|
up(&dpm_list_sem);
|
|
if (!dev->power.prev_state.event)
|
|
resume_device(dev);
|
|
down(&dpm_list_sem);
|
|
put_device(dev);
|
|
}
|
|
up(&dpm_list_sem);
|
|
}
|
|
|
|
|
|
/**
|
|
* device_resume - Restore state of each device in system.
|
|
*
|
|
* Walk the dpm_off list, remove each entry, resume the device,
|
|
* then add it to the dpm_active list.
|
|
*/
|
|
|
|
void device_resume(void)
|
|
{
|
|
might_sleep();
|
|
down(&dpm_sem);
|
|
dpm_resume();
|
|
up(&dpm_sem);
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(device_resume);
|
|
|
|
|
|
/**
|
|
* dpm_power_up - Power on some devices.
|
|
*
|
|
* Walk the dpm_off_irq list and power each device up. This
|
|
* is used for devices that required they be powered down with
|
|
* interrupts disabled. As devices are powered on, they are moved
|
|
* to the dpm_active list.
|
|
*
|
|
* Interrupts must be disabled when calling this.
|
|
*/
|
|
|
|
void dpm_power_up(void)
|
|
{
|
|
while(!list_empty(&dpm_off_irq)) {
|
|
struct list_head * entry = dpm_off_irq.next;
|
|
struct device * dev = to_device(entry);
|
|
|
|
list_move_tail(entry, &dpm_off);
|
|
resume_device_early(dev);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* device_power_up - Turn on all devices that need special attention.
|
|
*
|
|
* Power on system devices then devices that required we shut them down
|
|
* with interrupts disabled.
|
|
* Called with interrupts disabled.
|
|
*/
|
|
|
|
void device_power_up(void)
|
|
{
|
|
sysdev_resume();
|
|
dpm_power_up();
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(device_power_up);
|
|
|
|
|