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/mod_devicetable.h> 25 #include <acpi/acpi_bus.h> 26 27 #include "../base.h" 28 #include "pnpacpi.h" 29 30 static int num = 0; 31 32 /* We need only to blacklist devices that have already an acpi driver that 33 * can't use pnp layer. We don't need to blacklist device that are directly 34 * used by the kernel (PCI root, ...), as it is harmless and there were 35 * already present in pnpbios. But there is an exception for devices that 36 * have irqs (PIC, Timer) because we call acpi_register_gsi. 37 * Finally, only devices that have a CRS method need to be in this list. 38 */ 39 static struct acpi_device_id excluded_id_list[] __initdata = { 40 {"PNP0C09", 0}, /* EC */ 41 {"PNP0C0F", 0}, /* Link device */ 42 {"PNP0000", 0}, /* PIC */ 43 {"PNP0100", 0}, /* Timer */ 44 {"", 0}, 45 }; 46 47 static inline int __init is_exclusive_device(struct acpi_device *dev) 48 { 49 return (!acpi_match_device_ids(dev, excluded_id_list)); 50 } 51 52 /* 53 * Compatible Device IDs 54 */ 55 #define TEST_HEX(c) \ 56 if (!(('0' <= (c) && (c) <= '9') || ('A' <= (c) && (c) <= 'F'))) \ 57 return 0 58 #define TEST_ALPHA(c) \ 59 if (!('@' <= (c) || (c) <= 'Z')) \ 60 return 0 61 static int __init ispnpidacpi(char *id) 62 { 63 TEST_ALPHA(id[0]); 64 TEST_ALPHA(id[1]); 65 TEST_ALPHA(id[2]); 66 TEST_HEX(id[3]); 67 TEST_HEX(id[4]); 68 TEST_HEX(id[5]); 69 TEST_HEX(id[6]); 70 if (id[7] != '\0') 71 return 0; 72 return 1; 73 } 74 75 static int pnpacpi_get_resources(struct pnp_dev *dev) 76 { 77 pnp_dbg(&dev->dev, "get resources\n"); 78 return pnpacpi_parse_allocated_resource(dev); 79 } 80 81 static int pnpacpi_set_resources(struct pnp_dev *dev) 82 { 83 acpi_handle handle = dev->data; 84 struct acpi_buffer buffer; 85 int ret; 86 87 pnp_dbg(&dev->dev, "set resources\n"); 88 ret = pnpacpi_build_resource_template(dev, &buffer); 89 if (ret) 90 return ret; 91 ret = pnpacpi_encode_resources(dev, &buffer); 92 if (ret) { 93 kfree(buffer.pointer); 94 return ret; 95 } 96 if (ACPI_FAILURE(acpi_set_current_resources(handle, &buffer))) 97 ret = -EINVAL; 98 else if (acpi_bus_power_manageable(handle)) 99 ret = acpi_bus_set_power(handle, ACPI_STATE_D0); 100 kfree(buffer.pointer); 101 return ret; 102 } 103 104 static int pnpacpi_disable_resources(struct pnp_dev *dev) 105 { 106 acpi_handle handle = dev->data; 107 int ret; 108 109 dev_dbg(&dev->dev, "disable resources\n"); 110 111 /* acpi_unregister_gsi(pnp_irq(dev, 0)); */ 112 ret = 0; 113 if (acpi_bus_power_manageable(handle)) 114 acpi_bus_set_power(handle, ACPI_STATE_D3); 115 /* continue even if acpi_bus_set_power() fails */ 116 if (ACPI_FAILURE(acpi_evaluate_object(handle, "_DIS", NULL, NULL))) 117 ret = -ENODEV; 118 return ret; 119 } 120 121 #ifdef CONFIG_ACPI_SLEEP 122 static int pnpacpi_suspend(struct pnp_dev *dev, pm_message_t state) 123 { 124 int power_state; 125 126 power_state = acpi_pm_device_sleep_state(&dev->dev, NULL); 127 if (power_state < 0) 128 power_state = (state.event == PM_EVENT_ON) ? 129 ACPI_STATE_D0 : ACPI_STATE_D3; 130 131 return acpi_bus_set_power((acpi_handle) dev->data, power_state); 132 } 133 134 static int pnpacpi_resume(struct pnp_dev *dev) 135 { 136 return acpi_bus_set_power((acpi_handle) dev->data, ACPI_STATE_D0); 137 } 138 #endif 139 140 static struct pnp_protocol pnpacpi_protocol = { 141 .name = "Plug and Play ACPI", 142 .get = pnpacpi_get_resources, 143 .set = pnpacpi_set_resources, 144 .disable = pnpacpi_disable_resources, 145 #ifdef CONFIG_ACPI_SLEEP 146 .suspend = pnpacpi_suspend, 147 .resume = pnpacpi_resume, 148 #endif 149 }; 150 151 static int __init pnpacpi_add_device(struct acpi_device *device) 152 { 153 acpi_handle temp = NULL; 154 acpi_status status; 155 struct pnp_dev *dev; 156 struct acpi_hardware_id *id; 157 158 /* 159 * If a PnPacpi device is not present , the device 160 * driver should not be loaded. 161 */ 162 status = acpi_get_handle(device->handle, "_CRS", &temp); 163 if (ACPI_FAILURE(status) || !ispnpidacpi(acpi_device_hid(device)) || 164 is_exclusive_device(device) || (!device->status.present)) 165 return 0; 166 167 dev = pnp_alloc_dev(&pnpacpi_protocol, num, acpi_device_hid(device)); 168 if (!dev) 169 return -ENOMEM; 170 171 dev->data = device->handle; 172 /* .enabled means the device can decode the resources */ 173 dev->active = device->status.enabled; 174 status = acpi_get_handle(device->handle, "_SRS", &temp); 175 if (ACPI_SUCCESS(status)) 176 dev->capabilities |= PNP_CONFIGURABLE; 177 dev->capabilities |= PNP_READ; 178 if (device->flags.dynamic_status && (dev->capabilities & PNP_CONFIGURABLE)) 179 dev->capabilities |= PNP_WRITE; 180 if (device->flags.removable) 181 dev->capabilities |= PNP_REMOVABLE; 182 status = acpi_get_handle(device->handle, "_DIS", &temp); 183 if (ACPI_SUCCESS(status)) 184 dev->capabilities |= PNP_DISABLE; 185 186 if (strlen(acpi_device_name(device))) 187 strncpy(dev->name, acpi_device_name(device), sizeof(dev->name)); 188 else 189 strncpy(dev->name, acpi_device_bid(device), sizeof(dev->name)); 190 191 if (dev->active) 192 pnpacpi_parse_allocated_resource(dev); 193 194 if (dev->capabilities & PNP_CONFIGURABLE) 195 pnpacpi_parse_resource_option_data(dev); 196 197 list_for_each_entry(id, &device->pnp.ids, list) { 198 if (!strcmp(id->id, acpi_device_hid(device))) 199 continue; 200 if (!ispnpidacpi(id->id)) 201 continue; 202 pnp_add_id(dev, id->id); 203 } 204 205 /* clear out the damaged flags */ 206 if (!dev->active) 207 pnp_init_resources(dev); 208 pnp_add_device(dev); 209 num++; 210 211 return AE_OK; 212 } 213 214 static acpi_status __init pnpacpi_add_device_handler(acpi_handle handle, 215 u32 lvl, void *context, 216 void **rv) 217 { 218 struct acpi_device *device; 219 220 if (!acpi_bus_get_device(handle, &device)) 221 pnpacpi_add_device(device); 222 else 223 return AE_CTRL_DEPTH; 224 return AE_OK; 225 } 226 227 static int __init acpi_pnp_match(struct device *dev, void *_pnp) 228 { 229 struct acpi_device *acpi = to_acpi_device(dev); 230 struct pnp_dev *pnp = _pnp; 231 232 /* true means it matched */ 233 return !acpi_get_physical_device(acpi->handle) 234 && compare_pnp_id(pnp->id, acpi_device_hid(acpi)); 235 } 236 237 static int __init acpi_pnp_find_device(struct device *dev, acpi_handle * handle) 238 { 239 struct device *adev; 240 struct acpi_device *acpi; 241 242 adev = bus_find_device(&acpi_bus_type, NULL, 243 to_pnp_dev(dev), acpi_pnp_match); 244 if (!adev) 245 return -ENODEV; 246 247 acpi = to_acpi_device(adev); 248 *handle = acpi->handle; 249 put_device(adev); 250 return 0; 251 } 252 253 /* complete initialization of a PNPACPI device includes having 254 * pnpdev->dev.archdata.acpi_handle point to its ACPI sibling. 255 */ 256 static struct acpi_bus_type __initdata acpi_pnp_bus = { 257 .bus = &pnp_bus_type, 258 .find_device = acpi_pnp_find_device, 259 }; 260 261 int pnpacpi_disabled __initdata; 262 static int __init pnpacpi_init(void) 263 { 264 if (acpi_disabled || pnpacpi_disabled) { 265 printk(KERN_INFO "pnp: PnP ACPI: disabled\n"); 266 return 0; 267 } 268 printk(KERN_INFO "pnp: PnP ACPI init\n"); 269 pnp_register_protocol(&pnpacpi_protocol); 270 register_acpi_bus_type(&acpi_pnp_bus); 271 acpi_get_devices(NULL, pnpacpi_add_device_handler, NULL, NULL); 272 printk(KERN_INFO "pnp: PnP ACPI: found %d devices\n", num); 273 unregister_acpi_bus_type(&acpi_pnp_bus); 274 pnp_platform_devices = 1; 275 return 0; 276 } 277 278 fs_initcall(pnpacpi_init); 279 280 static int __init pnpacpi_setup(char *str) 281 { 282 if (str == NULL) 283 return 1; 284 if (!strncmp(str, "off", 3)) 285 pnpacpi_disabled = 1; 286 return 1; 287 } 288 289 __setup("pnpacpi=", pnpacpi_setup); 290