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

Commit 9d9ebe64 authored by Fabrice Gasnier's avatar Fabrice Gasnier Committed by Jonathan Cameron
Browse files

iio: dac: stm32: add support for stm32f4 



This adds support for STM32F4 Digital-To-Analog converter.
Add compatible configuration data to handle hfsel (not present
in stm32f4).

Signed-off-by: default avatarFabrice Gasnier <fabrice.gasnier@st.com>
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent 0c1a1b6c

drivers/iio/dac/stm32-dac-core.c

+31 −7
Original line number Diff line number Diff line
@@ -42,6 +42,14 @@ struct stm32_dac_priv { 
	struct stm32_dac_common common;

};



/**

 * struct stm32_dac_cfg - DAC configuration

 * @has_hfsel: DAC has high frequency control

 */

struct stm32_dac_cfg {

	bool has_hfsel;

};



static struct stm32_dac_priv *to_stm32_dac_priv(struct stm32_dac_common *com)

{

	return container_of(com, struct stm32_dac_priv, common);
@@ -57,6 +65,7 @@ static const struct regmap_config stm32_dac_regmap_cfg = { 
static int stm32_dac_probe(struct platform_device *pdev)

{

	struct device *dev = &pdev->dev;

	const struct stm32_dac_cfg *cfg;

	struct stm32_dac_priv *priv;

	struct regmap *regmap;

	struct resource *res;
@@ -69,6 +78,8 @@ static int stm32_dac_probe(struct platform_device *pdev) 
	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);

	if (!priv)

		return -ENOMEM;

	cfg = (const struct stm32_dac_cfg *)

		of_match_device(dev->driver->of_match_table, dev)->data;



	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

	mmio = devm_ioremap_resource(dev, res);
@@ -121,12 +132,16 @@ static int stm32_dac_probe(struct platform_device *pdev) 
		reset_control_deassert(priv->rst);

	}



	if (cfg && cfg->has_hfsel) {

		/* When clock speed is higher than 80MHz, set HFSEL */

		priv->common.hfsel = (clk_get_rate(priv->pclk) > 80000000UL);

	ret = regmap_update_bits(regmap, STM32_DAC_CR, STM32H7_DAC_CR_HFSEL,

				 priv->common.hfsel ? STM32H7_DAC_CR_HFSEL : 0);

		ret = regmap_update_bits(regmap, STM32_DAC_CR,

					 STM32H7_DAC_CR_HFSEL,

					 priv->common.hfsel ?

					 STM32H7_DAC_CR_HFSEL : 0);

		if (ret)

			goto err_pclk;

	}



	platform_set_drvdata(pdev, &priv->common);
@@ -158,8 +173,17 @@ static int stm32_dac_remove(struct platform_device *pdev) 
	return 0;

}



static const struct stm32_dac_cfg stm32h7_dac_cfg = {

	.has_hfsel = true,

};



static const struct of_device_id stm32_dac_of_match[] = {

	{ .compatible = "st,stm32h7-dac-core", },

	{

		.compatible = "st,stm32f4-dac-core",

	}, {

		.compatible = "st,stm32h7-dac-core",

		.data = (void *)&stm32h7_dac_cfg,

	},

	{},

};

MODULE_DEVICE_TABLE(of, stm32_dac_of_match);