]> git.ipfire.org Git - thirdparty/openwrt.git/commitdiff
airoha: replace PWM patch with upstream version
authorChristian Marangi <ansuelsmth@gmail.com>
Tue, 4 Nov 2025 19:40:15 +0000 (20:40 +0100)
committerChristian Marangi <ansuelsmth@gmail.com>
Mon, 10 Nov 2025 17:20:45 +0000 (18:20 +0100)
Replace Airoha AN7581 PWM patch with upstream version and add kernel
version tag.

(cherry picked from commit 2352de96c1c2fea34d31da24f8cbfc2faf6d820a)
[ fix conflict error ]
Signed-off-by: Christian Marangi <ansuelsmth@gmail.com>
target/linux/airoha/patches-6.6/107-v6.19-pwm-airoha-Add-support-for-EN7581-SoC.patch [new file with mode: 0644]
target/linux/airoha/patches-6.6/108-pwm-airoha-Add-support-for-EN7581-SoC.patch [deleted file]

diff --git a/target/linux/airoha/patches-6.6/107-v6.19-pwm-airoha-Add-support-for-EN7581-SoC.patch b/target/linux/airoha/patches-6.6/107-v6.19-pwm-airoha-Add-support-for-EN7581-SoC.patch
new file mode 100644 (file)
index 0000000..253fa37
--- /dev/null
@@ -0,0 +1,689 @@
+From 61d7c2f94d391594de08d8a52a7c2630d2f3d263 Mon Sep 17 00:00:00 2001
+From: Benjamin Larsson <benjamin.larsson@genexis.eu>
+Date: Mon, 13 Oct 2025 12:34:03 +0200
+Subject: [PATCH] pwm: airoha: Add support for EN7581 SoC
+MIME-Version: 1.0
+Content-Type: text/plain; charset=UTF-8
+Content-Transfer-Encoding: 8bit
+
+Introduce driver for PWM module available on EN7581 SoC.
+
+Limitations:
+- Only 8 concurrent waveform generators are available for 8 combinations of
+  duty_cycle and period. Waveform generators are shared between 16 GPIO
+  pins and 17 SIPO GPIO pins.
+- Supports only normal polarity.
+- On configuration the currently running period is completed.
+- Minimum supported period is 4 ms
+- Maximum supported period is 1s
+
+Signed-off-by: Benjamin Larsson <benjamin.larsson@genexis.eu>
+Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
+Co-developed-by: Lorenzo Bianconi <lorenzo@kernel.org>
+Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org>
+Reviewed-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
+Co-developed-by: Christian Marangi <ansuelsmth@gmail.com>
+Signed-off-by: Christian Marangi <ansuelsmth@gmail.com>
+Link: https://patch.msgid.link/20251013103408.14724-1-ansuelsmth@gmail.com
+Signed-off-by: Uwe Kleine-König <ukleinek@kernel.org>
+---
+ drivers/pwm/Kconfig      |  10 +
+ drivers/pwm/Makefile     |   1 +
+ drivers/pwm/pwm-airoha.c | 622 +++++++++++++++++++++++++++++++++++++++
+ 3 files changed, 633 insertions(+)
+ create mode 100644 drivers/pwm/pwm-airoha.c
+
+--- a/drivers/pwm/Kconfig
++++ b/drivers/pwm/Kconfig
+@@ -54,6 +54,16 @@ config PWM_ADP5585
+         This option enables support for the PWM function found in the Analog
+         Devices ADP5585.
++config PWM_AIROHA
++      tristate "Airoha PWM support"
++      depends on ARCH_AIROHA || COMPILE_TEST
++      select REGMAP_MMIO
++      help
++        Generic PWM framework driver for Airoha SoC.
++
++        To compile this driver as a module, choose M here: the module
++        will be called pwm-airoha.
++
+ config PWM_APPLE
+       tristate "Apple SoC PWM support"
+       depends on ARCH_APPLE || COMPILE_TEST
+--- a/drivers/pwm/Makefile
++++ b/drivers/pwm/Makefile
+@@ -2,6 +2,7 @@
+ obj-$(CONFIG_PWM)             += core.o
+ obj-$(CONFIG_PWM_SYSFS)               += sysfs.o
+ obj-$(CONFIG_PWM_AB8500)      += pwm-ab8500.o
++obj-$(CONFIG_PWM_AIROHA)      += pwm-airoha.o
+ obj-$(CONFIG_PWM_APPLE)               += pwm-apple.o
+ obj-$(CONFIG_PWM_ATMEL)               += pwm-atmel.o
+ obj-$(CONFIG_PWM_ATMEL_HLCDC_PWM)     += pwm-atmel-hlcdc.o
+--- /dev/null
++++ b/drivers/pwm/pwm-airoha.c
+@@ -0,0 +1,622 @@
++// SPDX-License-Identifier: GPL-2.0
++/*
++ * Copyright 2022 Markus Gothe <markus.gothe@genexis.eu>
++ * Copyright 2025 Christian Marangi <ansuelsmth@gmail.com>
++ *
++ *  Limitations:
++ *  - Only 8 concurrent waveform generators are available for 8 combinations of
++ *    duty_cycle and period. Waveform generators are shared between 16 GPIO
++ *    pins and 17 SIPO GPIO pins.
++ *  - Supports only normal polarity.
++ *  - On configuration the currently running period is completed.
++ *  - Minimum supported period is 4 ms
++ *  - Maximum supported period is 1s
++ */
++
++#include <linux/array_size.h>
++#include <linux/bitfield.h>
++#include <linux/bitmap.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/iopoll.h>
++#include <linux/math64.h>
++#include <linux/mfd/syscon.h>
++#include <linux/module.h>
++#include <linux/mod_devicetable.h>
++#include <linux/platform_device.h>
++#include <linux/pwm.h>
++#include <linux/regmap.h>
++#include <linux/types.h>
++
++#define AIROHA_PWM_REG_SGPIO_LED_DATA         0x0024
++#define AIROHA_PWM_SGPIO_LED_DATA_SHIFT_FLAG  BIT(31)
++#define AIROHA_PWM_SGPIO_LED_DATA_DATA                GENMASK(16, 0)
++
++#define AIROHA_PWM_REG_SGPIO_CLK_DIVR         0x0028
++#define AIROHA_PWM_SGPIO_CLK_DIVR             GENMASK(1, 0)
++#define AIROHA_PWM_SGPIO_CLK_DIVR_32          FIELD_PREP_CONST(AIROHA_PWM_SGPIO_CLK_DIVR, 3)
++#define AIROHA_PWM_SGPIO_CLK_DIVR_16          FIELD_PREP_CONST(AIROHA_PWM_SGPIO_CLK_DIVR, 2)
++#define AIROHA_PWM_SGPIO_CLK_DIVR_8           FIELD_PREP_CONST(AIROHA_PWM_SGPIO_CLK_DIVR, 1)
++#define AIROHA_PWM_SGPIO_CLK_DIVR_4           FIELD_PREP_CONST(AIROHA_PWM_SGPIO_CLK_DIVR, 0)
++
++#define AIROHA_PWM_REG_SGPIO_CLK_DLY          0x002c
++
++#define AIROHA_PWM_REG_SIPO_FLASH_MODE_CFG    0x0030
++#define AIROHA_PWM_SERIAL_GPIO_FLASH_MODE     BIT(1)
++#define AIROHA_PWM_SERIAL_GPIO_MODE_74HC164   BIT(0)
++
++#define AIROHA_PWM_REG_GPIO_FLASH_PRD_SET(_n) (0x003c + (4 * (_n)))
++#define AIROHA_PWM_REG_GPIO_FLASH_PRD_SHIFT(_n) (16 * (_n))
++#define AIROHA_PWM_GPIO_FLASH_PRD_LOW         GENMASK(15, 8)
++#define AIROHA_PWM_GPIO_FLASH_PRD_HIGH                GENMASK(7, 0)
++
++#define AIROHA_PWM_REG_GPIO_FLASH_MAP(_n)     (0x004c + (4 * (_n)))
++#define AIROHA_PWM_REG_GPIO_FLASH_MAP_SHIFT(_n) (4 * (_n))
++#define AIROHA_PWM_GPIO_FLASH_EN              BIT(3)
++#define AIROHA_PWM_GPIO_FLASH_SET_ID          GENMASK(2, 0)
++
++/* Register map is equal to GPIO flash map */
++#define AIROHA_PWM_REG_SIPO_FLASH_MAP(_n)     (0x0054 + (4 * (_n)))
++
++#define AIROHA_PWM_REG_CYCLE_CFG_VALUE(_n)    (0x0098 + (4 * (_n)))
++#define AIROHA_PWM_REG_CYCLE_CFG_SHIFT(_n)    (8 * (_n))
++#define AIROHA_PWM_WAVE_GEN_CYCLE             GENMASK(7, 0)
++
++/* GPIO/SIPO flash map handles 8 pins in one register */
++#define AIROHA_PWM_PINS_PER_FLASH_MAP         8
++/* Cycle(Period) registers handles 4 generators in one 32-bit register */
++#define AIROHA_PWM_BUCKET_PER_CYCLE_CFG               4
++/* Flash(Duty) producer handles 2 generators in one 32-bit register */
++#define AIROHA_PWM_BUCKET_PER_FLASH_PROD      2
++
++#define AIROHA_PWM_NUM_BUCKETS                        8
++/*
++ * The first 16 GPIO pins, GPIO0-GPIO15, are mapped into 16 PWM channels, 0-15.
++ * The SIPO GPIO pins are 17 pins which are mapped into 17 PWM channels, 16-32.
++ * However, we've only got 8 concurrent waveform generators and can therefore
++ * only use up to 8 different combinations of duty cycle and period at a time.
++ */
++#define AIROHA_PWM_NUM_GPIO                   16
++#define AIROHA_PWM_NUM_SIPO                   17
++#define AIROHA_PWM_MAX_CHANNELS                       (AIROHA_PWM_NUM_GPIO + AIROHA_PWM_NUM_SIPO)
++
++struct airoha_pwm_bucket {
++      /* Concurrent access protected by PWM core */
++      int used;
++      u32 period_ticks;
++      u32 duty_ticks;
++};
++
++struct airoha_pwm {
++      struct regmap *regmap;
++
++      DECLARE_BITMAP(initialized, AIROHA_PWM_MAX_CHANNELS);
++
++      struct airoha_pwm_bucket buckets[AIROHA_PWM_NUM_BUCKETS];
++
++      /* Cache bucket used by each pwm channel */
++      u8 channel_bucket[AIROHA_PWM_MAX_CHANNELS];
++};
++
++/* The PWM hardware supports periods between 4 ms and 1 s */
++#define AIROHA_PWM_PERIOD_TICK_NS     (4 * NSEC_PER_MSEC)
++#define AIROHA_PWM_PERIOD_MAX_NS      (1 * NSEC_PER_SEC)
++/* It is represented internally as 1/250 s between 1 and 250. Unit is ticks. */
++#define AIROHA_PWM_PERIOD_MIN         1
++#define AIROHA_PWM_PERIOD_MAX         250
++/* Duty cycle is relative with 255 corresponding to 100% */
++#define AIROHA_PWM_DUTY_FULL          255
++
++static void airoha_pwm_get_flash_map_addr_and_shift(unsigned int hwpwm,
++                                                  u32 *addr, u32 *shift)
++{
++      unsigned int offset, hwpwm_bit;
++
++      if (hwpwm >= AIROHA_PWM_NUM_GPIO) {
++              unsigned int sipohwpwm = hwpwm - AIROHA_PWM_NUM_GPIO;
++
++              offset = sipohwpwm / AIROHA_PWM_PINS_PER_FLASH_MAP;
++              hwpwm_bit = sipohwpwm % AIROHA_PWM_PINS_PER_FLASH_MAP;
++
++              /* One FLASH_MAP register handles 8 pins */
++              *shift = AIROHA_PWM_REG_GPIO_FLASH_MAP_SHIFT(hwpwm_bit);
++              *addr = AIROHA_PWM_REG_SIPO_FLASH_MAP(offset);
++      } else {
++              offset = hwpwm / AIROHA_PWM_PINS_PER_FLASH_MAP;
++              hwpwm_bit = hwpwm % AIROHA_PWM_PINS_PER_FLASH_MAP;
++
++              /* One FLASH_MAP register handles 8 pins */
++              *shift = AIROHA_PWM_REG_GPIO_FLASH_MAP_SHIFT(hwpwm_bit);
++              *addr = AIROHA_PWM_REG_GPIO_FLASH_MAP(offset);
++      }
++}
++
++static u32 airoha_pwm_get_period_ticks_from_ns(u32 period_ns)
++{
++      return period_ns / AIROHA_PWM_PERIOD_TICK_NS;
++}
++
++static u32 airoha_pwm_get_duty_ticks_from_ns(u32 period_ns, u32 duty_ns)
++{
++      return mul_u64_u32_div(duty_ns, AIROHA_PWM_DUTY_FULL, period_ns);
++}
++
++static u32 airoha_pwm_get_period_ns_from_ticks(u32 period_tick)
++{
++      return period_tick * AIROHA_PWM_PERIOD_TICK_NS;
++}
++
++static u32 airoha_pwm_get_duty_ns_from_ticks(u32 period_tick, u32 duty_tick)
++{
++      u32 period_ns = period_tick * AIROHA_PWM_PERIOD_TICK_NS;
++
++      /*
++       * Overflow can't occur in multiplication as duty_tick is just 8 bit
++       * and period_ns is clamped to AIROHA_PWM_PERIOD_MAX_NS and fit in a
++       * u64.
++       */
++      return DIV_U64_ROUND_UP(duty_tick * period_ns, AIROHA_PWM_DUTY_FULL);
++}
++
++static int airoha_pwm_get_bucket(struct airoha_pwm *pc, int bucket,
++                               u64 *period_ns, u64 *duty_ns)
++{
++      struct regmap *map = pc->regmap;
++      u32 period_tick, duty_tick;
++      unsigned int offset;
++      u32 shift, val;
++      int ret;
++
++      offset = bucket / AIROHA_PWM_BUCKET_PER_CYCLE_CFG;
++      shift = bucket % AIROHA_PWM_BUCKET_PER_CYCLE_CFG;
++      shift = AIROHA_PWM_REG_CYCLE_CFG_SHIFT(shift);
++
++      ret = regmap_read(map, AIROHA_PWM_REG_CYCLE_CFG_VALUE(offset), &val);
++      if (ret)
++              return ret;
++
++      period_tick = FIELD_GET(AIROHA_PWM_WAVE_GEN_CYCLE, val >> shift);
++      *period_ns = airoha_pwm_get_period_ns_from_ticks(period_tick);
++
++      offset = bucket / AIROHA_PWM_BUCKET_PER_FLASH_PROD;
++      shift = bucket % AIROHA_PWM_BUCKET_PER_FLASH_PROD;
++      shift = AIROHA_PWM_REG_GPIO_FLASH_PRD_SHIFT(shift);
++
++      ret = regmap_read(map, AIROHA_PWM_REG_GPIO_FLASH_PRD_SET(offset),
++                        &val);
++      if (ret)
++              return ret;
++
++      duty_tick = FIELD_GET(AIROHA_PWM_GPIO_FLASH_PRD_HIGH, val >> shift);
++      *duty_ns = airoha_pwm_get_duty_ns_from_ticks(period_tick, duty_tick);
++
++      return 0;
++}
++
++static int airoha_pwm_get_generator(struct airoha_pwm *pc, u32 duty_ticks,
++                                  u32 period_ticks)
++{
++      int best = -ENOENT, unused = -ENOENT;
++      u32 duty_ns, best_duty_ns = 0;
++      u32 best_period_ticks = 0;
++      unsigned int i;
++
++      duty_ns = airoha_pwm_get_duty_ns_from_ticks(period_ticks, duty_ticks);
++
++      for (i = 0; i < ARRAY_SIZE(pc->buckets); i++) {
++              struct airoha_pwm_bucket *bucket = &pc->buckets[i];
++              u32 bucket_period_ticks = bucket->period_ticks;
++              u32 bucket_duty_ticks = bucket->duty_ticks;
++
++              /* If found, save an unused bucket to return it later */
++              if (!bucket->used) {
++                      unused = i;
++                      continue;
++              }
++
++              /* We found a matching bucket, exit early */
++              if (duty_ticks == bucket_duty_ticks &&
++                  period_ticks == bucket_period_ticks)
++                      return i;
++
++              /*
++               * Unlike duty cycle zero, which can be handled by
++               * disabling PWM, a generator is needed for full duty
++               * cycle but it can be reused regardless of period
++               */
++              if (duty_ticks == AIROHA_PWM_DUTY_FULL &&
++                  bucket_duty_ticks == AIROHA_PWM_DUTY_FULL)
++                      return i;
++
++              /*
++               * With an unused bucket available, skip searching for
++               * a bucket to recycle (closer to the requested period/duty)
++               */
++              if (unused >= 0)
++                      continue;
++
++              /* Ignore bucket with invalid period */
++              if (bucket_period_ticks > period_ticks)
++                      continue;
++
++              /*
++               * Search for a bucket closer to the requested period
++               * that has the maximal possible period that isn't bigger
++               * than the requested period. For that period pick the maximal
++               * duty cycle that isn't bigger than the requested duty_cycle.
++               */
++              if (bucket_period_ticks >= best_period_ticks) {
++                      u32 bucket_duty_ns = airoha_pwm_get_duty_ns_from_ticks(bucket_period_ticks,
++                                                                             bucket_duty_ticks);
++
++                      /* Skip bucket that goes over the requested duty */
++                      if (bucket_duty_ns > duty_ns)
++                              continue;
++
++                      if (bucket_duty_ns > best_duty_ns) {
++                              best_period_ticks = bucket_period_ticks;
++                              best_duty_ns = bucket_duty_ns;
++                              best = i;
++                      }
++              }
++      }
++
++      /* Return an unused bucket or the best one found (if ever) */
++      return unused >= 0 ? unused : best;
++}
++
++static void airoha_pwm_release_bucket_config(struct airoha_pwm *pc,
++                                           unsigned int hwpwm)
++{
++      int bucket;
++
++      /* Nothing to clear, PWM channel never used */
++      if (!test_bit(hwpwm, pc->initialized))
++              return;
++
++      bucket = pc->channel_bucket[hwpwm];
++      pc->buckets[bucket].used--;
++}
++
++static int airoha_pwm_apply_bucket_config(struct airoha_pwm *pc, unsigned int bucket,
++                                        u32 duty_ticks, u32 period_ticks)
++{
++      u32 mask, shift, val;
++      u32 offset;
++      int ret;
++
++      offset = bucket / AIROHA_PWM_BUCKET_PER_CYCLE_CFG;
++      shift = bucket % AIROHA_PWM_BUCKET_PER_CYCLE_CFG;
++      shift = AIROHA_PWM_REG_CYCLE_CFG_SHIFT(shift);
++
++      /* Configure frequency divisor */
++      mask = AIROHA_PWM_WAVE_GEN_CYCLE << shift;
++      val = FIELD_PREP(AIROHA_PWM_WAVE_GEN_CYCLE, period_ticks) << shift;
++      ret = regmap_update_bits(pc->regmap, AIROHA_PWM_REG_CYCLE_CFG_VALUE(offset),
++                               mask, val);
++      if (ret)
++              return ret;
++
++      offset = bucket / AIROHA_PWM_BUCKET_PER_FLASH_PROD;
++      shift = bucket % AIROHA_PWM_BUCKET_PER_FLASH_PROD;
++      shift = AIROHA_PWM_REG_GPIO_FLASH_PRD_SHIFT(shift);
++
++      /* Configure duty cycle */
++      mask = AIROHA_PWM_GPIO_FLASH_PRD_HIGH << shift;
++      val = FIELD_PREP(AIROHA_PWM_GPIO_FLASH_PRD_HIGH, duty_ticks) << shift;
++      ret = regmap_update_bits(pc->regmap, AIROHA_PWM_REG_GPIO_FLASH_PRD_SET(offset),
++                               mask, val);
++      if (ret)
++              return ret;
++
++      mask = AIROHA_PWM_GPIO_FLASH_PRD_LOW << shift;
++      val = FIELD_PREP(AIROHA_PWM_GPIO_FLASH_PRD_LOW,
++                       AIROHA_PWM_DUTY_FULL - duty_ticks) << shift;
++      return regmap_update_bits(pc->regmap, AIROHA_PWM_REG_GPIO_FLASH_PRD_SET(offset),
++                                mask, val);
++}
++
++static int airoha_pwm_consume_generator(struct airoha_pwm *pc,
++                                      u32 duty_ticks, u32 period_ticks,
++                                      unsigned int hwpwm)
++{
++      bool config_bucket = false;
++      int bucket, ret;
++
++      /*
++       * Search for a bucket that already satisfies duty and period
++       * or an unused one.
++       * If not found, -ENOENT is returned.
++       */
++      bucket = airoha_pwm_get_generator(pc, duty_ticks, period_ticks);
++      if (bucket < 0)
++              return bucket;
++
++      /* Release previous used bucket (if any) */
++      airoha_pwm_release_bucket_config(pc, hwpwm);
++
++      if (!pc->buckets[bucket].used)
++              config_bucket = true;
++      pc->buckets[bucket].used++;
++
++      if (config_bucket) {
++              pc->buckets[bucket].period_ticks = period_ticks;
++              pc->buckets[bucket].duty_ticks = duty_ticks;
++              ret = airoha_pwm_apply_bucket_config(pc, bucket,
++                                                   duty_ticks,
++                                                   period_ticks);
++              if (ret) {
++                      pc->buckets[bucket].used--;
++                      return ret;
++              }
++      }
++
++      return bucket;
++}
++
++static int airoha_pwm_sipo_init(struct airoha_pwm *pc)
++{
++      u32 val;
++      int ret;
++
++      ret = regmap_clear_bits(pc->regmap, AIROHA_PWM_REG_SIPO_FLASH_MODE_CFG,
++                              AIROHA_PWM_SERIAL_GPIO_MODE_74HC164);
++      if (ret)
++              return ret;
++
++      /* Configure shift register chip clock timings, use 32x divisor */
++      ret = regmap_write(pc->regmap, AIROHA_PWM_REG_SGPIO_CLK_DIVR,
++                         AIROHA_PWM_SGPIO_CLK_DIVR_32);
++      if (ret)
++              return ret;
++
++      /*
++       * Configure the shift register chip clock delay. This needs
++       * to be configured based on the chip characteristics when the SoC
++       * apply the shift register configuration.
++       * This doesn't affect actual PWM operation and is only specific to
++       * the shift register chip.
++       *
++       * For 74HC164 we set it to 0.
++       *
++       * For reference, the actual delay applied is the internal clock
++       * feed to the SGPIO chip + 1.
++       *
++       * From documentation is specified that clock delay should not be
++       * greater than (AIROHA_PWM_REG_SGPIO_CLK_DIVR / 2) - 1.
++       */
++      ret = regmap_write(pc->regmap, AIROHA_PWM_REG_SGPIO_CLK_DLY, 0);
++      if (ret)
++              return ret;
++
++      /*
++       * It is necessary to explicitly shift out all zeros after muxing
++       * to initialize the shift register before enabling PWM
++       * mode because in PWM mode SIPO will not start shifting until
++       * it needs to output a non-zero value (bit 31 of led_data
++       * indicates shifting in progress and it must return to zero
++       * before led_data can be written or PWM mode can be set).
++       */
++      ret = regmap_read_poll_timeout(pc->regmap, AIROHA_PWM_REG_SGPIO_LED_DATA, val,
++                                     !(val & AIROHA_PWM_SGPIO_LED_DATA_SHIFT_FLAG),
++                                     10, 200 * USEC_PER_MSEC);
++      if (ret)
++              return ret;
++
++      ret = regmap_clear_bits(pc->regmap, AIROHA_PWM_REG_SGPIO_LED_DATA,
++                              AIROHA_PWM_SGPIO_LED_DATA_DATA);
++      if (ret)
++              return ret;
++      ret = regmap_read_poll_timeout(pc->regmap, AIROHA_PWM_REG_SGPIO_LED_DATA, val,
++                                     !(val & AIROHA_PWM_SGPIO_LED_DATA_SHIFT_FLAG),
++                                     10, 200 * USEC_PER_MSEC);
++      if (ret)
++              return ret;
++
++      /* Set SIPO in PWM mode */
++      return regmap_set_bits(pc->regmap, AIROHA_PWM_REG_SIPO_FLASH_MODE_CFG,
++                             AIROHA_PWM_SERIAL_GPIO_FLASH_MODE);
++}
++
++static int airoha_pwm_config_flash_map(struct airoha_pwm *pc,
++                                     unsigned int hwpwm, int index)
++{
++      unsigned int addr;
++      u32 shift;
++      int ret;
++
++      airoha_pwm_get_flash_map_addr_and_shift(hwpwm, &addr, &shift);
++
++      /* negative index means disable PWM channel */
++      if (index < 0) {
++              /*
++               * If we need to disable the PWM, we just put low the
++               * GPIO. No need to setup buckets.
++               */
++              return regmap_clear_bits(pc->regmap, addr,
++                                       AIROHA_PWM_GPIO_FLASH_EN << shift);
++      }
++
++      ret = regmap_update_bits(pc->regmap, addr,
++                               AIROHA_PWM_GPIO_FLASH_SET_ID << shift,
++                               FIELD_PREP(AIROHA_PWM_GPIO_FLASH_SET_ID, index) << shift);
++      if (ret)
++              return ret;
++
++      return regmap_set_bits(pc->regmap, addr, AIROHA_PWM_GPIO_FLASH_EN << shift);
++}
++
++static int airoha_pwm_config(struct airoha_pwm *pc, struct pwm_device *pwm,
++                           u32 period_ticks, u32 duty_ticks)
++{
++      unsigned int hwpwm = pwm->hwpwm;
++      int bucket, ret;
++
++      bucket = airoha_pwm_consume_generator(pc, duty_ticks, period_ticks,
++                                            hwpwm);
++      if (bucket < 0)
++              return bucket;
++
++      ret = airoha_pwm_config_flash_map(pc, hwpwm, bucket);
++      if (ret) {
++              pc->buckets[bucket].used--;
++              return ret;
++      }
++
++      __set_bit(hwpwm, pc->initialized);
++      pc->channel_bucket[hwpwm] = bucket;
++
++      /*
++       * SIPO are special GPIO attached to a shift register chip. The handling
++       * of this chip is internal to the SoC that takes care of applying the
++       * values based on the flash map. To apply a new flash map, it's needed
++       * to trigger a refresh on the shift register chip.
++       * If a SIPO is getting configuring , always reinit the shift register
++       * chip to make sure the correct flash map is applied.
++       * Skip reconfiguring the shift register if the related hwpwm
++       * is disabled (as it doesn't need to be mapped).
++       */
++      if (hwpwm >= AIROHA_PWM_NUM_GPIO) {
++              ret = airoha_pwm_sipo_init(pc);
++              if (ret) {
++                      airoha_pwm_release_bucket_config(pc, hwpwm);
++                      return ret;
++              }
++      }
++
++      return 0;
++}
++
++static void airoha_pwm_disable(struct airoha_pwm *pc, struct pwm_device *pwm)
++{
++      /* Disable PWM and release the bucket */
++      airoha_pwm_config_flash_map(pc, pwm->hwpwm, -1);
++      airoha_pwm_release_bucket_config(pc, pwm->hwpwm);
++
++      __clear_bit(pwm->hwpwm, pc->initialized);
++
++      /* If no SIPO is used, disable the shift register chip */
++      if (!bitmap_read(pc->initialized,
++                       AIROHA_PWM_NUM_GPIO, AIROHA_PWM_NUM_SIPO))
++              regmap_clear_bits(pc->regmap, AIROHA_PWM_REG_SIPO_FLASH_MODE_CFG,
++                                AIROHA_PWM_SERIAL_GPIO_FLASH_MODE);
++}
++
++static int airoha_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm,
++                          const struct pwm_state *state)
++{
++      struct airoha_pwm *pc = pwmchip_get_drvdata(chip);
++      u32 period_ticks, duty_ticks;
++      u32 period_ns, duty_ns;
++
++      if (!state->enabled) {
++              airoha_pwm_disable(pc, pwm);
++              return 0;
++      }
++
++      /* Only normal polarity is supported */
++      if (state->polarity == PWM_POLARITY_INVERSED)
++              return -EINVAL;
++
++      /* Exit early if period is less than minimum supported */
++      if (state->period < AIROHA_PWM_PERIOD_TICK_NS)
++              return -EINVAL;
++
++      /* Clamp period to MAX supported value */
++      if (state->period > AIROHA_PWM_PERIOD_MAX_NS)
++              period_ns = AIROHA_PWM_PERIOD_MAX_NS;
++      else
++              period_ns = state->period;
++
++      /* Validate duty to configured period */
++      if (state->duty_cycle > period_ns)
++              duty_ns = period_ns;
++      else
++              duty_ns = state->duty_cycle;
++
++      /* Convert period ns to ticks */
++      period_ticks = airoha_pwm_get_period_ticks_from_ns(period_ns);
++      /* Convert period ticks to ns again for cosistent duty tick calculation */
++      period_ns = airoha_pwm_get_period_ns_from_ticks(period_ticks);
++      duty_ticks = airoha_pwm_get_duty_ticks_from_ns(period_ns, duty_ns);
++
++      return airoha_pwm_config(pc, pwm, period_ticks, duty_ticks);
++}
++
++static int airoha_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm,
++                              struct pwm_state *state)
++{
++      struct airoha_pwm *pc = pwmchip_get_drvdata(chip);
++      int ret, hwpwm = pwm->hwpwm;
++      u32 addr, shift, val;
++      u8 bucket;
++
++      airoha_pwm_get_flash_map_addr_and_shift(hwpwm, &addr, &shift);
++
++      ret = regmap_read(pc->regmap, addr, &val);
++      if (ret)
++              return ret;
++
++      state->enabled = FIELD_GET(AIROHA_PWM_GPIO_FLASH_EN, val >> shift);
++      if (!state->enabled)
++              return 0;
++
++      state->polarity = PWM_POLARITY_NORMAL;
++
++      bucket = FIELD_GET(AIROHA_PWM_GPIO_FLASH_SET_ID, val >> shift);
++      return airoha_pwm_get_bucket(pc, bucket, &state->period,
++                                   &state->duty_cycle);
++}
++
++static const struct pwm_ops airoha_pwm_ops = {
++      .apply = airoha_pwm_apply,
++      .get_state = airoha_pwm_get_state,
++};
++
++static int airoha_pwm_probe(struct platform_device *pdev)
++{
++      struct device *dev = &pdev->dev;
++      struct airoha_pwm *pc;
++      struct pwm_chip *chip;
++      int ret;
++
++      chip = devm_pwmchip_alloc(dev, AIROHA_PWM_MAX_CHANNELS, sizeof(*pc));
++      if (IS_ERR(chip))
++              return PTR_ERR(chip);
++
++      chip->ops = &airoha_pwm_ops;
++      pc = pwmchip_get_drvdata(chip);
++
++      pc->regmap = device_node_to_regmap(dev_of_node(dev->parent));
++      if (IS_ERR(pc->regmap))
++              return dev_err_probe(dev, PTR_ERR(pc->regmap), "Failed to get PWM regmap\n");
++
++      ret = devm_pwmchip_add(dev, chip);
++      if (ret)
++              return dev_err_probe(dev, ret, "Failed to add PWM chip\n");
++
++      return 0;
++}
++
++static const struct of_device_id airoha_pwm_of_match[] = {
++      { .compatible = "airoha,en7581-pwm" },
++      { /* sentinel */ }
++};
++MODULE_DEVICE_TABLE(of, airoha_pwm_of_match);
++
++static struct platform_driver airoha_pwm_driver = {
++      .driver = {
++              .name = "pwm-airoha",
++              .probe_type = PROBE_PREFER_ASYNCHRONOUS,
++              .of_match_table = airoha_pwm_of_match,
++      },
++      .probe = airoha_pwm_probe,
++};
++module_platform_driver(airoha_pwm_driver);
++
++MODULE_AUTHOR("Lorenzo Bianconi <lorenzo@kernel.org>");
++MODULE_AUTHOR("Markus Gothe <markus.gothe@genexis.eu>");
++MODULE_AUTHOR("Benjamin Larsson <benjamin.larsson@genexis.eu>");
++MODULE_AUTHOR("Christian Marangi <ansuelsmth@gmail.com>");
++MODULE_DESCRIPTION("Airoha EN7581 PWM driver");
++MODULE_LICENSE("GPL");
diff --git a/target/linux/airoha/patches-6.6/108-pwm-airoha-Add-support-for-EN7581-SoC.patch b/target/linux/airoha/patches-6.6/108-pwm-airoha-Add-support-for-EN7581-SoC.patch
deleted file mode 100644 (file)
index 0b114d5..0000000
+++ /dev/null
@@ -1,439 +0,0 @@
-From 97e4e7b106b08373f90ff1b8c4daf6c2254386a8 Mon Sep 17 00:00:00 2001
-From: Benjamin Larsson <benjamin.larsson@genexis.eu>
-Date: Wed, 23 Oct 2024 01:20:06 +0200
-Subject: [PATCH] pwm: airoha: Add support for EN7581 SoC
-
-Introduce driver for PWM module available on EN7581 SoC.
-
-Signed-off-by: Benjamin Larsson <benjamin.larsson@genexis.eu>
-Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
-Co-developed-by: Lorenzo Bianconi <lorenzo@kernel.org>
-Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org>
----
- drivers/pwm/Kconfig      |  11 ++
- drivers/pwm/Makefile     |   1 +
- drivers/pwm/pwm-airoha.c | 386 +++++++++++++++++++++++++++++++++++++++
- 3 files changed, 398 insertions(+)
- create mode 100644 drivers/pwm/pwm-airoha.c
-
---- a/drivers/pwm/Kconfig
-+++ b/drivers/pwm/Kconfig
-@@ -51,6 +51,17 @@ config PWM_AB8500
-         To compile this driver as a module, choose M here: the module
-         will be called pwm-ab8500.
-+config PWM_AIROHA
-+      tristate "Airoha PWM support"
-+      depends on ARCH_AIROHA || COMPILE_TEST
-+      depends on OF
-+      select REGMAP_MMIO
-+      help
-+        Generic PWM framework driver for Airoha SoC.
-+
-+        To compile this driver as a module, choose M here: the module
-+        will be called pwm-airoha.
-+
- config PWM_APPLE
-       tristate "Apple SoC PWM support"
-       depends on ARCH_APPLE || COMPILE_TEST
---- a/drivers/pwm/Makefile
-+++ b/drivers/pwm/Makefile
-@@ -2,6 +2,7 @@
- obj-$(CONFIG_PWM)             += core.o
- obj-$(CONFIG_PWM_SYSFS)               += sysfs.o
- obj-$(CONFIG_PWM_AB8500)      += pwm-ab8500.o
-+obj-$(CONFIG_PWM_AIROHA)      += pwm-airoha.o
- obj-$(CONFIG_PWM_APPLE)               += pwm-apple.o
- obj-$(CONFIG_PWM_ATMEL)               += pwm-atmel.o
- obj-$(CONFIG_PWM_ATMEL_HLCDC_PWM)     += pwm-atmel-hlcdc.o
---- /dev/null
-+++ b/drivers/pwm/pwm-airoha.c
-@@ -0,0 +1,388 @@
-+// SPDX-License-Identifier: GPL-2.0
-+/*
-+ * Copyright 2022 Markus Gothe <markus.gothe@genexis.eu>
-+ *
-+ *  Limitations:
-+ *  - No disable bit, so a disabled PWM is simulated by setting duty_cycle to 0
-+ *  - Only 8 concurrent waveform generators are available for 8 combinations of
-+ *    duty_cycle and period. Waveform generators are shared between 16 GPIO
-+ *    pins and 17 SIPO GPIO pins.
-+ *  - Supports only normal polarity.
-+ *  - On configuration the currently running period is completed.
-+ */
-+
-+#include <linux/bitfield.h>
-+#include <linux/err.h>
-+#include <linux/io.h>
-+#include <linux/iopoll.h>
-+#include <linux/mfd/syscon.h>
-+#include <linux/module.h>
-+#include <linux/of.h>
-+#include <linux/platform_device.h>
-+#include <linux/pwm.h>
-+#include <linux/gpio.h>
-+#include <linux/bitops.h>
-+#include <linux/regmap.h>
-+#include <asm/div64.h>
-+
-+#define REG_SGPIO_LED_DATA            0x0024
-+#define SGPIO_LED_DATA_SHIFT_FLAG     BIT(31)
-+#define SGPIO_LED_DATA_DATA           GENMASK(16, 0)
-+
-+#define REG_SGPIO_CLK_DIVR            0x0028
-+#define REG_SGPIO_CLK_DIVR_MASK               GENMASK(1, 0)
-+#define REG_SGPIO_CLK_DLY             0x002c
-+
-+#define REG_SIPO_FLASH_MODE_CFG               0x0030
-+#define SERIAL_GPIO_FLASH_MODE                BIT(1)
-+#define SERIAL_GPIO_MODE_74HC164      BIT(0)
-+
-+#define REG_GPIO_FLASH_PRD_SET(_n)    (0x003c + ((_n) << 2))
-+#define GPIO_FLASH_PRD_MASK(_n)               GENMASK(15 + ((_n) << 4), ((_n) << 4))
-+
-+#define REG_GPIO_FLASH_MAP(_n)                (0x004c + ((_n) << 2))
-+#define GPIO_FLASH_SETID_MASK(_n)     GENMASK(2 + ((_n) << 2), ((_n) << 2))
-+#define GPIO_FLASH_EN(_n)             BIT(3 + ((_n) << 2))
-+
-+#define REG_SIPO_FLASH_MAP(_n)                (0x0054 + ((_n) << 2))
-+
-+#define REG_CYCLE_CFG_VALUE(_n)               (0x0098 + ((_n) << 2))
-+#define WAVE_GEN_CYCLE_MASK(_n)               GENMASK(7 + ((_n) << 3), ((_n) << 3))
-+
-+#define PWM_NUM_BUCKETS                       8
-+
-+struct airoha_pwm_bucket {
-+      /* Bitmask of PWM channels using this bucket */
-+      u64 used;
-+      u64 period_ns;
-+      u64 duty_ns;
-+};
-+
-+struct airoha_pwm {
-+      struct pwm_chip chip;
-+
-+      struct regmap *regmap;
-+
-+      struct device_node *np;
-+      u64 initialized;
-+
-+      struct airoha_pwm_bucket bucket[PWM_NUM_BUCKETS];
-+};
-+
-+/*
-+ * The first 16 GPIO pins, GPIO0-GPIO15, are mapped into 16 PWM channels, 0-15.
-+ * The SIPO GPIO pins are 17 pins which are mapped into 17 PWM channels, 16-32.
-+ * However, we've only got 8 concurrent waveform generators and can therefore
-+ * only use up to 8 different combinations of duty cycle and period at a time.
-+ */
-+#define PWM_NUM_GPIO  16
-+#define PWM_NUM_SIPO  17
-+
-+/* The PWM hardware supports periods between 4 ms and 1 s */
-+#define PERIOD_MIN_NS (4 * NSEC_PER_MSEC)
-+#define PERIOD_MAX_NS (1 * NSEC_PER_SEC)
-+/* It is represented internally as 1/250 s between 1 and 250 */
-+#define PERIOD_MIN    1
-+#define PERIOD_MAX    250
-+/* Duty cycle is relative with 255 corresponding to 100% */
-+#define DUTY_FULL     255
-+
-+static int airoha_pwm_get_generator(struct airoha_pwm *pc, u64 duty_ns,
-+                                  u64 period_ns)
-+{
-+      int i;
-+
-+      for (i = 0; i < ARRAY_SIZE(pc->bucket); i++) {
-+              if (!pc->bucket[i].used)
-+                      continue;
-+
-+              if (duty_ns == pc->bucket[i].duty_ns &&
-+                  period_ns == pc->bucket[i].period_ns)
-+                      return i;
-+
-+              /*
-+               * Unlike duty cycle zero, which can be handled by
-+               * disabling PWM, a generator is needed for full duty
-+               * cycle but it can be reused regardless of period
-+               */
-+              if (duty_ns == DUTY_FULL && pc->bucket[i].duty_ns == DUTY_FULL)
-+                      return i;
-+      }
-+
-+      return -1;
-+}
-+
-+static void airoha_pwm_release_bucket_config(struct airoha_pwm *pc,
-+                                           unsigned int hwpwm)
-+{
-+      int i;
-+
-+      for (i = 0; i < ARRAY_SIZE(pc->bucket); i++)
-+              pc->bucket[i].used &= ~BIT_ULL(hwpwm);
-+}
-+
-+static int airoha_pwm_consume_generator(struct airoha_pwm *pc,
-+                                      u64 duty_ns, u64 period_ns,
-+                                      unsigned int hwpwm)
-+{
-+      int id = airoha_pwm_get_generator(pc, duty_ns, period_ns);
-+
-+      if (id < 0) {
-+              int i;
-+
-+              /* find an unused waveform generator */
-+              for (i = 0; i < ARRAY_SIZE(pc->bucket); i++) {
-+                      if (!(pc->bucket[i].used & ~BIT_ULL(hwpwm))) {
-+                              id = i;
-+                              break;
-+                      }
-+              }
-+      }
-+
-+      if (id >= 0) {
-+              airoha_pwm_release_bucket_config(pc, hwpwm);
-+              pc->bucket[id].used |= BIT_ULL(hwpwm);
-+              pc->bucket[id].period_ns = period_ns;
-+              pc->bucket[id].duty_ns = duty_ns;
-+      }
-+
-+      return id;
-+}
-+
-+static int airoha_pwm_sipo_init(struct airoha_pwm *pc)
-+{
-+      u32 val;
-+
-+      if (!(pc->initialized >> PWM_NUM_GPIO))
-+              return 0;
-+
-+      regmap_clear_bits(pc->regmap, REG_SIPO_FLASH_MODE_CFG,
-+                        SERIAL_GPIO_MODE_74HC164);
-+
-+      /* Configure shift register timings, use 32x divisor */
-+      regmap_write(pc->regmap, REG_SGPIO_CLK_DIVR,
-+                   FIELD_PREP(REG_SGPIO_CLK_DIVR_MASK, 0x3));
-+
-+      /*
-+       * The actual delay is clock + 1.
-+       * Notice that clock delay should not be greater
-+       * than (divisor / 2) - 1.
-+       * Set to 0 by default. (aka 1)
-+       */
-+      regmap_write(pc->regmap, REG_SGPIO_CLK_DLY, 0x0);
-+
-+      /*
-+       * It it necessary to after muxing explicitly shift out all
-+       * zeroes to initialize the shift register before enabling PWM
-+       * mode because in PWM mode SIPO will not start shifting until
-+       * it needs to output a non-zero value (bit 31 of led_data
-+       * indicates shifting in progress and it must return to zero
-+       * before led_data can be written or PWM mode can be set)
-+       */
-+      if (regmap_read_poll_timeout(pc->regmap, REG_SGPIO_LED_DATA, val,
-+                                   !(val & SGPIO_LED_DATA_SHIFT_FLAG), 10,
-+                                   200 * USEC_PER_MSEC))
-+              return -ETIMEDOUT;
-+
-+      regmap_clear_bits(pc->regmap, REG_SGPIO_LED_DATA, SGPIO_LED_DATA_DATA);
-+      if (regmap_read_poll_timeout(pc->regmap, REG_SGPIO_LED_DATA, val,
-+                                   !(val & SGPIO_LED_DATA_SHIFT_FLAG), 10,
-+                                   200 * USEC_PER_MSEC))
-+              return -ETIMEDOUT;
-+
-+      /* Set SIPO in PWM mode */
-+      regmap_set_bits(pc->regmap, REG_SIPO_FLASH_MODE_CFG,
-+                      SERIAL_GPIO_FLASH_MODE);
-+
-+      return 0;
-+}
-+
-+static void airoha_pwm_calc_bucket_config(struct airoha_pwm *pc, int index,
-+                                        u64 duty_ns, u64 period_ns)
-+{
-+      u32 period, duty, mask, val;
-+      u64 tmp;
-+
-+      tmp = duty_ns * DUTY_FULL;
-+      duty = clamp_val(div64_u64(tmp, period_ns), 0, DUTY_FULL);
-+      tmp = period_ns * 25;
-+      period = clamp_val(div64_u64(tmp, 100000000), PERIOD_MIN, PERIOD_MAX);
-+
-+      /* Configure frequency divisor */
-+      mask = WAVE_GEN_CYCLE_MASK(index % 4);
-+      val = (period << __ffs(mask)) & mask;
-+      regmap_update_bits(pc->regmap, REG_CYCLE_CFG_VALUE(index / 4),
-+                         mask, val);
-+
-+      /* Configure duty cycle */
-+      duty = ((DUTY_FULL - duty) << 8) | duty;
-+      mask = GPIO_FLASH_PRD_MASK(index % 2);
-+      val = (duty << __ffs(mask)) & mask;
-+      regmap_update_bits(pc->regmap, REG_GPIO_FLASH_PRD_SET(index / 2),
-+                         mask, val);
-+}
-+
-+static void airoha_pwm_config_flash_map(struct airoha_pwm *pc,
-+                                      unsigned int hwpwm, int index)
-+{
-+      u32 addr, mask, val;
-+
-+      if (hwpwm < PWM_NUM_GPIO) {
-+              addr = REG_GPIO_FLASH_MAP(hwpwm / 8);
-+      } else {
-+              addr = REG_SIPO_FLASH_MAP(hwpwm / 8);
-+              hwpwm -= PWM_NUM_GPIO;
-+      }
-+
-+      if (index < 0) {
-+              /*
-+               * Change of waveform takes effect immediately but
-+               * disabling has some delay so to prevent glitching
-+               * only the enable bit is touched when disabling
-+               */
-+              regmap_clear_bits(pc->regmap, addr, GPIO_FLASH_EN(hwpwm % 8));
-+              return;
-+      }
-+
-+      mask = GPIO_FLASH_SETID_MASK(hwpwm % 8);
-+      val = ((index & 7) << __ffs(mask)) & mask;
-+      regmap_update_bits(pc->regmap, addr, mask, val);
-+      regmap_set_bits(pc->regmap, addr, GPIO_FLASH_EN(hwpwm % 8));
-+}
-+
-+static int airoha_pwm_config(struct airoha_pwm *pc, struct pwm_device *pwm,
-+                           u64 duty_ns, u64 period_ns)
-+{
-+      int index = -1;
-+
-+      index = airoha_pwm_consume_generator(pc, duty_ns, period_ns,
-+                                           pwm->hwpwm);
-+      if (index < 0)
-+              return -EBUSY;
-+
-+      if (!(pc->initialized & BIT_ULL(pwm->hwpwm)) &&
-+          pwm->hwpwm >= PWM_NUM_GPIO)
-+              airoha_pwm_sipo_init(pc);
-+
-+      if (index >= 0) {
-+              airoha_pwm_calc_bucket_config(pc, index, duty_ns, period_ns);
-+              airoha_pwm_config_flash_map(pc, pwm->hwpwm, index);
-+      } else {
-+              airoha_pwm_config_flash_map(pc, pwm->hwpwm, index);
-+              airoha_pwm_release_bucket_config(pc, pwm->hwpwm);
-+      }
-+
-+      pc->initialized |= BIT_ULL(pwm->hwpwm);
-+
-+      return 0;
-+}
-+
-+static void airoha_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm)
-+{
-+      struct airoha_pwm *pc = container_of(chip, struct airoha_pwm, chip);
-+
-+      /* Disable PWM and release the waveform */
-+      airoha_pwm_config_flash_map(pc, pwm->hwpwm, -1);
-+      airoha_pwm_release_bucket_config(pc, pwm->hwpwm);
-+
-+      pc->initialized &= ~BIT_ULL(pwm->hwpwm);
-+      if (!(pc->initialized >> PWM_NUM_GPIO))
-+              regmap_clear_bits(pc->regmap, REG_SIPO_FLASH_MODE_CFG,
-+                                SERIAL_GPIO_FLASH_MODE);
-+}
-+
-+static int airoha_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm,
-+                          const struct pwm_state *state)
-+{
-+      struct airoha_pwm *pc = container_of(chip, struct airoha_pwm, chip);
-+      u64 duty = state->enabled ? state->duty_cycle : 0;
-+      u64 period = state->period;
-+
-+      /* Only normal polarity is supported */
-+      if (state->polarity == PWM_POLARITY_INVERSED)
-+              return -EINVAL;
-+
-+      if (!state->enabled) {
-+              airoha_pwm_disable(chip, pwm);
-+              return 0;
-+      }
-+
-+      if (period < PERIOD_MIN_NS)
-+              return -EINVAL;
-+
-+      if (period > PERIOD_MAX_NS)
-+              period = PERIOD_MAX_NS;
-+
-+      return airoha_pwm_config(pc, pwm, duty, period);
-+}
-+
-+static int airoha_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm,
-+                              struct pwm_state *state)
-+{
-+      struct airoha_pwm *pc = container_of(chip, struct airoha_pwm, chip);
-+      int i;
-+
-+      /* find hwpwm in waveform generator bucket */
-+      for (i = 0; i < ARRAY_SIZE(pc->bucket); i++) {
-+              if (pc->bucket[i].used & BIT_ULL(pwm->hwpwm)) {
-+                      state->enabled = pc->initialized & BIT_ULL(pwm->hwpwm);
-+                      state->polarity = PWM_POLARITY_NORMAL;
-+                      state->period = pc->bucket[i].period_ns;
-+                      state->duty_cycle = pc->bucket[i].duty_ns;
-+                      break;
-+              }
-+      }
-+
-+      if (i == ARRAY_SIZE(pc->bucket))
-+              state->enabled = false;
-+
-+      return 0;
-+}
-+
-+static const struct pwm_ops airoha_pwm_ops = {
-+      .get_state = airoha_pwm_get_state,
-+      .apply = airoha_pwm_apply,
-+      .owner = THIS_MODULE,
-+};
-+
-+static int airoha_pwm_probe(struct platform_device *pdev)
-+{
-+      struct device *dev = &pdev->dev;
-+      struct airoha_pwm *pc;
-+
-+      pc = devm_kzalloc(dev, sizeof(*pc), GFP_KERNEL);
-+      if (!pc)
-+              return -ENOMEM;
-+
-+      pc->np = dev->of_node;
-+      pc->chip.dev = dev;
-+      pc->chip.ops = &airoha_pwm_ops;
-+      pc->chip.npwm = PWM_NUM_GPIO + PWM_NUM_SIPO;
-+
-+      pc->regmap = device_node_to_regmap(dev->parent->of_node);
-+      if (IS_ERR(pc->regmap))
-+              return PTR_ERR(pc->regmap);
-+
-+      return devm_pwmchip_add(&pdev->dev, &pc->chip);
-+}
-+
-+static const struct of_device_id airoha_pwm_of_match[] = {
-+      { .compatible = "airoha,en7581-pwm" },
-+      { /* sentinel */ }
-+};
-+MODULE_DEVICE_TABLE(of, airoha_pwm_of_match);
-+
-+static struct platform_driver airoha_pwm_driver = {
-+      .driver = {
-+              .name = "pwm-airoha",
-+              .of_match_table = airoha_pwm_of_match,
-+      },
-+      .probe = airoha_pwm_probe,
-+};
-+module_platform_driver(airoha_pwm_driver);
-+
-+MODULE_AUTHOR("Lorenzo Bianconi <lorenzo@kernel.org>");
-+MODULE_AUTHOR("Markus Gothe <markus.gothe@genexis.eu>");
-+MODULE_AUTHOR("Benjamin Larsson <benjamin.larsson@genexis.eu>");
-+MODULE_DESCRIPTION("Airoha EN7581 PWM driver");
-+MODULE_LICENSE("GPL");