@@ -53,9 +53,10 @@ static int acpi_pci_root_scan_dependent(struct acpi_device *adev)
}
#define ACPI_PCIE_REQ_SUPPORT (OSC_PCI_EXT_CONFIG_SUPPORT \
- | OSC_PCI_ASPM_SUPPORT \
- | OSC_PCI_CLOCK_PM_SUPPORT \
| OSC_PCI_MSI_SUPPORT)
+#define ACPI_PCIE_ASPM_SUPPORT (ACPI_PCIE_REQ_SUPPORT \
+ | OSC_PCI_ASPM_SUPPORT \
+ | OSC_PCI_CLOCK_PM_SUPPORT)
static const struct acpi_device_id root_device_ids[] = {
{"PNP0A03", 0},
@@ -421,10 +422,101 @@ acpi_status acpi_pci_osc_control_set(acpi_handle handle, u32 *mask, u32 req)
}
EXPORT_SYMBOL(acpi_pci_osc_control_set);
+static int __osc_check_support(struct acpi_pci_root *root, u32 support,
+ u32 required, const char *feature)
+{
+ acpi_status status;
+
+ if ((support & required) != required)
+ return -ENODEV;
+
+ status = acpi_pci_osc_support(root, support);
+ if (ACPI_FAILURE(status)) {
+ dev_info(&root->device->dev, "_OSC failed (%s); disabling %s\n",
+ acpi_format_exception(status), feature);
+ return -ENODEV;
+ }
+
+ return 0;
+}
+
+static inline int __osc_set_aspm_control(struct acpi_pci_root *root,
+ u32 support, u32 *control)
+{
+ int rc;
+
+ if (!IS_ENABLED(CONFIG_PCIEASPM))
+ return -ENODEV;
+
+ rc = __osc_check_support(root, support, ACPI_PCIE_ASPM_SUPPORT, "ASPM");
+ if (rc)
+ return rc;
+
+ *control |= OSC_PCI_EXPRESS_CAPABILITY_CONTROL |
+ OSC_PCI_EXPRESS_LTR_CONTROL |
+ OSC_PCI_EXPRESS_PME_CONTROL;
+
+ return 0;
+}
+
+static inline bool __osc_have_aspm_control(u32 control)
+{
+ u32 required = OSC_PCI_EXPRESS_CAPABILITY_CONTROL |
+ OSC_PCI_EXPRESS_LTR_CONTROL |
+ OSC_PCI_EXPRESS_PME_CONTROL;
+
+ return (control & required) == required;
+}
+
+static inline void __osc_set_pciehp_control(struct acpi_pci_root *root,
+ u32 support, u32 *control)
+{
+ if (!IS_ENABLED(CONFIG_HOTPLUG_PCI_PCIE))
+ return;
+
+ if (__osc_check_support(root, support, ACPI_PCIE_REQ_SUPPORT,
+ "PCIeHotplug"))
+ return;
+
+ *control |= OSC_PCI_EXPRESS_CAPABILITY_CONTROL |
+ OSC_PCI_EXPRESS_NATIVE_HP_CONTROL;
+}
+
+static inline void __osc_set_shpchp_control(struct acpi_pci_root *root,
+ u32 support, u32 *control)
+{
+ if (!IS_ENABLED(CONFIG_HOTPLUG_PCI_SHPC))
+ return;
+
+ if (__osc_check_support(root, support, ACPI_PCIE_REQ_SUPPORT,
+ "SHPCHotplug"))
+ return;
+
+ *control |= OSC_PCI_EXPRESS_CAPABILITY_CONTROL |
+ OSC_PCI_SHPC_NATIVE_HP_CONTROL;
+}
+
+static inline void __osc_set_aer_control(struct acpi_pci_root *root,
+ u32 support, u32 *control)
+{
+ if (!pci_aer_available())
+ return;
+
+ if (aer_acpi_firmware_first()) {
+ dev_info(&root->device->dev, "PCIe AER handled by firmware\n");
+ return;
+ }
+
+ if (__osc_check_support(root, support, ACPI_PCIE_REQ_SUPPORT, "AER"))
+ return;
+
+ *control |= OSC_PCI_EXPRESS_CAPABILITY_CONTROL |
+ OSC_PCI_EXPRESS_AER_CONTROL;
+}
+
static void negotiate_os_control(struct acpi_pci_root *root, int *no_aspm)
{
u32 support, control, requested;
- acpi_status status;
struct acpi_device *device = root->device;
acpi_handle handle = device->handle;
@@ -440,6 +532,12 @@ static void negotiate_os_control(struct acpi_pci_root *root, int *no_aspm)
return;
}
+ if (pcie_ports_disabled) {
+ dev_info(&device->dev,
+ "PCIe port services disabled; not requesting _OSC control\n");
+ return;
+ }
+
/*
* All supported architectures that use ACPI have support for
* PCI domains, so we indicate this in _OSC support capabilities.
@@ -453,50 +551,26 @@ static void negotiate_os_control(struct acpi_pci_root *root, int *no_aspm)
support |= OSC_PCI_MSI_SUPPORT;
decode_osc_support(root, "OS supports", support);
- status = acpi_pci_osc_support(root, support);
- if (ACPI_FAILURE(status)) {
- dev_info(&device->dev, "_OSC failed (%s); disabling ASPM\n",
- acpi_format_exception(status));
+
+ control = 0;
+ if (__osc_set_aspm_control(root, support, &control))
*no_aspm = 1;
- return;
- }
- if (pcie_ports_disabled) {
- dev_info(&device->dev, "PCIe port services disabled; not requesting _OSC control\n");
- return;
- }
+ __osc_set_pciehp_control(root, support, &control);
+ __osc_set_shpchp_control(root, support, &control);
+ __osc_set_aer_control(root, support, &control);
- if ((support & ACPI_PCIE_REQ_SUPPORT) != ACPI_PCIE_REQ_SUPPORT) {
- decode_osc_support(root, "not requesting OS control; OS requires",
- ACPI_PCIE_REQ_SUPPORT);
+ if (!control) {
+ dev_info(&device->dev, "_OSC: not requesting OS control\n");
return;
}
- control = OSC_PCI_EXPRESS_CAPABILITY_CONTROL
- | OSC_PCI_EXPRESS_PME_CONTROL;
-
- if (IS_ENABLED(CONFIG_PCIEASPM))
- control |= OSC_PCI_EXPRESS_LTR_CONTROL;
-
- if (IS_ENABLED(CONFIG_HOTPLUG_PCI_PCIE))
- control |= OSC_PCI_EXPRESS_NATIVE_HP_CONTROL;
-
- if (IS_ENABLED(CONFIG_HOTPLUG_PCI_SHPC))
- control |= OSC_PCI_SHPC_NATIVE_HP_CONTROL;
-
- if (pci_aer_available()) {
- if (aer_acpi_firmware_first())
- dev_info(&device->dev,
- "PCIe AER handled by firmware\n");
- else
- control |= OSC_PCI_EXPRESS_AER_CONTROL;
- }
-
requested = control;
- status = acpi_pci_osc_control_set(handle, &control,
- OSC_PCI_EXPRESS_CAPABILITY_CONTROL);
- if (ACPI_SUCCESS(status)) {
- decode_osc_control(root, "OS now controls", control);
+ acpi_pci_osc_control_set(handle, &control, 0);
+ decode_osc_control(root, "OS requested", requested);
+ decode_osc_control(root, "platform granted", control);
+
+ if (__osc_have_aspm_control(control)) {
if (acpi_gbl_FADT.boot_flags & ACPI_FADT_NO_ASPM) {
/*
* We have ASPM control, but the FADT indicates that
@@ -506,11 +580,8 @@ static void negotiate_os_control(struct acpi_pci_root *root, int *no_aspm)
dev_info(&device->dev, "FADT indicates ASPM is unsupported, using BIOS configuration\n");
*no_aspm = 1;
}
- } else {
- decode_osc_control(root, "OS requested", requested);
- decode_osc_control(root, "platform willing to grant", control);
- dev_info(&device->dev, "_OSC failed (%s); disabling ASPM\n",
- acpi_format_exception(status));
+ } else if (!*no_aspm) {
+ dev_info(&device->dev, "_OSC failed; disabling ASPM\n");
/*
* We want to disable ASPM here, but aspm_disabled
This patch reorganizes negotiate_os_control() to be less ASPM-centric in order to: 1. allow other features (notably AER) to work without enabling ASPM 2. better isolate feature-specific tests for readability/maintenance Each feature (ASPM, PCIe hotplug, SHPC hotplug, and AER) now has its own inline function for setting its _OSC control requests. Part of making this function more generic, required eliminating a test for overall success/failure that previously caused two different types of messages to be printed. Now, printed messages are streamlined to always show requested _OSC control versus what was granted. Previous output (success): acpi PNP0A08:00: _OSC: OS now controls [PME AER PCIeCapability LTR] Previous output (failure): acpi PNP0A08:00: _OSC: OS requested [PME AER PCIeCapability LTR] acpi PNP0A08:00: _OSC: platform willing to grant [] Now: acpi PNP0A08:00: _OSC: OS requested [PME AER PCIeCapability LTR] acpi PNP0A08:00: _OSC: platform granted [PME AER PCIeCapability LTR] Signed-off-by: Aaron Sierra <asierra@xes-inc.com> --- drivers/acpi/pci_root.c | 161 ++++++++++++++++++++++++++++++++++-------------- 1 file changed, 116 insertions(+), 45 deletions(-)