Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit ac9c052d authored by Kenji Kaneshige's avatar Kenji Kaneshige Committed by Jesse Barnes
Browse files

shpchp: check firmware before taking control 



Fix the following problems of shpchp driver about getting hotplug
control from firmware.

  - The shpchp driver must not control the hotplug controller if it
    fails to get control from the firmware. But current shpchp
    controls the hotplug controller regardless the result, because it
    doesn't check the return value of get_hp_hw_control_from_firmware().

  - Current shpchp driver doesn't support _OSC.

The pciehp driver already have the code for evaluating _OSC and OSHP
and shpchp and pciehp can share it. So this patch move that code from
pciehp to acpi_pcihp.c.

Signed-off-by: default avatarKenji Kaneshige <kaneshige.kenji@jp.fujitsu.com>
Signed-off-by: default avatarJesse Barnes <jbarnes@virtuousgeek.org>
parent d737bdc1

drivers/pci/hotplug/acpi_pcihp.c

+81 −4
Original line number Original line Diff line number Diff line
@@ -30,6 +30,7 @@ 
#include <linux/types.h>

#include <linux/types.h>

#include <linux/pci.h>

#include <linux/pci.h>

#include <linux/pci_hotplug.h>

#include <linux/pci_hotplug.h>

#include <linux/pci-acpi.h>

#include <acpi/acpi.h>

#include <acpi/acpi.h>

#include <acpi/acpi_bus.h>

#include <acpi/acpi_bus.h>

#include <acpi/actypes.h>

#include <acpi/actypes.h>
@@ -299,7 +300,7 @@ acpi_run_hpp(acpi_handle handle, struct hotplug_params *hpp) 
 *

 *

 * @handle - the handle of the hotplug controller.

 * @handle - the handle of the hotplug controller.

 */

 */

acpi_status acpi_run_oshp(acpi_handle handle)

static acpi_status acpi_run_oshp(acpi_handle handle)

{

{

	acpi_status		status;

	acpi_status		status;

	struct acpi_buffer	string = { ACPI_ALLOCATE_BUFFER, NULL };

	struct acpi_buffer	string = { ACPI_ALLOCATE_BUFFER, NULL };
@@ -322,9 +323,6 @@ acpi_status acpi_run_oshp(acpi_handle handle) 
	kfree(string.pointer);

	kfree(string.pointer);

	return status;

	return status;

}

}

EXPORT_SYMBOL_GPL(acpi_run_oshp);









/* acpi_get_hp_params_from_firmware

/* acpi_get_hp_params_from_firmware

 *

 *
@@ -374,6 +372,85 @@ acpi_status acpi_get_hp_params_from_firmware(struct pci_bus *bus, 
}

}

EXPORT_SYMBOL_GPL(acpi_get_hp_params_from_firmware);

EXPORT_SYMBOL_GPL(acpi_get_hp_params_from_firmware);





/**

 * acpi_get_hp_hw_control_from_firmware

 * @dev: the pci_dev of the bridge that has a hotplug controller

 * @flags: requested control bits for _OSC

 *

 * Attempt to take hotplug control from firmware.

 */

int acpi_get_hp_hw_control_from_firmware(struct pci_dev *dev, u32 flags)

{

	acpi_status status;

	acpi_handle chandle, handle = DEVICE_ACPI_HANDLE(&(dev->dev));

	struct pci_dev *pdev = dev;

	struct pci_bus *parent;

	struct acpi_buffer string = { ACPI_ALLOCATE_BUFFER, NULL };



	flags &= (OSC_PCI_EXPRESS_NATIVE_HP_CONTROL |

		  OSC_SHPC_NATIVE_HP_CONTROL |

		  OSC_PCI_EXPRESS_CAP_STRUCTURE_CONTROL);

	if (!flags) {

		err("Invalid flags %u specified!\n", flags);

		return -EINVAL;

	}



	/*

	 * Per PCI firmware specification, we should run the ACPI _OSC

	 * method to get control of hotplug hardware before using it. If

	 * an _OSC is missing, we look for an OSHP to do the same thing.

	 * To handle different BIOS behavior, we look for _OSC and OSHP

	 * within the scope of the hotplug controller and its parents,

	 * upto the host bridge under which this controller exists.

	 */

	while (!handle) {

		/*

		 * This hotplug controller was not listed in the ACPI name

		 * space at all. Try to get acpi handle of parent pci bus.

		 */

		if (!pdev || !pdev->bus->parent)

			break;

		parent = pdev->bus->parent;

		dbg("Could not find %s in acpi namespace, trying parent\n",

		    pci_name(pdev));

		if (!parent->self)

			/* Parent must be a host bridge */

			handle = acpi_get_pci_rootbridge_handle(

					pci_domain_nr(parent),

					parent->number);

		else

			handle = DEVICE_ACPI_HANDLE(&(parent->self->dev));

		pdev = parent->self;

	}



	while (handle) {

		acpi_get_name(handle, ACPI_FULL_PATHNAME, &string);

		dbg("Trying to get hotplug control for %s \n",

		    (char *)string.pointer);

		status = pci_osc_control_set(handle, flags);

		if (status == AE_NOT_FOUND)

			status = acpi_run_oshp(handle);

		if (ACPI_SUCCESS(status)) {

			dbg("Gained control for hotplug HW for pci %s (%s)\n",

			    pci_name(dev), (char *)string.pointer);

			kfree(string.pointer);

			return 0;

		}

		if (acpi_root_bridge(handle))

			break;

		chandle = handle;

		status = acpi_get_parent(chandle, &handle);

		if (ACPI_FAILURE(status))

			break;

	}



	dbg("Cannot get control of hotplug hardware for pci %s\n",

	    pci_name(dev));



	kfree(string.pointer);

	return -ENODEV;

}

EXPORT_SYMBOL(acpi_get_hp_hw_control_from_firmware);





/* acpi_root_bridge - check to see if this acpi object is a root bridge

/* acpi_root_bridge - check to see if this acpi object is a root bridge

 *

 *

drivers/pci/hotplug/pciehp.h

+7 −3
Original line number Original line Diff line number Diff line
@@ -202,9 +202,13 @@ struct hpc_ops { 
#include <acpi/actypes.h>

#include <acpi/actypes.h>

#include <linux/pci-acpi.h>

#include <linux/pci-acpi.h>





extern int pciehp_acpi_get_hp_hw_control_from_firmware(struct pci_dev *dev);

static inline int pciehp_get_hp_hw_control_from_firmware(struct pci_dev *dev)

#define pciehp_get_hp_hw_control_from_firmware(dev)			\

{

	pciehp_acpi_get_hp_hw_control_from_firmware(dev)

	u32 flags = (OSC_PCI_EXPRESS_NATIVE_HP_CONTROL |

		     OSC_PCI_EXPRESS_CAP_STRUCTURE_CONTROL);

	return acpi_get_hp_hw_control_from_firmware(dev, flags);

}



static inline int pciehp_get_hp_params_from_firmware(struct pci_dev *dev,

static inline int pciehp_get_hp_params_from_firmware(struct pci_dev *dev,

			struct hotplug_params *hpp)

			struct hotplug_params *hpp)

{

{

drivers/pci/hotplug/pciehp_hpc.c

+0 −69
Original line number Original line Diff line number Diff line
@@ -1009,75 +1009,6 @@ static struct hpc_ops pciehp_hpc_ops = { 
	.check_lnk_status		= hpc_check_lnk_status,

	.check_lnk_status		= hpc_check_lnk_status,

};

};





#ifdef CONFIG_ACPI

int pciehp_acpi_get_hp_hw_control_from_firmware(struct pci_dev *dev)

{

	acpi_status status;

	acpi_handle chandle, handle = DEVICE_ACPI_HANDLE(&(dev->dev));

	struct pci_dev *pdev = dev;

	struct pci_bus *parent;

	struct acpi_buffer string = { ACPI_ALLOCATE_BUFFER, NULL };



	/*

	 * Per PCI firmware specification, we should run the ACPI _OSC

	 * method to get control of hotplug hardware before using it.

	 * If an _OSC is missing, we look for an OSHP to do the same thing.

	 * To handle different BIOS behavior, we look for _OSC and OSHP

	 * within the scope of the hotplug controller and its parents, upto

	 * the host bridge under which this controller exists.

	 */

	while (!handle) {

		/*

		 * This hotplug controller was not listed in the ACPI name

		 * space at all. Try to get acpi handle of parent pci bus.

		 */

		if (!pdev || !pdev->bus->parent)

			break;

		parent = pdev->bus->parent;

		dbg("Could not find %s in acpi namespace, trying parent\n",

				pci_name(pdev));

		if (!parent->self)

			/* Parent must be a host bridge */

			handle = acpi_get_pci_rootbridge_handle(

					pci_domain_nr(parent),

					parent->number);

		else

			handle = DEVICE_ACPI_HANDLE(

					&(parent->self->dev));

		pdev = parent->self;

	}



	while (handle) {

		acpi_get_name(handle, ACPI_FULL_PATHNAME, &string);

		dbg("Trying to get hotplug control for %s \n",

			(char *)string.pointer);

		status = pci_osc_control_set(handle,

				OSC_PCI_EXPRESS_CAP_STRUCTURE_CONTROL |

				OSC_PCI_EXPRESS_NATIVE_HP_CONTROL);

		if (status == AE_NOT_FOUND)

			status = acpi_run_oshp(handle);

		if (ACPI_SUCCESS(status)) {

			dbg("Gained control for hotplug HW for pci %s (%s)\n",

				pci_name(dev), (char *)string.pointer);

			kfree(string.pointer);

			return 0;

		}

		if (acpi_root_bridge(handle))

			break;

		chandle = handle;

		status = acpi_get_parent(chandle, &handle);

		if (ACPI_FAILURE(status))

			break;

	}



	dbg("Cannot get control of hotplug hardware for pci %s\n",

			pci_name(dev));



	kfree(string.pointer);

	return -1;

}

#endif



static int pcie_init_hardware_part1(struct controller *ctrl,

static int pcie_init_hardware_part1(struct controller *ctrl,

				    struct pcie_device *dev)

				    struct pcie_device *dev)

{

{

drivers/pci/hotplug/shpchp.h

+8 −6
Original line number Original line Diff line number Diff line
@@ -170,6 +170,7 @@ extern void shpchp_queue_pushbutton_work(struct work_struct *work); 
extern int shpc_init( struct controller *ctrl, struct pci_dev *pdev);

extern int shpc_init( struct controller *ctrl, struct pci_dev *pdev);





#ifdef CONFIG_ACPI

#ifdef CONFIG_ACPI

#include <linux/pci-acpi.h>

static inline int get_hp_params_from_firmware(struct pci_dev *dev,

static inline int get_hp_params_from_firmware(struct pci_dev *dev,

					      struct hotplug_params *hpp)

					      struct hotplug_params *hpp)

{

{
@@ -177,14 +178,15 @@ static inline int get_hp_params_from_firmware(struct pci_dev *dev, 
			return -ENODEV;

			return -ENODEV;

	return 0;

	return 0;

}

}

#define get_hp_hw_control_from_firmware(pdev)				\



	do {								\

static inline int get_hp_hw_control_from_firmware(struct pci_dev *dev)

		if (DEVICE_ACPI_HANDLE(&(pdev->dev)))			\

{

			acpi_run_oshp(DEVICE_ACPI_HANDLE(&(pdev->dev)));\

	u32 flags = OSC_SHPC_NATIVE_HP_CONTROL;

	} while (0)

	return acpi_get_hp_hw_control_from_firmware(dev, flags);

}

#else

#else

#define get_hp_params_from_firmware(dev, hpp) (-ENODEV)

#define get_hp_params_from_firmware(dev, hpp) (-ENODEV)

#define get_hp_hw_control_from_firmware(dev) do { } while (0)

#define get_hp_hw_control_from_firmware(dev) (0)

#endif

#endif





struct ctrl_reg {

struct ctrl_reg {

drivers/pci/hotplug/shpchp_core.c

+8 −7
Original line number Original line Diff line number Diff line
@@ -333,10 +333,11 @@ static int is_shpc_capable(struct pci_dev *dev) 
	if ((dev->vendor == PCI_VENDOR_ID_AMD) || (dev->device ==

	if ((dev->vendor == PCI_VENDOR_ID_AMD) || (dev->device ==

						PCI_DEVICE_ID_AMD_GOLAM_7450))

						PCI_DEVICE_ID_AMD_GOLAM_7450))

		return 1;

		return 1;

       if (pci_find_capability(dev, PCI_CAP_ID_SHPC))

	if (!pci_find_capability(dev, PCI_CAP_ID_SHPC))

               return 1;



		return 0;

		return 0;

	if (get_hp_hw_control_from_firmware(dev))

		return 0;

	return 1;

}

}





static int shpc_probe(struct pci_dev *pdev, const struct pci_device_id *ent)

static int shpc_probe(struct pci_dev *pdev, const struct pci_device_id *ent)