Subversion Repositories c0or1k

/*

 * SP804 primecell driver honoring generic

 * timer library API

 *

 * Copyright (C) 2010 B Labs Ltd.

 *

 * Author: Bahadir Balban

 */

#include <l4lib/types.h>

#include "timer.h"

/* Enable timer with its current configuration */

void timer_start(unsigned long timer_base)

{

        volatile u32 reg = read(timer_base + SP804_CTRL);

        reg |= SP804_ENABLE;

        write(reg, timer_base + SP804_CTRL);

}

/* Load the timer with ticks value */

void timer_load(u32 loadval, unsigned long timer_base)

{

        write(loadval, timer_base + SP804_LOAD);

}

u32 timer_read(unsigned long timer_base)

{

        return read(timer_base + SP804_VALUE);

}

void timer_stop(unsigned long timer_base)

{

        write(0, timer_base + SP804_CTRL);

}

void timer_init_periodic(unsigned long timer_base, u32 load_value)

{

        volatile u32 reg = read(timer_base + SP804_CTRL);

        reg |= SP804_PERIODIC | SP804_32BIT | SP804_IRQEN;

        write(reg, timer_base + SP804_CTRL);

        if (load_value)

                timer_load(load_value, timer_base);

        else

                /* 1 tick per usec, 1 irq per msec */

                timer_load(1000, timer_base);

}

void timer_init_oneshot(unsigned long timer_base)

{

        volatile u32 reg = read(timer_base + SP804_CTRL);

        /* One shot, 32 bits, no irqs */

        reg |= SP804_32BIT | SP804_ONESHOT;

        write(reg, timer_base + SP804_CTRL);

}

void timer_init(unsigned long timer_base, u32 load_value)

{

        timer_stop(timer_base);

        timer_init_periodic(timer_base, load_value);

}