Subversion Repositories aor3000

/*

 * This file is subject to the terms and conditions of the GNU General Public

 * License.  See the file "COPYING" in the main directory of this archive

 * for more details.

 *

 * Copyright (C) 2014 Aleksander Osman

 */

#include <linux/interrupt.h>

#include <linux/irq.h>

#include <linux/time.h>

#include <linux/init.h>

#include <linux/clockchips.h>

#include <asm/time.h>

#define SIMPLE_TIMER_IRQ_NUMBER     2

#define SIMPLE_TIMER_ACK_ADDRESS    0xBFFFFFF8

static void simple_timer_set_mode(enum clock_event_mode mode,

              struct clock_event_device *evt)

{

    switch (mode) {

    case CLOCK_EVT_MODE_PERIODIC:

        break;

    case CLOCK_EVT_MODE_ONESHOT:

    case CLOCK_EVT_MODE_UNUSED:

    case CLOCK_EVT_MODE_SHUTDOWN:

        break;

    case CLOCK_EVT_MODE_RESUME:

        break;

    }

}

static struct clock_event_device simple_clockevent_device = {

    .name       = "simple-timer",

    .features   = CLOCK_EVT_FEAT_PERIODIC,

    /* .set_mode, .mult, .shift, .max_delta_ns and .min_delta_ns left uninitialized */

    .rating     = 300,

    .irq        = SIMPLE_TIMER_IRQ_NUMBER,

    .cpumask    = cpu_all_mask,

    .set_mode   = simple_timer_set_mode,

};

static irqreturn_t simple_timer_interrupt(int irq, void *dev_id)

{

    struct clock_event_device *cd = dev_id;

    *(volatile u8 *)SIMPLE_TIMER_ACK_ADDRESS = 0;

    cd->event_handler(cd);

    return IRQ_HANDLED;

}

static struct irqaction simple_timer_irqaction = {

    .handler    = simple_timer_interrupt,

    .flags      = IRQF_PERCPU | IRQF_TIMER,

    .name       = "simple-timer",

};

void __init plat_time_init(void)

{

    struct clock_event_device *cd = &simple_clockevent_device;

    struct irqaction *action = &simple_timer_irqaction;

    clockevent_set_clock(cd, 100);

    clockevents_register_device(cd);

    action->dev_id = cd;

    setup_irq(SIMPLE_TIMER_IRQ_NUMBER, &simple_timer_irqaction);

}