Commit 11e77776 authored by Ivaylo Ivanov's avatar Ivaylo Ivanov Committed by Krzysztof Kozlowski
Browse files

soc: samsung: usi: add a routine for unconfiguring the ip 



Add a devm_add_action_or_reset() routine for unconfiguring the USI IP
block whenever the device gets removed.

Signed-off-by: default avatarIvaylo Ivanov <ivo.ivanov.ivanov1@gmail.com>
Link: https://lore.kernel.org/r/20250204172803.3425496-3-ivo.ivanov.ivanov1@gmail.com


Signed-off-by: default avatarKrzysztof Kozlowski <krzysztof.kozlowski@linaro.org>
parent 648d2852

drivers/soc/samsung/exynos-usi.c

+28 −0
Original line number Diff line number Diff line
@@ -174,6 +174,30 @@ static int exynos_usi_configure(struct exynos_usi *usi) 
	return 0;

}



static void exynos_usi_unconfigure(void *data)

{

	struct exynos_usi *usi = data;

	u32 val;

	int ret;



	ret = clk_bulk_prepare_enable(usi->data->num_clks, usi->clks);

	if (ret)

		return;



	/* Make sure that we've stopped providing the clock to USI IP */

	val = readl(usi->regs + USI_OPTION);

	val &= ~USI_OPTION_CLKREQ_ON;

	val |= ~USI_OPTION_CLKSTOP_ON;

	writel(val, usi->regs + USI_OPTION);



	/* Set USI block state to reset */

	val = readl(usi->regs + USI_CON);

	val |= USI_CON_RESET;

	writel(val, usi->regs + USI_CON);



	clk_bulk_disable_unprepare(usi->data->num_clks, usi->clks);

}



static int exynos_usi_parse_dt(struct device_node *np, struct exynos_usi *usi)

{

	int ret;
@@ -251,6 +275,10 @@ static int exynos_usi_probe(struct platform_device *pdev) 
	if (ret)

		return ret;



	ret = devm_add_action_or_reset(&pdev->dev, exynos_usi_unconfigure, usi);

	if (ret)

		return ret;



	/* Make it possible to embed protocol nodes into USI np */

	return of_platform_populate(np, NULL, NULL, dev);

}