sambuc/codezero
1
0
Fork 0
mirror of https://github.com/drasko/codezero.git synced 2026-02-27 17:23:13 +01:00
Code Issues Actions Packages Projects Releases Wiki Activity

Cleaned the timer driver to make it generic.

Browse Source
This commit is contained in:
Amit Mahajan
2009-10-24 21:02:47 +05:30
parent 24cbc8d441
commit 8a586860b3
7 changed files with 111 additions and 57 deletions
Download Patch File Download Diff File Expand all files Collapse all files

76
src/drivers/timer/sp804/sp804_timer.c
View File

@@ -4,6 +4,7 @@
* Copyright (C) 2007 Bahadir Balban
*/
#include <l4/drivers/timer/sp804/sp804_timer.h>
#include INC_PLAT(irq.h)
/* FIXME: Fix the shameful uart driver and change to single definition of this! */
#if defined(read)
@@ -17,91 +18,98 @@
#define write(v, a) (*((volatile unsigned int *)(a)) = v)
#define setbit(bit, a) write(read(a) | bit, a)
#define clrbit(bit, a) write(read(a) & ~bit, a)
#define devio(base, reg, bit, setclr) \
((setclr) ? setbit(bit, base + reg) \
#define devio(base, reg, bit, setclr) ((setclr) ? setbit(bit, base + reg) \
: clrbit(bit, base + reg))
void sp804_irq_handler(void)
void sp804_irq_handler(unsigned int timer_base)
{
/* Timer enabled as Periodic/Wrapper only needs irq clearing
* as it automatically reloads and wraps. */
write(1, SP804_TIMER1INTCLR);
/*
* Timer enabled as Periodic/Wrapper only needs irq clearing
* as it automatically reloads and wraps
*/
write(1, (timer_base + SP804_TIMERINTCLR));
}
static inline void sp804_control(int timer, int bit, int setclr)
static inline void sp804_control(unsigned int timer_base, int bit, int setclr)
{
unsigned long addr = SP804_TIMER1CONTROL + (timer ? SP804_TIMER2OFFSET : 0);
unsigned long addr = (timer_base + SP804_TIMERCONTROL);
setclr ? setbit(bit, addr) : clrbit(bit, addr);
}
/* Sets timer's run mode:
/*
* Sets timer's run mode:
* @periodic: periodic mode = 1, free-running = 0.
*/
#define SP804_PEREN (1 << 6)
static inline void sp804_set_runmode(int timer, int periodic)
static inline void sp804_set_runmode(unsigned int timer_base, int periodic)
{
sp804_control(timer, SP804_PEREN, periodic);
sp804_control(timer_base, SP804_PEREN, periodic);
}
/* Sets timer's wrapping mode:
/*
* Sets timer's wrapping mode:
* @oneshot: oneshot = 1, wrapping = 0.
*/
#define SP804_ONESHOT (1 << 0)
static inline void sp804_set_wrapmode(int timer, int oneshot)
static inline void sp804_set_wrapmode(unsigned int timer_base, int oneshot)
{
sp804_control(timer, SP804_ONESHOT, oneshot);
sp804_control(timer_base, SP804_ONESHOT, oneshot);
}
/* Sets the operational width of timers.
/*
* Sets the operational width of timers.
* In 16bit mode, top halfword is ignored.
* @width: 32bit mode = 1; 16bit mode = 0
*/
#define SP804_32BIT (1 << 1)
static inline void sp804_set_widthmode(int timer, int width)
static inline void sp804_set_widthmode(unsigned int timer_base, int width)
{
sp804_control(timer, SP804_32BIT, width);
sp804_control(timer_base, SP804_32BIT, width);
}
/* Enable/disable timer:
/*
* Enable/disable timer:
* @enable: enable = 1, disable = 0;
*/
#define SP804_ENABLE (1 << 7)
void sp804_enable(int timer, int enable)
void sp804_enable(unsigned int timer_base, int enable)
{
sp804_control(timer, SP804_ENABLE, enable);
sp804_control(timer_base, SP804_ENABLE, enable);
}
/* Enable/disable local irq register:
/*
* Enable/disable local irq register:
* @enable: enable = 1, disable = 0
*/
#define SP804_IRQEN (1 << 5)
void sp804_set_irq(int timer, int enable)
void sp804_set_irq(unsigned int timer_base, int enable)
{
sp804_control(timer, SP804_IRQEN, enable);
sp804_control(timer_base, SP804_IRQEN, enable);
}
/* Loads timer with value in val */
static inline void sp804_load_value(int timer, u32 val)
static inline void sp804_load_value(unsigned int timer_base, u32 val)
{
write(val, SP804_TIMER1LOAD + (timer ? SP804_TIMER2OFFSET : 0));
write(val, (timer_base + SP804_TIMERLOAD));
}
/* Returns current timer value */
static inline u32 sp804_read_value(int timer)
static inline u32 sp804_read_value(unsigned int timer_base)
{
return read(SP804_TIMER1VALUE + (timer ? SP804_TIMER2OFFSET : 0));
return read(timer_base + SP804_TIMERVALUE);
}
/* TODO: These are default settings! The values must be passed as arguments */
void sp804_init(void)
/* TODO: Define macro values for duration */
void sp804_init(unsigned int timer_base, int run_mode, int wrap_mode, \
int width, int irq_enable)
{
/* 1 tick per usec */
const int duration = 250;
sp804_set_runmode(0, 1); /* Periodic */
sp804_set_wrapmode(0, 0); /* Wrapping */
sp804_set_widthmode(0, 1); /* 32 bit */
sp804_set_irq(0, 1); /* Enable */
sp804_load_value(0, duration);
sp804_set_runmode(timer_base, run_mode); /* Periodic */
sp804_set_wrapmode(timer_base, wrap_mode); /* Wrapping */
sp804_set_widthmode(timer_base, width); /* 32 bit */
sp804_set_irq(timer_base, irq_enable); /* Enable */
sp804_load_value(timer_base, duration);
}