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

Commit 7481a0b1 authored by Akash Asthana's avatar Akash Asthana
Browse files

Platform: msm-geni-se: Geni drivers shouldn't crash without ICC support 



Ideally GENI drivers shouldn't fail or crash if ICC entries are missing
from the DT node or CONFIG_INTERCONNECT is disabled. Most of the ICC APIs
returns success in such scenarios.

Since we have maintained our own wrapper for most of the ICC interaction
for ex: rmv_ab_ib/add_ab_ib/resources_init mostly due to QUP core clock
behaviour. So, let's bail out from these APIs if ICC entry is missing
in DT node. In future we can move ICC registration to probe to simplify
more.

Also, remove the obsolete iommu related code.

Change-Id: I48bec3d2a95ad53f2c2008e60be645ed829354ca
Signed-off-by: default avatarAkash Asthana <akashast@codeaurora.org>
parent aa860b5b

drivers/platform/msm/msm-geni-se.c

+17 −28
Original line number Diff line number Diff line
@@ -112,8 +112,6 @@ struct geni_se_device { 
#define HW_VER_MINOR_SHFT 16

#define HW_VER_STEP_MASK GENMASK(15, 0)



static int geni_se_iommu_map_and_attach(struct geni_se_device *geni_se_dev);



/**

 * geni_read_reg_nolog() - Helper function to read from a GENI register

 * @base:	Base address of the serial engine's register block.
@@ -714,6 +712,9 @@ static int geni_se_rmv_ab_ib(struct geni_se_device *geni_se_dev, 
	bool bus_bw_update_noc = false;

	int ret = 0;



	if (geni_se_dev->vectors == NULL)

		return 0;



	if (unlikely(list_empty(&rsc->ab_list) || list_empty(&rsc->ib_list)))

		return -EINVAL;
@@ -801,8 +802,7 @@ int se_geni_clks_off(struct se_geni_rsc *rsc) 
		return -EINVAL;



	geni_se_dev = dev_get_drvdata(rsc->wrapper_dev);

	if (unlikely(!geni_se_dev || !(geni_se_dev->bus_bw ||

					geni_se_dev->bus_bw_noc)))

	if (!geni_se_dev)

		return -ENODEV;



	clk_disable_unprepare(rsc->se_clk);
@@ -834,9 +834,7 @@ int se_geni_resources_off(struct se_geni_rsc *rsc) 
		return -EINVAL;



	geni_se_dev = dev_get_drvdata(rsc->wrapper_dev);

	if (unlikely(!geni_se_dev ||

			!(geni_se_dev->bus_bw ||

					geni_se_dev->bus_bw_noc)))

	if (!geni_se_dev)

		return -ENODEV;



	ret = se_geni_clks_off(rsc);
@@ -861,6 +859,9 @@ static int geni_se_add_ab_ib(struct geni_se_device *geni_se_dev, 
	bool bus_bw_update_noc = false;

	int ret = 0;



	if (geni_se_dev->vectors == NULL)

		return 0;



	mutex_lock(&geni_se_dev->geni_dev_lock);



	list_add(&rsc->ab_list, &geni_se_dev->ab_list_head);
@@ -1030,8 +1031,6 @@ int geni_se_resources_init(struct se_geni_rsc *rsc, 
			   unsigned long ab, unsigned long ib)

{

	struct geni_se_device *geni_se_dev;

	int ret = 0;

	const char *mode = NULL;



	if (unlikely(!rsc || !rsc->wrapper_dev))

		return -EINVAL;
@@ -1040,6 +1039,10 @@ int geni_se_resources_init(struct se_geni_rsc *rsc, 
	if (unlikely(!geni_se_dev))

		return -EPROBE_DEFER;



	/* Driver shouldn't crash, if ICC support is not present */

	if (geni_se_dev->vectors == NULL)

		return 0;



	if (IS_ERR_OR_NULL(geni_se_dev->bus_bw)) {

		geni_se_dev->bus_bw = icc_get(geni_se_dev->dev,

					geni_se_dev->vectors[0].src,
@@ -1086,18 +1089,7 @@ int geni_se_resources_init(struct se_geni_rsc *rsc, 
	INIT_LIST_HEAD(&rsc->ab_list);

	INIT_LIST_HEAD(&rsc->ib_list);



	ret = of_property_read_string(geni_se_dev->dev->of_node,

					"qcom,iommu-dma", &mode);



	if ((ret == 0) && (strcmp(mode, "disabled") == 0)) {

		ret = geni_se_iommu_map_and_attach(geni_se_dev);

		if (ret)

			GENI_SE_ERR(geni_se_dev->log_ctx, false, NULL,

				"%s: Error %d iommu_map_and_attach\n",

					 __func__, ret);

	}



	return ret;

	return 0;

}

EXPORT_SYMBOL(geni_se_resources_init);
@@ -1379,11 +1371,6 @@ int geni_se_qupv3_hw_version(struct device *wrapper_dev, unsigned int *major, 
}

EXPORT_SYMBOL(geni_se_qupv3_hw_version);



static int geni_se_iommu_map_and_attach(struct geni_se_device *geni_se_dev)

{

	return 0;

}



/**

 * geni_se_iommu_map_buf() - Map a single buffer into QUPv3 context bank

 * @wrapper_dev:	Pointer to the corresponding QUPv3 wrapper core.
@@ -1560,7 +1547,7 @@ void geni_se_dump_dbg_regs(struct se_geni_rsc *rsc, void __iomem *base, 
		return;



	geni_se_dev = dev_get_drvdata(rsc->wrapper_dev);

	if (unlikely(!geni_se_dev || !geni_se_dev->bus_bw))

	if (!geni_se_dev)

		return;

	if (unlikely(list_empty(&rsc->ab_list) || list_empty(&rsc->ib_list))) {

		GENI_SE_DBG(ipc, false, NULL, "%s: Clocks not on\n", __func__);
@@ -1723,7 +1710,9 @@ static int geni_se_probe(struct platform_device *pdev) 
	geni_se_dev->cb_dev = dev;

	ret = of_property_read_u32(dev->of_node, "qcom,msm-bus,num-paths",

					&geni_se_dev->num_paths);

	if (!ret) {

	if (ret) {

		dev_err(dev, "%s: ICC entry missing in DT node\n", __func__);

	} else {

		geni_se_dev->vectors = get_icc_paths(pdev, geni_se_dev);

		if (geni_se_dev->vectors == NULL) {

			dev_err(dev,