1 /* 2 * IOAPIC/IOxAPIC/IOSAPIC driver 3 * 4 * Copyright (C) 2009 Fujitsu Limited. 5 * (c) Copyright 2009 Hewlett-Packard Development Company, L.P. 6 * 7 * Copyright (C) 2014 Intel Corporation 8 * 9 * This program is free software; you can redistribute it and/or modify 10 * it under the terms of the GNU General Public License version 2 as 11 * published by the Free Software Foundation. 12 * 13 * Based on original drivers/pci/ioapic.c 14 * Yinghai Lu <yinghai@kernel.org> 15 * Jiang Liu <jiang.liu@intel.com> 16 */ 17 18 /* 19 * This driver manages I/O APICs added by hotplug after boot. 20 * We try to claim all I/O APIC devices, but those present at boot were 21 * registered when we parsed the ACPI MADT. 22 */ 23 24 #define pr_fmt(fmt) "ACPI : IOAPIC: " fmt 25 26 #include <linux/slab.h> 27 #include <linux/acpi.h> 28 #include <linux/pci.h> 29 #include <acpi/acpi.h> 30 31 struct acpi_pci_ioapic { 32 acpi_handle root_handle; 33 acpi_handle handle; 34 u32 gsi_base; 35 struct resource res; 36 struct pci_dev *pdev; 37 struct list_head list; 38 }; 39 40 static LIST_HEAD(ioapic_list); 41 static DEFINE_MUTEX(ioapic_list_lock); 42 43 static acpi_status setup_res(struct acpi_resource *acpi_res, void *data) 44 { 45 struct resource *res = data; 46 struct resource_win win; 47 48 res->flags = 0; 49 if (acpi_dev_filter_resource_type(acpi_res, IORESOURCE_MEM)) 50 return AE_OK; 51 52 if (!acpi_dev_resource_memory(acpi_res, res)) { 53 if (acpi_dev_resource_address_space(acpi_res, &win) || 54 acpi_dev_resource_ext_address_space(acpi_res, &win)) 55 *res = win.res; 56 } 57 if ((res->flags & IORESOURCE_PREFETCH) || 58 (res->flags & IORESOURCE_DISABLED)) 59 res->flags = 0; 60 61 return AE_CTRL_TERMINATE; 62 } 63 64 static bool acpi_is_ioapic(acpi_handle handle, char **type) 65 { 66 acpi_status status; 67 struct acpi_device_info *info; 68 char *hid = NULL; 69 bool match = false; 70 71 if (!acpi_has_method(handle, "_GSB")) 72 return false; 73 74 status = acpi_get_object_info(handle, &info); 75 if (ACPI_SUCCESS(status)) { 76 if (info->valid & ACPI_VALID_HID) 77 hid = info->hardware_id.string; 78 if (hid) { 79 if (strcmp(hid, "ACPI0009") == 0) { 80 *type = "IOxAPIC"; 81 match = true; 82 } else if (strcmp(hid, "ACPI000A") == 0) { 83 *type = "IOAPIC"; 84 match = true; 85 } 86 } 87 kfree(info); 88 } 89 90 return match; 91 } 92 93 static acpi_status handle_ioapic_add(acpi_handle handle, u32 lvl, 94 void *context, void **rv) 95 { 96 acpi_status status; 97 unsigned long long gsi_base; 98 struct acpi_pci_ioapic *ioapic; 99 struct pci_dev *dev = NULL; 100 struct resource *res = NULL, *pci_res = NULL, *crs_res; 101 char *type = NULL; 102 103 if (!acpi_is_ioapic(handle, &type)) 104 return AE_OK; 105 106 mutex_lock(&ioapic_list_lock); 107 list_for_each_entry(ioapic, &ioapic_list, list) 108 if (ioapic->handle == handle) { 109 mutex_unlock(&ioapic_list_lock); 110 return AE_OK; 111 } 112 113 status = acpi_evaluate_integer(handle, "_GSB", NULL, &gsi_base); 114 if (ACPI_FAILURE(status)) { 115 acpi_handle_warn(handle, "failed to evaluate _GSB method\n"); 116 goto exit; 117 } 118 119 ioapic = kzalloc(sizeof(*ioapic), GFP_KERNEL); 120 if (!ioapic) { 121 pr_err("cannot allocate memory for new IOAPIC\n"); 122 goto exit; 123 } else { 124 ioapic->root_handle = (acpi_handle)context; 125 ioapic->handle = handle; 126 ioapic->gsi_base = (u32)gsi_base; 127 INIT_LIST_HEAD(&ioapic->list); 128 } 129 130 if (acpi_ioapic_registered(handle, (u32)gsi_base)) 131 goto done; 132 133 dev = acpi_get_pci_dev(handle); 134 if (dev && pci_resource_len(dev, 0)) { 135 if (pci_enable_device(dev) < 0) 136 goto exit_put; 137 pci_set_master(dev); 138 if (pci_request_region(dev, 0, type)) 139 goto exit_disable; 140 pci_res = &dev->resource[0]; 141 ioapic->pdev = dev; 142 } else { 143 pci_dev_put(dev); 144 dev = NULL; 145 } 146 147 crs_res = &ioapic->res; 148 acpi_walk_resources(handle, METHOD_NAME__CRS, setup_res, crs_res); 149 crs_res->name = type; 150 crs_res->flags |= IORESOURCE_BUSY; 151 if (crs_res->flags == 0) { 152 acpi_handle_warn(handle, "failed to get resource\n"); 153 goto exit_release; 154 } else if (insert_resource(&iomem_resource, crs_res)) { 155 acpi_handle_warn(handle, "failed to insert resource\n"); 156 goto exit_release; 157 } 158 159 /* try pci resource first, then "_CRS" resource */ 160 res = pci_res; 161 if (!res || !res->flags) 162 res = crs_res; 163 164 if (acpi_register_ioapic(handle, res->start, (u32)gsi_base)) { 165 acpi_handle_warn(handle, "failed to register IOAPIC\n"); 166 goto exit_release; 167 } 168 done: 169 list_add(&ioapic->list, &ioapic_list); 170 mutex_unlock(&ioapic_list_lock); 171 172 if (dev) 173 dev_info(&dev->dev, "%s at %pR, GSI %u\n", 174 type, res, (u32)gsi_base); 175 else 176 acpi_handle_info(handle, "%s at %pR, GSI %u\n", 177 type, res, (u32)gsi_base); 178 179 return AE_OK; 180 181 exit_release: 182 if (dev) 183 pci_release_region(dev, 0); 184 if (ioapic->res.flags && ioapic->res.parent) 185 release_resource(&ioapic->res); 186 exit_disable: 187 if (dev) 188 pci_disable_device(dev); 189 exit_put: 190 pci_dev_put(dev); 191 kfree(ioapic); 192 exit: 193 mutex_unlock(&ioapic_list_lock); 194 *(acpi_status *)rv = AE_ERROR; 195 return AE_OK; 196 } 197 198 int acpi_ioapic_add(acpi_handle root_handle) 199 { 200 acpi_status status, retval = AE_OK; 201 202 status = acpi_walk_namespace(ACPI_TYPE_DEVICE, root_handle, 203 UINT_MAX, handle_ioapic_add, NULL, 204 root_handle, (void **)&retval); 205 206 return ACPI_SUCCESS(status) && ACPI_SUCCESS(retval) ? 0 : -ENODEV; 207 } 208 209 void pci_ioapic_remove(struct acpi_pci_root *root) 210 { 211 struct acpi_pci_ioapic *ioapic, *tmp; 212 213 mutex_lock(&ioapic_list_lock); 214 list_for_each_entry_safe(ioapic, tmp, &ioapic_list, list) { 215 if (root->device->handle != ioapic->root_handle) 216 continue; 217 if (ioapic->pdev) { 218 pci_release_region(ioapic->pdev, 0); 219 pci_disable_device(ioapic->pdev); 220 pci_dev_put(ioapic->pdev); 221 } 222 } 223 mutex_unlock(&ioapic_list_lock); 224 } 225 226 int acpi_ioapic_remove(struct acpi_pci_root *root) 227 { 228 int retval = 0; 229 struct acpi_pci_ioapic *ioapic, *tmp; 230 231 mutex_lock(&ioapic_list_lock); 232 list_for_each_entry_safe(ioapic, tmp, &ioapic_list, list) { 233 if (root->device->handle != ioapic->root_handle) 234 continue; 235 if (acpi_unregister_ioapic(ioapic->handle, ioapic->gsi_base)) 236 retval = -EBUSY; 237 if (ioapic->res.flags && ioapic->res.parent) 238 release_resource(&ioapic->res); 239 list_del(&ioapic->list); 240 kfree(ioapic); 241 } 242 mutex_unlock(&ioapic_list_lock); 243 244 return retval; 245 } 246