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 = 0; 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(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 int __init pnpacpi_add_device(struct acpi_device *device) 184 { 185 acpi_handle temp = NULL; 186 acpi_status status; 187 struct pnp_dev *dev; 188 struct acpi_hardware_id *id; 189 190 /* 191 * If a PnPacpi device is not present , the device 192 * driver should not be loaded. 193 */ 194 status = acpi_get_handle(device->handle, "_CRS", &temp); 195 if (ACPI_FAILURE(status) || !ispnpidacpi(acpi_device_hid(device)) || 196 is_exclusive_device(device) || (!device->status.present)) 197 return 0; 198 199 dev = pnp_alloc_dev(&pnpacpi_protocol, num, acpi_device_hid(device)); 200 if (!dev) 201 return -ENOMEM; 202 203 dev->data = device; 204 /* .enabled means the device can decode the resources */ 205 dev->active = device->status.enabled; 206 status = acpi_get_handle(device->handle, "_SRS", &temp); 207 if (ACPI_SUCCESS(status)) 208 dev->capabilities |= PNP_CONFIGURABLE; 209 dev->capabilities |= PNP_READ; 210 if (device->flags.dynamic_status && (dev->capabilities & PNP_CONFIGURABLE)) 211 dev->capabilities |= PNP_WRITE; 212 if (device->flags.removable) 213 dev->capabilities |= PNP_REMOVABLE; 214 status = acpi_get_handle(device->handle, "_DIS", &temp); 215 if (ACPI_SUCCESS(status)) 216 dev->capabilities |= PNP_DISABLE; 217 218 if (strlen(acpi_device_name(device))) 219 strncpy(dev->name, acpi_device_name(device), sizeof(dev->name)); 220 else 221 strncpy(dev->name, acpi_device_bid(device), sizeof(dev->name)); 222 223 if (dev->active) 224 pnpacpi_parse_allocated_resource(dev); 225 226 if (dev->capabilities & PNP_CONFIGURABLE) 227 pnpacpi_parse_resource_option_data(dev); 228 229 list_for_each_entry(id, &device->pnp.ids, list) { 230 if (!strcmp(id->id, acpi_device_hid(device))) 231 continue; 232 if (!ispnpidacpi(id->id)) 233 continue; 234 pnp_add_id(dev, id->id); 235 } 236 237 /* clear out the damaged flags */ 238 if (!dev->active) 239 pnp_init_resources(dev); 240 pnp_add_device(dev); 241 num++; 242 243 return AE_OK; 244 } 245 246 static acpi_status __init pnpacpi_add_device_handler(acpi_handle handle, 247 u32 lvl, void *context, 248 void **rv) 249 { 250 struct acpi_device *device; 251 252 if (!acpi_bus_get_device(handle, &device)) 253 pnpacpi_add_device(device); 254 else 255 return AE_CTRL_DEPTH; 256 return AE_OK; 257 } 258 259 static int __init acpi_pnp_match(struct device *dev, void *_pnp) 260 { 261 struct acpi_device *acpi = to_acpi_device(dev); 262 struct pnp_dev *pnp = _pnp; 263 264 /* true means it matched */ 265 return !acpi_get_physical_device(acpi->handle) 266 && compare_pnp_id(pnp->id, acpi_device_hid(acpi)); 267 } 268 269 static int __init acpi_pnp_find_device(struct device *dev, acpi_handle * handle) 270 { 271 struct device *adev; 272 struct acpi_device *acpi; 273 274 adev = bus_find_device(&acpi_bus_type, NULL, 275 to_pnp_dev(dev), acpi_pnp_match); 276 if (!adev) 277 return -ENODEV; 278 279 acpi = to_acpi_device(adev); 280 *handle = acpi->handle; 281 put_device(adev); 282 return 0; 283 } 284 285 /* complete initialization of a PNPACPI device includes having 286 * pnpdev->dev.archdata.acpi_handle point to its ACPI sibling. 287 */ 288 static struct acpi_bus_type __initdata acpi_pnp_bus = { 289 .bus = &pnp_bus_type, 290 .find_device = acpi_pnp_find_device, 291 }; 292 293 int pnpacpi_disabled __initdata; 294 static int __init pnpacpi_init(void) 295 { 296 if (acpi_disabled || pnpacpi_disabled) { 297 printk(KERN_INFO "pnp: PnP ACPI: disabled\n"); 298 return 0; 299 } 300 printk(KERN_INFO "pnp: PnP ACPI init\n"); 301 pnp_register_protocol(&pnpacpi_protocol); 302 register_acpi_bus_type(&acpi_pnp_bus); 303 acpi_get_devices(NULL, pnpacpi_add_device_handler, NULL, NULL); 304 printk(KERN_INFO "pnp: PnP ACPI: found %d devices\n", num); 305 unregister_acpi_bus_type(&acpi_pnp_bus); 306 pnp_platform_devices = 1; 307 return 0; 308 } 309 310 fs_initcall(pnpacpi_init); 311 312 static int __init pnpacpi_setup(char *str) 313 { 314 if (str == NULL) 315 return 1; 316 if (!strncmp(str, "off", 3)) 317 pnpacpi_disabled = 1; 318 return 1; 319 } 320 321 __setup("pnpacpi=", pnpacpi_setup); 322