1 /* 2 * pnpacpi -- PnP ACPI driver 3 * 4 * Copyright (c) 2004 Matthieu Castet <castet.matthieu@free.fr> 5 * Copyright (c) 2004 Li Shaohua <shaohua.li@intel.com> 6 * 7 * This program is free software; you can redistribute it and/or modify it 8 * under the terms of the GNU General Public License as published by the 9 * Free Software Foundation; either version 2, or (at your option) any 10 * later version. 11 * 12 * This program is distributed in the hope that it will be useful, but 13 * WITHOUT ANY WARRANTY; without even the implied warranty of 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 15 * General Public License for more 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 20 */ 21 22 #include <linux/acpi.h> 23 #include <linux/pnp.h> 24 #include <linux/slab.h> 25 #include <linux/mod_devicetable.h> 26 #include <acpi/acpi_bus.h> 27 28 #include "../base.h" 29 #include "pnpacpi.h" 30 31 static int num; 32 33 /* We need only to blacklist devices that have already an acpi driver that 34 * can't use pnp layer. We don't need to blacklist device that are directly 35 * used by the kernel (PCI root, ...), as it is harmless and there were 36 * already present in pnpbios. But there is an exception for devices that 37 * have irqs (PIC, Timer) because we call acpi_register_gsi. 38 * Finally, only devices that have a CRS method need to be in this list. 39 */ 40 static struct acpi_device_id excluded_id_list[] __initdata = { 41 {"PNP0C09", 0}, /* EC */ 42 {"PNP0C0F", 0}, /* Link device */ 43 {"PNP0000", 0}, /* PIC */ 44 {"PNP0100", 0}, /* Timer */ 45 {"", 0}, 46 }; 47 48 static inline int __init is_exclusive_device(struct acpi_device *dev) 49 { 50 return (!acpi_match_device_ids(dev, excluded_id_list)); 51 } 52 53 /* 54 * Compatible Device IDs 55 */ 56 #define TEST_HEX(c) \ 57 if (!(('0' <= (c) && (c) <= '9') || ('A' <= (c) && (c) <= 'F'))) \ 58 return 0 59 #define TEST_ALPHA(c) \ 60 if (!('@' <= (c) || (c) <= 'Z')) \ 61 return 0 62 static int __init ispnpidacpi(const char *id) 63 { 64 TEST_ALPHA(id[0]); 65 TEST_ALPHA(id[1]); 66 TEST_ALPHA(id[2]); 67 TEST_HEX(id[3]); 68 TEST_HEX(id[4]); 69 TEST_HEX(id[5]); 70 TEST_HEX(id[6]); 71 if (id[7] != '\0') 72 return 0; 73 return 1; 74 } 75 76 static int pnpacpi_get_resources(struct pnp_dev *dev) 77 { 78 pnp_dbg(&dev->dev, "get resources\n"); 79 return pnpacpi_parse_allocated_resource(dev); 80 } 81 82 static int pnpacpi_set_resources(struct pnp_dev *dev) 83 { 84 struct acpi_device *acpi_dev = dev->data; 85 acpi_handle handle = acpi_dev->handle; 86 struct acpi_buffer buffer; 87 int ret; 88 89 pnp_dbg(&dev->dev, "set resources\n"); 90 ret = pnpacpi_build_resource_template(dev, &buffer); 91 if (ret) 92 return ret; 93 ret = pnpacpi_encode_resources(dev, &buffer); 94 if (ret) { 95 kfree(buffer.pointer); 96 return ret; 97 } 98 if (ACPI_FAILURE(acpi_set_current_resources(handle, &buffer))) 99 ret = -EINVAL; 100 else if (acpi_bus_power_manageable(handle)) 101 ret = acpi_bus_set_power(handle, ACPI_STATE_D0); 102 kfree(buffer.pointer); 103 return ret; 104 } 105 106 static int pnpacpi_disable_resources(struct pnp_dev *dev) 107 { 108 struct acpi_device *acpi_dev = dev->data; 109 acpi_handle handle = acpi_dev->handle; 110 int ret; 111 112 dev_dbg(&dev->dev, "disable resources\n"); 113 114 /* acpi_unregister_gsi(pnp_irq(dev, 0)); */ 115 ret = 0; 116 if (acpi_bus_power_manageable(handle)) 117 acpi_bus_set_power(handle, ACPI_STATE_D3); 118 /* continue even if acpi_bus_set_power() fails */ 119 if (ACPI_FAILURE(acpi_evaluate_object(handle, "_DIS", NULL, NULL))) 120 ret = -ENODEV; 121 return ret; 122 } 123 124 #ifdef CONFIG_ACPI_SLEEP 125 static bool pnpacpi_can_wakeup(struct pnp_dev *dev) 126 { 127 struct acpi_device *acpi_dev = dev->data; 128 acpi_handle handle = acpi_dev->handle; 129 130 return acpi_bus_can_wakeup(handle); 131 } 132 133 static int pnpacpi_suspend(struct pnp_dev *dev, pm_message_t state) 134 { 135 struct acpi_device *acpi_dev = dev->data; 136 acpi_handle handle = acpi_dev->handle; 137 int power_state; 138 139 if (device_can_wakeup(&dev->dev)) { 140 int rc = acpi_pm_device_sleep_wake(&dev->dev, 141 device_may_wakeup(&dev->dev)); 142 143 if (rc) 144 return rc; 145 } 146 power_state = acpi_pm_device_sleep_state(&dev->dev, NULL); 147 if (power_state < 0) 148 power_state = (state.event == PM_EVENT_ON) ? 149 ACPI_STATE_D0 : ACPI_STATE_D3; 150 151 /* acpi_bus_set_power() often fails (keyboard port can't be 152 * powered-down?), and in any case, our return value is ignored 153 * by pnp_bus_suspend(). Hence we don't revert the wakeup 154 * setting if the set_power fails. 155 */ 156 return acpi_bus_set_power(handle, power_state); 157 } 158 159 static int pnpacpi_resume(struct pnp_dev *dev) 160 { 161 struct acpi_device *acpi_dev = dev->data; 162 acpi_handle handle = acpi_dev->handle; 163 164 if (device_may_wakeup(&dev->dev)) 165 acpi_pm_device_sleep_wake(&dev->dev, false); 166 return acpi_bus_set_power(handle, ACPI_STATE_D0); 167 } 168 #endif 169 170 struct pnp_protocol pnpacpi_protocol = { 171 .name = "Plug and Play ACPI", 172 .get = pnpacpi_get_resources, 173 .set = pnpacpi_set_resources, 174 .disable = pnpacpi_disable_resources, 175 #ifdef CONFIG_ACPI_SLEEP 176 .can_wakeup = pnpacpi_can_wakeup, 177 .suspend = pnpacpi_suspend, 178 .resume = pnpacpi_resume, 179 #endif 180 }; 181 EXPORT_SYMBOL(pnpacpi_protocol); 182 183 static char *__init pnpacpi_get_id(struct acpi_device *device) 184 { 185 struct acpi_hardware_id *id; 186 187 list_for_each_entry(id, &device->pnp.ids, list) { 188 if (ispnpidacpi(id->id)) 189 return id->id; 190 } 191 192 return NULL; 193 } 194 195 static int __init pnpacpi_add_device(struct acpi_device *device) 196 { 197 acpi_handle temp = NULL; 198 acpi_status status; 199 struct pnp_dev *dev; 200 char *pnpid; 201 struct acpi_hardware_id *id; 202 203 /* 204 * If a PnPacpi device is not present , the device 205 * driver should not be loaded. 206 */ 207 status = acpi_get_handle(device->handle, "_CRS", &temp); 208 if (ACPI_FAILURE(status)) 209 return 0; 210 211 pnpid = pnpacpi_get_id(device); 212 if (!pnpid) 213 return 0; 214 215 if (is_exclusive_device(device) || !device->status.present) 216 return 0; 217 218 dev = pnp_alloc_dev(&pnpacpi_protocol, num, pnpid); 219 if (!dev) 220 return -ENOMEM; 221 222 dev->data = device; 223 /* .enabled means the device can decode the resources */ 224 dev->active = device->status.enabled; 225 status = acpi_get_handle(device->handle, "_SRS", &temp); 226 if (ACPI_SUCCESS(status)) 227 dev->capabilities |= PNP_CONFIGURABLE; 228 dev->capabilities |= PNP_READ; 229 if (device->flags.dynamic_status && (dev->capabilities & PNP_CONFIGURABLE)) 230 dev->capabilities |= PNP_WRITE; 231 if (device->flags.removable) 232 dev->capabilities |= PNP_REMOVABLE; 233 status = acpi_get_handle(device->handle, "_DIS", &temp); 234 if (ACPI_SUCCESS(status)) 235 dev->capabilities |= PNP_DISABLE; 236 237 if (strlen(acpi_device_name(device))) 238 strncpy(dev->name, acpi_device_name(device), sizeof(dev->name)); 239 else 240 strncpy(dev->name, acpi_device_bid(device), sizeof(dev->name)); 241 242 if (dev->active) 243 pnpacpi_parse_allocated_resource(dev); 244 245 if (dev->capabilities & PNP_CONFIGURABLE) 246 pnpacpi_parse_resource_option_data(dev); 247 248 list_for_each_entry(id, &device->pnp.ids, list) { 249 if (!strcmp(id->id, pnpid)) 250 continue; 251 if (!ispnpidacpi(id->id)) 252 continue; 253 pnp_add_id(dev, id->id); 254 } 255 256 /* clear out the damaged flags */ 257 if (!dev->active) 258 pnp_init_resources(dev); 259 pnp_add_device(dev); 260 num++; 261 262 return AE_OK; 263 } 264 265 static acpi_status __init pnpacpi_add_device_handler(acpi_handle handle, 266 u32 lvl, void *context, 267 void **rv) 268 { 269 struct acpi_device *device; 270 271 if (!acpi_bus_get_device(handle, &device)) 272 pnpacpi_add_device(device); 273 else 274 return AE_CTRL_DEPTH; 275 return AE_OK; 276 } 277 278 static int __init acpi_pnp_match(struct device *dev, void *_pnp) 279 { 280 struct acpi_device *acpi = to_acpi_device(dev); 281 struct pnp_dev *pnp = _pnp; 282 283 /* true means it matched */ 284 return !acpi_get_physical_device(acpi->handle) 285 && compare_pnp_id(pnp->id, acpi_device_hid(acpi)); 286 } 287 288 static int __init acpi_pnp_find_device(struct device *dev, acpi_handle * handle) 289 { 290 struct device *adev; 291 struct acpi_device *acpi; 292 293 adev = bus_find_device(&acpi_bus_type, NULL, 294 to_pnp_dev(dev), acpi_pnp_match); 295 if (!adev) 296 return -ENODEV; 297 298 acpi = to_acpi_device(adev); 299 *handle = acpi->handle; 300 put_device(adev); 301 return 0; 302 } 303 304 /* complete initialization of a PNPACPI device includes having 305 * pnpdev->dev.archdata.acpi_handle point to its ACPI sibling. 306 */ 307 static struct acpi_bus_type __initdata acpi_pnp_bus = { 308 .bus = &pnp_bus_type, 309 .find_device = acpi_pnp_find_device, 310 }; 311 312 int pnpacpi_disabled __initdata; 313 static int __init pnpacpi_init(void) 314 { 315 if (acpi_disabled || pnpacpi_disabled) { 316 printk(KERN_INFO "pnp: PnP ACPI: disabled\n"); 317 return 0; 318 } 319 printk(KERN_INFO "pnp: PnP ACPI init\n"); 320 pnp_register_protocol(&pnpacpi_protocol); 321 register_acpi_bus_type(&acpi_pnp_bus); 322 acpi_get_devices(NULL, pnpacpi_add_device_handler, NULL, NULL); 323 printk(KERN_INFO "pnp: PnP ACPI: found %d devices\n", num); 324 unregister_acpi_bus_type(&acpi_pnp_bus); 325 pnp_platform_devices = 1; 326 return 0; 327 } 328 329 fs_initcall(pnpacpi_init); 330 331 static int __init pnpacpi_setup(char *str) 332 { 333 if (str == NULL) 334 return 1; 335 if (!strncmp(str, "off", 3)) 336 pnpacpi_disabled = 1; 337 return 1; 338 } 339 340 __setup("pnpacpi=", pnpacpi_setup); 341