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

Commit 6a1e046b authored by Shaoqing Liu's avatar Shaoqing Liu Committed by Gerrit - the friendly Code Review server
Browse files

soc: qcom: dcc_v2: Add virtualization support for (32 bit) QCS605 



Add dcc_sram_memset function in dcc_driver since hyp cannot support
virtualize stmgeia instruction in previous inline function
memset_io.

Change-Id: I2f0fc281216d897d33b421fd016a030221cc5c4d
Signed-off-by: default avatarShaoqing Liu <shaoqingliu@codeaurora.org>
parent d18e6bf7

drivers/soc/qcom/dcc_v2.c

+26 −3
Original line number Diff line number Diff line
@@ -162,6 +162,28 @@ static int dcc_sram_writel(struct dcc_drvdata *drvdata, 
	return 0;

}



static void dcc_sram_memset(const struct device *dev, void __iomem *dst,

			    int c, size_t count)

{

	u64 qc = (u8)c;



	qc |= qc << 8;

	qc |= qc << 16;



	if (!count || !IS_ALIGNED((unsigned long)dst, 4)

	    || !IS_ALIGNED((unsigned long)count, 4)) {

		dev_err(dev,

			"Target address or size not aligned with 4 bytes");

		return;

	}



	while (count >= 4) {

		__raw_writel_no_log(qc, dst);

		dst += 4;

		count -= 4;

	}

}



static bool dcc_ready(struct dcc_drvdata *drvdata)

{

	uint32_t val;
@@ -529,7 +551,7 @@ static int __dcc_ll_cfg(struct dcc_drvdata *drvdata, int curr_list) 
	return 0;

overstep:

	ret = -EINVAL;

	memset_io(drvdata->ram_base, 0, drvdata->ram_size);

	dcc_sram_memset(drvdata->dev, drvdata->ram_base, 0, drvdata->ram_size);

	dev_err(drvdata->dev, "DCC SRAM oversteps, 0x%x (0x%x)\n",

		sram_offset, drvdata->ram_size);

err:
@@ -587,7 +609,8 @@ static int dcc_enable(struct dcc_drvdata *drvdata) 


	mutex_lock(&drvdata->mutex);



	memset_io(drvdata->ram_base, 0xDE, drvdata->ram_size);

	dcc_sram_memset(drvdata->dev, drvdata->ram_base, 0xDE,

			drvdata->ram_size);



	for (list = 0; list < DCC_MAX_LINK_LIST; list++) {
@@ -1647,7 +1670,7 @@ static int dcc_probe(struct platform_device *pdev) 
		drvdata->nr_config[i] = 0;

	}



	memset_io(drvdata->ram_base, 0, drvdata->ram_size);

	dcc_sram_memset(drvdata->dev, drvdata->ram_base, 0, drvdata->ram_size);



	drvdata->data_sink = DCC_DATA_SINK_SRAM;

	ret = of_property_read_string(pdev->dev.of_node, "qcom,data-sink",