drivers/pwm/pwm-atmel-hlcdc.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2014 Free Electrons
   4  * Copyright (C) 2014 Atmel
   5  *
   6  * Author: Boris BREZILLON <boris.brezillon@free-electrons.com>
   7  */
   8
   9 #include <linux/clk.h>
  10 #include <linux/delay.h>
  11 #include <linux/mfd/atmel-hlcdc.h>
  12 #include <linux/module.h>
  13 #include <linux/platform_device.h>
  14 #include <linux/pwm.h>
  15 #include <linux/regmap.h>
  16
  17 #define ATMEL_HLCDC_PWMCVAL_MASK        GENMASK(15, 8)
  18 #define ATMEL_HLCDC_PWMCVAL(x)          (((x) << 8) & ATMEL_HLCDC_PWMCVAL_MASK)
  19 #define ATMEL_HLCDC_PWMPOL              BIT(4)
  20 #define ATMEL_HLCDC_PWMPS_MASK          GENMASK(2, 0)
  21 #define ATMEL_HLCDC_PWMPS_MAX           0x6
  22 #define ATMEL_HLCDC_PWMPS(x)            ((x) & ATMEL_HLCDC_PWMPS_MASK)
  23
  24 struct atmel_hlcdc_pwm_errata {
  25         bool slow_clk_erratum;
  26         bool div1_clk_erratum;
  27 };
  28
  29 struct atmel_hlcdc_pwm {
  30         struct pwm_chip chip;
  31         struct atmel_hlcdc *hlcdc;
  32         struct clk *cur_clk;
  33         const struct atmel_hlcdc_pwm_errata *errata;
  34 };
  35
  36 static inline struct atmel_hlcdc_pwm *to_atmel_hlcdc_pwm(struct pwm_chip *chip)
  37 {
  38         return container_of(chip, struct atmel_hlcdc_pwm, chip);
  39 }
  40
  41 static int atmel_hlcdc_pwm_apply(struct pwm_chip *c, struct pwm_device *pwm,
  42                                  struct pwm_state *state)
  43 {
  44         struct atmel_hlcdc_pwm *chip = to_atmel_hlcdc_pwm(c);
  45         struct atmel_hlcdc *hlcdc = chip->hlcdc;
  46         unsigned int status;
  47         int ret;
  48
  49         if (state->enabled) {
  50                 struct clk *new_clk = hlcdc->slow_clk;
  51                 u64 pwmcval = state->duty_cycle * 256;
  52                 unsigned long clk_freq;
  53                 u64 clk_period_ns;
  54                 u32 pwmcfg;
  55                 int pres;
  56
  57                 if (!chip->errata || !chip->errata->slow_clk_erratum) {
  58                         clk_freq = clk_get_rate(new_clk);
  59                         if (!clk_freq)
  60                                 return -EINVAL;
  61
  62                         clk_period_ns = (u64)NSEC_PER_SEC * 256;
  63                         do_div(clk_period_ns, clk_freq);
  64                 }
  65
  66                 /* Errata: cannot use slow clk on some IP revisions */
  67                 if ((chip->errata && chip->errata->slow_clk_erratum) ||
  68                     clk_period_ns > state->period) {
  69                         new_clk = hlcdc->sys_clk;
  70                         clk_freq = clk_get_rate(new_clk);
  71                         if (!clk_freq)
  72                                 return -EINVAL;
  73
  74                         clk_period_ns = (u64)NSEC_PER_SEC * 256;
  75                         do_div(clk_period_ns, clk_freq);
  76                 }
  77
  78                 for (pres = 0; pres <= ATMEL_HLCDC_PWMPS_MAX; pres++) {
  79                 /* Errata: cannot divide by 1 on some IP revisions */
  80                         if (!pres && chip->errata &&
  81                             chip->errata->div1_clk_erratum)
  82                                 continue;
  83
  84                         if ((clk_period_ns << pres) >= state->period)
  85                                 break;
  86                 }
  87
  88                 if (pres > ATMEL_HLCDC_PWMPS_MAX)
  89                         return -EINVAL;
  90
  91                 pwmcfg = ATMEL_HLCDC_PWMPS(pres);
  92
  93                 if (new_clk != chip->cur_clk) {
  94                         u32 gencfg = 0;
  95                         int ret;
  96
  97                         ret = clk_prepare_enable(new_clk);
  98                         if (ret)
  99                                 return ret;
 100
 101                         clk_disable_unprepare(chip->cur_clk);
 102                         chip->cur_clk = new_clk;
 103
 104                         if (new_clk == hlcdc->sys_clk)
 105                                 gencfg = ATMEL_HLCDC_CLKPWMSEL;
 106
 107                         ret = regmap_update_bits(hlcdc->regmap,
 108                                                  ATMEL_HLCDC_CFG(0),
 109                                                  ATMEL_HLCDC_CLKPWMSEL,
 110                                                  gencfg);
 111                         if (ret)
 112                                 return ret;
 113                 }
 114
 115                 do_div(pwmcval, state->period);
 116
 117                 /*
 118                  * The PWM duty cycle is configurable from 0/256 to 255/256 of
 119                  * the period cycle. Hence we can't set a duty cycle occupying
 120                  * the whole period cycle if we're asked to.
 121                  * Set it to 255 if pwmcval is greater than 256.
 122                  */
 123                 if (pwmcval > 255)
 124                         pwmcval = 255;
 125
 126                 pwmcfg |= ATMEL_HLCDC_PWMCVAL(pwmcval);
 127
 128                 if (state->polarity == PWM_POLARITY_NORMAL)
 129                         pwmcfg |= ATMEL_HLCDC_PWMPOL;
 130
 131                 ret = regmap_update_bits(hlcdc->regmap, ATMEL_HLCDC_CFG(6),
 132                                          ATMEL_HLCDC_PWMCVAL_MASK |
 133                                          ATMEL_HLCDC_PWMPS_MASK |
 134                                          ATMEL_HLCDC_PWMPOL,
 135                                          pwmcfg);
 136                 if (ret)
 137                         return ret;
 138
 139                 ret = regmap_write(hlcdc->regmap, ATMEL_HLCDC_EN,
 140                                    ATMEL_HLCDC_PWM);
 141                 if (ret)
 142                         return ret;
 143
 144                 ret = regmap_read_poll_timeout(hlcdc->regmap, ATMEL_HLCDC_SR,
 145                                                status,
 146                                                status & ATMEL_HLCDC_PWM,
 147                                                10, 0);
 148                 if (ret)
 149                         return ret;
 150         } else {
 151                 ret = regmap_write(hlcdc->regmap, ATMEL_HLCDC_DIS,
 152                                    ATMEL_HLCDC_PWM);
 153                 if (ret)
 154                         return ret;
 155
 156                 ret = regmap_read_poll_timeout(hlcdc->regmap, ATMEL_HLCDC_SR,
 157                                                status,
 158                                                !(status & ATMEL_HLCDC_PWM),
 159                                                10, 0);
 160                 if (ret)
 161                         return ret;
 162
 163                 clk_disable_unprepare(chip->cur_clk);
 164                 chip->cur_clk = NULL;
 165         }
 166
 167         return 0;
 168 }
 169
 170 static const struct pwm_ops atmel_hlcdc_pwm_ops = {
 171         .apply = atmel_hlcdc_pwm_apply,
 172         .owner = THIS_MODULE,
 173 };
 174
 175 static const struct atmel_hlcdc_pwm_errata atmel_hlcdc_pwm_at91sam9x5_errata = {
 176         .slow_clk_erratum = true,
 177 };
 178
 179 static const struct atmel_hlcdc_pwm_errata atmel_hlcdc_pwm_sama5d3_errata = {
 180         .div1_clk_erratum = true,
 181 };
 182
 183 #ifdef CONFIG_PM_SLEEP
 184 static int atmel_hlcdc_pwm_suspend(struct device *dev)
 185 {
 186         struct atmel_hlcdc_pwm *chip = dev_get_drvdata(dev);
 187
 188         /* Keep the periph clock enabled if the PWM is still running. */
 189         if (pwm_is_enabled(&chip->chip.pwms[0]))
 190                 clk_disable_unprepare(chip->hlcdc->periph_clk);
 191
 192         return 0;
 193 }
 194
 195 static int atmel_hlcdc_pwm_resume(struct device *dev)
 196 {
 197         struct atmel_hlcdc_pwm *chip = dev_get_drvdata(dev);
 198         struct pwm_state state;
 199         int ret;
 200
 201         pwm_get_state(&chip->chip.pwms[0], &state);
 202
 203         /* Re-enable the periph clock it was stopped during suspend. */
 204         if (!state.enabled) {
 205                 ret = clk_prepare_enable(chip->hlcdc->periph_clk);
 206                 if (ret)
 207                         return ret;
 208         }
 209
 210         return atmel_hlcdc_pwm_apply(&chip->chip, &chip->chip.pwms[0], &state);
 211 }
 212 #endif
 213
 214 static SIMPLE_DEV_PM_OPS(atmel_hlcdc_pwm_pm_ops,
 215                          atmel_hlcdc_pwm_suspend, atmel_hlcdc_pwm_resume);
 216
 217 static const struct of_device_id atmel_hlcdc_dt_ids[] = {
 218         {
 219                 .compatible = "atmel,at91sam9n12-hlcdc",
 220                 /* 9n12 has same errata as 9x5 HLCDC PWM */
 221                 .data = &atmel_hlcdc_pwm_at91sam9x5_errata,
 222         },
 223         {
 224                 .compatible = "atmel,at91sam9x5-hlcdc",
 225                 .data = &atmel_hlcdc_pwm_at91sam9x5_errata,
 226         },
 227         {
 228                 .compatible = "atmel,sama5d2-hlcdc",
 229         },
 230         {
 231                 .compatible = "atmel,sama5d3-hlcdc",
 232                 .data = &atmel_hlcdc_pwm_sama5d3_errata,
 233         },
 234         {
 235                 .compatible = "atmel,sama5d4-hlcdc",
 236                 .data = &atmel_hlcdc_pwm_sama5d3_errata,
 237         },
 238         { /* sentinel */ },
 239 };
 240 MODULE_DEVICE_TABLE(of, atmel_hlcdc_dt_ids);
 241
 242 static int atmel_hlcdc_pwm_probe(struct platform_device *pdev)
 243 {
 244         const struct of_device_id *match;
 245         struct device *dev = &pdev->dev;
 246         struct atmel_hlcdc_pwm *chip;
 247         struct atmel_hlcdc *hlcdc;
 248         int ret;
 249
 250         hlcdc = dev_get_drvdata(dev->parent);
 251
 252         chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL);
 253         if (!chip)
 254                 return -ENOMEM;
 255
 256         ret = clk_prepare_enable(hlcdc->periph_clk);
 257         if (ret)
 258                 return ret;
 259
 260         match = of_match_node(atmel_hlcdc_dt_ids, dev->parent->of_node);
 261         if (match)
 262                 chip->errata = match->data;
 263
 264         chip->hlcdc = hlcdc;
 265         chip->chip.ops = &atmel_hlcdc_pwm_ops;
 266         chip->chip.dev = dev;
 267         chip->chip.base = -1;
 268         chip->chip.npwm = 1;
 269         chip->chip.of_xlate = of_pwm_xlate_with_flags;
 270         chip->chip.of_pwm_n_cells = 3;
 271
 272         ret = pwmchip_add_with_polarity(&chip->chip, PWM_POLARITY_INVERSED);
 273         if (ret) {
 274                 clk_disable_unprepare(hlcdc->periph_clk);
 275                 return ret;
 276         }
 277
 278         platform_set_drvdata(pdev, chip);
 279
 280         return 0;
 281 }
 282
 283 static int atmel_hlcdc_pwm_remove(struct platform_device *pdev)
 284 {
 285         struct atmel_hlcdc_pwm *chip = platform_get_drvdata(pdev);
 286         int ret;
 287
 288         ret = pwmchip_remove(&chip->chip);
 289         if (ret)
 290                 return ret;
 291
 292         clk_disable_unprepare(chip->hlcdc->periph_clk);
 293
 294         return 0;
 295 }
 296
 297 static const struct of_device_id atmel_hlcdc_pwm_dt_ids[] = {
 298         { .compatible = "atmel,hlcdc-pwm" },
 299         { /* sentinel */ },
 300 };
 301
 302 static struct platform_driver atmel_hlcdc_pwm_driver = {
 303         .driver = {
 304                 .name = "atmel-hlcdc-pwm",
 305                 .of_match_table = atmel_hlcdc_pwm_dt_ids,
 306                 .pm = &atmel_hlcdc_pwm_pm_ops,
 307         },
 308         .probe = atmel_hlcdc_pwm_probe,
 309         .remove = atmel_hlcdc_pwm_remove,
 310 };
 311 module_platform_driver(atmel_hlcdc_pwm_driver);
 312
 313 MODULE_ALIAS("platform:atmel-hlcdc-pwm");
 314 MODULE_AUTHOR("Boris Brezillon <boris.brezillon@free-electrons.com>");
 315 MODULE_DESCRIPTION("Atmel HLCDC PWM driver");
 316 MODULE_LICENSE("GPL v2");