Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2004 Intel Corporation <naveen.b.s@intel.com> |
| 3 | * |
| 4 | * All rights reserved. |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License as published by |
| 8 | * the Free Software Foundation; either version 2 of the License, or (at |
| 9 | * your option) any later version. |
| 10 | * |
| 11 | * This program is distributed in the hope that it will be useful, but |
| 12 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or |
| 14 | * NON INFRINGEMENT. See the GNU General Public License for more |
| 15 | * details. |
| 16 | * |
| 17 | * You should have received a copy of the GNU General Public License |
| 18 | * along with this program; if not, write to the Free Software |
| 19 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| 20 | * |
| 21 | * |
| 22 | * ACPI based HotPlug driver that supports Memory Hotplug |
Nick Andrew | c7060d9 | 2009-01-03 18:53:39 +1100 | [diff] [blame] | 23 | * This driver fields notifications from firmware for memory add |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | * and remove operations and alerts the VM of the affected memory |
| 25 | * ranges. |
| 26 | */ |
| 27 | |
| 28 | #include <linux/kernel.h> |
| 29 | #include <linux/module.h> |
| 30 | #include <linux/init.h> |
| 31 | #include <linux/types.h> |
| 32 | #include <linux/memory_hotplug.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 33 | #include <linux/slab.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | #include <acpi/acpi_drivers.h> |
| 35 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | #define ACPI_MEMORY_DEVICE_CLASS "memory" |
| 37 | #define ACPI_MEMORY_DEVICE_HID "PNP0C80" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | #define ACPI_MEMORY_DEVICE_NAME "Hotplug Mem Device" |
| 39 | |
| 40 | #define _COMPONENT ACPI_MEMORY_DEVICE_COMPONENT |
| 41 | |
Zhao Yakui | aa7b2b2 | 2009-07-03 10:49:03 +0800 | [diff] [blame] | 42 | #undef PREFIX |
| 43 | #define PREFIX "ACPI:memory_hp:" |
| 44 | |
Len Brown | f52fd66 | 2007-02-12 22:42:12 -0500 | [diff] [blame] | 45 | ACPI_MODULE_NAME("acpi_memhotplug"); |
| 46 | MODULE_AUTHOR("Naveen B S <naveen.b.s@intel.com>"); |
Len Brown | 7cda93e | 2007-02-12 23:50:02 -0500 | [diff] [blame] | 47 | MODULE_DESCRIPTION("Hotplug Mem Driver"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | MODULE_LICENSE("GPL"); |
| 49 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 | /* Memory Device States */ |
| 51 | #define MEMORY_INVALID_STATE 0 |
| 52 | #define MEMORY_POWER_ON_STATE 1 |
| 53 | #define MEMORY_POWER_OFF_STATE 2 |
| 54 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 55 | static int acpi_memory_device_add(struct acpi_device *device); |
| 56 | static int acpi_memory_device_remove(struct acpi_device *device, int type); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | |
Thomas Renninger | 1ba90e3 | 2007-07-23 14:44:41 +0200 | [diff] [blame] | 58 | static const struct acpi_device_id memory_device_ids[] = { |
| 59 | {ACPI_MEMORY_DEVICE_HID, 0}, |
| 60 | {"", 0}, |
| 61 | }; |
| 62 | MODULE_DEVICE_TABLE(acpi, memory_device_ids); |
| 63 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | static struct acpi_driver acpi_memory_device_driver = { |
Len Brown | c2b6705 | 2007-02-12 23:33:40 -0500 | [diff] [blame] | 65 | .name = "acpi_memhotplug", |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 66 | .class = ACPI_MEMORY_DEVICE_CLASS, |
Thomas Renninger | 1ba90e3 | 2007-07-23 14:44:41 +0200 | [diff] [blame] | 67 | .ids = memory_device_ids, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 68 | .ops = { |
| 69 | .add = acpi_memory_device_add, |
| 70 | .remove = acpi_memory_device_remove, |
| 71 | }, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 | }; |
| 73 | |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 74 | struct acpi_memory_info { |
| 75 | struct list_head list; |
| 76 | u64 start_addr; /* Memory Range start physical addr */ |
| 77 | u64 length; /* Memory Range length */ |
| 78 | unsigned short caching; /* memory cache attribute */ |
| 79 | unsigned short write_protect; /* memory read/write attribute */ |
| 80 | unsigned int enabled:1; |
| 81 | }; |
| 82 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 83 | struct acpi_memory_device { |
Patrick Mochel | 3b74863 | 2006-05-19 16:54:38 -0400 | [diff] [blame] | 84 | struct acpi_device * device; |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 85 | unsigned int state; /* State of the memory device */ |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 86 | struct list_head res_list; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | }; |
| 88 | |
Yasunori Goto | 887b959 | 2006-10-19 23:28:31 -0700 | [diff] [blame] | 89 | static int acpi_hotmem_initialized; |
| 90 | |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 91 | static acpi_status |
| 92 | acpi_memory_get_resource(struct acpi_resource *resource, void *context) |
| 93 | { |
| 94 | struct acpi_memory_device *mem_device = context; |
| 95 | struct acpi_resource_address64 address64; |
| 96 | struct acpi_memory_info *info, *new; |
| 97 | acpi_status status; |
| 98 | |
| 99 | status = acpi_resource_to_address64(resource, &address64); |
| 100 | if (ACPI_FAILURE(status) || |
| 101 | (address64.resource_type != ACPI_MEMORY_RANGE)) |
| 102 | return AE_OK; |
| 103 | |
| 104 | list_for_each_entry(info, &mem_device->res_list, list) { |
| 105 | /* Can we combine the resource range information? */ |
| 106 | if ((info->caching == address64.info.mem.caching) && |
| 107 | (info->write_protect == address64.info.mem.write_protect) && |
| 108 | (info->start_addr + info->length == address64.minimum)) { |
| 109 | info->length += address64.address_length; |
| 110 | return AE_OK; |
| 111 | } |
| 112 | } |
| 113 | |
| 114 | new = kzalloc(sizeof(struct acpi_memory_info), GFP_KERNEL); |
| 115 | if (!new) |
| 116 | return AE_ERROR; |
| 117 | |
| 118 | INIT_LIST_HEAD(&new->list); |
| 119 | new->caching = address64.info.mem.caching; |
| 120 | new->write_protect = address64.info.mem.write_protect; |
| 121 | new->start_addr = address64.minimum; |
| 122 | new->length = address64.address_length; |
| 123 | list_add_tail(&new->list, &mem_device->res_list); |
| 124 | |
| 125 | return AE_OK; |
| 126 | } |
| 127 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 128 | static int |
| 129 | acpi_memory_get_device_resources(struct acpi_memory_device *mem_device) |
| 130 | { |
| 131 | acpi_status status; |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 132 | struct acpi_memory_info *info, *n; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 133 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | |
KAMEZAWA Hiroyuki | 5d2870f | 2006-08-05 12:15:04 -0700 | [diff] [blame] | 135 | if (!list_empty(&mem_device->res_list)) |
| 136 | return 0; |
| 137 | |
Patrick Mochel | b863278 | 2006-05-19 16:54:41 -0400 | [diff] [blame] | 138 | status = acpi_walk_resources(mem_device->device->handle, METHOD_NAME__CRS, |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 139 | acpi_memory_get_resource, mem_device); |
| 140 | if (ACPI_FAILURE(status)) { |
| 141 | list_for_each_entry_safe(info, n, &mem_device->res_list, list) |
| 142 | kfree(info); |
KAMEZAWA Hiroyuki | 5d2870f | 2006-08-05 12:15:04 -0700 | [diff] [blame] | 143 | INIT_LIST_HEAD(&mem_device->res_list); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 144 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 145 | } |
| 146 | |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 147 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | } |
| 149 | |
| 150 | static int |
| 151 | acpi_memory_get_device(acpi_handle handle, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 152 | struct acpi_memory_device **mem_device) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | { |
| 154 | acpi_status status; |
| 155 | acpi_handle phandle; |
| 156 | struct acpi_device *device = NULL; |
| 157 | struct acpi_device *pdevice = NULL; |
Zhao Yakui | aa7b2b2 | 2009-07-03 10:49:03 +0800 | [diff] [blame] | 158 | int result; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 159 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 160 | |
| 161 | if (!acpi_bus_get_device(handle, &device) && device) |
| 162 | goto end; |
| 163 | |
| 164 | status = acpi_get_parent(handle, &phandle); |
| 165 | if (ACPI_FAILURE(status)) { |
Thomas Renninger | a6fc672 | 2006-06-26 23:58:43 -0400 | [diff] [blame] | 166 | ACPI_EXCEPTION((AE_INFO, status, "Cannot find acpi parent")); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 167 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 168 | } |
| 169 | |
| 170 | /* Get the parent device */ |
Zhao Yakui | aa7b2b2 | 2009-07-03 10:49:03 +0800 | [diff] [blame] | 171 | result = acpi_bus_get_device(phandle, &pdevice); |
| 172 | if (result) { |
| 173 | printk(KERN_WARNING PREFIX "Cannot get acpi bus device"); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 174 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 175 | } |
| 176 | |
| 177 | /* |
| 178 | * Now add the notified device. This creates the acpi_device |
| 179 | * and invokes .add function |
| 180 | */ |
Zhao Yakui | aa7b2b2 | 2009-07-03 10:49:03 +0800 | [diff] [blame] | 181 | result = acpi_bus_add(&device, pdevice, handle, ACPI_BUS_TYPE_DEVICE); |
| 182 | if (result) { |
| 183 | printk(KERN_WARNING PREFIX "Cannot add acpi bus"); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 184 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | } |
| 186 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 187 | end: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 188 | *mem_device = acpi_driver_data(device); |
| 189 | if (!(*mem_device)) { |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 190 | printk(KERN_ERR "\n driver data not found"); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 191 | return -ENODEV; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | } |
| 193 | |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 194 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 195 | } |
| 196 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 197 | static int acpi_memory_check_device(struct acpi_memory_device *mem_device) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 198 | { |
Matthew Wilcox | 27663c5 | 2008-10-10 02:22:59 -0400 | [diff] [blame] | 199 | unsigned long long current_status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 | |
| 201 | /* Get device present/absent information from the _STA */ |
Patrick Mochel | b863278 | 2006-05-19 16:54:41 -0400 | [diff] [blame] | 202 | if (ACPI_FAILURE(acpi_evaluate_integer(mem_device->device->handle, "_STA", |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 203 | NULL, ¤t_status))) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 204 | return -ENODEV; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | /* |
| 206 | * Check for device status. Device should be |
| 207 | * present/enabled/functioning. |
| 208 | */ |
Bjorn Helgaas | a0bd4ac | 2007-04-25 14:17:39 -0400 | [diff] [blame] | 209 | if (!((current_status & ACPI_STA_DEVICE_PRESENT) |
| 210 | && (current_status & ACPI_STA_DEVICE_ENABLED) |
| 211 | && (current_status & ACPI_STA_DEVICE_FUNCTIONING))) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 212 | return -ENODEV; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 213 | |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 214 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 215 | } |
| 216 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 217 | static int acpi_memory_enable_device(struct acpi_memory_device *mem_device) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 218 | { |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 219 | int result, num_enabled = 0; |
| 220 | struct acpi_memory_info *info; |
Yasunori Goto | 1e3590e | 2006-06-27 02:53:31 -0700 | [diff] [blame] | 221 | int node; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 222 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 223 | |
| 224 | /* Get the range from the _CRS */ |
| 225 | result = acpi_memory_get_device_resources(mem_device); |
| 226 | if (result) { |
Len Brown | 6468463 | 2006-06-26 23:41:38 -0400 | [diff] [blame] | 227 | printk(KERN_ERR PREFIX "get_device_resources failed\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 228 | mem_device->state = MEMORY_INVALID_STATE; |
| 229 | return result; |
| 230 | } |
| 231 | |
Patrick Mochel | b863278 | 2006-05-19 16:54:41 -0400 | [diff] [blame] | 232 | node = acpi_get_node(mem_device->device->handle); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 233 | /* |
| 234 | * Tell the VM there is more memory here... |
| 235 | * Note: Assume that this function returns zero on success |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 236 | * We don't have memory-hot-add rollback function,now. |
| 237 | * (i.e. memory-hot-remove function) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | */ |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 239 | list_for_each_entry(info, &mem_device->res_list, list) { |
KAMEZAWA Hiroyuki | fa25d8d | 2006-08-05 12:15:02 -0700 | [diff] [blame] | 240 | if (info->enabled) { /* just sanity check...*/ |
Yasunori Goto | dd56a8e | 2006-06-27 02:53:29 -0700 | [diff] [blame] | 241 | num_enabled++; |
| 242 | continue; |
| 243 | } |
Zhao Yakui | 5d2619f | 2009-07-07 10:56:11 +0800 | [diff] [blame] | 244 | /* |
| 245 | * If the memory block size is zero, please ignore it. |
| 246 | * Don't try to do the following memory hotplug flowchart. |
| 247 | */ |
| 248 | if (!info->length) |
| 249 | continue; |
Keith Mannthey | 8c2676a | 2006-09-30 23:27:07 -0700 | [diff] [blame] | 250 | if (node < 0) |
| 251 | node = memory_add_physaddr_to_nid(info->start_addr); |
| 252 | |
Yasunori Goto | bc02af9 | 2006-06-27 02:53:30 -0700 | [diff] [blame] | 253 | result = add_memory(node, info->start_addr, info->length); |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 254 | if (result) |
| 255 | continue; |
| 256 | info->enabled = 1; |
| 257 | num_enabled++; |
| 258 | } |
| 259 | if (!num_enabled) { |
akpm@osdl.org | 0a1f1ab | 2006-06-30 03:15:00 -0400 | [diff] [blame] | 260 | printk(KERN_ERR PREFIX "add_memory failed\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 261 | mem_device->state = MEMORY_INVALID_STATE; |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 262 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 263 | } |
Zhao Yakui | 5d2619f | 2009-07-07 10:56:11 +0800 | [diff] [blame] | 264 | /* |
| 265 | * Sometimes the memory device will contain several memory blocks. |
| 266 | * When one memory block is hot-added to the system memory, it will |
| 267 | * be regarded as a success. |
| 268 | * Otherwise if the last memory block can't be hot-added to the system |
| 269 | * memory, it will be failure and the memory device can't be bound with |
| 270 | * driver. |
| 271 | */ |
| 272 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 273 | } |
| 274 | |
Yasuaki Ishimatsu | 19387b2 | 2012-11-15 06:59:31 +0000 | [diff] [blame] | 275 | static int acpi_memory_remove_memory(struct acpi_memory_device *mem_device) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 276 | { |
| 277 | int result; |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 278 | struct acpi_memory_info *info, *n; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 279 | |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 280 | list_for_each_entry_safe(info, n, &mem_device->res_list, list) { |
| 281 | if (info->enabled) { |
| 282 | result = remove_memory(info->start_addr, info->length); |
| 283 | if (result) |
| 284 | return result; |
| 285 | } |
Yasuaki Ishimatsu | 19387b2 | 2012-11-15 06:59:31 +0000 | [diff] [blame] | 286 | |
| 287 | list_del(&info->list); |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 288 | kfree(info); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 289 | } |
| 290 | |
Yasuaki Ishimatsu | 19387b2 | 2012-11-15 06:59:31 +0000 | [diff] [blame] | 291 | return 0; |
| 292 | } |
| 293 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 294 | static void acpi_memory_device_notify(acpi_handle handle, u32 event, void *data) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 295 | { |
| 296 | struct acpi_memory_device *mem_device; |
| 297 | struct acpi_device *device; |
Wen Congyang | 315bbae | 2012-11-16 02:04:05 +0100 | [diff] [blame^] | 298 | struct acpi_eject_event *ej_event = NULL; |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 299 | u32 ost_code = ACPI_OST_SC_NON_SPECIFIC_FAILURE; /* default */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | |
| 301 | switch (event) { |
| 302 | case ACPI_NOTIFY_BUS_CHECK: |
| 303 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 304 | "\nReceived BUS CHECK notification for device\n")); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 305 | /* Fall Through */ |
| 306 | case ACPI_NOTIFY_DEVICE_CHECK: |
| 307 | if (event == ACPI_NOTIFY_DEVICE_CHECK) |
| 308 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 309 | "\nReceived DEVICE CHECK notification for device\n")); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 310 | if (acpi_memory_get_device(handle, &mem_device)) { |
Len Brown | 6468463 | 2006-06-26 23:41:38 -0400 | [diff] [blame] | 311 | printk(KERN_ERR PREFIX "Cannot find driver data\n"); |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 312 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 313 | } |
| 314 | |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 315 | if (acpi_memory_check_device(mem_device)) |
| 316 | break; |
| 317 | |
| 318 | if (acpi_memory_enable_device(mem_device)) { |
| 319 | printk(KERN_ERR PREFIX "Cannot enable memory device\n"); |
| 320 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | } |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 322 | |
| 323 | ost_code = ACPI_OST_SC_SUCCESS; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 324 | break; |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 325 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 326 | case ACPI_NOTIFY_EJECT_REQUEST: |
| 327 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 328 | "\nReceived EJECT REQUEST notification for device\n")); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 329 | |
| 330 | if (acpi_bus_get_device(handle, &device)) { |
Len Brown | 6468463 | 2006-06-26 23:41:38 -0400 | [diff] [blame] | 331 | printk(KERN_ERR PREFIX "Device doesn't exist\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 332 | break; |
| 333 | } |
| 334 | mem_device = acpi_driver_data(device); |
| 335 | if (!mem_device) { |
Len Brown | 6468463 | 2006-06-26 23:41:38 -0400 | [diff] [blame] | 336 | printk(KERN_ERR PREFIX "Driver Data is NULL\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 | break; |
| 338 | } |
| 339 | |
Wen Congyang | 315bbae | 2012-11-16 02:04:05 +0100 | [diff] [blame^] | 340 | ej_event = kmalloc(sizeof(*ej_event), GFP_KERNEL); |
| 341 | if (!ej_event) { |
| 342 | pr_err(PREFIX "No memory, dropping EJECT\n"); |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 343 | break; |
| 344 | } |
| 345 | |
Wen Congyang | 315bbae | 2012-11-16 02:04:05 +0100 | [diff] [blame^] | 346 | ej_event->handle = handle; |
| 347 | ej_event->event = ACPI_NOTIFY_EJECT_REQUEST; |
| 348 | acpi_os_hotplug_execute(acpi_bus_hot_remove_device, |
| 349 | (void *)ej_event); |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 350 | |
Wen Congyang | 315bbae | 2012-11-16 02:04:05 +0100 | [diff] [blame^] | 351 | /* eject is performed asynchronously */ |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 352 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 353 | default: |
| 354 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 355 | "Unsupported event [0x%x]\n", event)); |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 356 | |
| 357 | /* non-hotplug event; possibly handled by other handler */ |
| 358 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 359 | } |
| 360 | |
Toshi Kani | b1f00de | 2012-05-23 20:25:22 -0600 | [diff] [blame] | 361 | /* Inform firmware that the hotplug operation has completed */ |
| 362 | (void) acpi_evaluate_hotplug_ost(handle, event, ost_code, NULL); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 363 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 364 | } |
| 365 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 366 | static int acpi_memory_device_add(struct acpi_device *device) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 367 | { |
| 368 | int result; |
| 369 | struct acpi_memory_device *mem_device = NULL; |
| 370 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 371 | |
| 372 | if (!device) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 373 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 374 | |
Burman Yan | 36bcbec | 2006-12-19 12:56:11 -0800 | [diff] [blame] | 375 | mem_device = kzalloc(sizeof(struct acpi_memory_device), GFP_KERNEL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 376 | if (!mem_device) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 377 | return -ENOMEM; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 378 | |
KAMEZAWA Hiroyuki | 9ac0239 | 2006-06-27 02:53:27 -0700 | [diff] [blame] | 379 | INIT_LIST_HEAD(&mem_device->res_list); |
Patrick Mochel | 3b74863 | 2006-05-19 16:54:38 -0400 | [diff] [blame] | 380 | mem_device->device = device; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 381 | sprintf(acpi_device_name(device), "%s", ACPI_MEMORY_DEVICE_NAME); |
| 382 | sprintf(acpi_device_class(device), "%s", ACPI_MEMORY_DEVICE_CLASS); |
Pavel Machek | db89b4f | 2008-09-22 14:37:34 -0700 | [diff] [blame] | 383 | device->driver_data = mem_device; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 384 | |
| 385 | /* Get the range from the _CRS */ |
| 386 | result = acpi_memory_get_device_resources(mem_device); |
| 387 | if (result) { |
| 388 | kfree(mem_device); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 389 | return result; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 390 | } |
| 391 | |
| 392 | /* Set the device state */ |
| 393 | mem_device->state = MEMORY_POWER_ON_STATE; |
| 394 | |
Yasunori Goto | 6cbe44c | 2006-10-19 23:28:30 -0700 | [diff] [blame] | 395 | printk(KERN_DEBUG "%s \n", acpi_device_name(device)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 396 | |
Bjorn Helgaas | 80f20fe | 2009-06-22 20:41:25 +0000 | [diff] [blame] | 397 | /* |
| 398 | * Early boot code has recognized memory area by EFI/E820. |
| 399 | * If DSDT shows these memory devices on boot, hotplug is not necessary |
| 400 | * for them. So, it just returns until completion of this driver's |
| 401 | * start up. |
| 402 | */ |
| 403 | if (!acpi_hotmem_initialized) |
| 404 | return 0; |
| 405 | |
| 406 | if (!acpi_memory_check_device(mem_device)) { |
| 407 | /* call add_memory func */ |
| 408 | result = acpi_memory_enable_device(mem_device); |
| 409 | if (result) |
| 410 | printk(KERN_ERR PREFIX |
| 411 | "Error in acpi_memory_enable_device\n"); |
| 412 | } |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 413 | return result; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 414 | } |
| 415 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 416 | static int acpi_memory_device_remove(struct acpi_device *device, int type) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 417 | { |
| 418 | struct acpi_memory_device *mem_device = NULL; |
Yasuaki Ishimatsu | 19387b2 | 2012-11-15 06:59:31 +0000 | [diff] [blame] | 419 | int result; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 420 | |
| 421 | if (!device || !acpi_driver_data(device)) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 422 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 423 | |
Jan Engelhardt | 50dd096 | 2006-10-01 00:28:50 +0200 | [diff] [blame] | 424 | mem_device = acpi_driver_data(device); |
Yasuaki Ishimatsu | 19387b2 | 2012-11-15 06:59:31 +0000 | [diff] [blame] | 425 | |
| 426 | result = acpi_memory_remove_memory(mem_device); |
| 427 | if (result) |
| 428 | return result; |
| 429 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 430 | kfree(mem_device); |
| 431 | |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 432 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 433 | } |
| 434 | |
| 435 | /* |
| 436 | * Helper function to check for memory device |
| 437 | */ |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 438 | static acpi_status is_memory_device(acpi_handle handle) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 439 | { |
| 440 | char *hardware_id; |
| 441 | acpi_status status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 442 | struct acpi_device_info *info; |
| 443 | |
Bob Moore | 15b8dd5 | 2009-06-29 13:39:29 +0800 | [diff] [blame] | 444 | status = acpi_get_object_info(handle, &info); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 445 | if (ACPI_FAILURE(status)) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 446 | return status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 447 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 448 | if (!(info->valid & ACPI_VALID_HID)) { |
Bob Moore | 15b8dd5 | 2009-06-29 13:39:29 +0800 | [diff] [blame] | 449 | kfree(info); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 450 | return AE_ERROR; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 451 | } |
| 452 | |
Bob Moore | 15b8dd5 | 2009-06-29 13:39:29 +0800 | [diff] [blame] | 453 | hardware_id = info->hardware_id.string; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 454 | if ((hardware_id == NULL) || |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 455 | (strcmp(hardware_id, ACPI_MEMORY_DEVICE_HID))) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 | status = AE_ERROR; |
| 457 | |
Bob Moore | 15b8dd5 | 2009-06-29 13:39:29 +0800 | [diff] [blame] | 458 | kfree(info); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 459 | return status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 460 | } |
| 461 | |
| 462 | static acpi_status |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 463 | acpi_memory_register_notify_handler(acpi_handle handle, |
| 464 | u32 level, void *ctxt, void **retv) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 465 | { |
| 466 | acpi_status status; |
| 467 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 468 | |
| 469 | status = is_memory_device(handle); |
Yasunori Goto | 07dd485 | 2006-08-14 22:37:32 -0700 | [diff] [blame] | 470 | if (ACPI_FAILURE(status)) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 471 | return AE_OK; /* continue */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 472 | |
Thomas Renninger | a6fc672 | 2006-06-26 23:58:43 -0400 | [diff] [blame] | 473 | status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, |
| 474 | acpi_memory_device_notify, NULL); |
| 475 | /* continue */ |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 476 | return AE_OK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 477 | } |
| 478 | |
| 479 | static acpi_status |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 480 | acpi_memory_deregister_notify_handler(acpi_handle handle, |
| 481 | u32 level, void *ctxt, void **retv) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 482 | { |
| 483 | acpi_status status; |
| 484 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 485 | |
| 486 | status = is_memory_device(handle); |
Yasunori Goto | 07dd485 | 2006-08-14 22:37:32 -0700 | [diff] [blame] | 487 | if (ACPI_FAILURE(status)) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 488 | return AE_OK; /* continue */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 489 | |
| 490 | status = acpi_remove_notify_handler(handle, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 491 | ACPI_SYSTEM_NOTIFY, |
| 492 | acpi_memory_device_notify); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 493 | |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 494 | return AE_OK; /* continue */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 495 | } |
| 496 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 497 | static int __init acpi_memory_device_init(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 498 | { |
| 499 | int result; |
| 500 | acpi_status status; |
| 501 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 502 | |
| 503 | result = acpi_bus_register_driver(&acpi_memory_device_driver); |
| 504 | |
| 505 | if (result < 0) |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 506 | return -ENODEV; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 507 | |
| 508 | status = acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 509 | ACPI_UINT32_MAX, |
Lin Ming | 2263576 | 2009-11-13 10:06:08 +0800 | [diff] [blame] | 510 | acpi_memory_register_notify_handler, NULL, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 511 | NULL, NULL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 512 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 513 | if (ACPI_FAILURE(status)) { |
Thomas Renninger | a6fc672 | 2006-06-26 23:58:43 -0400 | [diff] [blame] | 514 | ACPI_EXCEPTION((AE_INFO, status, "walk_namespace failed")); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 515 | acpi_bus_unregister_driver(&acpi_memory_device_driver); |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 516 | return -ENODEV; |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 517 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 518 | |
Yasunori Goto | 887b959 | 2006-10-19 23:28:31 -0700 | [diff] [blame] | 519 | acpi_hotmem_initialized = 1; |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 520 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 521 | } |
| 522 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 523 | static void __exit acpi_memory_device_exit(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 524 | { |
| 525 | acpi_status status; |
| 526 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 527 | |
| 528 | /* |
| 529 | * Adding this to un-install notification handlers for all the device |
| 530 | * handles. |
| 531 | */ |
| 532 | status = acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 533 | ACPI_UINT32_MAX, |
Lin Ming | 2263576 | 2009-11-13 10:06:08 +0800 | [diff] [blame] | 534 | acpi_memory_deregister_notify_handler, NULL, |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 535 | NULL, NULL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 536 | |
Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 537 | if (ACPI_FAILURE(status)) |
Thomas Renninger | a6fc672 | 2006-06-26 23:58:43 -0400 | [diff] [blame] | 538 | ACPI_EXCEPTION((AE_INFO, status, "walk_namespace failed")); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 539 | |
| 540 | acpi_bus_unregister_driver(&acpi_memory_device_driver); |
| 541 | |
Patrick Mochel | d550d98 | 2006-06-27 00:41:40 -0400 | [diff] [blame] | 542 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 543 | } |
| 544 | |
| 545 | module_init(acpi_memory_device_init); |
| 546 | module_exit(acpi_memory_device_exit); |