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
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()
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
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()
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()
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()
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()
178 		 * counter from the ramp, if this is >= PWM counter the output  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()
197 			/* STMPE2403 can simply set the right PWM value */  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()
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()
257 	dev_dbg(chip->dev, "programmed PWM#%u, %u bytes\n", pwm->hwpwm, i);  in stmpe_24xx_pwm_config()
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()
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()
284 		pwm->chip.ops = &stmpe_24xx_pwm_ops;  in stmpe_pwm_probe()
285 		pwm->chip.npwm = 3;  in stmpe_pwm_probe()
290 			dev_err(&pdev->dev, "Unknown STMPE PWM\n");  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",