linux-imx

/*

 * Freescale FlexTimer Module (FTM) timer driver.

 *

 * Copyright 2014 Freescale Semiconductor, Inc.

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License

 * as published by the Free Software Foundation; either version 2

 * of the License, or (at your option) any later version.

 */

​

#include <linux/clk.h>

#include <linux/clockchips.h>

#include <linux/clocksource.h>

#include <linux/err.h>

#include <linux/interrupt.h>

#include <linux/io.h>

#include <linux/of_address.h>

#include <linux/of_irq.h>

#include <linux/sched_clock.h>

#include <linux/slab.h>

​

#define FTM_SC      0x00

#define FTM_SC_CLK_SHIFT    3

#define FTM_SC_CLK_MASK (0x3 << FTM_SC_CLK_SHIFT)

#define FTM_SC_CLK(c)   ((c) << FTM_SC_CLK_SHIFT)

#define FTM_SC_PS_MASK  0x7

#define FTM_SC_TOIE BIT(6)

#define FTM_SC_TOF  BIT(7)

​

#define FTM_CNT     0x04

#define FTM_MOD     0x08

#define FTM_CNTIN   0x4C

​

#define FTM_PS_MAX  7

​

struct ftm_clock_device {

    void __iomem *clksrc_base;

    void __iomem *clkevt_base;

    unsigned long periodic_cyc;

    unsigned long ps;

    bool big_endian;

};

​

static struct ftm_clock_device *priv;

​

static inline u32 ftm_readl(void __iomem *addr)

{

    if (priv->big_endian)

        return ioread32be(addr);

    else

        return ioread32(addr);

}

​

static inline void ftm_writel(u32 val, void __iomem *addr)

{

    if (priv->big_endian)

        iowrite32be(val, addr);

    else

        iowrite32(val, addr);

}

​

static inline void ftm_counter_enable(void __iomem *base)

{

    u32 val;

​

    /* select and enable counter clock source */

    val = ftm_readl(base + FTM_SC);

    val &= ~(FTM_SC_PS_MASK | FTM_SC_CLK_MASK);

    val |= priv->ps | FTM_SC_CLK(1);

    ftm_writel(val, base + FTM_SC);

}

​

static inline void ftm_counter_disable(void __iomem *base)

{

    u32 val;

​

    /* disable counter clock source */

    val = ftm_readl(base + FTM_SC);

    val &= ~(FTM_SC_PS_MASK | FTM_SC_CLK_MASK);

    ftm_writel(val, base + FTM_SC);

}

​

static inline void ftm_irq_acknowledge(void __iomem *base)

{

    u32 val;

​

    val = ftm_readl(base + FTM_SC);

    val &= ~FTM_SC_TOF;

    ftm_writel(val, base + FTM_SC);

}

​