168 lines
4.5 KiB
C
168 lines
4.5 KiB
C
|
/*
|
||
|
* wakeup.c - support wakeup devices
|
||
|
* Copyright (C) 2004 Li Shaohua <shaohua.li@intel.com>
|
||
|
*/
|
||
|
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/acpi.h>
|
||
|
#include <acpi/acpi_drivers.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/types.h>
|
||
|
#include "sleep.h"
|
||
|
|
||
|
#define _COMPONENT ACPI_SYSTEM_COMPONENT
|
||
|
ACPI_MODULE_NAME("wakeup_devices")
|
||
|
|
||
|
extern struct list_head acpi_wakeup_device_list;
|
||
|
extern spinlock_t acpi_device_lock;
|
||
|
|
||
|
/**
|
||
|
* acpi_enable_wakeup_device_prep - prepare wakeup devices
|
||
|
* @sleep_state: ACPI state
|
||
|
* Enable all wakup devices power if the devices' wakeup level
|
||
|
* is higher than requested sleep level
|
||
|
*/
|
||
|
|
||
|
void acpi_enable_wakeup_device_prep(u8 sleep_state)
|
||
|
{
|
||
|
struct list_head *node, *next;
|
||
|
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
list_for_each_safe(node, next, &acpi_wakeup_device_list) {
|
||
|
struct acpi_device *dev = container_of(node,
|
||
|
struct acpi_device,
|
||
|
wakeup_list);
|
||
|
|
||
|
if (!dev->wakeup.flags.valid ||
|
||
|
!dev->wakeup.state.enabled ||
|
||
|
(sleep_state > (u32) dev->wakeup.sleep_state))
|
||
|
continue;
|
||
|
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
acpi_enable_wakeup_device_power(dev, sleep_state);
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
}
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* acpi_enable_wakeup_device - enable wakeup devices
|
||
|
* @sleep_state: ACPI state
|
||
|
* Enable all wakup devices's GPE
|
||
|
*/
|
||
|
void acpi_enable_wakeup_device(u8 sleep_state)
|
||
|
{
|
||
|
struct list_head *node, *next;
|
||
|
|
||
|
/*
|
||
|
* Caution: this routine must be invoked when interrupt is disabled
|
||
|
* Refer ACPI2.0: P212
|
||
|
*/
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
list_for_each_safe(node, next, &acpi_wakeup_device_list) {
|
||
|
struct acpi_device *dev =
|
||
|
container_of(node, struct acpi_device, wakeup_list);
|
||
|
|
||
|
if (!dev->wakeup.flags.valid)
|
||
|
continue;
|
||
|
|
||
|
/* If users want to disable run-wake GPE,
|
||
|
* we only disable it for wake and leave it for runtime
|
||
|
*/
|
||
|
if ((!dev->wakeup.state.enabled && !dev->wakeup.flags.prepared)
|
||
|
|| sleep_state > (u32) dev->wakeup.sleep_state) {
|
||
|
if (dev->wakeup.flags.run_wake) {
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
/* set_gpe_type will disable GPE, leave it like that */
|
||
|
acpi_set_gpe_type(dev->wakeup.gpe_device,
|
||
|
dev->wakeup.gpe_number,
|
||
|
ACPI_GPE_TYPE_RUNTIME);
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
}
|
||
|
continue;
|
||
|
}
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
if (!dev->wakeup.flags.run_wake)
|
||
|
acpi_enable_gpe(dev->wakeup.gpe_device,
|
||
|
dev->wakeup.gpe_number);
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
}
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* acpi_disable_wakeup_device - disable devices' wakeup capability
|
||
|
* @sleep_state: ACPI state
|
||
|
* Disable all wakup devices's GPE and wakeup capability
|
||
|
*/
|
||
|
void acpi_disable_wakeup_device(u8 sleep_state)
|
||
|
{
|
||
|
struct list_head *node, *next;
|
||
|
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
list_for_each_safe(node, next, &acpi_wakeup_device_list) {
|
||
|
struct acpi_device *dev =
|
||
|
container_of(node, struct acpi_device, wakeup_list);
|
||
|
|
||
|
if (!dev->wakeup.flags.valid)
|
||
|
continue;
|
||
|
|
||
|
if ((!dev->wakeup.state.enabled && !dev->wakeup.flags.prepared)
|
||
|
|| sleep_state > (u32) dev->wakeup.sleep_state) {
|
||
|
if (dev->wakeup.flags.run_wake) {
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
acpi_set_gpe_type(dev->wakeup.gpe_device,
|
||
|
dev->wakeup.gpe_number,
|
||
|
ACPI_GPE_TYPE_WAKE_RUN);
|
||
|
/* Re-enable it, since set_gpe_type will disable it */
|
||
|
acpi_enable_gpe(dev->wakeup.gpe_device,
|
||
|
dev->wakeup.gpe_number);
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
}
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
acpi_disable_wakeup_device_power(dev);
|
||
|
/* Never disable run-wake GPE */
|
||
|
if (!dev->wakeup.flags.run_wake) {
|
||
|
acpi_disable_gpe(dev->wakeup.gpe_device,
|
||
|
dev->wakeup.gpe_number);
|
||
|
acpi_clear_gpe(dev->wakeup.gpe_device,
|
||
|
dev->wakeup.gpe_number, ACPI_NOT_ISR);
|
||
|
}
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
}
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
}
|
||
|
|
||
|
static int __init acpi_wakeup_device_init(void)
|
||
|
{
|
||
|
struct list_head *node, *next;
|
||
|
|
||
|
if (acpi_disabled)
|
||
|
return 0;
|
||
|
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
list_for_each_safe(node, next, &acpi_wakeup_device_list) {
|
||
|
struct acpi_device *dev = container_of(node,
|
||
|
struct acpi_device,
|
||
|
wakeup_list);
|
||
|
/* In case user doesn't load button driver */
|
||
|
if (!dev->wakeup.flags.run_wake || dev->wakeup.state.enabled)
|
||
|
continue;
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
acpi_set_gpe_type(dev->wakeup.gpe_device,
|
||
|
dev->wakeup.gpe_number,
|
||
|
ACPI_GPE_TYPE_WAKE_RUN);
|
||
|
acpi_enable_gpe(dev->wakeup.gpe_device,
|
||
|
dev->wakeup.gpe_number);
|
||
|
dev->wakeup.state.enabled = 1;
|
||
|
spin_lock(&acpi_device_lock);
|
||
|
}
|
||
|
spin_unlock(&acpi_device_lock);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
late_initcall(acpi_wakeup_device_init);
|