3 files changed, 230 insertions, 0 deletions

diff --git a/drivers/pwm/Kconfig b/drivers/pwm/Kconfig
index 42e37c20b361..313c10789ca2 100644
--- a/drivers/pwm/Kconfig
+++ b/drivers/pwm/Kconfig
@@ -293,6 +293,15 @@ config PWM_MTK_DISP
           To compile this driver as a module, choose M here: the module
           will be called pwm-mtk-disp.
 
+config PWM_MEDIATEK
+        tristate "MediaTek PWM support"
+        depends on ARCH_MEDIATEK || COMPILE_TEST
+        help
+          Generic PWM framework driver for Mediatek ARM SoC.
+
+          To compile this driver as a module, choose M here: the module
+          will be called pwm-mxs.
+
 config PWM_MXS
         tristate "Freescale MXS PWM support"
         depends on ARCH_MXS && OF
diff --git a/drivers/pwm/Makefile b/drivers/pwm/Makefile
index 346a83b00f28..93da1f79a3b8 100644
--- a/drivers/pwm/Makefile
+++ b/drivers/pwm/Makefile
@@ -26,6 +26,7 @@ obj-$(CONFIG_PWM_LPSS)		+= pwm-lpss.o
 obj-$(CONFIG_PWM_LPSS_PCI)      += pwm-lpss-pci.o
 obj-$(CONFIG_PWM_LPSS_PLATFORM) += pwm-lpss-platform.o
 obj-$(CONFIG_PWM_MESON)         += pwm-meson.o
+obj-$(CONFIG_PWM_MEDIATEK)      += pwm-mediatek.o
 obj-$(CONFIG_PWM_MTK_DISP)      += pwm-mtk-disp.o
 obj-$(CONFIG_PWM_MXS)           += pwm-mxs.o
 obj-$(CONFIG_PWM_OMAP_DMTIMER)  += pwm-omap-dmtimer.o
diff --git a/drivers/pwm/pwm-mediatek.c b/drivers/pwm/pwm-mediatek.c
new file mode 100644
index 000000000000..7263952d1aac
--- /dev/null
+++ b/drivers/pwm/pwm-mediatek.c
@@ -0,0 +1,220 @@
+/*
+ * Mediatek Pulse Width Modulator driver
+ *
+ * Copyright (C) 2015 John Crispin <blogic@openwrt.org>
+ *
+ * This file is licensed under the terms of the GNU General Public
+ * License version 2. This program is licensed "as is" without any
+ * warranty of any kind, whether express or implied.
+ */
+
+#include <linux/err.h>
+#include <linux/io.h>
+#include <linux/ioport.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/clk.h>
+#include <linux/of.h>
+#include <linux/platform_device.h>
+#include <linux/pwm.h>
+#include <linux/slab.h>
+#include <linux/types.h>
+
+/* PWM registers and bits definitions */
+#define PWMCON                  0x00
+#define PWMHDUR                 0x04
+#define PWMLDUR                 0x08
+#define PWMGDUR                 0x0c
+#define PWMWAVENUM              0x28
+#define PWMDWIDTH               0x2c
+#define PWMTHRES                0x30
+
+enum {
+        MTK_CLK_MAIN = 0,
+        MTK_CLK_TOP,
+        MTK_CLK_PWM1,
+        MTK_CLK_PWM2,
+        MTK_CLK_PWM3,
+        MTK_CLK_PWM4,
+        MTK_CLK_PWM5,
+        MTK_CLK_MAX,
+};
+
+static const char * const mtk_pwm_clk_name[] = {
+        "main", "top", "pwm1", "pwm2", "pwm3", "pwm4", "pwm5"
+};
+
+/**
+ * struct mtk_pwm_chip - struct representing PWM chip
+ * @chip: linux PWM chip representation
+ * @regs: base address of PWM chip
+ * @clks: list of clocks
+ */
+struct mtk_pwm_chip {
+        struct pwm_chip chip;
+        void __iomem *regs;
+        struct clk *clks[MTK_CLK_MAX];
+};
+
+static inline struct mtk_pwm_chip *to_mtk_pwm_chip(struct pwm_chip *chip)
+{
+        return container_of(chip, struct mtk_pwm_chip, chip);
+}
+
+static inline u32 mtk_pwm_readl(struct mtk_pwm_chip *chip, unsigned int num,
+                                unsigned int offset)
+{
+        return readl(chip->regs + 0x10 + (num * 0x40) + offset);
+}
+
+static inline void mtk_pwm_writel(struct mtk_pwm_chip *chip,
+                                  unsigned int num, unsigned int offset,
+                                  u32 value)
+{
+        writel(value, chip->regs + 0x10 + (num * 0x40) + offset);
+}
+
+static int mtk_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm,
+                          int duty_ns, int period_ns)
+{
+        struct mtk_pwm_chip *pc = to_mtk_pwm_chip(chip);
+        struct clk *clk = pc->clks[MTK_CLK_PWM1 + pwm->hwpwm];
+        u32 resolution, clkdiv = 0;
+
+        resolution = NSEC_PER_SEC / clk_get_rate(clk);
+
+        while (period_ns / resolution > 8191) {
+                resolution *= 2;
+                clkdiv++;
+        }
+
+        if (clkdiv > 7)
+                return -EINVAL;
+
+        mtk_pwm_writel(pc, pwm->hwpwm, PWMCON, BIT(15) | BIT(3) | clkdiv);
+        mtk_pwm_writel(pc, pwm->hwpwm, PWMDWIDTH, period_ns / resolution);
+        mtk_pwm_writel(pc, pwm->hwpwm, PWMTHRES, duty_ns / resolution);
+
+        return 0;
+}
+
+static int mtk_pwm_enable(struct pwm_chip *chip, struct pwm_device *pwm)
+{
+        struct mtk_pwm_chip *pc = to_mtk_pwm_chip(chip);
+        u32 value;
+        int ret;
+
+        ret = clk_prepare(pc->clks[MTK_CLK_PWM1 + pwm->hwpwm]);
+        if (ret < 0)
+                return ret;
+
+        value = readl(pc->regs);
+        value |= BIT(pwm->hwpwm);
+        writel(value, pc->regs);
+
+        return 0;
+}
+
+static void mtk_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm)
+{
+        struct mtk_pwm_chip *pc = to_mtk_pwm_chip(chip);
+        u32 value;
+
+        value = readl(pc->regs);
+        value &= ~BIT(pwm->hwpwm);
+        writel(value, pc->regs);
+
+        clk_unprepare(pc->clks[MTK_CLK_PWM1 + pwm->hwpwm]);
+}
+
+static const struct pwm_ops mtk_pwm_ops = {
+        .config = mtk_pwm_config,
+        .enable = mtk_pwm_enable,
+        .disable = mtk_pwm_disable,
+        .owner = THIS_MODULE,
+};
+
+static int mtk_pwm_probe(struct platform_device *pdev)
+{
+        struct mtk_pwm_chip *pc;
+        struct resource *res;
+        unsigned int i;
+        int ret;
+
+        pc = devm_kzalloc(&pdev->dev, sizeof(*pc), GFP_KERNEL);
+        if (!pc)
+                return -ENOMEM;
+
+        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+        pc->regs = devm_ioremap_resource(&pdev->dev, res);
+        if (IS_ERR(pc->regs))
+                return PTR_ERR(pc->regs);
+
+        for (i = 0; i < MTK_CLK_MAX; i++) {
+                pc->clks[i] = devm_clk_get(&pdev->dev, mtk_pwm_clk_name[i]);
+                if (IS_ERR(pc->clks[i]))
+                        return PTR_ERR(pc->clks[i]);
+        }
+
+        ret = clk_prepare(pc->clks[MTK_CLK_TOP]);
+        if (ret < 0)
+                return ret;
+
+        ret = clk_prepare(pc->clks[MTK_CLK_MAIN]);
+        if (ret < 0)
+                goto disable_clk_top;
+
+        platform_set_drvdata(pdev, pc);
+
+        pc->chip.dev = &pdev->dev;
+        pc->chip.ops = &mtk_pwm_ops;
+        pc->chip.base = -1;
+        pc->chip.npwm = 5;
+
+        ret = pwmchip_add(&pc->chip);
+        if (ret < 0) {
+                dev_err(&pdev->dev, "pwmchip_add() failed: %d\n", ret);
+                goto disable_clk_main;
+        }
+
+        return 0;
+
+disable_clk_main:
+        clk_unprepare(pc->clks[MTK_CLK_MAIN]);
+disable_clk_top:
+