From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id 13EE0C4452B for ; Tue, 21 Jul 2026 06:23:41 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:Content-Transfer-Encoding: MIME-Version:References:In-Reply-To:Message-Id:Date:Subject:Cc:To:From: Reply-To:Content-Type:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=xYDLN0SdG2S2TMSfDca2PEVtas/kjDMgdSeF774LdcY=; b=fBZZHskp4qRN/3z5lR5CPAYsIm yUsd38frP8BF5HWDGiB/Xg7YUZFA8VIIf1tZrvrIs3egm+KWX6+Z2DVQztncWHYSs1WYkSHqmJpVa YMGcFBHWfptlqNLL4rnBJCNHAv8AxQpHb6B2Xg6WLj0cNd0SnqdCQKQggzW8gs7VWbDCgLVx+3Gbw 69inknzitkPK2kLpJAfzh7ysPD5B29T89CDx094+qZ1FKoqeonP0wjWFYJtTx0zxjS0r3/ZCjvYrR Pkaqz4hh4jSo4Ok3sKXWyPOkZXXQabYzJi9/N5HNIMe+eYZb3aXFnAYOfY8/o8dooL92YR69eXCx2 D9MYY3dQ==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.99.1 #2 (Red Hat Linux)) id 1wm3t8-00000008VnZ-20U9; Tue, 21 Jul 2026 06:23:34 +0000 Received: from mail-pf1-x42a.google.com ([2607:f8b0:4864:20::42a]) by bombadil.infradead.org with esmtps (Exim 4.99.1 #2 (Red Hat Linux)) id 1wm3t6-00000008Vmc-0F4Z for linux-arm-kernel@lists.infradead.org; Tue, 21 Jul 2026 06:23:33 +0000 Received: by mail-pf1-x42a.google.com with SMTP id d2e1a72fcca58-8487b7b3fc8so11042735b3a.3 for ; Mon, 20 Jul 2026 23:23:31 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20251104; t=1784615011; x=1785219811; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to:content-type; bh=xYDLN0SdG2S2TMSfDca2PEVtas/kjDMgdSeF774LdcY=; b=gsQv4actrcEORVmzT8978P3tbQP4jO3ngHhc2mtNAYmSJ4Yv/R9iTuyv0Tyqq0UJ1m UjXpNCASk6NauBYI9p3NqQhn9JtolXFW1pTftrHxJdR7S2BRtU9lNCgTGfy8/Ffm+s3H hie3a4NLcw4fisUlbDaqmjyTkRf/8+9Tb4FU0s0EPEEVOa6SLn3v6TpZluv8MN3OGCFG Di1QrCl+MbAxFarpD2Au5FcLukAaFp757M2UiFJEuFF3b5V2rDaWeW9G93o0EXXzcpTz FCLIUA0B3OgKg6QYE0TYc51cTlWly/WKghmpQ82Z8zaKtnI3eq+cwERPAlKkGY72r3rj Zf9w== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20251104; t=1784615011; x=1785219811; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-gg:x-gm-message-state:from :to:cc:subject:date:message-id:reply-to:content-type; bh=xYDLN0SdG2S2TMSfDca2PEVtas/kjDMgdSeF774LdcY=; b=EcYtD1g/mt1y+THYSiRJCriTQs0UY0NzSvnALX1csOi4+AoBx6yNcZVTBh8n+gn4GE k+sO9CqCdm08aAS8/YIykO5YH8rEKWUN7NnSkZ7Pvj9bxV4g/EtFQjyCbHzA5xIF6d2V iUUktGSfRH6iNAxXRiVqWtjM8OY5SA5a0E5XDcojjdaGVlMaJa3yiGxdOIrciopkaxTG sf3nmOUctWjALorgR5j4SbIVqRv8GkO5Cwc0SohP9UB5bOiNXjCiH4z4Bz+1eBdebpzG 7ZvuYixcvqP2cqadgNEPpStOISKJosJiYBfyje/C7ffD7bqR8m1g1jShmq2ZpZSfpMvm nqqw== X-Gm-Message-State: AOJu0YwHbcgNkWz//RmrHXFhzbddJYPUNAwdHelkzkGwWyfu029CKmkm tEEhqVpnP3pKjYt47RvlpGmn/L5ml+NwjFLfCeNyQu4tW5wyGMujKK/4 X-Gm-Gg: AR+sD138amnvnymFasTbVT6lMmKdHaCiuWiS16oZhwiJszo5qYThw4iaLsbx5ksziPp 7hEuQ5J7lnQYomzq8MfKHdEQH10ZjWNwd8Em7mokGm1wwQ4uLForc+4/msyPKbXWyGNwhJO0R/j 3vF0lFAzYCeRmQ+ocRWn3bKR0++o1DtsHkaVICUZ5+JyeWk44mIzv38pD4jE1qAY+PyVk1CFBhO JzOHQAXU1omEBr2ys4tf5wjTF8alN/2fp1zzWcToUnqahOILmnre65BSYuHxDhGaryZc22JiuXw oMITnZ23KN3K4TCSsnpve/TqLZNKRGEn49+X3YrMtzZozkigcEgCb3wLWmuVUXAuB46aJAf/unM Uo+MAv1U2gGSHpe/yk2YUa9kW+i5S0atl83ehn5bvOVcG0Wh/M0zvwn5oeUSRzgc+NILIp2jbtJ 5hs/19PzWPeNh0tC4c9YLuhNmUZHUBpGmKvSTr2t9Bm/8f8dKzF4U6B+Gai+3KXzEY X-Received: by 2002:a05:6a00:2353:b0:848:7443:f2de with SMTP id d2e1a72fcca58-84c292d1534mr16781590b3a.13.1784615010972; Mon, 20 Jul 2026 23:23:30 -0700 (PDT) Received: from localhost.localdomain (60-250-196-139.hinet-ip.hinet.net. [60.250.196.139]) by smtp.gmail.com with ESMTPSA id d2e1a72fcca58-84c4b640050sm4020710b3a.45.2026.07.20.23.23.28 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 20 Jul 2026 23:23:30 -0700 (PDT) From: Chi-Wen Weng To: ukleinek@kernel.org, robh@kernel.org, krzk+dt@kernel.org, conor+dt@kernel.org Cc: linux-arm-kernel@lists.infradead.org, linux-pwm@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, cwweng@nuvoton.com, cwweng.linux@gmail.com Subject: [PATCH v5 2/2] pwm: Add Nuvoton MA35D1 PWM controller support Date: Tue, 21 Jul 2026 14:23:08 +0800 Message-Id: <20260721062308.536947-3-cwweng.linux@gmail.com> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20260721062308.536947-1-cwweng.linux@gmail.com> References: <20260721062308.536947-1-cwweng.linux@gmail.com> MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.9.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20260720_232332_128550_BA786B1D X-CRM114-Status: GOOD ( 29.19 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Chi-Wen Weng Add a PWM framework driver for the Nuvoton MA35D1 EPWM controller. The controller provides 6 PWM channels and supports up, down and up-down counter types, auto-reload and one-shot counter modes, and independent and complementary output modes. The initial driver supports up-counting, auto-reload and independent output modes. It uses period loading mode and configures the waveform generator to drive the output high at the zero point and low at the compare-up point. In up-counting mode, the counter counts from 0 to PERIOD inclusive. With the selected waveform actions, CMPDAT = 0 generates a 0% duty cycle and CMPDAT > PERIOD generates a 100% duty cycle. Limit the period to 0xffff counter cycles so that PERIOD is at most 0xfffe and CMPDAT = 0xffff remains available for the full-duty case. The clock prescaler is shared by each pair of PWM channels. Preserve its existing value and account for CLKPSC + 1 when calculating and reporting the period and duty cycle. Do not modify the controller during probe, preserving PWM outputs that may already have been configured by firmware. Configure only the requested channel from the apply callback. Refuse to change an active complementary pair to independent mode when doing so would disturb the paired output. When disabling a channel, clear its output-enable and counter-enable bits. The output pin is then placed in tri-state by the hardware. Signed-off-by: Chi-Wen Weng --- drivers/pwm/Kconfig | 10 ++ drivers/pwm/Makefile | 1 + drivers/pwm/pwm-ma35d1.c | 380 +++++++++++++++++++++++++++++++++++++++ 3 files changed, 391 insertions(+) create mode 100644 drivers/pwm/pwm-ma35d1.c diff --git a/drivers/pwm/Kconfig b/drivers/pwm/Kconfig index e8886a9b64d9..d971760b37c6 100644 --- a/drivers/pwm/Kconfig +++ b/drivers/pwm/Kconfig @@ -463,6 +463,16 @@ config PWM_LPSS_PLATFORM To compile this driver as a module, choose M here: the module will be called pwm-lpss-platform. +config PWM_MA35D1 + tristate "Nuvoton MA35D1 PWM support" + depends on ARCH_MA35 || COMPILE_TEST + help + Generic PWM framework driver for the Nuvoton MA35D1 PWM + controller, which provides 6 PWM outputs. + + To compile this driver as a module, choose M here: the module + will be called pwm-ma35d1. + config PWM_MAX7360 tristate "MAX7360 PWMs" depends on MFD_MAX7360 diff --git a/drivers/pwm/Makefile b/drivers/pwm/Makefile index 5630a521a7cf..7ad761ea27d1 100644 --- a/drivers/pwm/Makefile +++ b/drivers/pwm/Makefile @@ -40,6 +40,7 @@ obj-$(CONFIG_PWM_LPC32XX) += pwm-lpc32xx.o 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_MA35D1) += pwm-ma35d1.o obj-$(CONFIG_PWM_MAX7360) += pwm-max7360.o obj-$(CONFIG_PWM_MC33XS2410) += pwm-mc33xs2410.o obj-$(CONFIG_PWM_MEDIATEK) += pwm-mediatek.o diff --git a/drivers/pwm/pwm-ma35d1.c b/drivers/pwm/pwm-ma35d1.c new file mode 100644 index 000000000000..4073cb72054a --- /dev/null +++ b/drivers/pwm/pwm-ma35d1.c @@ -0,0 +1,380 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for the Nuvoton MA35D1 PWM controller + * + * Copyright (C) 2026 Nuvoton Corporation + * Chi-Wen Weng + * + * Reference Manual: + * https://www.nuvoton.com/resource-download.jsp?tp_GUID=DA05-MA35D16 + * + * Limitations: + * - The hardware supports 6 PWM channels. + * - The hardware supports up, down and up-down counter types. This driver + * supports up-counting mode only. + * - The hardware supports auto-reload and one-shot counter modes. This driver + * supports auto-reload mode only. + * - The hardware supports independent and complementary output modes. This + * driver supports independent mode only. If a channel pair is already active + * in complementary mode, applying a new state to one channel fails with + * -EBUSY to avoid disturbing the paired output. + * - The hardware supports period, immediate, window and center loading modes. + * This driver supports period loading mode only. + * - The hardware supports programmable waveform actions at zero, period and + * compare points. This driver uses zero point high and compare-up point low + * actions for normal PWM output. + * - In up-counting mode, the counter counts from 0 to PERIOD inclusive. With + * zero point high and compare-up point low actions, CMPDAT = 0 produces 0% + * duty and CMPDAT > PERIOD produces 100% duty. + * - The driver limits the period to 0xffff counter cycles so that CMPDAT can + * be set greater than PERIOD to generate a 100% duty cycle. + * - Period and duty cycle changes are buffered by hardware and take effect at + * the end of the current period. + * - The clock prescaler is shared by each channel pair. The driver preserves + * the current prescaler and accounts for it in period and duty calculations. + * - Polarity and waveform-control changes are applied directly and may cause + * a transient output change if the PWM output is running. + * - When disabled, the output pin is put in tri-state by clearing POENn. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define MA35D1_REG_PWM_CTL0 0x00 +#define MA35D1_REG_PWM_CTL1 0x04 +#define MA35D1_REG_PWM_CLKPSC(ch) (0x14 + 4 * ((ch) / 2)) +#define MA35D1_REG_PWM_CNTEN 0x20 +#define MA35D1_REG_PWM_PERIOD(ch) (0x30 + 4 * (ch)) +#define MA35D1_REG_PWM_CMPDAT(ch) (0x50 + 4 * (ch)) +#define MA35D1_REG_PWM_WGCTL0 0xb0 +#define MA35D1_REG_PWM_WGCTL1 0xb4 +#define MA35D1_REG_PWM_POLCTL 0xd4 +#define MA35D1_REG_PWM_POEN 0xd8 + +#define MA35D1_PWM_CTL0_CTRLD(ch) BIT(ch) +#define MA35D1_PWM_CTL0_WINLDEN(ch) BIT(8 + (ch)) +#define MA35D1_PWM_CTL0_IMMLDEN(ch) BIT(16 + (ch)) + +#define MA35D1_PWM_CTL1_CNTTYPE_MASK(ch) (0x3 << (2 * (ch))) +#define MA35D1_PWM_CTL1_CNTMODE_MASK(ch) BIT(16 + (ch)) +#define MA35D1_PWM_CTL1_OUTMODE_MASK(ch) BIT(24 + ((ch) / 2)) + +#define MA35D1_PWM_WGCTL_ACTION_MASK 0x3 +#define MA35D1_PWM_WGCTL_ACTION(ch) \ + (MA35D1_PWM_WGCTL_ACTION_MASK << (2 * (ch))) +#define MA35D1_PWM_WGCTL_ACTION_VAL(ch, action) ((action) << (2 * (ch))) +#define MA35D1_PWM_WGCTL_ACTION_LOW 1 +#define MA35D1_PWM_WGCTL_ACTION_HIGH 2 + +#define MA35D1_PWM_CLKPSC_MASK GENMASK(11, 0) +#define MA35D1_PWM_DATA_MASK GENMASK(15, 0) +#define MA35D1_PWM_MAX_CYCLES 0xffff + +#define MA35D1_PWM_CNTEN_EN(ch) BIT(ch) +#define MA35D1_PWM_POEN_EN(ch) BIT(ch) +#define MA35D1_PWM_POLCTL_INV(ch) BIT(ch) + +#define MA35D1_PWM_NUM_CHANNELS 6 + +struct nuvoton_pwm { + void __iomem *base; + unsigned long clkrate; +}; + +static inline struct nuvoton_pwm *nuvoton_pwm_from_chip(struct pwm_chip *chip) +{ + return pwmchip_get_drvdata(chip); +} + +static inline u32 nuvoton_pwm_readl(struct nuvoton_pwm *nvtpwm, + unsigned int offset) +{ + return readl(nvtpwm->base + offset); +} + +static inline void nuvoton_pwm_writel(struct nuvoton_pwm *nvtpwm, + unsigned int offset, u32 value) +{ + writel(value, nvtpwm->base + offset); +} + +static inline void nuvoton_pwm_rmw(struct nuvoton_pwm *nvtpwm, + unsigned int offset, u32 mask, u32 value) +{ + u32 reg; + + reg = nuvoton_pwm_readl(nvtpwm, offset); + reg &= ~mask; + reg |= value & mask; + nuvoton_pwm_writel(nvtpwm, offset, reg); +} + +static bool nuvoton_pwm_channel_active(struct nuvoton_pwm *nvtpwm, + unsigned int ch) +{ + u32 cnten, poen; + u32 mask = BIT(ch); + + cnten = nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_CNTEN); + poen = nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_POEN); + + return (cnten | poen) & mask; +} + +static u32 nuvoton_pwm_get_prescale(struct nuvoton_pwm *nvtpwm, + unsigned int ch) +{ + return nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_CLKPSC(ch)) & + MA35D1_PWM_CLKPSC_MASK; +} + +static int nuvoton_pwm_config_channel(struct nuvoton_pwm *nvtpwm, + unsigned int ch) +{ + u32 ctl0_mask; + u32 ctl1, ctl1_mask, outmode_mask; + u32 wgctl0_mask, wgctl0_val; + u32 wgctl1_mask, wgctl1_val; + + outmode_mask = MA35D1_PWM_CTL1_OUTMODE_MASK(ch); + ctl1 = nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_CTL1); + + if ((ctl1 & outmode_mask) && + nuvoton_pwm_channel_active(nvtpwm, ch ^ 1)) + return -EBUSY; + + /* + * IMMLDENn = 0, WINLDENn = 0 and CTRLDn = 0 select period loading + * mode for up-counting operation. + */ + ctl0_mask = MA35D1_PWM_CTL0_IMMLDEN(ch); + ctl0_mask |= MA35D1_PWM_CTL0_WINLDEN(ch); + ctl0_mask |= MA35D1_PWM_CTL0_CTRLD(ch); + + /* + * CNTTYPEn = 00: up counter type + * CNTMODEn = 0: auto-reload mode + * OUTMODEn = 0: independent mode + */ + ctl1_mask = MA35D1_PWM_CTL1_CNTTYPE_MASK(ch); + ctl1_mask |= MA35D1_PWM_CTL1_CNTMODE_MASK(ch); + ctl1_mask |= outmode_mask; + + /* + * ZPCTLn = 10: output high at zero point + * PRDPCTLn = 00: do nothing at period point + */ + wgctl0_mask = MA35D1_PWM_WGCTL_ACTION(ch); + wgctl0_mask |= MA35D1_PWM_WGCTL_ACTION(ch) << 16; + wgctl0_val = MA35D1_PWM_WGCTL_ACTION_VAL(ch, + MA35D1_PWM_WGCTL_ACTION_HIGH); + + /* + * CMPUCTLn = 01: output low at compare up point + * CMPDCTLn = 00: do nothing at compare down point + */ + wgctl1_mask = MA35D1_PWM_WGCTL_ACTION(ch); + wgctl1_mask |= MA35D1_PWM_WGCTL_ACTION(ch) << 16; + wgctl1_val = MA35D1_PWM_WGCTL_ACTION_VAL(ch, + MA35D1_PWM_WGCTL_ACTION_LOW); + + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_CTL0, ctl0_mask, 0); + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_CTL1, ctl1_mask, 0); + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_WGCTL0, + wgctl0_mask, wgctl0_val); + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_WGCTL1, + wgctl1_mask, wgctl1_val); + + return 0; +} + +static int nuvoton_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm, + const struct pwm_state *state) +{ + struct nuvoton_pwm *nvtpwm = nuvoton_pwm_from_chip(chip); + unsigned int ch = pwm->hwpwm; + u64 duty_cycles, period_cycles; + u64 divisor; + u32 cmpdat, period, prescale; + int ret; + + if (!state->enabled) { + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_POEN, + MA35D1_PWM_POEN_EN(ch), 0); + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_CNTEN, + MA35D1_PWM_CNTEN_EN(ch), 0); + + return 0; + } + + prescale = nuvoton_pwm_get_prescale(nvtpwm, ch); + divisor = (u64)NSEC_PER_SEC * (prescale + 1); + + period_cycles = mul_u64_u64_div_u64(nvtpwm->clkrate, + state->period, divisor); + if (!period_cycles) + return -EINVAL; + + if (period_cycles > MA35D1_PWM_MAX_CYCLES) + period_cycles = MA35D1_PWM_MAX_CYCLES; + + duty_cycles = mul_u64_u64_div_u64(nvtpwm->clkrate, + state->duty_cycle, divisor); + if (duty_cycles > period_cycles) + duty_cycles = period_cycles; + + ret = nuvoton_pwm_config_channel(nvtpwm, ch); + if (ret) + return ret; + + if (state->polarity == PWM_POLARITY_NORMAL) + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_POLCTL, + MA35D1_PWM_POLCTL_INV(ch), 0); + else + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_POLCTL, + MA35D1_PWM_POLCTL_INV(ch), + MA35D1_PWM_POLCTL_INV(ch)); + + /* + * In up-counting mode the counter counts from 0 to PERIOD inclusive. + * With zero point high and compare-up point low actions: + * - CMPDAT = 0 produces 0% duty. + * - CMPDAT > PERIOD produces 100% duty. + * + * period_cycles is limited to 0xffff, so PERIOD is at most 0xfffe + * and a 100% duty cycle can be represented by CMPDAT = 0xffff. + */ + period = period_cycles - 1; + cmpdat = duty_cycles; + + nuvoton_pwm_writel(nvtpwm, MA35D1_REG_PWM_PERIOD(ch), period); + nuvoton_pwm_writel(nvtpwm, MA35D1_REG_PWM_CMPDAT(ch), cmpdat); + + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_POEN, + MA35D1_PWM_POEN_EN(ch), MA35D1_PWM_POEN_EN(ch)); + nuvoton_pwm_rmw(nvtpwm, MA35D1_REG_PWM_CNTEN, + MA35D1_PWM_CNTEN_EN(ch), MA35D1_PWM_CNTEN_EN(ch)); + + return 0; +} + +static int nuvoton_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm, + struct pwm_state *state) +{ + struct nuvoton_pwm *nvtpwm = nuvoton_pwm_from_chip(chip); + unsigned int ch = pwm->hwpwm; + u32 cmpdat, cnten, period, poen, polctl, prescale; + u64 duty_cycles, period_cycles; + u64 prescaled_cycles; + + cnten = nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_CNTEN); + poen = nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_POEN); + polctl = nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_POLCTL); + prescale = nuvoton_pwm_get_prescale(nvtpwm, ch); + period = nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_PERIOD(ch)) & + MA35D1_PWM_DATA_MASK; + cmpdat = nuvoton_pwm_readl(nvtpwm, MA35D1_REG_PWM_CMPDAT(ch)) & + MA35D1_PWM_DATA_MASK; + + period_cycles = period + 1; + if (cmpdat > period) + duty_cycles = period_cycles; + else + duty_cycles = cmpdat; + + state->enabled = (cnten & MA35D1_PWM_CNTEN_EN(ch)) && + (poen & MA35D1_PWM_POEN_EN(ch)); + state->polarity = (polctl & MA35D1_PWM_POLCTL_INV(ch)) ? + PWM_POLARITY_INVERSED : PWM_POLARITY_NORMAL; + + prescaled_cycles = period_cycles * (prescale + 1); + state->period = DIV64_U64_ROUND_UP(prescaled_cycles * NSEC_PER_SEC, + nvtpwm->clkrate); + + prescaled_cycles = duty_cycles * (prescale + 1); + state->duty_cycle = + DIV64_U64_ROUND_UP(prescaled_cycles * NSEC_PER_SEC, + nvtpwm->clkrate); + + return 0; +} + +static const struct pwm_ops nuvoton_pwm_ops = { + .apply = nuvoton_pwm_apply, + .get_state = nuvoton_pwm_get_state, +}; + +static int nuvoton_pwm_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct pwm_chip *chip; + struct nuvoton_pwm *nvtpwm; + struct clk *clk; + int ret; + + chip = devm_pwmchip_alloc(dev, MA35D1_PWM_NUM_CHANNELS, + sizeof(*nvtpwm)); + if (IS_ERR(chip)) + return PTR_ERR(chip); + + nvtpwm = nuvoton_pwm_from_chip(chip); + + nvtpwm->base = devm_platform_ioremap_resource(pdev, 0); + if (IS_ERR(nvtpwm->base)) + return PTR_ERR(nvtpwm->base); + + clk = devm_clk_get_enabled(dev, NULL); + if (IS_ERR(clk)) + return dev_err_probe(dev, PTR_ERR(clk), + "Unable to get the clock\n"); + + ret = devm_clk_rate_exclusive_get(dev, clk); + if (ret) + return dev_err_probe(dev, ret, + "Unable to get exclusive clock rate\n"); + + nvtpwm->clkrate = clk_get_rate(clk); + if (!nvtpwm->clkrate) + return dev_err_probe(dev, -EINVAL, + "PWM clock rate is zero\n"); + + if (nvtpwm->clkrate > NSEC_PER_SEC) + return dev_err_probe(dev, -EINVAL, + "PWM clock out of range (%lu)\n", + nvtpwm->clkrate); + + chip->ops = &nuvoton_pwm_ops; + chip->atomic = true; + + ret = devm_pwmchip_add(dev, chip); + if (ret) + return dev_err_probe(dev, ret, "Unable to add PWM chip\n"); + + return 0; +} + +static const struct of_device_id nuvoton_pwm_of_match[] = { + { .compatible = "nuvoton,ma35d1-pwm" }, + { } +}; +MODULE_DEVICE_TABLE(of, nuvoton_pwm_of_match); + +static struct platform_driver nuvoton_pwm_driver = { + .probe = nuvoton_pwm_probe, + .driver = { + .name = "nuvoton-pwm", + .of_match_table = nuvoton_pwm_of_match, + }, +}; +module_platform_driver(nuvoton_pwm_driver); + +MODULE_AUTHOR("Chi-Wen Weng "); +MODULE_DESCRIPTION("Nuvoton MA35D1 PWM driver"); +MODULE_LICENSE("GPL"); -- 2.25.1