11ccea77eSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2d09f0081Syuanjian /* 3d09f0081Syuanjian * PWM Controller Driver for HiSilicon BVT SoCs 4d09f0081Syuanjian * 5d09f0081Syuanjian * Copyright (c) 2016 HiSilicon Technologies Co., Ltd. 6d09f0081Syuanjian */ 7d09f0081Syuanjian 8d09f0081Syuanjian #include <linux/bitops.h> 9d09f0081Syuanjian #include <linux/clk.h> 10d09f0081Syuanjian #include <linux/delay.h> 11d09f0081Syuanjian #include <linux/io.h> 12d09f0081Syuanjian #include <linux/module.h> 13d09f0081Syuanjian #include <linux/of_device.h> 14d09f0081Syuanjian #include <linux/platform_device.h> 15d09f0081Syuanjian #include <linux/pwm.h> 16d09f0081Syuanjian #include <linux/reset.h> 17d09f0081Syuanjian 18d09f0081Syuanjian #define PWM_CFG0_ADDR(x) (((x) * 0x20) + 0x0) 19d09f0081Syuanjian #define PWM_CFG1_ADDR(x) (((x) * 0x20) + 0x4) 20d09f0081Syuanjian #define PWM_CFG2_ADDR(x) (((x) * 0x20) + 0x8) 21d09f0081Syuanjian #define PWM_CTRL_ADDR(x) (((x) * 0x20) + 0xC) 22d09f0081Syuanjian 23d09f0081Syuanjian #define PWM_ENABLE_SHIFT 0 24d09f0081Syuanjian #define PWM_ENABLE_MASK BIT(0) 25d09f0081Syuanjian 26d09f0081Syuanjian #define PWM_POLARITY_SHIFT 1 27d09f0081Syuanjian #define PWM_POLARITY_MASK BIT(1) 28d09f0081Syuanjian 29d09f0081Syuanjian #define PWM_KEEP_SHIFT 2 30d09f0081Syuanjian #define PWM_KEEP_MASK BIT(2) 31d09f0081Syuanjian 32d09f0081Syuanjian #define PWM_PERIOD_MASK GENMASK(31, 0) 33d09f0081Syuanjian #define PWM_DUTY_MASK GENMASK(31, 0) 34d09f0081Syuanjian 35d09f0081Syuanjian struct hibvt_pwm_chip { 36d09f0081Syuanjian struct pwm_chip chip; 37d09f0081Syuanjian struct clk *clk; 38d09f0081Syuanjian void __iomem *base; 39d09f0081Syuanjian struct reset_control *rstc; 4077c3eddeSMathieu Othacehe const struct hibvt_pwm_soc *soc; 41d09f0081Syuanjian }; 42d09f0081Syuanjian 43d09f0081Syuanjian struct hibvt_pwm_soc { 44d09f0081Syuanjian u32 num_pwms; 457a58fc54SMathieu Othacehe bool quirk_force_enable; 46d09f0081Syuanjian }; 47d09f0081Syuanjian 4877c3eddeSMathieu Othacehe static const struct hibvt_pwm_soc hi3516cv300_soc_info = { 4977c3eddeSMathieu Othacehe .num_pwms = 4, 5077c3eddeSMathieu Othacehe }; 5177c3eddeSMathieu Othacehe 5277c3eddeSMathieu Othacehe static const struct hibvt_pwm_soc hi3519v100_soc_info = { 5377c3eddeSMathieu Othacehe .num_pwms = 8, 54d09f0081Syuanjian }; 55d09f0081Syuanjian 567a58fc54SMathieu Othacehe static const struct hibvt_pwm_soc hi3559v100_shub_soc_info = { 577a58fc54SMathieu Othacehe .num_pwms = 8, 587a58fc54SMathieu Othacehe .quirk_force_enable = true, 597a58fc54SMathieu Othacehe }; 607a58fc54SMathieu Othacehe 617a58fc54SMathieu Othacehe static const struct hibvt_pwm_soc hi3559v100_soc_info = { 627a58fc54SMathieu Othacehe .num_pwms = 2, 637a58fc54SMathieu Othacehe .quirk_force_enable = true, 647a58fc54SMathieu Othacehe }; 657a58fc54SMathieu Othacehe 66d09f0081Syuanjian static inline struct hibvt_pwm_chip *to_hibvt_pwm_chip(struct pwm_chip *chip) 67d09f0081Syuanjian { 68d09f0081Syuanjian return container_of(chip, struct hibvt_pwm_chip, chip); 69d09f0081Syuanjian } 70d09f0081Syuanjian 71d09f0081Syuanjian static void hibvt_pwm_set_bits(void __iomem *base, u32 offset, 72d09f0081Syuanjian u32 mask, u32 data) 73d09f0081Syuanjian { 74d09f0081Syuanjian void __iomem *address = base + offset; 75d09f0081Syuanjian u32 value; 76d09f0081Syuanjian 77d09f0081Syuanjian value = readl(address); 78d09f0081Syuanjian value &= ~mask; 79d09f0081Syuanjian value |= (data & mask); 80d09f0081Syuanjian writel(value, address); 81d09f0081Syuanjian } 82d09f0081Syuanjian 83d09f0081Syuanjian static void hibvt_pwm_enable(struct pwm_chip *chip, struct pwm_device *pwm) 84d09f0081Syuanjian { 85d09f0081Syuanjian struct hibvt_pwm_chip *hi_pwm_chip = to_hibvt_pwm_chip(chip); 86d09f0081Syuanjian 87d09f0081Syuanjian hibvt_pwm_set_bits(hi_pwm_chip->base, PWM_CTRL_ADDR(pwm->hwpwm), 88d09f0081Syuanjian PWM_ENABLE_MASK, 0x1); 89d09f0081Syuanjian } 90d09f0081Syuanjian 91d09f0081Syuanjian static void hibvt_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm) 92d09f0081Syuanjian { 93d09f0081Syuanjian struct hibvt_pwm_chip *hi_pwm_chip = to_hibvt_pwm_chip(chip); 94d09f0081Syuanjian 95d09f0081Syuanjian hibvt_pwm_set_bits(hi_pwm_chip->base, PWM_CTRL_ADDR(pwm->hwpwm), 96d09f0081Syuanjian PWM_ENABLE_MASK, 0x0); 97d09f0081Syuanjian } 98d09f0081Syuanjian 99d09f0081Syuanjian static void hibvt_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm, 100d09f0081Syuanjian int duty_cycle_ns, int period_ns) 101d09f0081Syuanjian { 102d09f0081Syuanjian struct hibvt_pwm_chip *hi_pwm_chip = to_hibvt_pwm_chip(chip); 103d09f0081Syuanjian u32 freq, period, duty; 104d09f0081Syuanjian 105d09f0081Syuanjian freq = div_u64(clk_get_rate(hi_pwm_chip->clk), 1000000); 106d09f0081Syuanjian 107d09f0081Syuanjian period = div_u64(freq * period_ns, 1000); 108d09f0081Syuanjian duty = div_u64(period * duty_cycle_ns, period_ns); 109d09f0081Syuanjian 110d09f0081Syuanjian hibvt_pwm_set_bits(hi_pwm_chip->base, PWM_CFG0_ADDR(pwm->hwpwm), 111d09f0081Syuanjian PWM_PERIOD_MASK, period); 112d09f0081Syuanjian 113d09f0081Syuanjian hibvt_pwm_set_bits(hi_pwm_chip->base, PWM_CFG1_ADDR(pwm->hwpwm), 114d09f0081Syuanjian PWM_DUTY_MASK, duty); 115d09f0081Syuanjian } 116d09f0081Syuanjian 117d09f0081Syuanjian static void hibvt_pwm_set_polarity(struct pwm_chip *chip, 118d09f0081Syuanjian struct pwm_device *pwm, 119d09f0081Syuanjian enum pwm_polarity polarity) 120d09f0081Syuanjian { 121d09f0081Syuanjian struct hibvt_pwm_chip *hi_pwm_chip = to_hibvt_pwm_chip(chip); 122d09f0081Syuanjian 123d09f0081Syuanjian if (polarity == PWM_POLARITY_INVERSED) 124d09f0081Syuanjian hibvt_pwm_set_bits(hi_pwm_chip->base, PWM_CTRL_ADDR(pwm->hwpwm), 125d09f0081Syuanjian PWM_POLARITY_MASK, (0x1 << PWM_POLARITY_SHIFT)); 126d09f0081Syuanjian else 127d09f0081Syuanjian hibvt_pwm_set_bits(hi_pwm_chip->base, PWM_CTRL_ADDR(pwm->hwpwm), 128d09f0081Syuanjian PWM_POLARITY_MASK, (0x0 << PWM_POLARITY_SHIFT)); 129d09f0081Syuanjian } 130d09f0081Syuanjian 1316c452cffSUwe Kleine-König static int hibvt_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm, 132d09f0081Syuanjian struct pwm_state *state) 133d09f0081Syuanjian { 134d09f0081Syuanjian struct hibvt_pwm_chip *hi_pwm_chip = to_hibvt_pwm_chip(chip); 135d09f0081Syuanjian void __iomem *base; 136d09f0081Syuanjian u32 freq, value; 137d09f0081Syuanjian 138d09f0081Syuanjian freq = div_u64(clk_get_rate(hi_pwm_chip->clk), 1000000); 139d09f0081Syuanjian base = hi_pwm_chip->base; 140d09f0081Syuanjian 141d09f0081Syuanjian value = readl(base + PWM_CFG0_ADDR(pwm->hwpwm)); 142d09f0081Syuanjian state->period = div_u64(value * 1000, freq); 143d09f0081Syuanjian 144d09f0081Syuanjian value = readl(base + PWM_CFG1_ADDR(pwm->hwpwm)); 145d09f0081Syuanjian state->duty_cycle = div_u64(value * 1000, freq); 146d09f0081Syuanjian 147d09f0081Syuanjian value = readl(base + PWM_CTRL_ADDR(pwm->hwpwm)); 148d09f0081Syuanjian state->enabled = (PWM_ENABLE_MASK & value); 1496f579379SUwe Kleine-König state->polarity = (PWM_POLARITY_MASK & value) ? PWM_POLARITY_INVERSED : PWM_POLARITY_NORMAL; 1506c452cffSUwe Kleine-König 1516c452cffSUwe Kleine-König return 0; 152d09f0081Syuanjian } 153d09f0081Syuanjian 154d09f0081Syuanjian static int hibvt_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm, 15571523d18SUwe Kleine-König const struct pwm_state *state) 156d09f0081Syuanjian { 1577a58fc54SMathieu Othacehe struct hibvt_pwm_chip *hi_pwm_chip = to_hibvt_pwm_chip(chip); 1587a58fc54SMathieu Othacehe 159d09f0081Syuanjian if (state->polarity != pwm->state.polarity) 160d09f0081Syuanjian hibvt_pwm_set_polarity(chip, pwm, state->polarity); 161d09f0081Syuanjian 162d09f0081Syuanjian if (state->period != pwm->state.period || 1637a58fc54SMathieu Othacehe state->duty_cycle != pwm->state.duty_cycle) { 164d09f0081Syuanjian hibvt_pwm_config(chip, pwm, state->duty_cycle, state->period); 165d09f0081Syuanjian 1667a58fc54SMathieu Othacehe /* 1677a58fc54SMathieu Othacehe * Some implementations require the PWM to be enabled twice 1687a58fc54SMathieu Othacehe * each time the duty cycle is refreshed. 1697a58fc54SMathieu Othacehe */ 1707a58fc54SMathieu Othacehe if (hi_pwm_chip->soc->quirk_force_enable && state->enabled) 1717a58fc54SMathieu Othacehe hibvt_pwm_enable(chip, pwm); 1727a58fc54SMathieu Othacehe } 1737a58fc54SMathieu Othacehe 174d09f0081Syuanjian if (state->enabled != pwm->state.enabled) { 175d09f0081Syuanjian if (state->enabled) 176d09f0081Syuanjian hibvt_pwm_enable(chip, pwm); 177d09f0081Syuanjian else 178d09f0081Syuanjian hibvt_pwm_disable(chip, pwm); 179d09f0081Syuanjian } 180d09f0081Syuanjian 181d09f0081Syuanjian return 0; 182d09f0081Syuanjian } 183d09f0081Syuanjian 184c034a6fdSArvind Yadav static const struct pwm_ops hibvt_pwm_ops = { 185d09f0081Syuanjian .get_state = hibvt_pwm_get_state, 186d09f0081Syuanjian .apply = hibvt_pwm_apply, 187d09f0081Syuanjian 188d09f0081Syuanjian .owner = THIS_MODULE, 189d09f0081Syuanjian }; 190d09f0081Syuanjian 191d09f0081Syuanjian static int hibvt_pwm_probe(struct platform_device *pdev) 192d09f0081Syuanjian { 193d09f0081Syuanjian const struct hibvt_pwm_soc *soc = 194d09f0081Syuanjian of_device_get_match_data(&pdev->dev); 195d09f0081Syuanjian struct hibvt_pwm_chip *pwm_chip; 196cecccd8dSYangtao Li int ret, i; 197d09f0081Syuanjian 198d09f0081Syuanjian pwm_chip = devm_kzalloc(&pdev->dev, sizeof(*pwm_chip), GFP_KERNEL); 199d09f0081Syuanjian if (pwm_chip == NULL) 200d09f0081Syuanjian return -ENOMEM; 201d09f0081Syuanjian 202d09f0081Syuanjian pwm_chip->clk = devm_clk_get(&pdev->dev, NULL); 203d09f0081Syuanjian if (IS_ERR(pwm_chip->clk)) { 204d09f0081Syuanjian dev_err(&pdev->dev, "getting clock failed with %ld\n", 205d09f0081Syuanjian PTR_ERR(pwm_chip->clk)); 206d09f0081Syuanjian return PTR_ERR(pwm_chip->clk); 207d09f0081Syuanjian } 208d09f0081Syuanjian 209d09f0081Syuanjian pwm_chip->chip.ops = &hibvt_pwm_ops; 210d09f0081Syuanjian pwm_chip->chip.dev = &pdev->dev; 211d09f0081Syuanjian pwm_chip->chip.npwm = soc->num_pwms; 21277c3eddeSMathieu Othacehe pwm_chip->soc = soc; 213d09f0081Syuanjian 214cecccd8dSYangtao Li pwm_chip->base = devm_platform_ioremap_resource(pdev, 0); 215d09f0081Syuanjian if (IS_ERR(pwm_chip->base)) 216d09f0081Syuanjian return PTR_ERR(pwm_chip->base); 217d09f0081Syuanjian 218d09f0081Syuanjian ret = clk_prepare_enable(pwm_chip->clk); 219d09f0081Syuanjian if (ret < 0) 220d09f0081Syuanjian return ret; 221d09f0081Syuanjian 2220fd3b93fSPhilipp Zabel pwm_chip->rstc = devm_reset_control_get_exclusive(&pdev->dev, NULL); 223d09f0081Syuanjian if (IS_ERR(pwm_chip->rstc)) { 224d09f0081Syuanjian clk_disable_unprepare(pwm_chip->clk); 225d09f0081Syuanjian return PTR_ERR(pwm_chip->rstc); 226d09f0081Syuanjian } 227d09f0081Syuanjian 228d09f0081Syuanjian reset_control_assert(pwm_chip->rstc); 229d09f0081Syuanjian msleep(30); 230d09f0081Syuanjian reset_control_deassert(pwm_chip->rstc); 231d09f0081Syuanjian 232d09f0081Syuanjian ret = pwmchip_add(&pwm_chip->chip); 233d09f0081Syuanjian if (ret < 0) { 234d09f0081Syuanjian clk_disable_unprepare(pwm_chip->clk); 235d09f0081Syuanjian return ret; 236d09f0081Syuanjian } 237d09f0081Syuanjian 238d09f0081Syuanjian for (i = 0; i < pwm_chip->chip.npwm; i++) { 239d09f0081Syuanjian hibvt_pwm_set_bits(pwm_chip->base, PWM_CTRL_ADDR(i), 240d09f0081Syuanjian PWM_KEEP_MASK, (0x1 << PWM_KEEP_SHIFT)); 241d09f0081Syuanjian } 242d09f0081Syuanjian 243d09f0081Syuanjian platform_set_drvdata(pdev, pwm_chip); 244d09f0081Syuanjian 245d09f0081Syuanjian return 0; 246d09f0081Syuanjian } 247d09f0081Syuanjian 248*1b6d6ce5SUwe Kleine-König static void hibvt_pwm_remove(struct platform_device *pdev) 249d09f0081Syuanjian { 250d09f0081Syuanjian struct hibvt_pwm_chip *pwm_chip; 251d09f0081Syuanjian 252d09f0081Syuanjian pwm_chip = platform_get_drvdata(pdev); 253d09f0081Syuanjian 25404d77521SUwe Kleine-König pwmchip_remove(&pwm_chip->chip); 25504d77521SUwe Kleine-König 256d09f0081Syuanjian reset_control_assert(pwm_chip->rstc); 257d09f0081Syuanjian msleep(30); 258d09f0081Syuanjian reset_control_deassert(pwm_chip->rstc); 259d09f0081Syuanjian 260d09f0081Syuanjian clk_disable_unprepare(pwm_chip->clk); 261d09f0081Syuanjian } 262d09f0081Syuanjian 263d09f0081Syuanjian static const struct of_device_id hibvt_pwm_of_match[] = { 26477c3eddeSMathieu Othacehe { .compatible = "hisilicon,hi3516cv300-pwm", 26577c3eddeSMathieu Othacehe .data = &hi3516cv300_soc_info }, 26677c3eddeSMathieu Othacehe { .compatible = "hisilicon,hi3519v100-pwm", 26777c3eddeSMathieu Othacehe .data = &hi3519v100_soc_info }, 2687a58fc54SMathieu Othacehe { .compatible = "hisilicon,hi3559v100-shub-pwm", 2697a58fc54SMathieu Othacehe .data = &hi3559v100_shub_soc_info }, 2707a58fc54SMathieu Othacehe { .compatible = "hisilicon,hi3559v100-pwm", 2717a58fc54SMathieu Othacehe .data = &hi3559v100_soc_info }, 272d09f0081Syuanjian { } 273d09f0081Syuanjian }; 274d09f0081Syuanjian MODULE_DEVICE_TABLE(of, hibvt_pwm_of_match); 275d09f0081Syuanjian 276d09f0081Syuanjian static struct platform_driver hibvt_pwm_driver = { 277d09f0081Syuanjian .driver = { 278d09f0081Syuanjian .name = "hibvt-pwm", 279d09f0081Syuanjian .of_match_table = hibvt_pwm_of_match, 280d09f0081Syuanjian }, 281d09f0081Syuanjian .probe = hibvt_pwm_probe, 282*1b6d6ce5SUwe Kleine-König .remove_new = hibvt_pwm_remove, 283d09f0081Syuanjian }; 284d09f0081Syuanjian module_platform_driver(hibvt_pwm_driver); 285d09f0081Syuanjian 286d09f0081Syuanjian MODULE_AUTHOR("Jian Yuan"); 287d09f0081Syuanjian MODULE_DESCRIPTION("HiSilicon BVT SoCs PWM driver"); 288d09f0081Syuanjian MODULE_LICENSE("GPL"); 289