.. | .. |
---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
---|
1 | 2 | /* |
---|
2 | 3 | * Copyright (C) STMicroelectronics 2017 |
---|
3 | 4 | * |
---|
4 | 5 | * Author: Fabrice Gasnier <fabrice.gasnier@st.com> |
---|
5 | | - * |
---|
6 | | - * License terms: GNU General Public License (GPL), version 2 |
---|
7 | 6 | */ |
---|
8 | 7 | |
---|
9 | 8 | #include <linux/bitfield.h> |
---|
.. | .. |
---|
15 | 14 | #include <linux/platform_device.h> |
---|
16 | 15 | #include <linux/regulator/driver.h> |
---|
17 | 16 | #include <linux/regulator/of_regulator.h> |
---|
| 17 | +#include <linux/pm_runtime.h> |
---|
18 | 18 | |
---|
19 | 19 | /* STM32 VREFBUF registers */ |
---|
20 | 20 | #define STM32_VREFBUF_CSR 0x00 |
---|
.. | .. |
---|
25 | 25 | #define STM32_HIZ BIT(1) |
---|
26 | 26 | #define STM32_ENVR BIT(0) |
---|
27 | 27 | |
---|
| 28 | +#define STM32_VREFBUF_AUTO_SUSPEND_DELAY_MS 10 |
---|
| 29 | + |
---|
28 | 30 | struct stm32_vrefbuf { |
---|
29 | 31 | void __iomem *base; |
---|
30 | 32 | struct clk *clk; |
---|
| 33 | + struct device *dev; |
---|
31 | 34 | }; |
---|
32 | 35 | |
---|
33 | 36 | static const unsigned int stm32_vrefbuf_voltages[] = { |
---|
.. | .. |
---|
38 | 41 | static int stm32_vrefbuf_enable(struct regulator_dev *rdev) |
---|
39 | 42 | { |
---|
40 | 43 | struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev); |
---|
41 | | - u32 val = readl_relaxed(priv->base + STM32_VREFBUF_CSR); |
---|
| 44 | + u32 val; |
---|
42 | 45 | int ret; |
---|
43 | 46 | |
---|
| 47 | + ret = pm_runtime_get_sync(priv->dev); |
---|
| 48 | + if (ret < 0) { |
---|
| 49 | + pm_runtime_put_noidle(priv->dev); |
---|
| 50 | + return ret; |
---|
| 51 | + } |
---|
| 52 | + |
---|
| 53 | + val = readl_relaxed(priv->base + STM32_VREFBUF_CSR); |
---|
44 | 54 | val = (val & ~STM32_HIZ) | STM32_ENVR; |
---|
45 | 55 | writel_relaxed(val, priv->base + STM32_VREFBUF_CSR); |
---|
46 | 56 | |
---|
.. | .. |
---|
59 | 69 | writel_relaxed(val, priv->base + STM32_VREFBUF_CSR); |
---|
60 | 70 | } |
---|
61 | 71 | |
---|
| 72 | + pm_runtime_mark_last_busy(priv->dev); |
---|
| 73 | + pm_runtime_put_autosuspend(priv->dev); |
---|
| 74 | + |
---|
62 | 75 | return ret; |
---|
63 | 76 | } |
---|
64 | 77 | |
---|
65 | 78 | static int stm32_vrefbuf_disable(struct regulator_dev *rdev) |
---|
66 | 79 | { |
---|
67 | 80 | struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev); |
---|
68 | | - u32 val = readl_relaxed(priv->base + STM32_VREFBUF_CSR); |
---|
| 81 | + u32 val; |
---|
| 82 | + int ret; |
---|
69 | 83 | |
---|
70 | | - val = (val & ~STM32_ENVR) | STM32_HIZ; |
---|
| 84 | + ret = pm_runtime_get_sync(priv->dev); |
---|
| 85 | + if (ret < 0) { |
---|
| 86 | + pm_runtime_put_noidle(priv->dev); |
---|
| 87 | + return ret; |
---|
| 88 | + } |
---|
| 89 | + |
---|
| 90 | + val = readl_relaxed(priv->base + STM32_VREFBUF_CSR); |
---|
| 91 | + val &= ~STM32_ENVR; |
---|
71 | 92 | writel_relaxed(val, priv->base + STM32_VREFBUF_CSR); |
---|
| 93 | + |
---|
| 94 | + pm_runtime_mark_last_busy(priv->dev); |
---|
| 95 | + pm_runtime_put_autosuspend(priv->dev); |
---|
72 | 96 | |
---|
73 | 97 | return 0; |
---|
74 | 98 | } |
---|
.. | .. |
---|
76 | 100 | static int stm32_vrefbuf_is_enabled(struct regulator_dev *rdev) |
---|
77 | 101 | { |
---|
78 | 102 | struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev); |
---|
| 103 | + int ret; |
---|
79 | 104 | |
---|
80 | | - return readl_relaxed(priv->base + STM32_VREFBUF_CSR) & STM32_ENVR; |
---|
| 105 | + ret = pm_runtime_get_sync(priv->dev); |
---|
| 106 | + if (ret < 0) { |
---|
| 107 | + pm_runtime_put_noidle(priv->dev); |
---|
| 108 | + return ret; |
---|
| 109 | + } |
---|
| 110 | + |
---|
| 111 | + ret = readl_relaxed(priv->base + STM32_VREFBUF_CSR) & STM32_ENVR; |
---|
| 112 | + |
---|
| 113 | + pm_runtime_mark_last_busy(priv->dev); |
---|
| 114 | + pm_runtime_put_autosuspend(priv->dev); |
---|
| 115 | + |
---|
| 116 | + return ret; |
---|
81 | 117 | } |
---|
82 | 118 | |
---|
83 | 119 | static int stm32_vrefbuf_set_voltage_sel(struct regulator_dev *rdev, |
---|
84 | 120 | unsigned sel) |
---|
85 | 121 | { |
---|
86 | 122 | struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev); |
---|
87 | | - u32 val = readl_relaxed(priv->base + STM32_VREFBUF_CSR); |
---|
| 123 | + u32 val; |
---|
| 124 | + int ret; |
---|
88 | 125 | |
---|
| 126 | + ret = pm_runtime_get_sync(priv->dev); |
---|
| 127 | + if (ret < 0) { |
---|
| 128 | + pm_runtime_put_noidle(priv->dev); |
---|
| 129 | + return ret; |
---|
| 130 | + } |
---|
| 131 | + |
---|
| 132 | + val = readl_relaxed(priv->base + STM32_VREFBUF_CSR); |
---|
89 | 133 | val = (val & ~STM32_VRS) | FIELD_PREP(STM32_VRS, sel); |
---|
90 | 134 | writel_relaxed(val, priv->base + STM32_VREFBUF_CSR); |
---|
| 135 | + |
---|
| 136 | + pm_runtime_mark_last_busy(priv->dev); |
---|
| 137 | + pm_runtime_put_autosuspend(priv->dev); |
---|
91 | 138 | |
---|
92 | 139 | return 0; |
---|
93 | 140 | } |
---|
.. | .. |
---|
95 | 142 | static int stm32_vrefbuf_get_voltage_sel(struct regulator_dev *rdev) |
---|
96 | 143 | { |
---|
97 | 144 | struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev); |
---|
98 | | - u32 val = readl_relaxed(priv->base + STM32_VREFBUF_CSR); |
---|
| 145 | + u32 val; |
---|
| 146 | + int ret; |
---|
99 | 147 | |
---|
100 | | - return FIELD_GET(STM32_VRS, val); |
---|
| 148 | + ret = pm_runtime_get_sync(priv->dev); |
---|
| 149 | + if (ret < 0) { |
---|
| 150 | + pm_runtime_put_noidle(priv->dev); |
---|
| 151 | + return ret; |
---|
| 152 | + } |
---|
| 153 | + |
---|
| 154 | + val = readl_relaxed(priv->base + STM32_VREFBUF_CSR); |
---|
| 155 | + ret = FIELD_GET(STM32_VRS, val); |
---|
| 156 | + |
---|
| 157 | + pm_runtime_mark_last_busy(priv->dev); |
---|
| 158 | + pm_runtime_put_autosuspend(priv->dev); |
---|
| 159 | + |
---|
| 160 | + return ret; |
---|
101 | 161 | } |
---|
102 | 162 | |
---|
103 | 163 | static const struct regulator_ops stm32_vrefbuf_volt_ops = { |
---|
.. | .. |
---|
115 | 175 | .volt_table = stm32_vrefbuf_voltages, |
---|
116 | 176 | .n_voltages = ARRAY_SIZE(stm32_vrefbuf_voltages), |
---|
117 | 177 | .ops = &stm32_vrefbuf_volt_ops, |
---|
| 178 | + .off_on_delay = 1000, |
---|
118 | 179 | .type = REGULATOR_VOLTAGE, |
---|
119 | 180 | .owner = THIS_MODULE, |
---|
120 | 181 | }; |
---|
121 | 182 | |
---|
122 | 183 | static int stm32_vrefbuf_probe(struct platform_device *pdev) |
---|
123 | 184 | { |
---|
124 | | - struct resource *res; |
---|
125 | 185 | struct stm32_vrefbuf *priv; |
---|
126 | 186 | struct regulator_config config = { }; |
---|
127 | 187 | struct regulator_dev *rdev; |
---|
.. | .. |
---|
130 | 190 | priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); |
---|
131 | 191 | if (!priv) |
---|
132 | 192 | return -ENOMEM; |
---|
| 193 | + priv->dev = &pdev->dev; |
---|
133 | 194 | |
---|
134 | | - res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
---|
135 | | - priv->base = devm_ioremap_resource(&pdev->dev, res); |
---|
| 195 | + priv->base = devm_platform_ioremap_resource(pdev, 0); |
---|
136 | 196 | if (IS_ERR(priv->base)) |
---|
137 | 197 | return PTR_ERR(priv->base); |
---|
138 | 198 | |
---|
.. | .. |
---|
140 | 200 | if (IS_ERR(priv->clk)) |
---|
141 | 201 | return PTR_ERR(priv->clk); |
---|
142 | 202 | |
---|
| 203 | + pm_runtime_get_noresume(&pdev->dev); |
---|
| 204 | + pm_runtime_set_active(&pdev->dev); |
---|
| 205 | + pm_runtime_set_autosuspend_delay(&pdev->dev, |
---|
| 206 | + STM32_VREFBUF_AUTO_SUSPEND_DELAY_MS); |
---|
| 207 | + pm_runtime_use_autosuspend(&pdev->dev); |
---|
| 208 | + pm_runtime_enable(&pdev->dev); |
---|
| 209 | + |
---|
143 | 210 | ret = clk_prepare_enable(priv->clk); |
---|
144 | 211 | if (ret) { |
---|
145 | 212 | dev_err(&pdev->dev, "clk prepare failed with error %d\n", ret); |
---|
146 | | - return ret; |
---|
| 213 | + goto err_pm_stop; |
---|
147 | 214 | } |
---|
148 | 215 | |
---|
149 | 216 | config.dev = &pdev->dev; |
---|
.. | .. |
---|
161 | 228 | } |
---|
162 | 229 | platform_set_drvdata(pdev, rdev); |
---|
163 | 230 | |
---|
| 231 | + pm_runtime_mark_last_busy(&pdev->dev); |
---|
| 232 | + pm_runtime_put_autosuspend(&pdev->dev); |
---|
| 233 | + |
---|
164 | 234 | return 0; |
---|
165 | 235 | |
---|
166 | 236 | err_clk_dis: |
---|
167 | 237 | clk_disable_unprepare(priv->clk); |
---|
| 238 | +err_pm_stop: |
---|
| 239 | + pm_runtime_disable(&pdev->dev); |
---|
| 240 | + pm_runtime_set_suspended(&pdev->dev); |
---|
| 241 | + pm_runtime_put_noidle(&pdev->dev); |
---|
168 | 242 | |
---|
169 | 243 | return ret; |
---|
170 | 244 | } |
---|
.. | .. |
---|
174 | 248 | struct regulator_dev *rdev = platform_get_drvdata(pdev); |
---|
175 | 249 | struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev); |
---|
176 | 250 | |
---|
| 251 | + pm_runtime_get_sync(&pdev->dev); |
---|
177 | 252 | regulator_unregister(rdev); |
---|
178 | 253 | clk_disable_unprepare(priv->clk); |
---|
| 254 | + pm_runtime_disable(&pdev->dev); |
---|
| 255 | + pm_runtime_set_suspended(&pdev->dev); |
---|
| 256 | + pm_runtime_put_noidle(&pdev->dev); |
---|
179 | 257 | |
---|
180 | 258 | return 0; |
---|
181 | 259 | }; |
---|
182 | 260 | |
---|
183 | | -static const struct of_device_id stm32_vrefbuf_of_match[] = { |
---|
| 261 | +static int __maybe_unused stm32_vrefbuf_runtime_suspend(struct device *dev) |
---|
| 262 | +{ |
---|
| 263 | + struct regulator_dev *rdev = dev_get_drvdata(dev); |
---|
| 264 | + struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev); |
---|
| 265 | + |
---|
| 266 | + clk_disable_unprepare(priv->clk); |
---|
| 267 | + |
---|
| 268 | + return 0; |
---|
| 269 | +} |
---|
| 270 | + |
---|
| 271 | +static int __maybe_unused stm32_vrefbuf_runtime_resume(struct device *dev) |
---|
| 272 | +{ |
---|
| 273 | + struct regulator_dev *rdev = dev_get_drvdata(dev); |
---|
| 274 | + struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev); |
---|
| 275 | + |
---|
| 276 | + return clk_prepare_enable(priv->clk); |
---|
| 277 | +} |
---|
| 278 | + |
---|
| 279 | +static const struct dev_pm_ops stm32_vrefbuf_pm_ops = { |
---|
| 280 | + SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, |
---|
| 281 | + pm_runtime_force_resume) |
---|
| 282 | + SET_RUNTIME_PM_OPS(stm32_vrefbuf_runtime_suspend, |
---|
| 283 | + stm32_vrefbuf_runtime_resume, |
---|
| 284 | + NULL) |
---|
| 285 | +}; |
---|
| 286 | + |
---|
| 287 | +static const struct of_device_id __maybe_unused stm32_vrefbuf_of_match[] = { |
---|
184 | 288 | { .compatible = "st,stm32-vrefbuf", }, |
---|
185 | 289 | {}, |
---|
186 | 290 | }; |
---|
.. | .. |
---|
192 | 296 | .driver = { |
---|
193 | 297 | .name = "stm32-vrefbuf", |
---|
194 | 298 | .of_match_table = of_match_ptr(stm32_vrefbuf_of_match), |
---|
| 299 | + .pm = &stm32_vrefbuf_pm_ops, |
---|
195 | 300 | }, |
---|
196 | 301 | }; |
---|
197 | 302 | module_platform_driver(stm32_vrefbuf_driver); |
---|