Lines Matching +full:pwm +full:- +full:off +full:- +full:delay +full:- +full:ms
1 // SPDX-License-Identifier: GPL-2.0-only
9 #include <linux/delay.h>
15 #include <linux/pwm.h>
39 static int stmpe_24xx_pwm_enable(struct pwm_chip *chip, struct pwm_device *pwm) in stmpe_24xx_pwm_enable() argument
45 ret = stmpe_reg_read(stmpe_pwm->stmpe, STMPE24XX_PWMCS); in stmpe_24xx_pwm_enable()
47 dev_err(chip->dev, "error reading PWM#%u control\n", in stmpe_24xx_pwm_enable()
48 pwm->hwpwm); in stmpe_24xx_pwm_enable()
52 value = ret | BIT(pwm->hwpwm); in stmpe_24xx_pwm_enable()
54 ret = stmpe_reg_write(stmpe_pwm->stmpe, STMPE24XX_PWMCS, value); in stmpe_24xx_pwm_enable()
56 dev_err(chip->dev, "error writing PWM#%u control\n", in stmpe_24xx_pwm_enable()
57 pwm->hwpwm); in stmpe_24xx_pwm_enable()
65 struct pwm_device *pwm) in stmpe_24xx_pwm_disable() argument
71 ret = stmpe_reg_read(stmpe_pwm->stmpe, STMPE24XX_PWMCS); in stmpe_24xx_pwm_disable()
73 dev_err(chip->dev, "error reading PWM#%u control\n", in stmpe_24xx_pwm_disable()
74 pwm->hwpwm); in stmpe_24xx_pwm_disable()
78 value = ret & ~BIT(pwm->hwpwm); in stmpe_24xx_pwm_disable()
80 ret = stmpe_reg_write(stmpe_pwm->stmpe, STMPE24XX_PWMCS, value); in stmpe_24xx_pwm_disable()
82 dev_err(chip->dev, "error writing PWM#%u control\n", in stmpe_24xx_pwm_disable()
83 pwm->hwpwm); in stmpe_24xx_pwm_disable()
88 /* STMPE 24xx PWM instructions */
99 static int stmpe_24xx_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm, in stmpe_24xx_pwm_config() argument
113 if (pwm_is_enabled(pwm)) { in stmpe_24xx_pwm_config()
114 stmpe_24xx_pwm_disable(chip, pwm); in stmpe_24xx_pwm_config()
116 /* Connect the PWM to the pin */ in stmpe_24xx_pwm_config()
117 pin = pwm->hwpwm; in stmpe_24xx_pwm_config()
120 if (stmpe_pwm->stmpe->partnum == STMPE2401 || in stmpe_24xx_pwm_config()
121 stmpe_pwm->stmpe->partnum == STMPE2403) in stmpe_24xx_pwm_config()
124 ret = stmpe_set_altfunc(stmpe_pwm->stmpe, BIT(pin), in stmpe_24xx_pwm_config()
127 dev_err(chip->dev, "unable to connect PWM#%u to pin\n", in stmpe_24xx_pwm_config()
128 pwm->hwpwm); in stmpe_24xx_pwm_config()
134 switch (pwm->hwpwm) { in stmpe_24xx_pwm_config()
149 return -ENODEV; in stmpe_24xx_pwm_config()
152 dev_dbg(chip->dev, "PWM#%u: config duty %d ns, period %d ns\n", in stmpe_24xx_pwm_config()
153 pwm->hwpwm, duty_ns, period_ns); in stmpe_24xx_pwm_config()
156 if (stmpe_pwm->stmpe->partnum == STMPE2401) in stmpe_24xx_pwm_config()
157 program[0] = SMAX; /* off all the time */ in stmpe_24xx_pwm_config()
159 if (stmpe_pwm->stmpe->partnum == STMPE2403) in stmpe_24xx_pwm_config()
162 stmpe_pwm->last_duty = 0x00; in stmpe_24xx_pwm_config()
164 if (stmpe_pwm->stmpe->partnum == STMPE2401) in stmpe_24xx_pwm_config()
167 if (stmpe_pwm->stmpe->partnum == STMPE2403) in stmpe_24xx_pwm_config()
170 stmpe_pwm->last_duty = 0xff; in stmpe_24xx_pwm_config()
172 u8 value, last = stmpe_pwm->last_duty; in stmpe_24xx_pwm_config()
178 * counter from the ramp, if this is >= PWM counter the output in stmpe_24xx_pwm_config()
182 * Prescale = 0 -> 2 kHz -> T = 1/f = 488281.25 ns in stmpe_24xx_pwm_config()
192 if (pwm_is_enabled(pwm)) in stmpe_24xx_pwm_config()
193 stmpe_24xx_pwm_enable(chip, pwm); in stmpe_24xx_pwm_config()
196 } else if (stmpe_pwm->stmpe->partnum == STMPE2403) { in stmpe_24xx_pwm_config()
197 /* STMPE2403 can simply set the right PWM value */ in stmpe_24xx_pwm_config()
200 } else if (stmpe_pwm->stmpe->partnum == STMPE2401) { in stmpe_24xx_pwm_config()
206 incdec = RAMPUP | (value - last); in stmpe_24xx_pwm_config()
209 incdec = RAMPDOWN | (last - value); in stmpe_24xx_pwm_config()
218 dev_dbg(chip->dev, in stmpe_24xx_pwm_config()
219 "PWM#%u: value = %02x, last_duty = %02x, program=%04x,%04x,%04x\n", in stmpe_24xx_pwm_config()
220 pwm->hwpwm, value, last, program[0], program[1], in stmpe_24xx_pwm_config()
222 stmpe_pwm->last_duty = value; in stmpe_24xx_pwm_config()
226 * We can write programs of up to 64 16-bit words into this channel. in stmpe_24xx_pwm_config()
233 ret = stmpe_reg_write(stmpe_pwm->stmpe, offset, value); in stmpe_24xx_pwm_config()
235 dev_err(chip->dev, "error writing register %02x: %d\n", in stmpe_24xx_pwm_config()
242 ret = stmpe_reg_write(stmpe_pwm->stmpe, offset, value); in stmpe_24xx_pwm_config()
244 dev_err(chip->dev, "error writing register %02x: %d\n", in stmpe_24xx_pwm_config()
250 /* If we were enabled, re-enable this PWM */ in stmpe_24xx_pwm_config()
251 if (pwm_is_enabled(pwm)) in stmpe_24xx_pwm_config()
252 stmpe_24xx_pwm_enable(chip, pwm); in stmpe_24xx_pwm_config()
254 /* Sleep for 200ms so we're sure it will take effect */ in stmpe_24xx_pwm_config()
257 dev_dbg(chip->dev, "programmed PWM#%u, %u bytes\n", pwm->hwpwm, i); in stmpe_24xx_pwm_config()
271 struct stmpe *stmpe = dev_get_drvdata(pdev->dev.parent); in stmpe_pwm_probe()
272 struct stmpe_pwm *pwm; in stmpe_pwm_probe() local
275 pwm = devm_kzalloc(&pdev->dev, sizeof(*pwm), GFP_KERNEL); in stmpe_pwm_probe()
276 if (!pwm) in stmpe_pwm_probe()
277 return -ENOMEM; in stmpe_pwm_probe()
279 pwm->stmpe = stmpe; in stmpe_pwm_probe()
280 pwm->chip.dev = &pdev->dev; in stmpe_pwm_probe()
281 pwm->chip.base = -1; in stmpe_pwm_probe()
283 if (stmpe->partnum == STMPE2401 || stmpe->partnum == STMPE2403) { in stmpe_pwm_probe()
284 pwm->chip.ops = &stmpe_24xx_pwm_ops; in stmpe_pwm_probe()
285 pwm->chip.npwm = 3; in stmpe_pwm_probe()
287 if (stmpe->partnum == STMPE1601) in stmpe_pwm_probe()
288 dev_err(&pdev->dev, "STMPE1601 not yet supported\n"); in stmpe_pwm_probe()
290 dev_err(&pdev->dev, "Unknown STMPE PWM\n"); in stmpe_pwm_probe()
292 return -ENODEV; in stmpe_pwm_probe()
299 ret = pwmchip_add(&pwm->chip); in stmpe_pwm_probe()
305 platform_set_drvdata(pdev, pwm); in stmpe_pwm_probe()
312 .name = "stmpe-pwm",