2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Copyright (C) 2004 Intel Corporation <naveen.b.s@intel.com>
|
|
|
|
*
|
|
|
|
* All rights reserved.
|
|
|
|
*
|
|
|
|
* 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, GOOD TITLE or
|
|
|
|
* NON INFRINGEMENT. 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*
|
|
|
|
*
|
|
|
|
* ACPI based HotPlug driver that supports Memory Hotplug
|
|
|
|
* This driver fields notifications from firmare for memory add
|
|
|
|
* and remove operations and alerts the VM of the affected memory
|
|
|
|
* ranges.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/memory_hotplug.h>
|
|
|
|
#include <acpi/acpi_drivers.h>
|
|
|
|
|
|
|
|
#define ACPI_MEMORY_DEVICE_COMPONENT 0x08000000UL
|
|
|
|
#define ACPI_MEMORY_DEVICE_CLASS "memory"
|
|
|
|
#define ACPI_MEMORY_DEVICE_HID "PNP0C80"
|
|
|
|
#define ACPI_MEMORY_DEVICE_DRIVER_NAME "Hotplug Mem Driver"
|
|
|
|
#define ACPI_MEMORY_DEVICE_NAME "Hotplug Mem Device"
|
|
|
|
|
|
|
|
#define _COMPONENT ACPI_MEMORY_DEVICE_COMPONENT
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
ACPI_MODULE_NAME("acpi_memory")
|
|
|
|
MODULE_AUTHOR("Naveen B S <naveen.b.s@intel.com>");
|
2005-04-17 06:20:36 +08:00
|
|
|
MODULE_DESCRIPTION(ACPI_MEMORY_DEVICE_DRIVER_NAME);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
|
|
|
/* ACPI _STA method values */
|
|
|
|
#define ACPI_MEMORY_STA_PRESENT (0x00000001UL)
|
|
|
|
#define ACPI_MEMORY_STA_ENABLED (0x00000002UL)
|
|
|
|
#define ACPI_MEMORY_STA_FUNCTIONAL (0x00000008UL)
|
|
|
|
|
|
|
|
/* Memory Device States */
|
|
|
|
#define MEMORY_INVALID_STATE 0
|
|
|
|
#define MEMORY_POWER_ON_STATE 1
|
|
|
|
#define MEMORY_POWER_OFF_STATE 2
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static int acpi_memory_device_add(struct acpi_device *device);
|
|
|
|
static int acpi_memory_device_remove(struct acpi_device *device, int type);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
static struct acpi_driver acpi_memory_device_driver = {
|
2005-08-05 12:44:28 +08:00
|
|
|
.name = ACPI_MEMORY_DEVICE_DRIVER_NAME,
|
|
|
|
.class = ACPI_MEMORY_DEVICE_CLASS,
|
|
|
|
.ids = ACPI_MEMORY_DEVICE_HID,
|
|
|
|
.ops = {
|
|
|
|
.add = acpi_memory_device_add,
|
|
|
|
.remove = acpi_memory_device_remove,
|
|
|
|
},
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
struct acpi_memory_device {
|
|
|
|
acpi_handle handle;
|
2005-08-05 12:44:28 +08:00
|
|
|
unsigned int state; /* State of the memory device */
|
2006-01-06 14:31:00 +08:00
|
|
|
unsigned short caching; /* memory cache attribute */
|
|
|
|
unsigned short write_protect; /* memory read/write attribute */
|
2005-08-05 12:44:28 +08:00
|
|
|
u64 start_addr; /* Memory Range start physical addr */
|
2006-03-29 06:04:00 +08:00
|
|
|
u64 length; /* Memory Range length */
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
static int
|
|
|
|
acpi_memory_get_device_resources(struct acpi_memory_device *mem_device)
|
|
|
|
{
|
|
|
|
acpi_status status;
|
2005-08-05 12:44:28 +08:00
|
|
|
struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
|
2005-04-17 06:20:36 +08:00
|
|
|
struct acpi_resource *resource = NULL;
|
|
|
|
struct acpi_resource_address64 address64;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_get_device_resources");
|
|
|
|
|
|
|
|
/* Get the range from the _CRS */
|
|
|
|
status = acpi_get_current_resources(mem_device->handle, &buffer);
|
|
|
|
if (ACPI_FAILURE(status))
|
|
|
|
return_VALUE(-EINVAL);
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
resource = (struct acpi_resource *)buffer.pointer;
|
2005-04-17 06:20:36 +08:00
|
|
|
status = acpi_resource_to_address64(resource, &address64);
|
|
|
|
if (ACPI_SUCCESS(status)) {
|
|
|
|
if (address64.resource_type == ACPI_MEMORY_RANGE) {
|
|
|
|
/* Populate the structure */
|
2006-03-29 06:04:00 +08:00
|
|
|
mem_device->caching = address64.info.mem.caching;
|
2006-01-06 14:31:00 +08:00
|
|
|
mem_device->write_protect =
|
|
|
|
address64.info.mem.write_protect;
|
[ACPI] ACPICA 20050930
Completed a major overhaul of the Resource Manager code -
specifically, optimizations in the area of the AML/internal
resource conversion code. The code has been optimized to
simplify and eliminate duplicated code, CPU stack use has
been decreased by optimizing function parameters and local
variables, and naming conventions across the manager have
been standardized for clarity and ease of maintenance (this
includes function, parameter, variable, and struct/typedef
names.)
All Resource Manager dispatch and information tables have
been moved to a single location for clarity and ease of
maintenance. One new file was created, named "rsinfo.c".
The ACPI return macros (return_ACPI_STATUS, etc.) have
been modified to guarantee that the argument is
not evaluated twice, making them less prone to macro
side-effects. However, since there exists the possibility
of additional stack use if a particular compiler cannot
optimize them (such as in the debug generation case),
the original macros are optionally available. Note that
some invocations of the return_VALUE macro may now cause
size mismatch warnings; the return_UINT8 and return_UINT32
macros are provided to eliminate these. (From Randy Dunlap)
Implemented a new mechanism to enable debug tracing for
individual control methods. A new external interface,
acpi_debug_trace(), is provided to enable this mechanism. The
intent is to allow the host OS to easily enable and disable
tracing for problematic control methods. This interface
can be easily exposed to a user or debugger interface if
desired. See the file psxface.c for details.
acpi_ut_callocate() will now return a valid pointer if a
length of zero is specified - a length of one is used
and a warning is issued. This matches the behavior of
acpi_ut_allocate().
Signed-off-by: Bob Moore <robert.moore@intel.com>
Signed-off-by: Len Brown <len.brown@intel.com>
2005-10-01 07:03:00 +08:00
|
|
|
mem_device->start_addr = address64.minimum;
|
2006-03-29 06:04:00 +08:00
|
|
|
mem_device->length = address64.address_length;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
acpi_os_free(buffer.pointer);
|
|
|
|
return_VALUE(0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
acpi_memory_get_device(acpi_handle handle,
|
2005-08-05 12:44:28 +08:00
|
|
|
struct acpi_memory_device **mem_device)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
acpi_status status;
|
|
|
|
acpi_handle phandle;
|
|
|
|
struct acpi_device *device = NULL;
|
|
|
|
struct acpi_device *pdevice = NULL;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_get_device");
|
|
|
|
|
|
|
|
if (!acpi_bus_get_device(handle, &device) && device)
|
|
|
|
goto end;
|
|
|
|
|
|
|
|
status = acpi_get_parent(handle, &phandle);
|
|
|
|
if (ACPI_FAILURE(status)) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_EXCEPTION((AE_INFO, status, "Cannot find acpi parent"));
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VALUE(-EINVAL);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get the parent device */
|
|
|
|
status = acpi_bus_get_device(phandle, &pdevice);
|
|
|
|
if (ACPI_FAILURE(status)) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_EXCEPTION((AE_INFO, status, "Cannot get acpi bus device"));
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VALUE(-EINVAL);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Now add the notified device. This creates the acpi_device
|
|
|
|
* and invokes .add function
|
|
|
|
*/
|
|
|
|
status = acpi_bus_add(&device, pdevice, handle, ACPI_BUS_TYPE_DEVICE);
|
|
|
|
if (ACPI_FAILURE(status)) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_EXCEPTION((AE_INFO, status, "Cannot add acpi bus"));
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VALUE(-EINVAL);
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
end:
|
2005-04-17 06:20:36 +08:00
|
|
|
*mem_device = acpi_driver_data(device);
|
|
|
|
if (!(*mem_device)) {
|
2005-08-05 12:44:28 +08:00
|
|
|
printk(KERN_ERR "\n driver data not found");
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VALUE(-ENODEV);
|
|
|
|
}
|
|
|
|
|
|
|
|
return_VALUE(0);
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static int acpi_memory_check_device(struct acpi_memory_device *mem_device)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
unsigned long current_status;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_check_device");
|
|
|
|
|
|
|
|
/* Get device present/absent information from the _STA */
|
|
|
|
if (ACPI_FAILURE(acpi_evaluate_integer(mem_device->handle, "_STA",
|
2005-08-05 12:44:28 +08:00
|
|
|
NULL, ¤t_status)))
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VALUE(-ENODEV);
|
|
|
|
/*
|
|
|
|
* Check for device status. Device should be
|
|
|
|
* present/enabled/functioning.
|
|
|
|
*/
|
|
|
|
if (!((current_status & ACPI_MEMORY_STA_PRESENT)
|
2005-08-05 12:44:28 +08:00
|
|
|
&& (current_status & ACPI_MEMORY_STA_ENABLED)
|
|
|
|
&& (current_status & ACPI_MEMORY_STA_FUNCTIONAL)))
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VALUE(-ENODEV);
|
|
|
|
|
|
|
|
return_VALUE(0);
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static int acpi_memory_enable_device(struct acpi_memory_device *mem_device)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
int result;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_enable_device");
|
|
|
|
|
|
|
|
/* Get the range from the _CRS */
|
|
|
|
result = acpi_memory_get_device_resources(mem_device);
|
|
|
|
if (result) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_ERROR((AE_INFO, "get_device_resources failed"));
|
2005-04-17 06:20:36 +08:00
|
|
|
mem_device->state = MEMORY_INVALID_STATE;
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Tell the VM there is more memory here...
|
|
|
|
* Note: Assume that this function returns zero on success
|
|
|
|
*/
|
2006-03-29 06:04:00 +08:00
|
|
|
result = add_memory(mem_device->start_addr, mem_device->length);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (result) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_ERROR((AE_INFO, "add_memory failed"));
|
2005-04-17 06:20:36 +08:00
|
|
|
mem_device->state = MEMORY_INVALID_STATE;
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static int acpi_memory_powerdown_device(struct acpi_memory_device *mem_device)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
acpi_status status;
|
2005-08-05 12:44:28 +08:00
|
|
|
struct acpi_object_list arg_list;
|
2005-04-17 06:20:36 +08:00
|
|
|
union acpi_object arg;
|
|
|
|
unsigned long current_status;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_powerdown_device");
|
|
|
|
|
|
|
|
/* Issue the _EJ0 command */
|
|
|
|
arg_list.count = 1;
|
|
|
|
arg_list.pointer = &arg;
|
|
|
|
arg.type = ACPI_TYPE_INTEGER;
|
|
|
|
arg.integer.value = 1;
|
|
|
|
status = acpi_evaluate_object(mem_device->handle,
|
2005-08-05 12:44:28 +08:00
|
|
|
"_EJ0", &arg_list, NULL);
|
2005-04-17 06:20:36 +08:00
|
|
|
/* Return on _EJ0 failure */
|
|
|
|
if (ACPI_FAILURE(status)) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_EXCEPTION((AE_INFO, status, "_EJ0 failed"));
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VALUE(-ENODEV);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Evalute _STA to check if the device is disabled */
|
|
|
|
status = acpi_evaluate_integer(mem_device->handle, "_STA",
|
2005-08-05 12:44:28 +08:00
|
|
|
NULL, ¤t_status);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (ACPI_FAILURE(status))
|
|
|
|
return_VALUE(-ENODEV);
|
|
|
|
|
|
|
|
/* Check for device status. Device should be disabled */
|
|
|
|
if (current_status & ACPI_MEMORY_STA_ENABLED)
|
|
|
|
return_VALUE(-EINVAL);
|
|
|
|
|
|
|
|
return_VALUE(0);
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static int acpi_memory_disable_device(struct acpi_memory_device *mem_device)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
int result;
|
|
|
|
u64 start = mem_device->start_addr;
|
2006-03-29 06:04:00 +08:00
|
|
|
u64 len = mem_device->length;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_disable_device");
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Ask the VM to offline this memory range.
|
|
|
|
* Note: Assume that this function returns zero on success
|
|
|
|
*/
|
2005-10-30 09:16:55 +08:00
|
|
|
result = remove_memory(start, len);
|
2006-06-27 11:58:43 +08:00
|
|
|
if (result)
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VALUE(result);
|
|
|
|
|
|
|
|
/* Power-off and eject the device */
|
|
|
|
result = acpi_memory_powerdown_device(mem_device);
|
|
|
|
if (result) {
|
|
|
|
/* Set the status of the device to invalid */
|
|
|
|
mem_device->state = MEMORY_INVALID_STATE;
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
mem_device->state = MEMORY_POWER_OFF_STATE;
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static void acpi_memory_device_notify(acpi_handle handle, u32 event, void *data)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct acpi_memory_device *mem_device;
|
|
|
|
struct acpi_device *device;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_device_notify");
|
|
|
|
|
|
|
|
switch (event) {
|
|
|
|
case ACPI_NOTIFY_BUS_CHECK:
|
|
|
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO,
|
2005-08-05 12:44:28 +08:00
|
|
|
"\nReceived BUS CHECK notification for device\n"));
|
2005-04-17 06:20:36 +08:00
|
|
|
/* Fall Through */
|
|
|
|
case ACPI_NOTIFY_DEVICE_CHECK:
|
|
|
|
if (event == ACPI_NOTIFY_DEVICE_CHECK)
|
|
|
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO,
|
2005-08-05 12:44:28 +08:00
|
|
|
"\nReceived DEVICE CHECK notification for device\n"));
|
2005-04-17 06:20:36 +08:00
|
|
|
if (acpi_memory_get_device(handle, &mem_device)) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_ERROR((AE_INFO, "Cannot find driver data"));
|
2005-04-17 06:20:36 +08:00
|
|
|
return_VOID;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!acpi_memory_check_device(mem_device)) {
|
|
|
|
if (acpi_memory_enable_device(mem_device))
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_ERROR((AE_INFO,
|
|
|
|
"Cannot enable memory device"));
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
case ACPI_NOTIFY_EJECT_REQUEST:
|
|
|
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO,
|
2005-08-05 12:44:28 +08:00
|
|
|
"\nReceived EJECT REQUEST notification for device\n"));
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (acpi_bus_get_device(handle, &device)) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_ERROR((AE_INFO, "Device doesn't exist"));
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
mem_device = acpi_driver_data(device);
|
|
|
|
if (!mem_device) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_ERROR((AE_INFO, "Driver Data is NULL"));
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Currently disabling memory device from kernel mode
|
|
|
|
* TBD: Can also be disabled from user mode scripts
|
|
|
|
* TBD: Can also be disabled by Callback registration
|
2005-08-05 12:44:28 +08:00
|
|
|
* with generic sysfs driver
|
2005-04-17 06:20:36 +08:00
|
|
|
*/
|
|
|
|
if (acpi_memory_disable_device(mem_device))
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_ERROR((AE_INFO,
|
|
|
|
"Disable memory device\n"));
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* TBD: Invoke acpi_bus_remove to cleanup data structures
|
|
|
|
*/
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO,
|
2005-08-05 12:44:28 +08:00
|
|
|
"Unsupported event [0x%x]\n", event));
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return_VOID;
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static int acpi_memory_device_add(struct acpi_device *device)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
int result;
|
|
|
|
struct acpi_memory_device *mem_device = NULL;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_device_add");
|
|
|
|
|
|
|
|
if (!device)
|
|
|
|
return_VALUE(-EINVAL);
|
|
|
|
|
|
|
|
mem_device = kmalloc(sizeof(struct acpi_memory_device), GFP_KERNEL);
|
|
|
|
if (!mem_device)
|
|
|
|
return_VALUE(-ENOMEM);
|
|
|
|
memset(mem_device, 0, sizeof(struct acpi_memory_device));
|
|
|
|
|
|
|
|
mem_device->handle = device->handle;
|
|
|
|
sprintf(acpi_device_name(device), "%s", ACPI_MEMORY_DEVICE_NAME);
|
|
|
|
sprintf(acpi_device_class(device), "%s", ACPI_MEMORY_DEVICE_CLASS);
|
|
|
|
acpi_driver_data(device) = mem_device;
|
|
|
|
|
|
|
|
/* Get the range from the _CRS */
|
|
|
|
result = acpi_memory_get_device_resources(mem_device);
|
|
|
|
if (result) {
|
|
|
|
kfree(mem_device);
|
|
|
|
return_VALUE(result);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Set the device state */
|
|
|
|
mem_device->state = MEMORY_POWER_ON_STATE;
|
|
|
|
|
|
|
|
printk(KERN_INFO "%s \n", acpi_device_name(device));
|
|
|
|
|
|
|
|
return_VALUE(result);
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static int acpi_memory_device_remove(struct acpi_device *device, int type)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct acpi_memory_device *mem_device = NULL;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_device_remove");
|
|
|
|
|
|
|
|
if (!device || !acpi_driver_data(device))
|
|
|
|
return_VALUE(-EINVAL);
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
mem_device = (struct acpi_memory_device *)acpi_driver_data(device);
|
2005-04-17 06:20:36 +08:00
|
|
|
kfree(mem_device);
|
|
|
|
|
|
|
|
return_VALUE(0);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Helper function to check for memory device
|
|
|
|
*/
|
2005-08-05 12:44:28 +08:00
|
|
|
static acpi_status is_memory_device(acpi_handle handle)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
char *hardware_id;
|
|
|
|
acpi_status status;
|
2005-08-05 12:44:28 +08:00
|
|
|
struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
|
2005-04-17 06:20:36 +08:00
|
|
|
struct acpi_device_info *info;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("is_memory_device");
|
|
|
|
|
|
|
|
status = acpi_get_object_info(handle, &buffer);
|
|
|
|
if (ACPI_FAILURE(status))
|
2006-06-27 11:58:43 +08:00
|
|
|
return_ACPI_STATUS(status);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
info = buffer.pointer;
|
|
|
|
if (!(info->valid & ACPI_VALID_HID)) {
|
|
|
|
acpi_os_free(buffer.pointer);
|
|
|
|
return_ACPI_STATUS(AE_ERROR);
|
|
|
|
}
|
|
|
|
|
|
|
|
hardware_id = info->hardware_id.value;
|
|
|
|
if ((hardware_id == NULL) ||
|
2005-08-05 12:44:28 +08:00
|
|
|
(strcmp(hardware_id, ACPI_MEMORY_DEVICE_HID)))
|
2005-04-17 06:20:36 +08:00
|
|
|
status = AE_ERROR;
|
|
|
|
|
|
|
|
acpi_os_free(buffer.pointer);
|
|
|
|
return_ACPI_STATUS(status);
|
|
|
|
}
|
|
|
|
|
|
|
|
static acpi_status
|
2005-08-05 12:44:28 +08:00
|
|
|
acpi_memory_register_notify_handler(acpi_handle handle,
|
|
|
|
u32 level, void *ctxt, void **retv)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
acpi_status status;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_register_notify_handler");
|
|
|
|
|
|
|
|
status = is_memory_device(handle);
|
2006-06-27 11:58:43 +08:00
|
|
|
if (ACPI_FAILURE(status)){
|
|
|
|
ACPI_EXCEPTION((AE_INFO, status, "handle is no memory device"));
|
2005-04-17 06:20:36 +08:00
|
|
|
return_ACPI_STATUS(AE_OK); /* continue */
|
2006-06-27 11:58:43 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
|
2005-08-05 12:44:28 +08:00
|
|
|
acpi_memory_device_notify, NULL);
|
2006-06-27 11:58:43 +08:00
|
|
|
/* continue */
|
|
|
|
return_ACPI_STATUS(AE_OK);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static acpi_status
|
2005-08-05 12:44:28 +08:00
|
|
|
acpi_memory_deregister_notify_handler(acpi_handle handle,
|
|
|
|
u32 level, void *ctxt, void **retv)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
acpi_status status;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_deregister_notify_handler");
|
|
|
|
|
|
|
|
status = is_memory_device(handle);
|
2006-06-27 11:58:43 +08:00
|
|
|
if (ACPI_FAILURE(status)){
|
|
|
|
ACPI_EXCEPTION((AE_INFO, status, "handle is no memory device"));
|
2005-04-17 06:20:36 +08:00
|
|
|
return_ACPI_STATUS(AE_OK); /* continue */
|
2006-06-27 11:58:43 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
status = acpi_remove_notify_handler(handle,
|
2005-08-05 12:44:28 +08:00
|
|
|
ACPI_SYSTEM_NOTIFY,
|
|
|
|
acpi_memory_device_notify);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-06-27 11:58:43 +08:00
|
|
|
return_ACPI_STATUS(AE_OK); /* continue */
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static int __init acpi_memory_device_init(void)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
int result;
|
|
|
|
acpi_status status;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_device_init");
|
|
|
|
|
|
|
|
result = acpi_bus_register_driver(&acpi_memory_device_driver);
|
|
|
|
|
|
|
|
if (result < 0)
|
|
|
|
return_VALUE(-ENODEV);
|
|
|
|
|
|
|
|
status = acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT,
|
2005-08-05 12:44:28 +08:00
|
|
|
ACPI_UINT32_MAX,
|
|
|
|
acpi_memory_register_notify_handler,
|
|
|
|
NULL, NULL);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
if (ACPI_FAILURE(status)) {
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_EXCEPTION((AE_INFO, status, "walk_namespace failed"));
|
2005-04-17 06:20:36 +08:00
|
|
|
acpi_bus_unregister_driver(&acpi_memory_device_driver);
|
|
|
|
return_VALUE(-ENODEV);
|
2005-08-05 12:44:28 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
return_VALUE(0);
|
|
|
|
}
|
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
static void __exit acpi_memory_device_exit(void)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
acpi_status status;
|
|
|
|
|
|
|
|
ACPI_FUNCTION_TRACE("acpi_memory_device_exit");
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Adding this to un-install notification handlers for all the device
|
|
|
|
* handles.
|
|
|
|
*/
|
|
|
|
status = acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT,
|
2005-08-05 12:44:28 +08:00
|
|
|
ACPI_UINT32_MAX,
|
|
|
|
acpi_memory_deregister_notify_handler,
|
|
|
|
NULL, NULL);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2005-08-05 12:44:28 +08:00
|
|
|
if (ACPI_FAILURE(status))
|
2006-06-27 11:58:43 +08:00
|
|
|
ACPI_EXCEPTION((AE_INFO, status, "walk_namespace failed"));
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
acpi_bus_unregister_driver(&acpi_memory_device_driver);
|
|
|
|
|
|
|
|
return_VOID;
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(acpi_memory_device_init);
|
|
|
|
module_exit(acpi_memory_device_exit);
|