0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019 #include <linux/module.h>
0020 #include <linux/platform_device.h>
0021 #include <linux/slab.h>
0022 #include <linux/clk.h>
0023 #include <linux/err.h>
0024 #include <linux/io.h>
0025 #include <linux/pwm.h>
0026
0027 #include <asm/div64.h>
0028
0029 #include <linux/soc/cirrus/ep93xx.h> /* for ep93xx_pwm_{acquire,release}_gpio() */
0030
0031 #define EP93XX_PWMx_TERM_COUNT 0x00
0032 #define EP93XX_PWMx_DUTY_CYCLE 0x04
0033 #define EP93XX_PWMx_ENABLE 0x08
0034 #define EP93XX_PWMx_INVERT 0x0c
0035
0036 struct ep93xx_pwm {
0037 void __iomem *base;
0038 struct clk *clk;
0039 struct pwm_chip chip;
0040 };
0041
0042 static inline struct ep93xx_pwm *to_ep93xx_pwm(struct pwm_chip *chip)
0043 {
0044 return container_of(chip, struct ep93xx_pwm, chip);
0045 }
0046
0047 static int ep93xx_pwm_request(struct pwm_chip *chip, struct pwm_device *pwm)
0048 {
0049 struct platform_device *pdev = to_platform_device(chip->dev);
0050
0051 return ep93xx_pwm_acquire_gpio(pdev);
0052 }
0053
0054 static void ep93xx_pwm_free(struct pwm_chip *chip, struct pwm_device *pwm)
0055 {
0056 struct platform_device *pdev = to_platform_device(chip->dev);
0057
0058 ep93xx_pwm_release_gpio(pdev);
0059 }
0060
0061 static int ep93xx_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm,
0062 const struct pwm_state *state)
0063 {
0064 int ret;
0065 struct ep93xx_pwm *ep93xx_pwm = to_ep93xx_pwm(chip);
0066 bool enabled = state->enabled;
0067 void __iomem *base = ep93xx_pwm->base;
0068 unsigned long long c;
0069 unsigned long period_cycles;
0070 unsigned long duty_cycles;
0071 unsigned long term;
0072
0073 if (state->polarity != pwm->state.polarity) {
0074 if (enabled) {
0075 writew(0x0, ep93xx_pwm->base + EP93XX_PWMx_ENABLE);
0076 clk_disable_unprepare(ep93xx_pwm->clk);
0077 enabled = false;
0078 }
0079
0080
0081
0082
0083
0084 ret = clk_prepare_enable(ep93xx_pwm->clk);
0085 if (ret)
0086 return ret;
0087
0088 if (state->polarity == PWM_POLARITY_INVERSED)
0089 writew(0x1, ep93xx_pwm->base + EP93XX_PWMx_INVERT);
0090 else
0091 writew(0x0, ep93xx_pwm->base + EP93XX_PWMx_INVERT);
0092
0093 clk_disable_unprepare(ep93xx_pwm->clk);
0094 }
0095
0096 if (!state->enabled) {
0097 if (enabled) {
0098 writew(0x0, ep93xx_pwm->base + EP93XX_PWMx_ENABLE);
0099 clk_disable_unprepare(ep93xx_pwm->clk);
0100 }
0101
0102 return 0;
0103 }
0104
0105
0106
0107
0108
0109 if (!pwm_is_enabled(pwm)) {
0110 ret = clk_prepare_enable(ep93xx_pwm->clk);
0111 if (ret)
0112 return ret;
0113 }
0114
0115 c = clk_get_rate(ep93xx_pwm->clk);
0116 c *= state->period;
0117 do_div(c, 1000000000);
0118 period_cycles = c;
0119
0120 c = period_cycles;
0121 c *= state->duty_cycle;
0122 do_div(c, state->period);
0123 duty_cycles = c;
0124
0125 if (period_cycles < 0x10000 && duty_cycles < 0x10000) {
0126 term = readw(base + EP93XX_PWMx_TERM_COUNT);
0127
0128
0129 if (period_cycles > term) {
0130 writew(period_cycles, base + EP93XX_PWMx_TERM_COUNT);
0131 writew(duty_cycles, base + EP93XX_PWMx_DUTY_CYCLE);
0132 } else {
0133 writew(duty_cycles, base + EP93XX_PWMx_DUTY_CYCLE);
0134 writew(period_cycles, base + EP93XX_PWMx_TERM_COUNT);
0135 }
0136 ret = 0;
0137 } else {
0138 ret = -EINVAL;
0139 }
0140
0141 if (!pwm_is_enabled(pwm))
0142 clk_disable_unprepare(ep93xx_pwm->clk);
0143
0144 if (ret)
0145 return ret;
0146
0147 if (!enabled) {
0148 ret = clk_prepare_enable(ep93xx_pwm->clk);
0149 if (ret)
0150 return ret;
0151
0152 writew(0x1, ep93xx_pwm->base + EP93XX_PWMx_ENABLE);
0153 }
0154
0155 return 0;
0156 }
0157
0158 static const struct pwm_ops ep93xx_pwm_ops = {
0159 .request = ep93xx_pwm_request,
0160 .free = ep93xx_pwm_free,
0161 .apply = ep93xx_pwm_apply,
0162 .owner = THIS_MODULE,
0163 };
0164
0165 static int ep93xx_pwm_probe(struct platform_device *pdev)
0166 {
0167 struct ep93xx_pwm *ep93xx_pwm;
0168 int ret;
0169
0170 ep93xx_pwm = devm_kzalloc(&pdev->dev, sizeof(*ep93xx_pwm), GFP_KERNEL);
0171 if (!ep93xx_pwm)
0172 return -ENOMEM;
0173
0174 ep93xx_pwm->base = devm_platform_ioremap_resource(pdev, 0);
0175 if (IS_ERR(ep93xx_pwm->base))
0176 return PTR_ERR(ep93xx_pwm->base);
0177
0178 ep93xx_pwm->clk = devm_clk_get(&pdev->dev, "pwm_clk");
0179 if (IS_ERR(ep93xx_pwm->clk))
0180 return PTR_ERR(ep93xx_pwm->clk);
0181
0182 ep93xx_pwm->chip.dev = &pdev->dev;
0183 ep93xx_pwm->chip.ops = &ep93xx_pwm_ops;
0184 ep93xx_pwm->chip.npwm = 1;
0185
0186 ret = devm_pwmchip_add(&pdev->dev, &ep93xx_pwm->chip);
0187 if (ret < 0)
0188 return ret;
0189
0190 return 0;
0191 }
0192
0193 static struct platform_driver ep93xx_pwm_driver = {
0194 .driver = {
0195 .name = "ep93xx-pwm",
0196 },
0197 .probe = ep93xx_pwm_probe,
0198 };
0199 module_platform_driver(ep93xx_pwm_driver);
0200
0201 MODULE_DESCRIPTION("Cirrus Logic EP93xx PWM driver");
0202 MODULE_AUTHOR("Matthieu Crapet <mcrapet@gmail.com>");
0203 MODULE_AUTHOR("H Hartley Sweeten <hsweeten@visionengravers.com>");
0204 MODULE_ALIAS("platform:ep93xx-pwm");
0205 MODULE_LICENSE("GPL");