[PATCH 2/3] mpc52xx/wdt: merge WDT code into the GPT
Grant Likely
grant.likely at secretlab.ca
Wed Nov 11 07:59:39 EST 2009
On Tue, Nov 10, 2009 at 12:41 PM, Albrecht Dreß <albrecht.dress at arcor.de> wrote:
> Merge the WDT code into the GPT interface.
>
> Signed-off-by: Albrecht Dreß <albrecht.dress at arcor.de>
> ---
Hi Albrecht,
Thanks for this work. Comments below.
>
> Notes:
>
> The maximum timeout for a 5200 GPT @ 33 MHz clock is ~130 seconds. As this
> exceeds the range of an int, some api's had to be changed to u64.
>
> The WDT api is exported as to keep the WDT driver separated from the GPT
> driver.
>
> If GPT0 is used as WDT, this prevents the use of any GPT0 GPT function (i.e.
> they will fail with -EBUSY). IOW, the safety function always has precedence
> over the GPT function. If the kernel has been compiled with
> CONFIG_WATCHDOG_NOWAYOUT, this means that GPT0 is locked in WDT mode until
> the next reboot - this may be a requirement in safety applications.
This description would look great in the header comment block of the
.c file.
Also, as I commented in patch 3; I'd rather see all the WDT
functionality rolled into this driver. As long as you keep the
functional code blocks logically arranged, I think the driver will be
easier to maintain and understand that way.
> arch/powerpc/include/asm/mpc52xx.h | 18 ++-
> arch/powerpc/platforms/52xx/mpc52xx_gpt.c | 281 ++++++++++++++++++++++++++---
> 2 files changed, 270 insertions(+), 29 deletions(-)
>
> diff --git a/arch/powerpc/platforms/52xx/mpc52xx_gpt.c b/arch/powerpc/platforms/52xx/mpc52xx_gpt.c
> index 2c3fa13..8274ebb 100644
> --- a/arch/powerpc/platforms/52xx/mpc52xx_gpt.c
> +++ b/arch/powerpc/platforms/52xx/mpc52xx_gpt.c
> @@ -60,9 +60,13 @@
> #include <asm/mpc52xx.h>
>
> MODULE_DESCRIPTION("Freescale MPC52xx gpt driver");
> -MODULE_AUTHOR("Sascha Hauer, Grant Likely");
> +MODULE_AUTHOR("Sascha Hauer, Grant Likely, Albrecht Dreß");
> MODULE_LICENSE("GPL");
>
> +#if (defined(CONFIG_MPC5200_WDT)) || (defined(CONFIG_MPC5200_WDT_MODULE))
> +#define HAVE_MPC5200_WDT
> +#endif
> +
> /**
> * struct mpc52xx_gpt - Private data structure for MPC52xx GPT driver
> * @dev: pointer to device structure
> @@ -70,6 +74,8 @@ MODULE_LICENSE("GPL");
> * @lock: spinlock to coordinate between different functions.
> * @of_gc: of_gpio_chip instance structure; used when GPIO is enabled
> * @irqhost: Pointer to irq_host instance; used when IRQ mode is supported
> + * @wdt_mode: only used for gpt 0: 0 gpt-only timer, 1 can be used as a
> + * wdt, 2 currently used as wdt, cannot be used as gpt
> */
> struct mpc52xx_gpt_priv {
> struct list_head list; /* List of all GPT devices */
> @@ -78,6 +84,9 @@ struct mpc52xx_gpt_priv {
> spinlock_t lock;
> struct irq_host *irqhost;
> u32 ipb_freq;
> +#if defined(HAVE_MPC5200_WDT)
> + u8 wdt_mode;
> +#endif
I wouldn't bother with the #if/#endif. I'm willing to sacrifice
32bits for the sake of readability of the code.
> +#define NS_PER_SEC 1000000000LL
> +
> +#define MPC52xx_GPT_CAN_WDT (1 << 0)
> +#define MPC52xx_GPT_IS_WDT (1 << 1)
> +
> +
> /* ---------------------------------------------------------------------
> * Cascaded interrupt controller hooks
> */
> @@ -375,36 +393,22 @@ struct mpc52xx_gpt_priv *mpc52xx_gpt_from_irq(int irq)
> }
> EXPORT_SYMBOL(mpc52xx_gpt_from_irq);
>
> -/**
> - * mpc52xx_gpt_start_timer - Set and enable the GPT timer
> - * @gpt: Pointer to gpt private data structure
> - * @period: period of timer
> - * @continuous: set to 1 to make timer continuous free running
> - *
> - * An interrupt will be generated every time the timer fires
> - */
> -int mpc52xx_gpt_start_timer(struct mpc52xx_gpt_priv *gpt, int period,
> - int continuous)
> +/* Calculate the timer counter input register MBAR + 0x6n4 from the
> + * period in ns. The maximum period for 33 MHz IPB clock is ~130s. */
> +static int mpc52xx_gpt_calc_counter_input(u64 period, u64 ipb_freq,
> + u32 *reg_val)
> {
> - u32 clear, set;
> u64 clocks;
> u32 prescale;
> - unsigned long flags;
> -
> - clear = MPC52xx_GPT_MODE_MS_MASK | MPC52xx_GPT_MODE_CONTINUOUS;
> - set = MPC52xx_GPT_MODE_MS_GPIO | MPC52xx_GPT_MODE_COUNTER_ENABLE;
> - if (continuous)
> - set |= MPC52xx_GPT_MODE_CONTINUOUS;
>
> /* Determine the number of clocks in the requested period. 64 bit
> * arithmatic is done here to preserve the precision until the value
> - * is scaled back down into the u32 range. Period is in 'ns', bus
> - * frequency is in Hz. */
> - clocks = (u64)period * (u64)gpt->ipb_freq;
> - do_div(clocks, 1000000000); /* Scale it down to ns range */
> + * is scaled back down into the u32 range. */
> + clocks = period * ipb_freq;
> + do_div(clocks, NS_PER_SEC); /* Scale it down to ns range */
Nit: I wouldn't bother with the NS_PER_SEC macro personally. ns per s
is such a fundamental property that I'd rather see the actual number.
>
> - /* This device cannot handle a clock count greater than 32 bits */
> - if (clocks > 0xffffffff)
> + /* the maximum count is 0x10000 pre-scaler * 0xffff count */
> + if (clocks > 0xffff0000)
> return -EINVAL;
This a bug fix? Separate patch please.
> /* Calculate the prescaler and count values from the clocks value.
> @@ -427,9 +431,47 @@ int mpc52xx_gpt_start_timer(struct mpc52xx_gpt_priv *gpt, int period,
> return -EINVAL;
> }
>
> + *reg_val = (prescale & 0xffff) << 16 | clocks;
> + return 0;
> +}
> +
> +/**
> + * mpc52xx_gpt_start_timer - Set and enable the GPT timer
> + * @gpt: Pointer to gpt private data structure
> + * @period: period of timer in ns
> + * @continuous: set to 1 to make timer continuous free running
> + *
> + * An interrupt will be generated every time the timer fires
> + */
> +int mpc52xx_gpt_start_timer(struct mpc52xx_gpt_priv *gpt, u64 period,
> + int continuous)
> +{
> + u32 clear, set;
> + u32 counter_reg;
> + unsigned long flags;
> +
> +#if defined(HAVE_MPC5200_WDT)
> + /* reject the operation if the timer is used as watchdog (gpt 0 only) */
> + spin_lock_irqsave(&gpt->lock, flags);
> + if ((gpt->wdt_mode & MPC52xx_GPT_IS_WDT)) {
> + spin_unlock_irqrestore(&gpt->lock, flags);
> + return -EBUSY;
> + }
> + spin_unlock_irqrestore(&gpt->lock, flags);
> +#endif
I think the behaviour needs to be consistent, regardless of
HAVE_MPC5200_WDT state. If the IS_WDT flag is set, then this needs
to bail, even if WDT support is not enabled.
Also, move this code block down into the spin lock/unlock block lower
in the function. it doesn't make much sense to grab the spin lock
twice in the same function, and the worst think that can happen if
this test fails is that a few extra cycles are burned calculating what
the counter_reg value should be.
> +
> + clear = MPC52xx_GPT_MODE_MS_MASK | MPC52xx_GPT_MODE_CONTINUOUS;
> + set = MPC52xx_GPT_MODE_MS_GPIO | MPC52xx_GPT_MODE_COUNTER_ENABLE;
> + if (continuous)
> + set |= MPC52xx_GPT_MODE_CONTINUOUS;
> +
> + if (mpc52xx_gpt_calc_counter_input(period, (u64)gpt->ipb_freq,
> + &counter_reg) != 0)
> + return -EINVAL;
> +
> /* Set and enable the timer */
> spin_lock_irqsave(&gpt->lock, flags);
> - out_be32(&gpt->regs->count, prescale << 16 | clocks);
> + out_be32(&gpt->regs->count, counter_reg);
> clrsetbits_be32(&gpt->regs->mode, clear, set);
> spin_unlock_irqrestore(&gpt->lock, flags);
>
> @@ -437,12 +479,175 @@ int mpc52xx_gpt_start_timer(struct mpc52xx_gpt_priv *gpt, int period,
> }
> EXPORT_SYMBOL(mpc52xx_gpt_start_timer);
>
> -void mpc52xx_gpt_stop_timer(struct mpc52xx_gpt_priv *gpt)
> +/**
> + * mpc52xx_gpt_timer_period - Return the timer period in nanoseconds
> + * Note: reads the timer config directly from the hardware
> + */
> +u64 mpc52xx_gpt_timer_period(struct mpc52xx_gpt_priv *gpt)
> +{
> + u64 period;
> + u32 prescale;
> + unsigned long flags;
> +
> + spin_lock_irqsave(&gpt->lock, flags);
> + period = in_be32(&gpt->regs->count);
> + spin_unlock_irqrestore(&gpt->lock, flags);
> +
> + prescale = period >> 16;
> + period &= 0xffff;
> + if (prescale == 0)
> + prescale = 0x10000;
> + period = period * (u64) prescale * NS_PER_SEC;
> + do_div(period, (u64)gpt->ipb_freq);
Are the casts necessary? Maybe prescale should just be a u64 value?
> + return period;
> +}
> +EXPORT_SYMBOL(mpc52xx_gpt_timer_period);
> +
> +int mpc52xx_gpt_stop_timer(struct mpc52xx_gpt_priv *gpt)
> {
> + unsigned long flags;
> +
> + /* reject the operation if the timer is used as watchdog (gpt 0 only) */
> + spin_lock_irqsave(&gpt->lock, flags);
> +#if defined(HAVE_MPC5200_WDT)
> + if ((gpt->wdt_mode & MPC52xx_GPT_IS_WDT)) {
> + spin_unlock_irqrestore(&gpt->lock, flags);
> + return -EBUSY;
> + }
> +#endif
Again, drop the #if/endif wrapper.
> +/**
> + * mpc52xx_gpt_wdt_release - Release the watchdog so it can be used as gpt
> + * @gpt_wdt: the watchdog gpt
> + *
> + * Note: Stops the watchdog if CONFIG_WATCHDOG_NOWAYOUT is not defined.
> + * the function does not protect itself form being called without a
> + * timer or with a timer which cannot function as wdt.
> + */
> +int mpc52xx_gpt_wdt_release(struct mpc52xx_gpt_priv *gpt_wdt)
> +{
> +#if !defined(CONFIG_WATCHDOG_NOWAYOUT)
> + unsigned long flags;
> +
> + spin_lock_irqsave(&gpt_wdt->lock, flags);
> + clrbits32(&gpt_wdt->regs->mode,
> + MPC52xx_GPT_MODE_COUNTER_ENABLE | MPC52xx_GPT_MODE_WDT_EN);
> + gpt_wdt->wdt_mode &= ~MPC52xx_GPT_IS_WDT;
> + spin_unlock_irqrestore(&gpt_wdt->lock, flags);
> +#endif
> + return 0;
> +}
> +EXPORT_SYMBOL(mpc52xx_gpt_wdt_release);
> +
> +#if !defined(CONFIG_WATCHDOG_NOWAYOUT)
> +/**
> + * mpc52xx_gpt_wdt_stop - Stop the watchdog
> + * @gpt_wdt: the watchdog gpt
> + *
> + * Note: the function does not protect itself form being called without a
> + * timer or with a timer which cannot function as wdt.
> + */
> +int mpc52xx_gpt_wdt_stop(struct mpc52xx_gpt_priv *gpt_wdt)
> +{
> + unsigned long flags;
> +
> + spin_lock_irqsave(&gpt_wdt->lock, flags);
> + clrbits32(&gpt_wdt->regs->mode,
> + MPC52xx_GPT_MODE_COUNTER_ENABLE | MPC52xx_GPT_MODE_WDT_EN);
> + gpt_wdt->wdt_mode &= ~MPC52xx_GPT_IS_WDT;
> + spin_unlock_irqrestore(&gpt_wdt->lock, flags);
> + return 0;
> +}
> +EXPORT_SYMBOL(mpc52xx_gpt_wdt_stop);
> +#endif /* CONFIG_WATCHDOG_NOWAYOUT */
> +#endif /* HAVE_MPC5200_WDT */
> +
> /* ---------------------------------------------------------------------
> * of_platform bus binding code
> */
> @@ -473,6 +678,30 @@ static int __devinit mpc52xx_gpt_probe(struct of_device *ofdev,
> list_add(&gpt->list, &mpc52xx_gpt_list);
> mutex_unlock(&mpc52xx_gpt_list_mutex);
>
> +#if defined(HAVE_MPC5200_WDT)
> + /* check if this device could be a watchdog */
> + if (of_get_property(ofdev->node, "fsl,has-wdt", NULL) ||
> + of_get_property(ofdev->node, "has-wdt", NULL)) {
> + const u32 *on_boot_wdt;
> +
> + gpt->wdt_mode = MPC52xx_GPT_CAN_WDT;
> +
> + /* check if the device shall be used as on-boot watchdog */
> + on_boot_wdt = of_get_property(ofdev->node, "wdt,on-boot", NULL);
> + if (on_boot_wdt) {
> + gpt->wdt_mode |= MPC52xx_GPT_IS_WDT;
> + if (*on_boot_wdt > 0 &&
> + mpc52xx_gpt_wdt_start(gpt, *on_boot_wdt) == 0)
> + dev_info(gpt->dev,
> + "running as wdt, timeout %us\n",
> + *on_boot_wdt);
> + else
> + dev_info(gpt->dev, "reserved as wdt\n");
> + } else
> + dev_info(gpt->dev, "can function as wdt\n");
> + }
> +#endif
Ditto on the #if/endif
Cheers,
g.
--
Grant Likely, B.Sc., P.Eng.
Secret Lab Technologies Ltd.
More information about the devicetree-discuss
mailing list