Merge "mhi: controller: qcom: added support to dynamically switch L1 configuration" (05c0685f) · Commits · e / devices / android_kernel_fairphone_FP4

drivers/bus/mhi/controllers/mhi_qcom.c

+64 −0

Original line number	Diff line number	Diff line
		@@ -289,6 +289,68 @@ static int mhi_link_status(struct mhi_controller mhi_cntrl, void priv)
		return (ret \|\| dev_id != mhi_cntrl->dev_id) ? -EIO : 0;
		}

		/* disable PCIe L1 */
		static int mhi_lpm_disable(struct mhi_controller mhi_cntrl, void priv)
		{
		struct mhi_dev *mhi_dev = priv;
		struct pci_dev *pci_dev = mhi_dev->pci_dev;
		int lnkctl = pci_dev->pcie_cap + PCI_EXP_LNKCTL;
		u8 val;
		int ret;

		ret = pci_read_config_byte(pci_dev, lnkctl, &val);
		if (ret) {
		MHI_ERR("Error reading LNKCTL, ret:%d\n", ret);
		return ret;
		}

		/* L1 is not supported or already disabled */
		if (!(val & PCI_EXP_LNKCTL_ASPM_L1))
		return 0;

		val &= ~PCI_EXP_LNKCTL_ASPM_L1;
		ret = pci_write_config_byte(pci_dev, lnkctl, val);
		if (ret) {
		MHI_ERR("Error writing LNKCTL to disable LPM, ret:%d\n", ret);
		return ret;
		}

		mhi_dev->lpm_disabled = true;

		return ret;
		}

		/* enable PCIe L1 */
		static int mhi_lpm_enable(struct mhi_controller mhi_cntrl, void priv)
		{
		struct mhi_dev *mhi_dev = priv;
		struct pci_dev *pci_dev = mhi_dev->pci_dev;
		int lnkctl = pci_dev->pcie_cap + PCI_EXP_LNKCTL;
		u8 val;
		int ret;

		/* L1 is not supported or already disabled */
		if (!mhi_dev->lpm_disabled)
		return 0;

		ret = pci_read_config_byte(pci_dev, lnkctl, &val);
		if (ret) {
		MHI_ERR("Error reading LNKCTL, ret:%d\n", ret);
		return ret;
		}

		val \|= PCI_EXP_LNKCTL_ASPM_L1;
		ret = pci_write_config_byte(pci_dev, lnkctl, val);
		if (ret) {
		MHI_ERR("Error writing LNKCTL to enable LPM, ret:%d\n", ret);
		return ret;
		}

		mhi_dev->lpm_disabled = false;

		return ret;
		}

		static int mhi_runtime_get(struct mhi_controller mhi_cntrl, void priv)
		{
		struct mhi_dev *mhi_dev = priv;
		@@ -485,6 +547,8 @@ static struct mhi_controller mhi_register_controller(struct pci_dev pci_dev)
		mhi_cntrl->runtime_put = mhi_runtime_put;
		mhi_cntrl->link_status = mhi_link_status;

		mhi_cntrl->lpm_disable = mhi_lpm_disable;
		mhi_cntrl->lpm_enable = mhi_lpm_enable;
		mhi_cntrl->time_get = mhi_time_get;

		ret = of_register_mhi_controller(mhi_cntrl);

drivers/bus/mhi/controllers/mhi_qcom.h

+1 −0

Original line number	Diff line number	Diff line
		@@ -29,6 +29,7 @@ struct mhi_dev {
		bool powered_on;
		dma_addr_t iova_start;
		dma_addr_t iova_stop;
		bool lpm_disabled;
		};

		void mhi_deinit_pci_dev(struct mhi_controller *mhi_cntrl);