Commit | Line | Data |
---|---|---|
378fe115 LJ |
1 | /* |
2 | * PWM device driver for ST SoCs. | |
3 | * Author: Ajit Pal Singh <ajitpal.singh@st.com> | |
4 | * | |
5 | * Copyright (C) 2013-2014 STMicroelectronics (R&D) Limited | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License, or | |
10 | * (at your option) any later version. | |
11 | */ | |
12 | ||
378fe115 | 13 | #include <linux/clk.h> |
3f0925b5 | 14 | #include <linux/interrupt.h> |
378fe115 LJ |
15 | #include <linux/math64.h> |
16 | #include <linux/mfd/syscon.h> | |
17 | #include <linux/module.h> | |
18 | #include <linux/of.h> | |
19 | #include <linux/platform_device.h> | |
20 | #include <linux/pwm.h> | |
21 | #include <linux/regmap.h> | |
3f0925b5 | 22 | #include <linux/sched.h> |
378fe115 LJ |
23 | #include <linux/slab.h> |
24 | #include <linux/time.h> | |
3f0925b5 | 25 | #include <linux/wait.h> |
378fe115 | 26 | |
c5f94ae6 | 27 | #define PWM_OUT_VAL(x) (0x00 + (4 * (x))) /* Device's Duty Cycle register */ |
f66d78fa LJ |
28 | #define PWM_CPT_VAL(x) (0x10 + (4 * (x))) /* Capture value */ |
29 | #define PWM_CPT_EDGE(x) (0x30 + (4 * (x))) /* Edge to capture on */ | |
c5f94ae6 LJ |
30 | |
31 | #define STI_PWM_CTRL 0x50 /* Control/Config register */ | |
32 | #define STI_INT_EN 0x54 /* Interrupt Enable/Disable register */ | |
f66d78fa LJ |
33 | #define STI_INT_STA 0x58 /* Interrupt Status register */ |
34 | #define PWM_INT_ACK 0x5c | |
bf9cc80b APS |
35 | #define PWM_PRESCALE_LOW_MASK 0x0f |
36 | #define PWM_PRESCALE_HIGH_MASK 0xf0 | |
f66d78fa LJ |
37 | #define PWM_CPT_EDGE_MASK 0x03 |
38 | #define PWM_INT_ACK_MASK 0x1ff | |
39 | ||
40 | #define STI_MAX_CPT_DEVS 4 | |
41 | #define CPT_DC_MAX 0xff | |
378fe115 LJ |
42 | |
43 | /* Regfield IDs */ | |
44 | enum { | |
c5f94ae6 | 45 | /* Bits in PWM_CTRL*/ |
bf9cc80b APS |
46 | PWMCLK_PRESCALE_LOW, |
47 | PWMCLK_PRESCALE_HIGH, | |
f66d78fa | 48 | CPTCLK_PRESCALE, |
c5f94ae6 LJ |
49 | |
50 | PWM_OUT_EN, | |
f66d78fa | 51 | PWM_CPT_EN, |
c5f94ae6 LJ |
52 | |
53 | PWM_CPT_INT_EN, | |
f66d78fa | 54 | PWM_CPT_INT_STAT, |
378fe115 LJ |
55 | |
56 | /* Keep last */ | |
57 | MAX_REGFIELDS | |
58 | }; | |
59 | ||
f66d78fa LJ |
60 | /* Each capture input can be programmed to detect rising-edge, falling-edge, |
61 | * either edge or neither egde | |
62 | */ | |
63 | enum sti_cpt_edge { | |
64 | CPT_EDGE_DISABLED, | |
65 | CPT_EDGE_RISING, | |
66 | CPT_EDGE_FALLING, | |
67 | CPT_EDGE_BOTH, | |
68 | }; | |
69 | ||
3f0925b5 LJ |
70 | struct sti_cpt_ddata { |
71 | u32 snapshot[3]; | |
72 | unsigned int index; | |
73 | struct mutex lock; | |
74 | wait_queue_head_t wait; | |
75 | }; | |
76 | ||
378fe115 LJ |
77 | struct sti_pwm_compat_data { |
78 | const struct reg_field *reg_fields; | |
3f0925b5 LJ |
79 | unsigned int pwm_num_devs; |
80 | unsigned int cpt_num_devs; | |
378fe115 LJ |
81 | unsigned int max_pwm_cnt; |
82 | unsigned int max_prescale; | |
83 | }; | |
84 | ||
85 | struct sti_pwm_chip { | |
86 | struct device *dev; | |
c5f94ae6 | 87 | struct clk *pwm_clk; |
d66a928d | 88 | struct clk *cpt_clk; |
378fe115 LJ |
89 | struct regmap *regmap; |
90 | struct sti_pwm_compat_data *cdata; | |
bf9cc80b APS |
91 | struct regmap_field *prescale_low; |
92 | struct regmap_field *prescale_high; | |
c5f94ae6 | 93 | struct regmap_field *pwm_out_en; |
25eb5380 | 94 | struct regmap_field *pwm_cpt_en; |
c5f94ae6 | 95 | struct regmap_field *pwm_cpt_int_en; |
25eb5380 | 96 | struct regmap_field *pwm_cpt_int_stat; |
378fe115 | 97 | struct pwm_chip chip; |
5165166e | 98 | struct pwm_device *cur; |
cd264b6a | 99 | unsigned long configured; |
6ad6b838 APS |
100 | unsigned int en_count; |
101 | struct mutex sti_pwm_lock; /* To sync between enable/disable calls */ | |
378fe115 LJ |
102 | void __iomem *mmio; |
103 | }; | |
104 | ||
105 | static const struct reg_field sti_pwm_regfields[MAX_REGFIELDS] = { | |
c5f94ae6 LJ |
106 | [PWMCLK_PRESCALE_LOW] = REG_FIELD(STI_PWM_CTRL, 0, 3), |
107 | [PWMCLK_PRESCALE_HIGH] = REG_FIELD(STI_PWM_CTRL, 11, 14), | |
f66d78fa | 108 | [CPTCLK_PRESCALE] = REG_FIELD(STI_PWM_CTRL, 4, 8), |
c5f94ae6 | 109 | [PWM_OUT_EN] = REG_FIELD(STI_PWM_CTRL, 9, 9), |
f66d78fa | 110 | [PWM_CPT_EN] = REG_FIELD(STI_PWM_CTRL, 10, 10), |
c5f94ae6 | 111 | [PWM_CPT_INT_EN] = REG_FIELD(STI_INT_EN, 1, 4), |
f66d78fa | 112 | [PWM_CPT_INT_STAT] = REG_FIELD(STI_INT_STA, 1, 4), |
378fe115 LJ |
113 | }; |
114 | ||
115 | static inline struct sti_pwm_chip *to_sti_pwmchip(struct pwm_chip *chip) | |
116 | { | |
117 | return container_of(chip, struct sti_pwm_chip, chip); | |
118 | } | |
119 | ||
120 | /* | |
3aacd3e1 | 121 | * Calculate the prescaler value corresponding to the period. |
378fe115 | 122 | */ |
3aacd3e1 APS |
123 | static int sti_pwm_get_prescale(struct sti_pwm_chip *pc, unsigned long period, |
124 | unsigned int *prescale) | |
378fe115 LJ |
125 | { |
126 | struct sti_pwm_compat_data *cdata = pc->cdata; | |
d81738b7 | 127 | unsigned long clk_rate; |
378fe115 | 128 | unsigned long val; |
3aacd3e1 | 129 | unsigned int ps; |
378fe115 | 130 | |
d81738b7 LJ |
131 | clk_rate = clk_get_rate(pc->pwm_clk); |
132 | if (!clk_rate) { | |
133 | dev_err(pc->dev, "failed to get clock rate\n"); | |
134 | return -EINVAL; | |
135 | } | |
136 | ||
378fe115 | 137 | /* |
3aacd3e1 | 138 | * prescale = ((period_ns * clk_rate) / (10^9 * (max_pwm_count + 1)) - 1 |
378fe115 | 139 | */ |
d81738b7 | 140 | val = NSEC_PER_SEC / clk_rate; |
378fe115 LJ |
141 | val *= cdata->max_pwm_cnt + 1; |
142 | ||
3aacd3e1 APS |
143 | if (period % val) { |
144 | return -EINVAL; | |
145 | } else { | |
146 | ps = period / val - 1; | |
147 | if (ps > cdata->max_prescale) | |
148 | return -EINVAL; | |
378fe115 | 149 | } |
3aacd3e1 APS |
150 | *prescale = ps; |
151 | ||
152 | return 0; | |
378fe115 LJ |
153 | } |
154 | ||
378fe115 LJ |
155 | /* |
156 | * For STiH4xx PWM IP, the PWM period is fixed to 256 local clock cycles. | |
157 | * The only way to change the period (apart from changing the PWM input clock) | |
158 | * is to change the PWM clock prescaler. | |
bf9cc80b APS |
159 | * The prescaler is of 8 bits, so 256 prescaler values and hence |
160 | * 256 possible period values are supported (for a particular clock rate). | |
378fe115 | 161 | * The requested period will be applied only if it matches one of these |
bf9cc80b | 162 | * 256 values. |
378fe115 LJ |
163 | */ |
164 | static int sti_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm, | |
165 | int duty_ns, int period_ns) | |
166 | { | |
167 | struct sti_pwm_chip *pc = to_sti_pwmchip(chip); | |
168 | struct sti_pwm_compat_data *cdata = pc->cdata; | |
5165166e | 169 | struct pwm_device *cur = pc->cur; |
378fe115 | 170 | struct device *dev = pc->dev; |
5165166e | 171 | unsigned int prescale = 0, pwmvalx; |
378fe115 | 172 | int ret; |
5165166e APS |
173 | unsigned int ncfg; |
174 | bool period_same = false; | |
175 | ||
cd264b6a | 176 | ncfg = hweight_long(pc->configured); |
5165166e APS |
177 | if (ncfg) |
178 | period_same = (period_ns == pwm_get_period(cur)); | |
179 | ||
180 | /* Allow configuration changes if one of the | |
181 | * following conditions satisfy. | |
09022e61 LJ |
182 | * 1. No devices have been configured. |
183 | * 2. Only one device has been configured and the new request | |
184 | * is for the same device. | |
185 | * 3. Only one device has been configured and the new request is | |
186 | * for a new device and period of the new device is same as | |
5165166e | 187 | * the current configured period. |
09022e61 | 188 | * 4. More than one devices are configured and period of the new |
5165166e | 189 | * requestis the same as the current period. |
378fe115 | 190 | */ |
5165166e APS |
191 | if (!ncfg || |
192 | ((ncfg == 1) && (pwm->hwpwm == cur->hwpwm)) || | |
193 | ((ncfg == 1) && (pwm->hwpwm != cur->hwpwm) && period_same) || | |
194 | ((ncfg > 1) && period_same)) { | |
195 | /* Enable clock before writing to PWM registers. */ | |
c5f94ae6 | 196 | ret = clk_enable(pc->pwm_clk); |
5165166e APS |
197 | if (ret) |
198 | return ret; | |
199 | ||
d66a928d LJ |
200 | ret = clk_enable(pc->cpt_clk); |
201 | if (ret) | |
202 | return ret; | |
203 | ||
5165166e | 204 | if (!period_same) { |
3aacd3e1 APS |
205 | ret = sti_pwm_get_prescale(pc, period_ns, &prescale); |
206 | if (ret) | |
5165166e | 207 | goto clk_dis; |
5165166e APS |
208 | |
209 | ret = | |
210 | regmap_field_write(pc->prescale_low, | |
211 | prescale & PWM_PRESCALE_LOW_MASK); | |
212 | if (ret) | |
213 | goto clk_dis; | |
214 | ||
215 | ret = | |
216 | regmap_field_write(pc->prescale_high, | |
217 | (prescale & PWM_PRESCALE_HIGH_MASK) >> 4); | |
218 | if (ret) | |
219 | goto clk_dis; | |
220 | } | |
221 | ||
222 | /* | |
223 | * When PWMVal == 0, PWM pulse = 1 local clock cycle. | |
224 | * When PWMVal == max_pwm_count, | |
225 | * PWM pulse = (max_pwm_count + 1) local cycles, | |
226 | * that is continuous pulse: signal never goes low. | |
227 | */ | |
228 | pwmvalx = cdata->max_pwm_cnt * duty_ns / period_ns; | |
229 | ||
c5f94ae6 LJ |
230 | ret = regmap_write(pc->regmap, |
231 | PWM_OUT_VAL(pwm->hwpwm), pwmvalx); | |
5165166e APS |
232 | if (ret) |
233 | goto clk_dis; | |
234 | ||
c5f94ae6 | 235 | ret = regmap_field_write(pc->pwm_cpt_int_en, 0); |
5165166e | 236 | |
cd264b6a | 237 | set_bit(pwm->hwpwm, &pc->configured); |
5165166e APS |
238 | pc->cur = pwm; |
239 | ||
240 | dev_dbg(dev, "prescale:%u, period:%i, duty:%i, pwmvalx:%u\n", | |
241 | prescale, period_ns, duty_ns, pwmvalx); | |
242 | } else { | |
378fe115 LJ |
243 | return -EINVAL; |
244 | } | |
245 | ||
378fe115 | 246 | clk_dis: |
c5f94ae6 | 247 | clk_disable(pc->pwm_clk); |
d66a928d | 248 | clk_disable(pc->cpt_clk); |
378fe115 LJ |
249 | return ret; |
250 | } | |
251 | ||
252 | static int sti_pwm_enable(struct pwm_chip *chip, struct pwm_device *pwm) | |
253 | { | |
254 | struct sti_pwm_chip *pc = to_sti_pwmchip(chip); | |
255 | struct device *dev = pc->dev; | |
6ad6b838 | 256 | int ret = 0; |
378fe115 | 257 | |
6ad6b838 | 258 | /* |
09022e61 | 259 | * Since we have a common enable for all PWM devices, |
6ad6b838 APS |
260 | * do not enable if already enabled. |
261 | */ | |
262 | mutex_lock(&pc->sti_pwm_lock); | |
263 | if (!pc->en_count) { | |
c5f94ae6 | 264 | ret = clk_enable(pc->pwm_clk); |
6ad6b838 APS |
265 | if (ret) |
266 | goto out; | |
378fe115 | 267 | |
d66a928d LJ |
268 | ret = clk_enable(pc->cpt_clk); |
269 | if (ret) | |
270 | goto out; | |
271 | ||
c5f94ae6 | 272 | ret = regmap_field_write(pc->pwm_out_en, 1); |
6ad6b838 APS |
273 | if (ret) { |
274 | dev_err(dev, "failed to enable PWM device:%d\n", | |
275 | pwm->hwpwm); | |
276 | goto out; | |
277 | } | |
278 | } | |
279 | pc->en_count++; | |
280 | out: | |
281 | mutex_unlock(&pc->sti_pwm_lock); | |
378fe115 LJ |
282 | return ret; |
283 | } | |
284 | ||
285 | static void sti_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm) | |
286 | { | |
287 | struct sti_pwm_chip *pc = to_sti_pwmchip(chip); | |
378fe115 | 288 | |
6ad6b838 APS |
289 | mutex_lock(&pc->sti_pwm_lock); |
290 | if (--pc->en_count) { | |
291 | mutex_unlock(&pc->sti_pwm_lock); | |
292 | return; | |
293 | } | |
c5f94ae6 | 294 | regmap_field_write(pc->pwm_out_en, 0); |
378fe115 | 295 | |
c5f94ae6 | 296 | clk_disable(pc->pwm_clk); |
d66a928d | 297 | clk_disable(pc->cpt_clk); |
6ad6b838 | 298 | mutex_unlock(&pc->sti_pwm_lock); |
378fe115 LJ |
299 | } |
300 | ||
cd264b6a APS |
301 | static void sti_pwm_free(struct pwm_chip *chip, struct pwm_device *pwm) |
302 | { | |
303 | struct sti_pwm_chip *pc = to_sti_pwmchip(chip); | |
304 | ||
305 | clear_bit(pwm->hwpwm, &pc->configured); | |
306 | } | |
307 | ||
378fe115 LJ |
308 | static const struct pwm_ops sti_pwm_ops = { |
309 | .config = sti_pwm_config, | |
310 | .enable = sti_pwm_enable, | |
311 | .disable = sti_pwm_disable, | |
cd264b6a | 312 | .free = sti_pwm_free, |
378fe115 LJ |
313 | .owner = THIS_MODULE, |
314 | }; | |
315 | ||
25eb5380 LJ |
316 | static irqreturn_t sti_pwm_interrupt(int irq, void *data) |
317 | { | |
318 | struct sti_pwm_chip *pc = data; | |
319 | struct device *dev = pc->dev; | |
320 | struct sti_cpt_ddata *ddata; | |
321 | int devicenum; | |
322 | unsigned int cpt_int_stat; | |
323 | unsigned int reg; | |
324 | int ret = IRQ_NONE; | |
325 | ||
326 | ret = regmap_field_read(pc->pwm_cpt_int_stat, &cpt_int_stat); | |
327 | if (ret) | |
328 | return ret; | |
329 | ||
330 | while (cpt_int_stat) { | |
331 | devicenum = ffs(cpt_int_stat) - 1; | |
332 | ||
333 | ddata = pwm_get_chip_data(&pc->chip.pwms[devicenum]); | |
334 | ||
335 | /* | |
336 | * Capture input: | |
337 | * _______ _______ | |
338 | * | | | | | |
339 | * __| |_________________| |________ | |
340 | * ^0 ^1 ^2 | |
341 | * | |
342 | * Capture start by the first available rising edge | |
343 | * When a capture event occurs, capture value (CPT_VALx) | |
344 | * is stored, index incremented, capture edge changed. | |
345 | * | |
346 | * After the capture, if the index > 1, we have collected | |
347 | * the necessary data so we signal the thread waiting for it | |
348 | * and disable the capture by setting capture edge to none | |
349 | * | |
350 | */ | |
351 | ||
352 | regmap_read(pc->regmap, | |
353 | PWM_CPT_VAL(devicenum), | |
354 | &ddata->snapshot[ddata->index]); | |
355 | ||
356 | switch (ddata->index) { | |
357 | case 0: | |
358 | case 1: | |
359 | regmap_read(pc->regmap, PWM_CPT_EDGE(devicenum), ®); | |
360 | reg ^= PWM_CPT_EDGE_MASK; | |
361 | regmap_write(pc->regmap, PWM_CPT_EDGE(devicenum), reg); | |
362 | ||
363 | ddata->index++; | |
364 | break; | |
365 | case 2: | |
366 | regmap_write(pc->regmap, | |
367 | PWM_CPT_EDGE(devicenum), | |
368 | CPT_EDGE_DISABLED); | |
369 | wake_up(&ddata->wait); | |
370 | break; | |
371 | default: | |
372 | dev_err(dev, "Internal error\n"); | |
373 | } | |
374 | ||
375 | cpt_int_stat &= ~BIT_MASK(devicenum); | |
376 | ||
377 | ret = IRQ_HANDLED; | |
378 | } | |
379 | ||
380 | /* Just ACK everything */ | |
381 | regmap_write(pc->regmap, PWM_INT_ACK, PWM_INT_ACK_MASK); | |
382 | ||
383 | return ret; | |
384 | } | |
385 | ||
378fe115 LJ |
386 | static int sti_pwm_probe_dt(struct sti_pwm_chip *pc) |
387 | { | |
388 | struct device *dev = pc->dev; | |
389 | const struct reg_field *reg_fields; | |
390 | struct device_node *np = dev->of_node; | |
391 | struct sti_pwm_compat_data *cdata = pc->cdata; | |
09022e61 | 392 | u32 num_devs; |
3f0925b5 | 393 | int ret; |
378fe115 | 394 | |
3f0925b5 LJ |
395 | ret = of_property_read_u32(np, "st,pwm-num-chan", &num_devs); |
396 | if (!ret) | |
397 | cdata->pwm_num_devs = num_devs; | |
398 | ||
399 | ret = of_property_read_u32(np, "st,capture-num-chan", &num_devs); | |
400 | if (!ret) | |
401 | cdata->cpt_num_devs = num_devs; | |
378fe115 LJ |
402 | |
403 | reg_fields = cdata->reg_fields; | |
404 | ||
bf9cc80b APS |
405 | pc->prescale_low = devm_regmap_field_alloc(dev, pc->regmap, |
406 | reg_fields[PWMCLK_PRESCALE_LOW]); | |
407 | if (IS_ERR(pc->prescale_low)) | |
408 | return PTR_ERR(pc->prescale_low); | |
409 | ||
410 | pc->prescale_high = devm_regmap_field_alloc(dev, pc->regmap, | |
411 | reg_fields[PWMCLK_PRESCALE_HIGH]); | |
412 | if (IS_ERR(pc->prescale_high)) | |
413 | return PTR_ERR(pc->prescale_high); | |
378fe115 | 414 | |
378fe115 | 415 | |
c5f94ae6 LJ |
416 | pc->pwm_out_en = devm_regmap_field_alloc(dev, pc->regmap, |
417 | reg_fields[PWM_OUT_EN]); | |
418 | if (IS_ERR(pc->pwm_out_en)) | |
419 | return PTR_ERR(pc->pwm_out_en); | |
420 | ||
421 | pc->pwm_cpt_int_en = devm_regmap_field_alloc(dev, pc->regmap, | |
422 | reg_fields[PWM_CPT_INT_EN]); | |
423 | if (IS_ERR(pc->pwm_cpt_int_en)) | |
424 | return PTR_ERR(pc->pwm_cpt_int_en); | |
378fe115 | 425 | |
25eb5380 LJ |
426 | pc->pwm_cpt_int_stat = devm_regmap_field_alloc(dev, pc->regmap, |
427 | reg_fields[PWM_CPT_INT_STAT]); | |
428 | if (PTR_ERR_OR_ZERO(pc->pwm_cpt_int_stat)) | |
429 | return PTR_ERR(pc->pwm_cpt_int_stat); | |
430 | ||
378fe115 LJ |
431 | return 0; |
432 | } | |
433 | ||
434 | static const struct regmap_config sti_pwm_regmap_config = { | |
435 | .reg_bits = 32, | |
436 | .val_bits = 32, | |
437 | .reg_stride = 4, | |
438 | }; | |
439 | ||
440 | static int sti_pwm_probe(struct platform_device *pdev) | |
441 | { | |
442 | struct device *dev = &pdev->dev; | |
443 | struct sti_pwm_compat_data *cdata; | |
444 | struct sti_pwm_chip *pc; | |
445 | struct resource *res; | |
3f0925b5 | 446 | unsigned int i; |
25eb5380 | 447 | int irq, ret; |
378fe115 LJ |
448 | |
449 | pc = devm_kzalloc(dev, sizeof(*pc), GFP_KERNEL); | |
450 | if (!pc) | |
451 | return -ENOMEM; | |
452 | ||
453 | cdata = devm_kzalloc(dev, sizeof(*cdata), GFP_KERNEL); | |
454 | if (!cdata) | |
455 | return -ENOMEM; | |
456 | ||
457 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
458 | ||
459 | pc->mmio = devm_ioremap_resource(dev, res); | |
460 | if (IS_ERR(pc->mmio)) | |
461 | return PTR_ERR(pc->mmio); | |
462 | ||
463 | pc->regmap = devm_regmap_init_mmio(dev, pc->mmio, | |
464 | &sti_pwm_regmap_config); | |
465 | if (IS_ERR(pc->regmap)) | |
466 | return PTR_ERR(pc->regmap); | |
467 | ||
25eb5380 LJ |
468 | irq = platform_get_irq(pdev, 0); |
469 | if (irq < 0) { | |
470 | dev_err(&pdev->dev, "Failed to obtain IRQ\n"); | |
471 | return irq; | |
472 | } | |
473 | ||
474 | ret = devm_request_irq(&pdev->dev, irq, sti_pwm_interrupt, 0, | |
475 | pdev->name, pc); | |
476 | if (ret < 0) { | |
477 | dev_err(&pdev->dev, "Failed to request IRQ\n"); | |
478 | return ret; | |
479 | } | |
480 | ||
378fe115 LJ |
481 | /* |
482 | * Setup PWM data with default values: some values could be replaced | |
483 | * with specific ones provided from Device Tree. | |
484 | */ | |
485 | cdata->reg_fields = &sti_pwm_regfields[0]; | |
486 | cdata->max_prescale = 0xff; | |
487 | cdata->max_pwm_cnt = 255; | |
3f0925b5 LJ |
488 | cdata->pwm_num_devs = 1; |
489 | cdata->cpt_num_devs = 0; | |
378fe115 LJ |
490 | |
491 | pc->cdata = cdata; | |
492 | pc->dev = dev; | |
6ad6b838 APS |
493 | pc->en_count = 0; |
494 | mutex_init(&pc->sti_pwm_lock); | |
378fe115 LJ |
495 | |
496 | ret = sti_pwm_probe_dt(pc); | |
497 | if (ret) | |
498 | return ret; | |
499 | ||
c5f94ae6 LJ |
500 | pc->pwm_clk = of_clk_get_by_name(dev->of_node, "pwm"); |
501 | if (IS_ERR(pc->pwm_clk)) { | |
378fe115 | 502 | dev_err(dev, "failed to get PWM clock\n"); |
c5f94ae6 | 503 | return PTR_ERR(pc->pwm_clk); |
378fe115 LJ |
504 | } |
505 | ||
c5f94ae6 | 506 | ret = clk_prepare(pc->pwm_clk); |
378fe115 LJ |
507 | if (ret) { |
508 | dev_err(dev, "failed to prepare clock\n"); | |
509 | return ret; | |
510 | } | |
511 | ||
d66a928d LJ |
512 | pc->cpt_clk = of_clk_get_by_name(dev->of_node, "capture"); |
513 | if (IS_ERR(pc->cpt_clk)) { | |
514 | dev_err(dev, "failed to get PWM capture clock\n"); | |
515 | return PTR_ERR(pc->cpt_clk); | |
516 | } | |
517 | ||
518 | ret = clk_prepare(pc->cpt_clk); | |
519 | if (ret) { | |
520 | dev_err(dev, "failed to prepare clock\n"); | |
521 | return ret; | |
522 | } | |
523 | ||
378fe115 LJ |
524 | pc->chip.dev = dev; |
525 | pc->chip.ops = &sti_pwm_ops; | |
526 | pc->chip.base = -1; | |
3f0925b5 | 527 | pc->chip.npwm = pc->cdata->pwm_num_devs; |
378fe115 LJ |
528 | pc->chip.can_sleep = true; |
529 | ||
530 | ret = pwmchip_add(&pc->chip); | |
531 | if (ret < 0) { | |
c5f94ae6 | 532 | clk_unprepare(pc->pwm_clk); |
d66a928d | 533 | clk_unprepare(pc->cpt_clk); |
378fe115 LJ |
534 | return ret; |
535 | } | |
536 | ||
3f0925b5 LJ |
537 | for (i = 0; i < cdata->cpt_num_devs; i++) { |
538 | struct sti_cpt_ddata *ddata; | |
539 | ||
540 | ddata = devm_kzalloc(dev, sizeof(*ddata), GFP_KERNEL); | |
541 | if (!ddata) | |
542 | return -ENOMEM; | |
543 | ||
544 | init_waitqueue_head(&ddata->wait); | |
545 | mutex_init(&ddata->lock); | |
546 | ||
547 | pwm_set_chip_data(&pc->chip.pwms[i], ddata); | |
548 | } | |
549 | ||
378fe115 LJ |
550 | platform_set_drvdata(pdev, pc); |
551 | ||
552 | return 0; | |
553 | } | |
554 | ||
555 | static int sti_pwm_remove(struct platform_device *pdev) | |
556 | { | |
557 | struct sti_pwm_chip *pc = platform_get_drvdata(pdev); | |
558 | unsigned int i; | |
559 | ||
3f0925b5 | 560 | for (i = 0; i < pc->cdata->pwm_num_devs; i++) |
378fe115 LJ |
561 | pwm_disable(&pc->chip.pwms[i]); |
562 | ||
c5f94ae6 | 563 | clk_unprepare(pc->pwm_clk); |
d66a928d | 564 | clk_unprepare(pc->cpt_clk); |
378fe115 LJ |
565 | |
566 | return pwmchip_remove(&pc->chip); | |
567 | } | |
568 | ||
569 | static const struct of_device_id sti_pwm_of_match[] = { | |
570 | { .compatible = "st,sti-pwm", }, | |
571 | { /* sentinel */ } | |
572 | }; | |
573 | MODULE_DEVICE_TABLE(of, sti_pwm_of_match); | |
574 | ||
575 | static struct platform_driver sti_pwm_driver = { | |
576 | .driver = { | |
577 | .name = "sti-pwm", | |
578 | .of_match_table = sti_pwm_of_match, | |
579 | }, | |
580 | .probe = sti_pwm_probe, | |
581 | .remove = sti_pwm_remove, | |
582 | }; | |
583 | module_platform_driver(sti_pwm_driver); | |
584 | ||
585 | MODULE_AUTHOR("Ajit Pal Singh <ajitpal.singh@st.com>"); | |
586 | MODULE_DESCRIPTION("STMicroelectronics ST PWM driver"); | |
587 | MODULE_LICENSE("GPL"); |