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

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
...@@ -42,6 +42,14 @@ struct stm32_dac_priv { ...@@ -42,6 +42,14 @@ struct stm32_dac_priv {
struct stm32_dac_common common; 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) static struct stm32_dac_priv *to_stm32_dac_priv(struct stm32_dac_common *com)
{ {
return container_of(com, struct stm32_dac_priv, common); return container_of(com, struct stm32_dac_priv, common);
...@@ -57,6 +65,7 @@ static const struct regmap_config stm32_dac_regmap_cfg = { ...@@ -57,6 +65,7 @@ static const struct regmap_config stm32_dac_regmap_cfg = {
static int stm32_dac_probe(struct platform_device *pdev) static int stm32_dac_probe(struct platform_device *pdev)
{ {
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
const struct stm32_dac_cfg *cfg;
struct stm32_dac_priv *priv; struct stm32_dac_priv *priv;
struct regmap *regmap; struct regmap *regmap;
struct resource *res; struct resource *res;
...@@ -69,6 +78,8 @@ static int stm32_dac_probe(struct platform_device *pdev) ...@@ -69,6 +78,8 @@ static int stm32_dac_probe(struct platform_device *pdev)
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
if (!priv) if (!priv)
return -ENOMEM; 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); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
mmio = devm_ioremap_resource(dev, res); mmio = devm_ioremap_resource(dev, res);
...@@ -121,12 +132,16 @@ static int stm32_dac_probe(struct platform_device *pdev) ...@@ -121,12 +132,16 @@ static int stm32_dac_probe(struct platform_device *pdev)
reset_control_deassert(priv->rst); reset_control_deassert(priv->rst);
} }
/* When clock speed is higher than 80MHz, set HFSEL */ if (cfg && cfg->has_hfsel) {
priv->common.hfsel = (clk_get_rate(priv->pclk) > 80000000UL); /* When clock speed is higher than 80MHz, set HFSEL */
ret = regmap_update_bits(regmap, STM32_DAC_CR, STM32H7_DAC_CR_HFSEL, priv->common.hfsel = (clk_get_rate(priv->pclk) > 80000000UL);
priv->common.hfsel ? STM32H7_DAC_CR_HFSEL : 0); ret = regmap_update_bits(regmap, STM32_DAC_CR,
if (ret) STM32H7_DAC_CR_HFSEL,
goto err_pclk; priv->common.hfsel ?
STM32H7_DAC_CR_HFSEL : 0);
if (ret)
goto err_pclk;
}
platform_set_drvdata(pdev, &priv->common); platform_set_drvdata(pdev, &priv->common);
...@@ -158,8 +173,17 @@ static int stm32_dac_remove(struct platform_device *pdev) ...@@ -158,8 +173,17 @@ static int stm32_dac_remove(struct platform_device *pdev)
return 0; return 0;
} }
static const struct stm32_dac_cfg stm32h7_dac_cfg = {
.has_hfsel = true,
};
static const struct of_device_id stm32_dac_of_match[] = { 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); MODULE_DEVICE_TABLE(of, stm32_dac_of_match);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment