Re: [PATCH v10] pwm: airoha: Add support for EN7581 SoC

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



Hello,

thanks for your patience.

On Sun, Nov 03, 2024 at 10:04:04PM +0100, Lorenzo Bianconi wrote:
> From: Benjamin Larsson <benjamin.larsson@xxxxxxxxxx>
> 
> Introduce driver for PWM module available on EN7581 SoC.
> 
> Co-developed-by: Christian Marangi <ansuelsmth@xxxxxxxxx>
> Signed-off-by: Christian Marangi <ansuelsmth@xxxxxxxxx>
> Signed-off-by: Benjamin Larsson <benjamin.larsson@xxxxxxxxxx>
> Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@xxxxxxxxxxxxx>
> Co-developed-by: Lorenzo Bianconi <lorenzo@xxxxxxxxxx>
> Signed-off-by: Lorenzo Bianconi <lorenzo@xxxxxxxxxx>
> ---
> Introduce airoha-mfd driver in order to load pinctrl and pwm drivers for
> EN7581 SoC. airoha-mfd is needed since both pinctrl and pwm drivers
> needs to access the same memory block (gpio memory region) to configure
> {gio,irq}_chip and pwm functionalities respectively, so model them as
> childs of a parent mfd driver.
> Current EN7581 pinctrl driver supports the following functionalities:
> - pin multiplexing via chip_scu syscon
> - pin pull-up, pull-down, open-drain, current strength,
>   {input,output}_enable, output_{low,high} via chip_scu syscon
> - gpio controller
> - irq controller
> ---
> Changes in v10:
> - repost just patch 6/6 (pwm driver) since patches {1/6-5/6} have been
>   already applied in linux-pinctrl tree
> - pwm: introduce AIROHA_PWM_FIELD_GET and AIROHA_PWM_FIELD_SET macros to
>   get/set field with non-const mask
> - pwm: simplify airoha_pwm_get_generator() to report unused generator
>   and remove double lookup
> - pwm: remove device_node pointer in airoha_pwm struct since this is
>   write-only field
> - pwm: cosmetics
> - Link to v9: https://lore.kernel.org/r/20241023-en7581-pinctrl-v9-0-afb0cbcab0ec@xxxxxxxxxx
> 
> Changes in v9:
> - pwm: remove unused properties
> - Link to v8: https://lore.kernel.org/r/20241018-en7581-pinctrl-v8-0-b676b966a1d1@xxxxxxxxxx
> 
> Changes in v8:
> - pwm: add missing properties documentation
> - Link to v7: https://lore.kernel.org/r/20241016-en7581-pinctrl-v7-0-4ff611f263a7@xxxxxxxxxx
> 
> Changes in v7:
> - pinctrl: cosmetics
> - pinctrl: fix compilation warning
> - Link to v6: https://lore.kernel.org/r/20241013-en7581-pinctrl-v6-0-2048e2d099c2@xxxxxxxxxx
> 
> Changes in v6:
> - pwm: rely on regmap APIs
> - pwm: introduce compatible string
> - pinctrl: introduce compatible string
> - remove airoha-mfd driver
> - add airoha,en7581-pinctrl binding
> - add airoha,en7581-pwm binding
> - update airoha,en7581-gpio-sysctl binding
> - Link to v5: https://lore.kernel.org/r/20241001-en7581-pinctrl-v5-0-dc1ce542b6c6@xxxxxxxxxx
> 
> Changes in v5:
> - use spin_lock in airoha_pinctrl_rmw instead of a mutex since it can run
>   in interrupt context
> - remove unused includes in pinctrl driver
> - since the irq_chip is immutable, allocate the gpio_irq_chip struct
>   statically in pinctrl driver
> - rely on regmap APIs in pinctrl driver but keep the spin_lock local to the
>   driver
> - rely on guard/guard_scope APIs in pinctrl driver
> - improve naming convention pinctrl driver
> - introduce airoha_pinconf_set_pin_value utility routine
> - Link to v4: https://lore.kernel.org/r/20240911-en7581-pinctrl-v4-0-60ac93d760bb@xxxxxxxxxx
> 
> Changes in v4:
> - add 'Limitation' description in pwm driver
> - fix comments in pwm driver
> - rely on mfd->base __iomem pointer in pwm driver, modify register
>   offsets according to it and get rid of sgpio_cfg, flash_cfg and
>   cycle_cfg pointers
> - simplify register utility routines in pwm driver
> - use 'generator' instead of 'waveform' suffix for pwm routines
> - fix possible overflow calculating duty cycle in pwm driver
> - do not modify pwm state in free callback in pwm driver
> - cap the maximum period in pwm driver
> - do not allow inverse polarity in pwm driver
> - do not set of_xlate callback in the pwm driver and allow the stack to
>   do it
> - fix MAINTAINERS file for airoha pinctrl driver
> - fix undefined reference to __ffsdi2 in pinctrl driver
> - simplify airoha,en7581-gpio-sysctl.yam binding
> - Link to v3: https://lore.kernel.org/r/20240831-en7581-pinctrl-v3-0-98eebfb4da66@xxxxxxxxxx
> 
> Changes in v3:
> - introduce airoha-mfd driver
> - add pwm driver to the same series
> - model pinctrl and pwm drivers as childs of a parent mfd driver.
> - access chip-scu memory region in pinctrl driver via syscon
> - introduce a single airoha,en7581-gpio-sysctl.yaml binding and get rid
>   of dedicated bindings for pinctrl and pwm
> - add airoha,en7581-chip-scu.yaml binding do the series
> - Link to v2: https://lore.kernel.org/r/20240822-en7581-pinctrl-v2-0-ba1559173a7f@xxxxxxxxxx
> 
> Changes in v2:
> - Fix compilation errors
> - Collapse some register mappings for gpio and irq controllers
> - update dt-bindings according to new register mapping
> - fix some dt-bindings errors
> - Link to v1: https://lore.kernel.org/all/cover.1723392444.git.lorenzo@xxxxxxxxxx/
> ---
>  drivers/pwm/Kconfig      |  11 ++
>  drivers/pwm/Makefile     |   1 +
>  drivers/pwm/pwm-airoha.c | 434 +++++++++++++++++++++++++++++++++++++++++++++++
>  3 files changed, 446 insertions(+)
> 
> diff --git a/drivers/pwm/pwm-airoha.c b/drivers/pwm/pwm-airoha.c
> new file mode 100644
> index 0000000000000000000000000000000000000000..78bc29e1deef9640f7021ce44fff5bce32dd5477
> --- /dev/null
> +++ b/drivers/pwm/pwm-airoha.c
> @@ -0,0 +1,434 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2022 Markus Gothe <markus.gothe@xxxxxxxxxx>
> + *
> + *  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.

If there is a public datasheet, adding a link here would be great.

> + */
> +
> +#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_MASK	BIT(31)
> +#define SGPIO_LED_DATA_DATA_MASK	GENMASK(16, 0)
> +
> +#define REG_SGPIO_CLK_DIVR		0x0028
> +#define 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_MASK	BIT(1)
> +#define SERIAL_GPIO_MODE_74HC164_MASK	BIT(0)
> +
> +#define REG_GPIO_FLASH_PRD_SET(_n)	(0x003c + (((_n) >> 1) << 2))
> +#define GPIO_FLASH_PRD_HIGH_MASK(_n)	\
> +	GENMASK(7 + (((_n) % 2) << 4),	((_n) % 2) << 4)
> +#define GPIO_FLASH_PRD_LOW_MASK(_n)	\
> +	GENMASK(15 + (((_n) % 2) << 4), 8 + (((_n) % 2) << 4))
> +
> +#define REG_GPIO_FLASH_MAP(_n)		(0x004c + (((_n) >> 3) << 2))

Huh, this makes the usage ugly. E.g.

	addr = REG_GPIO_FLASH_MAP(hwpwm);

looks as if there was a register per hwpwm. Also in general it's
beneficial to have the defines match the data sheet and I doubt that
there are GPIO_FLASH_MAP0, GPIO_FLASH_MAP1 ... REG_GPIO_FLASH_MAP15 with
only two distinct values. Assuming the official names are

	GPIO_FLASH_MAP0
	GPIO_FLASH_MAP1

I'd do:

	#define AIROHA_PWM_GPIO_FLASH_MAP(n)	(0x004c + 4 * (n))

	...

	/* One GPIO_FLASH_MAP register handles 8 pins */
	addr = AIROHA_PWM_GPIO_FLASH_MAP(hwpwm / 8);

and then I'd even go so far and do

	mask = GPIO_FLASH_SET_ID_MASK(hwpwm % 8);

and drop the % 8 from the definition of GPIO_FLASH_SET_ID_MASK.

> +#define GPIO_FLASH_EN_MASK(_n)		BIT(3 + (((_n) % 8) << 2))

This is a flag in the REG_GPIO_FLASH_MAP register, so it would be nice
if the name would show that (i.e. please include the full name of the
register in the bit field define).

Also there is little gain in the MASK suffix.

> +#define GPIO_FLASH_SET_ID_MASK(_n)	\
> +	GENMASK(2 + (((_n) % 8) << 2), ((_n) % 8) << 2)
> +
> +/* Register map is equal to GPIO flash map */
> +#define REG_SIPO_FLASH_MAP(_n)		(0x0054 + (((_n) >> 3) << 2))
> +
> +#define REG_CYCLE_CFG_VALUE(_n)		(0x0098 + (((_n) >> 2) << 2))
> +#define WAVE_GEN_CYCLE_MASK(_n)		\
> +	GENMASK(7 + (((_n) % 4) << 3), ((_n) % 4) << 3)
> +

Can you please give these defines all a common name prefix?

> +#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)
> +

A comment here about why AIROHA_PWM_FIELD_[GS]ET exists would be nice.

> +#define AIROHA_PWM_FIELD_GET(mask, val)	(((val) & (mask)) >> __ffs(mask))
> +#define AIROHA_PWM_FIELD_SET(mask, val)	(((val) << __ffs(mask)) & (mask))
> +
> +struct airoha_pwm_bucket {
> +	/* Bitmask of PWM channels using this bucket */
> +	u64 used;
> +	u64 period_ns;
> +	u64 duty_ns;
> +};
> +
> +struct airoha_pwm {
> +	struct regmap *regmap;
> +
> +	u64 initialized;
> +
> +	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_MIN_NS	(4 * NSEC_PER_MSEC)
> +#define AIROHA_PWM_PERIOD_MAX_NS	(1 * NSEC_PER_SEC)

the MAX_NS symbol is unused. If you want to mention that, do that in the
Limitations list.

> +/* It is represented internally as 1/250 s between 1 and 250 */
> +#define AIROHA_PWM_PERIOD_MIN		1
> +#define AIROHA_PWM_PERIOD_MAX		250

The unit of these is ticks. Maybe add that info in a comment.

> +/* Duty cycle is relative with 255 corresponding to 100% */
> +#define AIROHA_PWM_DUTY_FULL		255

So a setting of period_ticks = 1 and duty_ticks = 1 gives a setting of
period = 4000 µs and duty_cycle = 1 s / (250 * 255) = 15.686274509803921
µs? So either the hardware has a fractional divider or the input clock
runs with a rate that is a multiple of 63750 Hz. While this is
theoretically possible I would have expected a 64 kHz input, but then
something is wrong here. Do you really get a 100% relative duty_cycle
with duty_step = 255?

> +static u32 airoha_pwm_get_duty_tick_from_ns(u64 duty_ns, u64 period_ns)
> +{
> +	u32 duty_tick;
> +
> +	duty_tick = mul_u64_u64_div_u64(duty_ns, AIROHA_PWM_DUTY_FULL,
> +					period_ns);
> +	return min_t(u32, duty_tick, AIROHA_PWM_DUTY_FULL);
> +}
> +
> +static int airoha_pwm_get_generator(struct airoha_pwm *pc, u64 duty_ns,
> +				    u64 period_ns)
> +{
> +	int i, unused = -1;
> +
> +	for (i = 0; i < ARRAY_SIZE(pc->buckets); i++) {
> +		struct airoha_pwm_bucket *bucket = &pc->buckets[i];
> +		u32 duty_tick, duty_tick_bucket;
> +
> +		/* If found, save an unused bucket to return it later */
> +		if (!bucket->used && unused == -1) {
> +			unused = i;
> +			continue;
> +		}
> +
> +		if (duty_ns == bucket->duty_ns &&
> +		    period_ns == bucket->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
> +		 */
> +		duty_tick = airoha_pwm_get_duty_tick_from_ns(duty_ns,
> +							     period_ns);
> +		duty_tick_bucket =
> +			airoha_pwm_get_duty_tick_from_ns(bucket->duty_ns,
> +							 bucket->period_ns);
> +		if (duty_tick == AIROHA_PWM_DUTY_FULL &&
> +		    duty_tick == duty_tick_bucket)
> +			return i;
> +	}
> +
> +	return unused;
> +}
> +
> +static void airoha_pwm_release_bucket_config(struct airoha_pwm *pc,
> +					     unsigned int hwpwm)
> +{
> +	int bucket;
> +
> +	/* Nothing to clear, PWM channel never used */
> +	if (!(pc->initialized & BIT_ULL(hwpwm)))
> +		return;
> +
> +	bucket = pc->channel_bucket[hwpwm];
> +	pc->buckets[bucket].used &= ~BIT_ULL(hwpwm);
> +}
> +
> +static int airoha_pwm_consume_generator(struct airoha_pwm *pc,
> +					u64 duty_ns, u64 period_ns,
> +					unsigned int hwpwm)
> +{
> +	int bucket;
> +
> +	/*
> +	 * Search for a bucket that already satisfy duty and period
> +	 * or an unused one.
> +	 * If not found, -1 is returned.
> +	 */
> +	bucket = airoha_pwm_get_generator(pc, duty_ns, period_ns);
> +	if (bucket < 0)
> +		return bucket;
> +
> +	airoha_pwm_release_bucket_config(pc, hwpwm);
> +	pc->buckets[bucket].used |= BIT_ULL(hwpwm);
> +	pc->buckets[bucket].period_ns = period_ns;
> +	pc->buckets[bucket].duty_ns = duty_ns;
> +
> +	return bucket;
> +}
> +
> +static int airoha_pwm_sipo_init(struct airoha_pwm *pc)
> +{
> +	u32 val;
> +
> +	if (!(pc->initialized >> AIROHA_PWM_NUM_GPIO))
> +		return 0;
> +
> +	regmap_clear_bits(pc->regmap, REG_SIPO_FLASH_MODE_CFG,
> +			  SERIAL_GPIO_MODE_74HC164_MASK);
> +
> +	/* Configure shift register timings, use 32x divisor */
> +	regmap_write(pc->regmap, REG_SGPIO_CLK_DIVR,
> +		     FIELD_PREP(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_MASK),
> +				     10, 200 * USEC_PER_MSEC))
> +		return -ETIMEDOUT;
> +
> +	regmap_clear_bits(pc->regmap, REG_SGPIO_LED_DATA,
> +			  SGPIO_LED_DATA_DATA_MASK);
> +	if (regmap_read_poll_timeout(pc->regmap, REG_SGPIO_LED_DATA, val,
> +				     !(val & SGPIO_LED_DATA_SHIFT_FLAG_MASK),
> +				     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_MASK);
> +
> +	return 0;
> +}
> +
> +static void airoha_pwm_calc_bucket_config(struct airoha_pwm *pc, int bucket,
> +					  u64 duty_ns, u64 period_ns)
> +{
> +	u32 period_tick, duty_tick, mask, val;
> +
> +	duty_tick = airoha_pwm_get_duty_tick_from_ns(duty_ns, period_ns);
> +	period_tick = mul_u64_u64_div_u64(period_ns, AIROHA_PWM_PERIOD_MAX,
> +					  NSEC_PER_SEC);
> +	period_tick = min_t(u32, period_tick, AIROHA_PWM_PERIOD_MAX);

This is inexact. You're supposed to pick the highest duty_cycle not
bigger than the requested value after picking the period in the same
way.

A request of

	.period = 43999999
	.duty_cycle = 19921569

yields actual .period = 40000000 ns and .duty_cycle =
18039215.68627451 ns (with period_tick = 10 and duty_tick = 115) while
it could use duty_tick = 127 which (I think) gives a duty cycle of
19921568.62745098 ns.

> +	/* Configure frequency divisor */
> +	mask = WAVE_GEN_CYCLE_MASK(bucket);
> +	val = AIROHA_PWM_FIELD_SET(mask, period_tick);
> +	regmap_update_bits(pc->regmap, REG_CYCLE_CFG_VALUE(bucket), mask, val);
> +
> +	/* Configure duty cycle */
> +	mask = GPIO_FLASH_PRD_HIGH_MASK(bucket);
> +	val = AIROHA_PWM_FIELD_SET(mask, duty_tick);
> +	regmap_update_bits(pc->regmap, REG_GPIO_FLASH_PRD_SET(bucket),
> +			   mask, val);
> +
> +	mask = GPIO_FLASH_PRD_LOW_MASK(bucket);
> +	val = AIROHA_PWM_FIELD_SET(mask, AIROHA_PWM_DUTY_FULL - duty_tick);
> +	regmap_update_bits(pc->regmap, REG_GPIO_FLASH_PRD_SET(bucket),
> +			   mask, val);
> +}
> +
> +static void airoha_pwm_config_flash_map(struct airoha_pwm *pc,
> +					unsigned int hwpwm, int index)
> +{
> +	u32 addr, mask, val;
> +
> +	if (hwpwm < AIROHA_PWM_NUM_GPIO) {
> +		addr = REG_GPIO_FLASH_MAP(hwpwm);
> +	} else {
> +		hwpwm -= AIROHA_PWM_NUM_GPIO;
> +		addr = REG_SIPO_FLASH_MAP(hwpwm);
> +	}
> +
> +	/* index -1 means disable PWM channel */
> +	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.
> +		 * Duty cycle can't be set to 0 as it might be shared with
> +		 * others channels with same duty cycle.
> +		 */
> +		regmap_clear_bits(pc->regmap, addr, GPIO_FLASH_EN_MASK(hwpwm));
> +		return;
> +	}
> +
> +	mask = GPIO_FLASH_SET_ID_MASK(hwpwm);
> +	val = AIROHA_PWM_FIELD_SET(mask, index);
> +	regmap_update_bits(pc->regmap, addr, mask, val);
> +	regmap_set_bits(pc->regmap, addr, GPIO_FLASH_EN_MASK(hwpwm));
> +}
> +
> +static int airoha_pwm_config(struct airoha_pwm *pc, struct pwm_device *pwm,
> +			     u64 duty_ns, u64 period_ns)
> +{
> +	int bucket, hwpwm = pwm->hwpwm;
> +
> +	bucket = airoha_pwm_consume_generator(pc, duty_ns, period_ns,
> +					      hwpwm);
> +	if (bucket < 0)
> +		return -EBUSY;
> +
> +	if (!(pc->initialized & BIT_ULL(hwpwm)) &&
> +	    hwpwm >= AIROHA_PWM_NUM_GPIO)

No need for a line break in that if condition.

> +		airoha_pwm_sipo_init(pc);

Do you need to do that on each reconfiguration?

> +	airoha_pwm_calc_bucket_config(pc, bucket, duty_ns, period_ns);
> +	airoha_pwm_config_flash_map(pc, hwpwm, bucket);
> +
> +	pc->initialized |= BIT_ULL(hwpwm);
> +	pc->channel_bucket[hwpwm] = bucket;
> +
> +	return 0;
> +}
> +
> +static void airoha_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm)
> +{
> +	struct airoha_pwm *pc = pwmchip_get_drvdata(chip);
> +
> +	/* Disable PWM and release the bucket */
> +	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 >> AIROHA_PWM_NUM_GPIO))
> +		regmap_clear_bits(pc->regmap, REG_SIPO_FLASH_MODE_CFG,
> +				  SERIAL_GPIO_FLASH_MODE_MASK);
> +}
> +
> +static int airoha_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm,
> +			    const struct pwm_state *state)
> +{
> +	u64 duty_ns = state->enabled ? state->duty_cycle : 0;

Using

	u64 duty_ns = state->duty_cycle

has the same effect and is simpler. Then dropping this variable is even
simpler as it's used only once.

> +	struct airoha_pwm *pc = pwmchip_get_drvdata(chip);
> +	u64 period_ns = 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_ns < AIROHA_PWM_PERIOD_MIN_NS)
> +		return -EINVAL;
> +
> +	return airoha_pwm_config(pc, pwm, duty_ns, period_ns);
> +}
> +
> +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, val;
> +	u8 bucket;
> +
> +	if (hwpwm < AIROHA_PWM_NUM_GPIO) {
> +		addr = REG_GPIO_FLASH_MAP(hwpwm);
> +	} else {
> +		hwpwm -= AIROHA_PWM_NUM_GPIO;
> +		addr = REG_SIPO_FLASH_MAP(hwpwm);
> +	}
> +
> +	ret = regmap_read(pc->regmap, addr, &val);
> +	if (ret)
> +		return ret;
> +
> +	state->enabled = AIROHA_PWM_FIELD_GET(GPIO_FLASH_EN_MASK(hwpwm), val);
> +	if (!state->enabled)
> +		return 0;
> +
> +	state->polarity = PWM_POLARITY_NORMAL;
> +
> +	bucket = AIROHA_PWM_FIELD_GET(GPIO_FLASH_SET_ID_MASK(hwpwm), val);
> +	ret = regmap_read(pc->regmap, REG_CYCLE_CFG_VALUE(bucket), &val);
> +	if (ret)
> +		return ret;
> +
> +	state->period = pc->buckets[bucket].period_ns;
> +	state->duty_cycle = pc->buckets[bucket].duty_ns;

So if airoha_pwm_get_state() is called before a setting was
airoha_pwm_apply()d, this gives 0, right? Would be great if you returned
the actually configured settings here. Additionally to the model
matching the reality better then, the inexactness I found above would
have been catchable by intensive testing.

> +	return 0;
> +}
> +
> +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->parent->of_node);
> +	if (IS_ERR(pc->regmap)) {
> +		dev_err_probe(dev, PTR_ERR(pc->regmap), "failed to get PWM regmap");
> +		return PTR_ERR(pc->regmap);

return dev_err_probe(dev, PTR_ERR(pc->regmap), "Failed to get PWM regmap\n");

(Note there are three relevant changes in this suggestion.)

> +	}
> +
> +	ret = devm_pwmchip_add(&pdev->dev, chip);
> +	if (ret)
> +		dev_err_probe(dev, ret, "failed to add PWM chip");

return dev_err_probe(dev, ret, "Failed to add PWM chip\n");

> +	return ret;

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",
> +		.of_match_table = airoha_pwm_of_match,
> +	},
> +	.probe = airoha_pwm_probe,
> +};
> +module_platform_driver(airoha_pwm_driver);
> +
> +MODULE_AUTHOR("Lorenzo Bianconi <lorenzo@xxxxxxxxxx>");
> +MODULE_AUTHOR("Markus Gothe <markus.gothe@xxxxxxxxxx>");
> +MODULE_AUTHOR("Benjamin Larsson <benjamin.larsson@xxxxxxxxxx>");
> +MODULE_DESCRIPTION("Airoha EN7581 PWM driver");
> +MODULE_LICENSE("GPL");

Best regards
Uwe

Attachment: signature.asc
Description: PGP signature


[Index of Archives]     [Device Tree Compilter]     [Device Tree Spec]     [Linux Driver Backports]     [Video for Linux]     [Linux USB Devel]     [Linux PCI Devel]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [XFree86]     [Yosemite Backpacking]


  Powered by Linux