linux-imx

/*

 * Copyright (C) 2013 Pengutronix

 * Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>

 *

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

 * the terms of the GNU General Public License version 2 as published by the

 * Free Software Foundation.

 */

​

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

​

#include <linux/kernel.h>

#include <linux/clocksource.h>

#include <linux/clockchips.h>

#include <linux/irq.h>

#include <linux/interrupt.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/of_irq.h>

#include <linux/clk.h>

​

#define TIMERn_CTRL         0x00

#define TIMERn_CTRL_PRESC(val)          (((val) & 0xf) << 24)

#define TIMERn_CTRL_PRESC_1024          TIMERn_CTRL_PRESC(10)

#define TIMERn_CTRL_CLKSEL(val)         (((val) & 0x3) << 16)

#define TIMERn_CTRL_CLKSEL_PRESCHFPERCLK    TIMERn_CTRL_CLKSEL(0)

#define TIMERn_CTRL_OSMEN           0x00000010

#define TIMERn_CTRL_MODE(val)           (((val) & 0x3) <<  0)

#define TIMERn_CTRL_MODE_UP         TIMERn_CTRL_MODE(0)

#define TIMERn_CTRL_MODE_DOWN           TIMERn_CTRL_MODE(1)

​

#define TIMERn_CMD          0x04

#define TIMERn_CMD_START            0x00000001

#define TIMERn_CMD_STOP             0x00000002

​

#define TIMERn_IEN          0x0c

#define TIMERn_IF           0x10

#define TIMERn_IFS          0x14

#define TIMERn_IFC          0x18

#define TIMERn_IRQ_UF               0x00000002

​

#define TIMERn_TOP          0x1c

#define TIMERn_CNT          0x24

​

struct efm32_clock_event_ddata {

    struct clock_event_device evtdev;

    void __iomem *base;

    unsigned periodic_top;

};

​

static int efm32_clock_event_shutdown(struct clock_event_device *evtdev)

{

    struct efm32_clock_event_ddata *ddata =

        container_of(evtdev, struct efm32_clock_event_ddata, evtdev);

​

    writel_relaxed(TIMERn_CMD_STOP, ddata->base + TIMERn_CMD);

    return 0;

}

​

static int efm32_clock_event_set_oneshot(struct clock_event_device *evtdev)

{

    struct efm32_clock_event_ddata *ddata =

        container_of(evtdev, struct efm32_clock_event_ddata, evtdev);

​

    writel_relaxed(TIMERn_CMD_STOP, ddata->base + TIMERn_CMD);

    writel_relaxed(TIMERn_CTRL_PRESC_1024 |

               TIMERn_CTRL_CLKSEL_PRESCHFPERCLK |

               TIMERn_CTRL_OSMEN |

               TIMERn_CTRL_MODE_DOWN,

               ddata->base + TIMERn_CTRL);

    return 0;

}

​

static int efm32_clock_event_set_periodic(struct clock_event_device *evtdev)

{

    struct efm32_clock_event_ddata *ddata =

        container_of(evtdev, struct efm32_clock_event_ddata, evtdev);

​

    writel_relaxed(TIMERn_CMD_STOP, ddata->base + TIMERn_CMD);

    writel_relaxed(ddata->periodic_top, ddata->base + TIMERn_TOP);

    writel_relaxed(TIMERn_CTRL_PRESC_1024 |

               TIMERn_CTRL_CLKSEL_PRESCHFPERCLK |

               TIMERn_CTRL_MODE_DOWN,

               ddata->base + TIMERn_CTRL);

    writel_relaxed(TIMERn_CMD_START, ddata->base + TIMERn_CMD);

    return 0;

}

​

static int efm32_clock_event_set_next_event(unsigned long evt,

                        struct clock_event_device *evtdev)

{

    struct efm32_clock_event_ddata *ddata =