blob: 93772ab8d7e3e3f1bad619d97f0527961ddd9813 [file] [log] [blame]
Thomas Gleixnerc82ee6d2019-05-19 15:51:48 +02001// SPDX-License-Identifier: GPL-2.0-or-later
Sascha Hauer0c2498f2011-01-28 09:40:40 +01002/*
3 * Generic pwmlib implementation
4 *
5 * Copyright (C) 2011 Sascha Hauer <s.hauer@pengutronix.de>
Thierry Redingf051c462011-12-14 11:12:23 +01006 * Copyright (C) 2011-2012 Avionic Design GmbH
Sascha Hauer0c2498f2011-01-28 09:40:40 +01007 */
8
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +02009#include <linux/acpi.h>
Sascha Hauer0c2498f2011-01-28 09:40:40 +010010#include <linux/module.h>
11#include <linux/pwm.h>
Thierry Redingf051c462011-12-14 11:12:23 +010012#include <linux/radix-tree.h>
Sascha Hauer0c2498f2011-01-28 09:40:40 +010013#include <linux/list.h>
14#include <linux/mutex.h>
15#include <linux/err.h>
16#include <linux/slab.h>
17#include <linux/device.h>
Thierry Reding62099ab2012-03-26 09:31:48 +020018#include <linux/debugfs.h>
19#include <linux/seq_file.h>
Sascha Hauer0c2498f2011-01-28 09:40:40 +010020
Laurent Pinchart208be762013-07-18 00:54:22 +020021#include <dt-bindings/pwm/pwm.h>
Sascha Hauer0c2498f2011-01-28 09:40:40 +010022
Uwe Kleine-König11888292019-10-24 10:08:29 +020023#define CREATE_TRACE_POINTS
24#include <trace/events/pwm.h>
25
Laurent Pinchart208be762013-07-18 00:54:22 +020026#define MAX_PWMS 1024
Philip, Avinash83af2402012-11-21 13:10:44 +053027
Thierry Reding8138d2d2012-03-26 08:42:48 +020028static DEFINE_MUTEX(pwm_lookup_lock);
29static LIST_HEAD(pwm_lookup_list);
Sascha Hauer0c2498f2011-01-28 09:40:40 +010030static DEFINE_MUTEX(pwm_lock);
Thierry Redingf051c462011-12-14 11:12:23 +010031static LIST_HEAD(pwm_chips);
32static DECLARE_BITMAP(allocated_pwms, MAX_PWMS);
33static RADIX_TREE(pwm_tree, GFP_KERNEL);
Sascha Hauer0c2498f2011-01-28 09:40:40 +010034
Thierry Redingf051c462011-12-14 11:12:23 +010035static struct pwm_device *pwm_to_device(unsigned int pwm)
Sascha Hauer0c2498f2011-01-28 09:40:40 +010036{
Thierry Redingf051c462011-12-14 11:12:23 +010037 return radix_tree_lookup(&pwm_tree, pwm);
38}
Sascha Hauer0c2498f2011-01-28 09:40:40 +010039
Uwe Kleine-Königf9a8ee82021-03-01 19:57:19 +010040static int alloc_pwms(unsigned int count)
Thierry Redingf051c462011-12-14 11:12:23 +010041{
Thierry Redingf051c462011-12-14 11:12:23 +010042 unsigned int start;
43
Uwe Kleine-Königf9a8ee82021-03-01 19:57:19 +010044 start = bitmap_find_next_zero_area(allocated_pwms, MAX_PWMS, 0,
Thierry Redingf051c462011-12-14 11:12:23 +010045 count, 0);
46
Thierry Redingf051c462011-12-14 11:12:23 +010047 if (start + count > MAX_PWMS)
48 return -ENOSPC;
49
50 return start;
51}
52
53static void free_pwms(struct pwm_chip *chip)
54{
55 unsigned int i;
56
57 for (i = 0; i < chip->npwm; i++) {
58 struct pwm_device *pwm = &chip->pwms[i];
Thierry Reding83a98862016-05-02 12:05:55 +020059
Thierry Redingf051c462011-12-14 11:12:23 +010060 radix_tree_delete(&pwm_tree, pwm->pwm);
Sascha Hauer0c2498f2011-01-28 09:40:40 +010061 }
62
Thierry Redingf051c462011-12-14 11:12:23 +010063 bitmap_clear(allocated_pwms, chip->base, chip->npwm);
64
65 kfree(chip->pwms);
66 chip->pwms = NULL;
67}
68
Thierry Reding8138d2d2012-03-26 08:42:48 +020069static struct pwm_chip *pwmchip_find_by_name(const char *name)
70{
71 struct pwm_chip *chip;
72
73 if (!name)
74 return NULL;
75
76 mutex_lock(&pwm_lock);
77
78 list_for_each_entry(chip, &pwm_chips, list) {
79 const char *chip_name = dev_name(chip->dev);
80
81 if (chip_name && strcmp(chip_name, name) == 0) {
82 mutex_unlock(&pwm_lock);
83 return chip;
84 }
85 }
86
87 mutex_unlock(&pwm_lock);
88
89 return NULL;
90}
91
Thierry Redingf051c462011-12-14 11:12:23 +010092static int pwm_device_request(struct pwm_device *pwm, const char *label)
93{
94 int err;
95
96 if (test_bit(PWMF_REQUESTED, &pwm->flags))
97 return -EBUSY;
98
99 if (!try_module_get(pwm->chip->ops->owner))
100 return -ENODEV;
101
102 if (pwm->chip->ops->request) {
103 err = pwm->chip->ops->request(pwm->chip, pwm);
104 if (err) {
105 module_put(pwm->chip->ops->owner);
106 return err;
107 }
108 }
109
Uwe Kleine-König11888292019-10-24 10:08:29 +0200110 if (pwm->chip->ops->get_state) {
Thierry Redingcfc4c182019-10-21 12:51:56 +0200111 pwm->chip->ops->get_state(pwm->chip, pwm, &pwm->state);
Uwe Kleine-König11888292019-10-24 10:08:29 +0200112 trace_pwm_get(pwm, &pwm->state);
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100113
Kees Cookf5641d02020-06-03 15:40:56 -0700114 if (IS_ENABLED(CONFIG_PWM_DEBUG))
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100115 pwm->last = pwm->state;
Uwe Kleine-König11888292019-10-24 10:08:29 +0200116 }
Thierry Redingcfc4c182019-10-21 12:51:56 +0200117
Thierry Redingf051c462011-12-14 11:12:23 +0100118 set_bit(PWMF_REQUESTED, &pwm->flags);
119 pwm->label = label;
120
121 return 0;
122}
123
Philip, Avinash83af2402012-11-21 13:10:44 +0530124struct pwm_device *
125of_pwm_xlate_with_flags(struct pwm_chip *pc, const struct of_phandle_args *args)
126{
127 struct pwm_device *pwm;
128
Uwe Kleine-Königcf38c972021-05-10 16:06:37 +0200129 if (pc->of_pwm_n_cells < 2)
Philip, Avinash83af2402012-11-21 13:10:44 +0530130 return ERR_PTR(-EINVAL);
131
Lothar Wassmann42883cb2017-01-29 22:54:13 +0100132 /* flags in the third cell are optional */
133 if (args->args_count < 2)
134 return ERR_PTR(-EINVAL);
135
Philip, Avinash83af2402012-11-21 13:10:44 +0530136 if (args->args[0] >= pc->npwm)
137 return ERR_PTR(-EINVAL);
138
139 pwm = pwm_request_from_chip(pc, args->args[0], NULL);
140 if (IS_ERR(pwm))
141 return pwm;
142
Boris Brezillone39c0df2016-04-14 21:17:21 +0200143 pwm->args.period = args->args[1];
Lothar Wassmann42883cb2017-01-29 22:54:13 +0100144 pwm->args.polarity = PWM_POLARITY_NORMAL;
Philip, Avinash83af2402012-11-21 13:10:44 +0530145
Uwe Kleine-Königcf38c972021-05-10 16:06:37 +0200146 if (pc->of_pwm_n_cells >= 3) {
147 if (args->args_count > 2 && args->args[2] & PWM_POLARITY_INVERTED)
148 pwm->args.polarity = PWM_POLARITY_INVERSED;
149 }
Philip, Avinash83af2402012-11-21 13:10:44 +0530150
151 return pwm;
152}
Thierry Reding417328c2012-11-28 15:12:07 +0100153EXPORT_SYMBOL_GPL(of_pwm_xlate_with_flags);
Philip, Avinash83af2402012-11-21 13:10:44 +0530154
Bjorn Andersson3ab7b6a2021-10-25 10:09:23 -0700155struct pwm_device *
156of_pwm_single_xlate(struct pwm_chip *pc, const struct of_phandle_args *args)
157{
158 struct pwm_device *pwm;
159
160 if (pc->of_pwm_n_cells < 1)
161 return ERR_PTR(-EINVAL);
162
163 /* validate that one cell is specified, optionally with flags */
164 if (args->args_count != 1 && args->args_count != 2)
165 return ERR_PTR(-EINVAL);
166
167 pwm = pwm_request_from_chip(pc, 0, NULL);
168 if (IS_ERR(pwm))
169 return pwm;
170
171 pwm->args.period = args->args[0];
172 pwm->args.polarity = PWM_POLARITY_NORMAL;
173
174 if (args->args_count == 2 && args->args[2] & PWM_POLARITY_INVERTED)
175 pwm->args.polarity = PWM_POLARITY_INVERSED;
176
177 return pwm;
178}
179EXPORT_SYMBOL_GPL(of_pwm_single_xlate);
180
Sachin Kamatdfeb86e2012-08-02 12:32:42 +0530181static void of_pwmchip_add(struct pwm_chip *chip)
Thierry Reding7299ab72011-12-14 11:10:32 +0100182{
183 if (!chip->dev || !chip->dev->of_node)
184 return;
185
186 if (!chip->of_xlate) {
Uwe Kleine-König69230cf2021-05-10 16:06:39 +0200187 u32 pwm_cells;
188
189 if (of_property_read_u32(chip->dev->of_node, "#pwm-cells",
190 &pwm_cells))
191 pwm_cells = 2;
192
Uwe Kleine-König5447e782021-05-10 16:06:38 +0200193 chip->of_xlate = of_pwm_xlate_with_flags;
Uwe Kleine-König69230cf2021-05-10 16:06:39 +0200194 chip->of_pwm_n_cells = pwm_cells;
Thierry Reding7299ab72011-12-14 11:10:32 +0100195 }
196
197 of_node_get(chip->dev->of_node);
198}
199
Sachin Kamatdfeb86e2012-08-02 12:32:42 +0530200static void of_pwmchip_remove(struct pwm_chip *chip)
Thierry Reding7299ab72011-12-14 11:10:32 +0100201{
Markus Elfring8d6cc072015-02-03 11:54:28 +0100202 if (chip->dev)
Thierry Reding7299ab72011-12-14 11:10:32 +0100203 of_node_put(chip->dev->of_node);
204}
205
Thierry Redingf051c462011-12-14 11:12:23 +0100206/**
207 * pwm_set_chip_data() - set private chip data for a PWM
208 * @pwm: PWM device
209 * @data: pointer to chip-specific data
Thierry Reding04883802015-07-27 11:58:32 +0200210 *
211 * Returns: 0 on success or a negative error code on failure.
Thierry Redingf051c462011-12-14 11:12:23 +0100212 */
213int pwm_set_chip_data(struct pwm_device *pwm, void *data)
214{
215 if (!pwm)
216 return -EINVAL;
217
218 pwm->chip_data = data;
219
220 return 0;
221}
Thierry Reding928c4472013-01-30 09:22:24 +0100222EXPORT_SYMBOL_GPL(pwm_set_chip_data);
Thierry Redingf051c462011-12-14 11:12:23 +0100223
224/**
225 * pwm_get_chip_data() - get private chip data for a PWM
226 * @pwm: PWM device
Thierry Reding04883802015-07-27 11:58:32 +0200227 *
228 * Returns: A pointer to the chip-private data for the PWM device.
Thierry Redingf051c462011-12-14 11:12:23 +0100229 */
230void *pwm_get_chip_data(struct pwm_device *pwm)
231{
232 return pwm ? pwm->chip_data : NULL;
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100233}
Thierry Reding928c4472013-01-30 09:22:24 +0100234EXPORT_SYMBOL_GPL(pwm_get_chip_data);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100235
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100236static bool pwm_ops_check(const struct pwm_chip *chip)
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200237{
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100238
239 const struct pwm_ops *ops = chip->ops;
240
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200241 /* driver supports legacy, non-atomic operation */
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100242 if (ops->config && ops->enable && ops->disable) {
243 if (IS_ENABLED(CONFIG_PWM_DEBUG))
244 dev_warn(chip->dev,
245 "Driver needs updating to atomic API\n");
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200246
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200247 return true;
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100248 }
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200249
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100250 if (!ops->apply)
251 return false;
252
253 if (IS_ENABLED(CONFIG_PWM_DEBUG) && !ops->get_state)
254 dev_warn(chip->dev,
255 "Please implement the .get_state() callback\n");
256
257 return true;
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200258}
259
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100260/**
Uwe Kleine-König9666cec2020-12-07 14:45:56 +0100261 * pwmchip_add() - register a new PWM chip
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100262 * @chip: the PWM chip to add
Thierry Redingf051c462011-12-14 11:12:23 +0100263 *
Uwe Kleine-König9666cec2020-12-07 14:45:56 +0100264 * Register a new PWM chip.
Thierry Reding04883802015-07-27 11:58:32 +0200265 *
266 * Returns: 0 on success or a negative error code on failure.
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100267 */
Uwe Kleine-König9666cec2020-12-07 14:45:56 +0100268int pwmchip_add(struct pwm_chip *chip)
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100269{
270 struct pwm_device *pwm;
Thierry Redingf051c462011-12-14 11:12:23 +0100271 unsigned int i;
272 int ret;
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100273
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200274 if (!chip || !chip->dev || !chip->ops || !chip->npwm)
275 return -EINVAL;
276
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100277 if (!pwm_ops_check(chip))
Thierry Redingf051c462011-12-14 11:12:23 +0100278 return -EINVAL;
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100279
280 mutex_lock(&pwm_lock);
281
Uwe Kleine-Königf9a8ee82021-03-01 19:57:19 +0100282 ret = alloc_pwms(chip->npwm);
Thierry Redingf051c462011-12-14 11:12:23 +0100283 if (ret < 0)
284 goto out;
285
Uwe Kleine-Königf9a8ee82021-03-01 19:57:19 +0100286 chip->base = ret;
287
Thierry Reding2907f8a2016-05-02 12:07:34 +0200288 chip->pwms = kcalloc(chip->npwm, sizeof(*pwm), GFP_KERNEL);
Thierry Redingf051c462011-12-14 11:12:23 +0100289 if (!chip->pwms) {
290 ret = -ENOMEM;
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100291 goto out;
292 }
293
Thierry Redingf051c462011-12-14 11:12:23 +0100294 for (i = 0; i < chip->npwm; i++) {
295 pwm = &chip->pwms[i];
296
297 pwm->chip = chip;
298 pwm->pwm = chip->base + i;
299 pwm->hwpwm = i;
300
301 radix_tree_insert(&pwm_tree, pwm->pwm, pwm);
302 }
303
304 bitmap_set(allocated_pwms, chip->base, chip->npwm);
305
306 INIT_LIST_HEAD(&chip->list);
307 list_add(&chip->list, &pwm_chips);
308
309 ret = 0;
310
Thierry Reding7299ab72011-12-14 11:10:32 +0100311 if (IS_ENABLED(CONFIG_OF))
312 of_pwmchip_add(chip);
313
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100314out:
315 mutex_unlock(&pwm_lock);
Phong Hoang347ab942019-03-19 19:40:08 +0900316
317 if (!ret)
318 pwmchip_sysfs_export(chip);
319
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100320 return ret;
321}
322EXPORT_SYMBOL_GPL(pwmchip_add);
323
324/**
325 * pwmchip_remove() - remove a PWM chip
326 * @chip: the PWM chip to remove
327 *
328 * Removes a PWM chip. This function may return busy if the PWM chip provides
329 * a PWM device that is still requested.
Thierry Reding04883802015-07-27 11:58:32 +0200330 *
331 * Returns: 0 on success or a negative error code on failure.
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100332 */
Uwe Kleine-König8083f582021-07-07 18:28:35 +0200333void pwmchip_remove(struct pwm_chip *chip)
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100334{
Phong Hoang347ab942019-03-19 19:40:08 +0900335 pwmchip_sysfs_unexport(chip);
David Hsu07334242016-08-09 14:57:46 -0700336
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100337 mutex_lock(&pwm_lock);
338
Thierry Redingf051c462011-12-14 11:12:23 +0100339 list_del_init(&chip->list);
Thierry Reding7299ab72011-12-14 11:10:32 +0100340
341 if (IS_ENABLED(CONFIG_OF))
342 of_pwmchip_remove(chip);
343
Thierry Redingf051c462011-12-14 11:12:23 +0100344 free_pwms(chip);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100345
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100346 mutex_unlock(&pwm_lock);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100347}
348EXPORT_SYMBOL_GPL(pwmchip_remove);
349
Uwe Kleine-Königbcda91b2021-04-07 10:01:54 +0200350static void devm_pwmchip_remove(void *data)
351{
352 struct pwm_chip *chip = data;
353
354 pwmchip_remove(chip);
355}
356
357int devm_pwmchip_add(struct device *dev, struct pwm_chip *chip)
358{
359 int ret;
360
361 ret = pwmchip_add(chip);
362 if (ret)
363 return ret;
364
365 return devm_add_action_or_reset(dev, devm_pwmchip_remove, chip);
366}
367EXPORT_SYMBOL_GPL(devm_pwmchip_add);
368
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100369/**
370 * pwm_request() - request a PWM device
Thierry Reding04883802015-07-27 11:58:32 +0200371 * @pwm: global PWM device index
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100372 * @label: PWM device label
Thierry Reding8138d2d2012-03-26 08:42:48 +0200373 *
374 * This function is deprecated, use pwm_get() instead.
Thierry Reding04883802015-07-27 11:58:32 +0200375 *
376 * Returns: A pointer to a PWM device or an ERR_PTR()-encoded error code on
377 * failure.
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100378 */
Thierry Redingf051c462011-12-14 11:12:23 +0100379struct pwm_device *pwm_request(int pwm, const char *label)
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100380{
Thierry Redingf051c462011-12-14 11:12:23 +0100381 struct pwm_device *dev;
382 int err;
383
384 if (pwm < 0 || pwm >= MAX_PWMS)
385 return ERR_PTR(-EINVAL);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100386
387 mutex_lock(&pwm_lock);
388
Thierry Redingf051c462011-12-14 11:12:23 +0100389 dev = pwm_to_device(pwm);
390 if (!dev) {
391 dev = ERR_PTR(-EPROBE_DEFER);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100392 goto out;
393 }
394
Thierry Redingf051c462011-12-14 11:12:23 +0100395 err = pwm_device_request(dev, label);
396 if (err < 0)
397 dev = ERR_PTR(err);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100398
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100399out:
400 mutex_unlock(&pwm_lock);
401
Thierry Redingf051c462011-12-14 11:12:23 +0100402 return dev;
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100403}
404EXPORT_SYMBOL_GPL(pwm_request);
405
406/**
Thierry Redingf051c462011-12-14 11:12:23 +0100407 * pwm_request_from_chip() - request a PWM device relative to a PWM chip
408 * @chip: PWM chip
409 * @index: per-chip index of the PWM to request
410 * @label: a literal description string of this PWM
411 *
Thierry Reding04883802015-07-27 11:58:32 +0200412 * Returns: A pointer to the PWM device at the given index of the given PWM
413 * chip. A negative error code is returned if the index is not valid for the
414 * specified PWM chip or if the PWM device cannot be requested.
Thierry Redingf051c462011-12-14 11:12:23 +0100415 */
416struct pwm_device *pwm_request_from_chip(struct pwm_chip *chip,
417 unsigned int index,
418 const char *label)
419{
420 struct pwm_device *pwm;
421 int err;
422
423 if (!chip || index >= chip->npwm)
424 return ERR_PTR(-EINVAL);
425
426 mutex_lock(&pwm_lock);
427 pwm = &chip->pwms[index];
428
429 err = pwm_device_request(pwm, label);
430 if (err < 0)
431 pwm = ERR_PTR(err);
432
433 mutex_unlock(&pwm_lock);
434 return pwm;
435}
436EXPORT_SYMBOL_GPL(pwm_request_from_chip);
437
438/**
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100439 * pwm_free() - free a PWM device
440 * @pwm: PWM device
Thierry Reding8138d2d2012-03-26 08:42:48 +0200441 *
442 * This function is deprecated, use pwm_put() instead.
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100443 */
444void pwm_free(struct pwm_device *pwm)
445{
Thierry Reding8138d2d2012-03-26 08:42:48 +0200446 pwm_put(pwm);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100447}
448EXPORT_SYMBOL_GPL(pwm_free);
449
Jason Yan374c1102020-04-02 14:57:18 +0800450static void pwm_apply_state_debug(struct pwm_device *pwm,
451 const struct pwm_state *state)
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100452{
453 struct pwm_state *last = &pwm->last;
454 struct pwm_chip *chip = pwm->chip;
455 struct pwm_state s1, s2;
456 int err;
457
458 if (!IS_ENABLED(CONFIG_PWM_DEBUG))
459 return;
460
461 /* No reasonable diagnosis possible without .get_state() */
462 if (!chip->ops->get_state)
463 return;
464
465 /*
466 * *state was just applied. Read out the hardware state and do some
467 * checks.
468 */
469
470 chip->ops->get_state(chip, pwm, &s1);
471 trace_pwm_get(pwm, &s1);
472
473 /*
474 * The lowlevel driver either ignored .polarity (which is a bug) or as
475 * best effort inverted .polarity and fixed .duty_cycle respectively.
476 * Undo this inversion and fixup for further tests.
477 */
478 if (s1.enabled && s1.polarity != state->polarity) {
479 s2.polarity = state->polarity;
480 s2.duty_cycle = s1.period - s1.duty_cycle;
481 s2.period = s1.period;
482 s2.enabled = s1.enabled;
483 } else {
484 s2 = s1;
485 }
486
487 if (s2.polarity != state->polarity &&
488 state->duty_cycle < state->period)
489 dev_warn(chip->dev, ".apply ignored .polarity\n");
490
491 if (state->enabled &&
492 last->polarity == state->polarity &&
493 last->period > s2.period &&
494 last->period <= state->period)
495 dev_warn(chip->dev,
Guru Das Srinagesha9d887d2020-06-02 15:31:16 -0700496 ".apply didn't pick the best available period (requested: %llu, applied: %llu, possible: %llu)\n",
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100497 state->period, s2.period, last->period);
498
499 if (state->enabled && state->period < s2.period)
500 dev_warn(chip->dev,
Guru Das Srinagesha9d887d2020-06-02 15:31:16 -0700501 ".apply is supposed to round down period (requested: %llu, applied: %llu)\n",
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100502 state->period, s2.period);
503
504 if (state->enabled &&
505 last->polarity == state->polarity &&
506 last->period == s2.period &&
507 last->duty_cycle > s2.duty_cycle &&
508 last->duty_cycle <= state->duty_cycle)
509 dev_warn(chip->dev,
Guru Das Srinagesha9d887d2020-06-02 15:31:16 -0700510 ".apply didn't pick the best available duty cycle (requested: %llu/%llu, applied: %llu/%llu, possible: %llu/%llu)\n",
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100511 state->duty_cycle, state->period,
512 s2.duty_cycle, s2.period,
513 last->duty_cycle, last->period);
514
515 if (state->enabled && state->duty_cycle < s2.duty_cycle)
516 dev_warn(chip->dev,
Guru Das Srinagesha9d887d2020-06-02 15:31:16 -0700517 ".apply is supposed to round down duty_cycle (requested: %llu/%llu, applied: %llu/%llu)\n",
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100518 state->duty_cycle, state->period,
519 s2.duty_cycle, s2.period);
520
521 if (!state->enabled && s2.enabled && s2.duty_cycle > 0)
522 dev_warn(chip->dev,
Christophe JAILLETdb539cb2020-04-11 17:35:28 +0200523 "requested disabled, but yielded enabled with duty > 0\n");
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100524
525 /* reapply the state that the driver reported being configured. */
526 err = chip->ops->apply(chip, pwm, &s1);
527 if (err) {
528 *last = s1;
529 dev_err(chip->dev, "failed to reapply current setting\n");
530 return;
531 }
532
533 trace_pwm_apply(pwm, &s1);
534
535 chip->ops->get_state(chip, pwm, last);
536 trace_pwm_get(pwm, last);
537
538 /* reapplication of the current state should give an exact match */
539 if (s1.enabled != last->enabled ||
540 s1.polarity != last->polarity ||
541 (s1.enabled && s1.period != last->period) ||
542 (s1.enabled && s1.duty_cycle != last->duty_cycle)) {
543 dev_err(chip->dev,
Guru Das Srinagesha9d887d2020-06-02 15:31:16 -0700544 ".apply is not idempotent (ena=%d pol=%d %llu/%llu) -> (ena=%d pol=%d %llu/%llu)\n",
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100545 s1.enabled, s1.polarity, s1.duty_cycle, s1.period,
546 last->enabled, last->polarity, last->duty_cycle,
547 last->period);
548 }
549}
550
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100551/**
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200552 * pwm_apply_state() - atomically apply a new state to a PWM device
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100553 * @pwm: PWM device
Uwe Kleine-König71523d12019-08-24 17:37:07 +0200554 * @state: new state to apply
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100555 */
Uwe Kleine-König71523d12019-08-24 17:37:07 +0200556int pwm_apply_state(struct pwm_device *pwm, const struct pwm_state *state)
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100557{
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200558 struct pwm_chip *chip;
H Hartley Sweeten76abbdde2013-06-11 10:38:59 -0700559 int err;
560
Uwe Kleine-König4ad91a22021-09-09 11:48:49 +0200561 /*
562 * Some lowlevel driver's implementations of .apply() make use of
563 * mutexes, also with some drivers only returning when the new
564 * configuration is active calling pwm_apply_state() from atomic context
565 * is a bad idea. So make it explicit that calling this function might
566 * sleep.
567 */
568 might_sleep();
569
Brian Norrisef2bf492016-05-27 09:45:49 -0700570 if (!pwm || !state || !state->period ||
571 state->duty_cycle > state->period)
Jonathan Richardsond1cd2142015-10-16 17:40:58 -0700572 return -EINVAL;
573
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200574 chip = pwm->chip;
575
Uwe Kleine-König309b32f2019-01-07 20:49:37 +0100576 if (state->period == pwm->state.period &&
577 state->duty_cycle == pwm->state.duty_cycle &&
578 state->polarity == pwm->state.polarity &&
Clemens Gruber9e40ee12021-05-07 15:18:42 +0200579 state->enabled == pwm->state.enabled &&
580 state->usage_power == pwm->state.usage_power)
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200581 return 0;
Jonathan Richardsond1cd2142015-10-16 17:40:58 -0700582
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200583 if (chip->ops->apply) {
584 err = chip->ops->apply(chip, pwm, state);
Jonathan Richardsond1cd2142015-10-16 17:40:58 -0700585 if (err)
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200586 return err;
587
Uwe Kleine-König11888292019-10-24 10:08:29 +0200588 trace_pwm_apply(pwm, state);
589
Thierry Reding40a6b9a2019-10-21 12:41:40 +0200590 pwm->state = *state;
Uwe Kleine-König3ad1f3a2020-02-10 22:35:18 +0100591
592 /*
593 * only do this after pwm->state was applied as some
594 * implementations of .get_state depend on this
595 */
596 pwm_apply_state_debug(pwm, state);
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200597 } else {
598 /*
599 * FIXME: restore the initial state in case of error.
600 */
601 if (state->polarity != pwm->state.polarity) {
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200602 if (!chip->ops->set_polarity)
Uwe Kleine-Königd58cb0e2021-03-01 19:23:07 +0100603 return -EINVAL;
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200604
605 /*
606 * Changing the polarity of a running PWM is
607 * only allowed when the PWM driver implements
608 * ->apply().
609 */
610 if (pwm->state.enabled) {
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200611 chip->ops->disable(chip, pwm);
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200612 pwm->state.enabled = false;
613 }
614
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200615 err = chip->ops->set_polarity(chip, pwm,
616 state->polarity);
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200617 if (err)
618 return err;
619
620 pwm->state.polarity = state->polarity;
621 }
622
623 if (state->period != pwm->state.period ||
624 state->duty_cycle != pwm->state.duty_cycle) {
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200625 err = chip->ops->config(pwm->chip, pwm,
626 state->duty_cycle,
627 state->period);
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200628 if (err)
629 return err;
630
631 pwm->state.duty_cycle = state->duty_cycle;
632 pwm->state.period = state->period;
633 }
634
635 if (state->enabled != pwm->state.enabled) {
636 if (state->enabled) {
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200637 err = chip->ops->enable(chip, pwm);
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200638 if (err)
639 return err;
640 } else {
Uwe Kleine-Königfc3c5512019-08-24 17:37:02 +0200641 chip->ops->disable(chip, pwm);
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200642 }
643
644 pwm->state.enabled = state->enabled;
645 }
Jonathan Richardsond1cd2142015-10-16 17:40:58 -0700646 }
647
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200648 return 0;
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100649}
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200650EXPORT_SYMBOL_GPL(pwm_apply_state);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100651
652/**
Lee Jones3a3d1a42016-06-08 10:21:23 +0100653 * pwm_capture() - capture and report a PWM signal
654 * @pwm: PWM device
655 * @result: structure to fill with capture result
656 * @timeout: time to wait, in milliseconds, before giving up on capture
657 *
658 * Returns: 0 on success or a negative error code on failure.
659 */
660int pwm_capture(struct pwm_device *pwm, struct pwm_capture *result,
661 unsigned long timeout)
662{
663 int err;
664
665 if (!pwm || !pwm->chip->ops)
666 return -EINVAL;
667
668 if (!pwm->chip->ops->capture)
669 return -ENOSYS;
670
671 mutex_lock(&pwm_lock);
672 err = pwm->chip->ops->capture(pwm->chip, pwm, result, timeout);
673 mutex_unlock(&pwm_lock);
674
675 return err;
676}
677EXPORT_SYMBOL_GPL(pwm_capture);
678
679/**
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200680 * pwm_adjust_config() - adjust the current PWM config to the PWM arguments
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100681 * @pwm: PWM device
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200682 *
683 * This function will adjust the PWM config to the PWM arguments provided
684 * by the DT or PWM lookup table. This is particularly useful to adapt
685 * the bootloader config to the Linux one.
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100686 */
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200687int pwm_adjust_config(struct pwm_device *pwm)
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100688{
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200689 struct pwm_state state;
690 struct pwm_args pargs;
Boris Brezillon09a7e4a2016-04-14 21:17:39 +0200691
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200692 pwm_get_args(pwm, &pargs);
693 pwm_get_state(pwm, &state);
694
695 /*
696 * If the current period is zero it means that either the PWM driver
697 * does not support initial state retrieval or the PWM has not yet
698 * been configured.
699 *
700 * In either case, we setup the new period and polarity, and assign a
701 * duty cycle of 0.
702 */
703 if (!state.period) {
704 state.duty_cycle = 0;
705 state.period = pargs.period;
706 state.polarity = pargs.polarity;
707
708 return pwm_apply_state(pwm, &state);
Boris Brezillon09a7e4a2016-04-14 21:17:39 +0200709 }
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200710
711 /*
712 * Adjust the PWM duty cycle/period based on the period value provided
713 * in PWM args.
714 */
715 if (pargs.period != state.period) {
716 u64 dutycycle = (u64)state.duty_cycle * pargs.period;
717
718 do_div(dutycycle, state.period);
719 state.duty_cycle = dutycycle;
720 state.period = pargs.period;
721 }
722
723 /*
724 * If the polarity changed, we should also change the duty cycle.
725 */
726 if (pargs.polarity != state.polarity) {
727 state.polarity = pargs.polarity;
728 state.duty_cycle = state.period - state.duty_cycle;
729 }
730
731 return pwm_apply_state(pwm, &state);
Sascha Hauer0c2498f2011-01-28 09:40:40 +0100732}
Boris Brezillon5ec803e2016-04-14 21:17:41 +0200733EXPORT_SYMBOL_GPL(pwm_adjust_config);
Thierry Reding62099ab2012-03-26 09:31:48 +0200734
Andy Shevchenkoca066162021-06-07 15:24:54 +0300735static struct pwm_chip *fwnode_to_pwmchip(struct fwnode_handle *fwnode)
Thierry Reding7299ab72011-12-14 11:10:32 +0100736{
737 struct pwm_chip *chip;
738
739 mutex_lock(&pwm_lock);
740
741 list_for_each_entry(chip, &pwm_chips, list)
Andy Shevchenkoca066162021-06-07 15:24:54 +0300742 if (chip->dev && dev_fwnode(chip->dev) == fwnode) {
Thierry Reding7299ab72011-12-14 11:10:32 +0100743 mutex_unlock(&pwm_lock);
744 return chip;
745 }
746
747 mutex_unlock(&pwm_lock);
748
749 return ERR_PTR(-EPROBE_DEFER);
750}
751
Fabrice Gasnierb2c200e2019-04-18 11:37:47 +0200752static struct device_link *pwm_device_link_add(struct device *dev,
753 struct pwm_device *pwm)
754{
755 struct device_link *dl;
756
757 if (!dev) {
758 /*
759 * No device for the PWM consumer has been provided. It may
760 * impact the PM sequence ordering: the PWM supplier may get
761 * suspended before the consumer.
762 */
763 dev_warn(pwm->chip->dev,
764 "No consumer device specified to create a link to\n");
765 return NULL;
766 }
767
768 dl = device_link_add(dev, pwm->chip->dev, DL_FLAG_AUTOREMOVE_CONSUMER);
769 if (!dl) {
770 dev_err(dev, "failed to create device link to %s\n",
771 dev_name(pwm->chip->dev));
772 return ERR_PTR(-EINVAL);
773 }
774
775 return dl;
776}
777
Thierry Reding7299ab72011-12-14 11:10:32 +0100778/**
Peter Ujfalusi8eb96122012-12-21 01:43:58 -0800779 * of_pwm_get() - request a PWM via the PWM framework
Fabrice Gasnierb2c200e2019-04-18 11:37:47 +0200780 * @dev: device for PWM consumer
Thierry Reding7299ab72011-12-14 11:10:32 +0100781 * @np: device node to get the PWM from
782 * @con_id: consumer name
783 *
784 * Returns the PWM device parsed from the phandle and index specified in the
785 * "pwms" property of a device tree node or a negative error-code on failure.
786 * Values parsed from the device tree are stored in the returned PWM device
787 * object.
788 *
789 * If con_id is NULL, the first PWM device listed in the "pwms" property will
790 * be requested. Otherwise the "pwm-names" property is used to do a reverse
791 * lookup of the PWM index. This also means that the "pwm-names" property
792 * becomes mandatory for devices that look up the PWM device via the con_id
793 * parameter.
Thierry Reding04883802015-07-27 11:58:32 +0200794 *
795 * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
796 * error code on failure.
Thierry Reding7299ab72011-12-14 11:10:32 +0100797 */
Fabrice Gasnierb2c200e2019-04-18 11:37:47 +0200798struct pwm_device *of_pwm_get(struct device *dev, struct device_node *np,
799 const char *con_id)
Thierry Reding7299ab72011-12-14 11:10:32 +0100800{
801 struct pwm_device *pwm = NULL;
802 struct of_phandle_args args;
Fabrice Gasnierb2c200e2019-04-18 11:37:47 +0200803 struct device_link *dl;
Thierry Reding7299ab72011-12-14 11:10:32 +0100804 struct pwm_chip *pc;
805 int index = 0;
806 int err;
807
808 if (con_id) {
809 index = of_property_match_string(np, "pwm-names", con_id);
810 if (index < 0)
811 return ERR_PTR(index);
812 }
813
814 err = of_parse_phandle_with_args(np, "pwms", "#pwm-cells", index,
815 &args);
816 if (err) {
Lothar Wassmannf2dafc02017-01-29 22:54:05 +0100817 pr_err("%s(): can't parse \"pwms\" property\n", __func__);
Thierry Reding7299ab72011-12-14 11:10:32 +0100818 return ERR_PTR(err);
819 }
820
Andy Shevchenkoca066162021-06-07 15:24:54 +0300821 pc = fwnode_to_pwmchip(of_fwnode_handle(args.np));
Thierry Reding7299ab72011-12-14 11:10:32 +0100822 if (IS_ERR(pc)) {
Jerome Brunet93c292e2017-05-23 18:05:03 +0200823 if (PTR_ERR(pc) != -EPROBE_DEFER)
824 pr_err("%s(): PWM chip not found\n", __func__);
825
Thierry Reding7299ab72011-12-14 11:10:32 +0100826 pwm = ERR_CAST(pc);
827 goto put;
828 }
829
Thierry Reding7299ab72011-12-14 11:10:32 +0100830 pwm = pc->of_xlate(pc, &args);
831 if (IS_ERR(pwm))
832 goto put;
833
Fabrice Gasnierb2c200e2019-04-18 11:37:47 +0200834 dl = pwm_device_link_add(dev, pwm);
835 if (IS_ERR(dl)) {
836 /* of_xlate ended up calling pwm_request_from_chip() */
837 pwm_free(pwm);
838 pwm = ERR_CAST(dl);
839 goto put;
840 }
841
Thierry Reding7299ab72011-12-14 11:10:32 +0100842 /*
843 * If a consumer name was not given, try to look it up from the
844 * "pwm-names" property if it exists. Otherwise use the name of
845 * the user device node.
846 */
847 if (!con_id) {
848 err = of_property_read_string_index(np, "pwm-names", index,
849 &con_id);
850 if (err < 0)
851 con_id = np->name;
852 }
853
854 pwm->label = con_id;
855
856put:
857 of_node_put(args.np);
858
859 return pwm;
860}
Peter Ujfalusi8eb96122012-12-21 01:43:58 -0800861EXPORT_SYMBOL_GPL(of_pwm_get);
Thierry Reding7299ab72011-12-14 11:10:32 +0100862
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200863/**
864 * acpi_pwm_get() - request a PWM via parsing "pwms" property in ACPI
Andy Shevchenkoe625fb72021-06-07 15:24:56 +0300865 * @fwnode: firmware node to get the "pwms" property from
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200866 *
867 * Returns the PWM device parsed from the fwnode and index specified in the
868 * "pwms" property or a negative error-code on failure.
869 * Values parsed from the device tree are stored in the returned PWM device
870 * object.
871 *
872 * This is analogous to of_pwm_get() except con_id is not yet supported.
873 * ACPI entries must look like
874 * Package () {"pwms", Package ()
875 * { <PWM device reference>, <PWM index>, <PWM period> [, <PWM flags>]}}
876 *
877 * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
878 * error code on failure.
879 */
Andy Shevchenkoe625fb72021-06-07 15:24:56 +0300880static struct pwm_device *acpi_pwm_get(const struct fwnode_handle *fwnode)
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200881{
Colin Ian Kingbebedf22021-07-06 16:11:32 +0100882 struct pwm_device *pwm;
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200883 struct fwnode_reference_args args;
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200884 struct pwm_chip *chip;
885 int ret;
886
887 memset(&args, 0, sizeof(args));
888
889 ret = __acpi_node_get_property_reference(fwnode, "pwms", 0, 3, &args);
890 if (ret < 0)
891 return ERR_PTR(ret);
892
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200893 if (args.nargs < 2)
894 return ERR_PTR(-EPROTO);
895
Andy Shevchenkoe5c38ba2021-06-07 15:24:55 +0300896 chip = fwnode_to_pwmchip(args.fwnode);
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200897 if (IS_ERR(chip))
898 return ERR_CAST(chip);
899
900 pwm = pwm_request_from_chip(chip, args.args[0], NULL);
901 if (IS_ERR(pwm))
902 return pwm;
903
904 pwm->args.period = args.args[1];
905 pwm->args.polarity = PWM_POLARITY_NORMAL;
906
907 if (args.nargs > 2 && args.args[2] & PWM_POLARITY_INVERTED)
908 pwm->args.polarity = PWM_POLARITY_INVERSED;
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200909
910 return pwm;
911}
912
Thierry Reding8138d2d2012-03-26 08:42:48 +0200913/**
914 * pwm_add_table() - register PWM device consumers
915 * @table: array of consumers to register
916 * @num: number of consumers in table
917 */
Shobhit Kumarc264f112015-03-12 22:01:31 +0530918void pwm_add_table(struct pwm_lookup *table, size_t num)
Thierry Reding8138d2d2012-03-26 08:42:48 +0200919{
920 mutex_lock(&pwm_lookup_lock);
921
922 while (num--) {
923 list_add_tail(&table->list, &pwm_lookup_list);
924 table++;
925 }
926
927 mutex_unlock(&pwm_lookup_lock);
928}
929
930/**
Shobhit Kumarefb0de52015-05-05 15:04:18 +0530931 * pwm_remove_table() - unregister PWM device consumers
932 * @table: array of consumers to unregister
933 * @num: number of consumers in table
934 */
935void pwm_remove_table(struct pwm_lookup *table, size_t num)
936{
937 mutex_lock(&pwm_lookup_lock);
938
939 while (num--) {
940 list_del(&table->list);
941 table++;
942 }
943
944 mutex_unlock(&pwm_lookup_lock);
945}
946
947/**
Thierry Reding8138d2d2012-03-26 08:42:48 +0200948 * pwm_get() - look up and request a PWM device
949 * @dev: device for PWM consumer
950 * @con_id: consumer name
951 *
Thierry Reding7299ab72011-12-14 11:10:32 +0100952 * Lookup is first attempted using DT. If the device was not instantiated from
953 * a device tree, a PWM chip and a relative index is looked up via a table
954 * supplied by board setup code (see pwm_add_table()).
Thierry Reding8138d2d2012-03-26 08:42:48 +0200955 *
956 * Once a PWM chip has been found the specified PWM device will be requested
957 * and is ready to be used.
Thierry Reding04883802015-07-27 11:58:32 +0200958 *
959 * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
960 * error code on failure.
Thierry Reding8138d2d2012-03-26 08:42:48 +0200961 */
962struct pwm_device *pwm_get(struct device *dev, const char *con_id)
963{
Andy Shevchenkoe625fb72021-06-07 15:24:56 +0300964 const struct fwnode_handle *fwnode = dev ? dev_fwnode(dev) : NULL;
Sachin Kamate50d3522012-08-10 16:41:13 +0530965 const char *dev_id = dev ? dev_name(dev) : NULL;
Hans de Goede69efb342017-01-22 17:14:07 +0100966 struct pwm_device *pwm;
967 struct pwm_chip *chip;
Fabrice Gasnierb2c200e2019-04-18 11:37:47 +0200968 struct device_link *dl;
Thierry Reding8138d2d2012-03-26 08:42:48 +0200969 unsigned int best = 0;
Geert Uytterhoeven70145f82014-08-28 11:03:14 +0200970 struct pwm_lookup *p, *chosen = NULL;
Thierry Reding8138d2d2012-03-26 08:42:48 +0200971 unsigned int match;
Hans de Goedeb526a312017-01-22 17:14:08 +0100972 int err;
Thierry Reding8138d2d2012-03-26 08:42:48 +0200973
Thierry Reding7299ab72011-12-14 11:10:32 +0100974 /* look up via DT first */
Andy Shevchenkoe625fb72021-06-07 15:24:56 +0300975 if (is_of_node(fwnode))
976 return of_pwm_get(dev, to_of_node(fwnode), con_id);
Thierry Reding7299ab72011-12-14 11:10:32 +0100977
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +0200978 /* then lookup via ACPI */
Andy Shevchenkoe625fb72021-06-07 15:24:56 +0300979 if (is_acpi_node(fwnode)) {
980 pwm = acpi_pwm_get(fwnode);
Hans de Goede6cf94812019-07-30 17:48:48 +0200981 if (!IS_ERR(pwm) || PTR_ERR(pwm) != -ENOENT)
982 return pwm;
983 }
Thierry Reding62099ab2012-03-26 09:31:48 +0200984
985 /*
986 * We look up the provider in the static table typically provided by
987 * board setup code. We first try to lookup the consumer device by
988 * name. If the consumer device was passed in as NULL or if no match
989 * was found, we try to find the consumer by directly looking it up
990 * by name.
991 *
992 * If a match is found, the provider PWM chip is looked up by name
993 * and a PWM device is requested using the PWM device per-chip index.
994 *
995 * The lookup algorithm was shamelessly taken from the clock
996 * framework:
997 *
998 * We do slightly fuzzy matching here:
999 * An entry with a NULL ID is assumed to be a wildcard.
1000 * If an entry has a device ID, it must match
1001 * If an entry has a connection ID, it must match
1002 * Then we take the most specific entry - with the following order
1003 * of precedence: dev+con > dev only > con only.
1004 */
1005 mutex_lock(&pwm_lookup_lock);
1006
1007 list_for_each_entry(p, &pwm_lookup_list, list) {
1008 match = 0;
1009
1010 if (p->dev_id) {
1011 if (!dev_id || strcmp(p->dev_id, dev_id))
1012 continue;
1013
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001014 match += 2;
1015 }
1016
1017 if (p->con_id) {
1018 if (!con_id || strcmp(p->con_id, con_id))
1019 continue;
1020
1021 match += 1;
1022 }
1023
1024 if (match > best) {
Geert Uytterhoeven70145f82014-08-28 11:03:14 +02001025 chosen = p;
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001026
1027 if (match != 3)
1028 best = match;
1029 else
1030 break;
1031 }
1032 }
1033
Hans de Goede69efb342017-01-22 17:14:07 +01001034 mutex_unlock(&pwm_lookup_lock);
1035
1036 if (!chosen)
1037 return ERR_PTR(-ENODEV);
Alexandre Belloni3796ce12014-05-19 22:42:32 +02001038
Geert Uytterhoeven70145f82014-08-28 11:03:14 +02001039 chip = pwmchip_find_by_name(chosen->provider);
Hans de Goedeb526a312017-01-22 17:14:08 +01001040
1041 /*
1042 * If the lookup entry specifies a module, load the module and retry
1043 * the PWM chip lookup. This can be used to work around driver load
1044 * ordering issues if driver's can't be made to properly support the
1045 * deferred probe mechanism.
1046 */
1047 if (!chip && chosen->module) {
1048 err = request_module(chosen->module);
1049 if (err == 0)
1050 chip = pwmchip_find_by_name(chosen->provider);
1051 }
1052
Geert Uytterhoeven70145f82014-08-28 11:03:14 +02001053 if (!chip)
Hans de Goede69efb342017-01-22 17:14:07 +01001054 return ERR_PTR(-EPROBE_DEFER);
Geert Uytterhoeven70145f82014-08-28 11:03:14 +02001055
1056 pwm = pwm_request_from_chip(chip, chosen->index, con_id ?: dev_id);
Alexandre Belloni3796ce12014-05-19 22:42:32 +02001057 if (IS_ERR(pwm))
Hans de Goede69efb342017-01-22 17:14:07 +01001058 return pwm;
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001059
Fabrice Gasnierb2c200e2019-04-18 11:37:47 +02001060 dl = pwm_device_link_add(dev, pwm);
1061 if (IS_ERR(dl)) {
1062 pwm_free(pwm);
1063 return ERR_CAST(dl);
1064 }
1065
Boris Brezillonfbd45a12016-05-17 14:27:25 +02001066 pwm->args.period = chosen->period;
1067 pwm->args.polarity = chosen->polarity;
1068
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001069 return pwm;
1070}
1071EXPORT_SYMBOL_GPL(pwm_get);
1072
1073/**
1074 * pwm_put() - release a PWM device
1075 * @pwm: PWM device
1076 */
1077void pwm_put(struct pwm_device *pwm)
1078{
1079 if (!pwm)
1080 return;
1081
1082 mutex_lock(&pwm_lock);
1083
1084 if (!test_and_clear_bit(PWMF_REQUESTED, &pwm->flags)) {
Sachin Kamate50d3522012-08-10 16:41:13 +05301085 pr_warn("PWM device already freed\n");
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001086 goto out;
1087 }
1088
1089 if (pwm->chip->ops->free)
1090 pwm->chip->ops->free(pwm->chip, pwm);
1091
Uwe Kleine-Könige926b122019-03-25 10:49:33 +01001092 pwm_set_chip_data(pwm, NULL);
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001093 pwm->label = NULL;
1094
1095 module_put(pwm->chip->ops->owner);
1096out:
1097 mutex_unlock(&pwm_lock);
1098}
1099EXPORT_SYMBOL_GPL(pwm_put);
1100
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001101static void devm_pwm_release(void *pwm)
Alexandre Courbot63543162012-08-01 19:20:58 +09001102{
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001103 pwm_put(pwm);
Alexandre Courbot63543162012-08-01 19:20:58 +09001104}
1105
1106/**
1107 * devm_pwm_get() - resource managed pwm_get()
1108 * @dev: device for PWM consumer
1109 * @con_id: consumer name
1110 *
1111 * This function performs like pwm_get() but the acquired PWM device will
1112 * automatically be released on driver detach.
Thierry Reding04883802015-07-27 11:58:32 +02001113 *
1114 * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
1115 * error code on failure.
Alexandre Courbot63543162012-08-01 19:20:58 +09001116 */
1117struct pwm_device *devm_pwm_get(struct device *dev, const char *con_id)
1118{
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001119 struct pwm_device *pwm;
1120 int ret;
Alexandre Courbot63543162012-08-01 19:20:58 +09001121
1122 pwm = pwm_get(dev, con_id);
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001123 if (IS_ERR(pwm))
1124 return pwm;
1125
1126 ret = devm_add_action_or_reset(dev, devm_pwm_release, pwm);
1127 if (ret)
1128 return ERR_PTR(ret);
Alexandre Courbot63543162012-08-01 19:20:58 +09001129
1130 return pwm;
1131}
1132EXPORT_SYMBOL_GPL(devm_pwm_get);
1133
Peter Ujfalusi261a5ed2012-12-21 01:43:59 -08001134/**
1135 * devm_of_pwm_get() - resource managed of_pwm_get()
1136 * @dev: device for PWM consumer
1137 * @np: device node to get the PWM from
1138 * @con_id: consumer name
1139 *
1140 * This function performs like of_pwm_get() but the acquired PWM device will
1141 * automatically be released on driver detach.
Thierry Reding04883802015-07-27 11:58:32 +02001142 *
1143 * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
1144 * error code on failure.
Peter Ujfalusi261a5ed2012-12-21 01:43:59 -08001145 */
1146struct pwm_device *devm_of_pwm_get(struct device *dev, struct device_node *np,
1147 const char *con_id)
1148{
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001149 struct pwm_device *pwm;
1150 int ret;
Peter Ujfalusi261a5ed2012-12-21 01:43:59 -08001151
Fabrice Gasnierb2c200e2019-04-18 11:37:47 +02001152 pwm = of_pwm_get(dev, np, con_id);
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001153 if (IS_ERR(pwm))
1154 return pwm;
1155
1156 ret = devm_add_action_or_reset(dev, devm_pwm_release, pwm);
1157 if (ret)
1158 return ERR_PTR(ret);
Peter Ujfalusi261a5ed2012-12-21 01:43:59 -08001159
1160 return pwm;
1161}
1162EXPORT_SYMBOL_GPL(devm_of_pwm_get);
1163
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +02001164/**
1165 * devm_fwnode_pwm_get() - request a resource managed PWM from firmware node
1166 * @dev: device for PWM consumer
1167 * @fwnode: firmware node to get the PWM from
1168 * @con_id: consumer name
1169 *
1170 * Returns the PWM device parsed from the firmware node. See of_pwm_get() and
1171 * acpi_pwm_get() for a detailed description.
1172 *
1173 * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
1174 * error code on failure.
1175 */
1176struct pwm_device *devm_fwnode_pwm_get(struct device *dev,
1177 struct fwnode_handle *fwnode,
1178 const char *con_id)
1179{
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001180 struct pwm_device *pwm = ERR_PTR(-ENODEV);
1181 int ret;
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +02001182
1183 if (is_of_node(fwnode))
1184 pwm = of_pwm_get(dev, to_of_node(fwnode), con_id);
1185 else if (is_acpi_node(fwnode))
1186 pwm = acpi_pwm_get(fwnode);
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001187 if (IS_ERR(pwm))
1188 return pwm;
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +02001189
Andy Shevchenko9ae241d2021-06-07 15:24:58 +03001190 ret = devm_add_action_or_reset(dev, devm_pwm_release, pwm);
1191 if (ret)
1192 return ERR_PTR(ret);
Nikolaus Voss4a6ef8e2019-06-12 10:36:07 +02001193
1194 return pwm;
1195}
1196EXPORT_SYMBOL_GPL(devm_fwnode_pwm_get);
1197
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001198#ifdef CONFIG_DEBUG_FS
1199static void pwm_dbg_show(struct pwm_chip *chip, struct seq_file *s)
1200{
1201 unsigned int i;
1202
1203 for (i = 0; i < chip->npwm; i++) {
1204 struct pwm_device *pwm = &chip->pwms[i];
Boris Brezillon39100ce2016-04-14 21:17:43 +02001205 struct pwm_state state;
1206
1207 pwm_get_state(pwm, &state);
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001208
1209 seq_printf(s, " pwm-%-3d (%-20.20s):", i, pwm->label);
1210
1211 if (test_bit(PWMF_REQUESTED, &pwm->flags))
Jingoo Hanadcba1e2013-12-19 13:31:24 +09001212 seq_puts(s, " requested");
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001213
Boris Brezillon39100ce2016-04-14 21:17:43 +02001214 if (state.enabled)
Jingoo Hanadcba1e2013-12-19 13:31:24 +09001215 seq_puts(s, " enabled");
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001216
Guru Das Srinagesha9d887d2020-06-02 15:31:16 -07001217 seq_printf(s, " period: %llu ns", state.period);
1218 seq_printf(s, " duty: %llu ns", state.duty_cycle);
Heiko Stübner23e35232016-04-14 21:17:44 +02001219 seq_printf(s, " polarity: %s",
1220 state.polarity ? "inverse" : "normal");
1221
Clemens Gruber9e40ee12021-05-07 15:18:42 +02001222 if (state.usage_power)
1223 seq_puts(s, " usage_power");
1224
Jingoo Hanadcba1e2013-12-19 13:31:24 +09001225 seq_puts(s, "\n");
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001226 }
1227}
1228
1229static void *pwm_seq_start(struct seq_file *s, loff_t *pos)
1230{
1231 mutex_lock(&pwm_lock);
1232 s->private = "";
1233
1234 return seq_list_start(&pwm_chips, *pos);
1235}
1236
1237static void *pwm_seq_next(struct seq_file *s, void *v, loff_t *pos)
1238{
1239 s->private = "\n";
1240
1241 return seq_list_next(v, &pwm_chips, pos);
1242}
1243
1244static void pwm_seq_stop(struct seq_file *s, void *v)
1245{
1246 mutex_unlock(&pwm_lock);
1247}
1248
1249static int pwm_seq_show(struct seq_file *s, void *v)
1250{
1251 struct pwm_chip *chip = list_entry(v, struct pwm_chip, list);
1252
1253 seq_printf(s, "%s%s/%s, %d PWM device%s\n", (char *)s->private,
1254 chip->dev->bus ? chip->dev->bus->name : "no-bus",
1255 dev_name(chip->dev), chip->npwm,
1256 (chip->npwm != 1) ? "s" : "");
1257
Uwe Kleine-Königcc2d2242019-01-07 20:49:39 +01001258 pwm_dbg_show(chip, s);
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001259
1260 return 0;
1261}
1262
Liu Shixinf339e792020-09-16 10:50:28 +08001263static const struct seq_operations pwm_debugfs_sops = {
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001264 .start = pwm_seq_start,
1265 .next = pwm_seq_next,
1266 .stop = pwm_seq_stop,
1267 .show = pwm_seq_show,
1268};
1269
Liu Shixinf339e792020-09-16 10:50:28 +08001270DEFINE_SEQ_ATTRIBUTE(pwm_debugfs);
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001271
1272static int __init pwm_debugfs_init(void)
1273{
Soham Biswas765edf02020-11-18 20:21:12 +05301274 debugfs_create_file("pwm", S_IFREG | 0444, NULL, NULL,
Liu Shixinf339e792020-09-16 10:50:28 +08001275 &pwm_debugfs_fops);
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001276
1277 return 0;
1278}
Sascha Hauer0c2498f2011-01-28 09:40:40 +01001279subsys_initcall(pwm_debugfs_init);
1280#endif /* CONFIG_DEBUG_FS */