/* This file is part of test microkernel for OpenRISC 1000. */
|
/* This file is part of test microkernel for OpenRISC 1000. */
|
/* (C) 2001 Simon Srot, srot@opencores.org */
|
/* (C) 2001 Simon Srot, srot@opencores.org */
|
|
|
#include "spr_defs.h"
|
#include "spr_defs.h"
|
#include "int.h"
|
#include "int.h"
|
#include "support.h"
|
#include "support.h"
|
|
|
/* Tick timer period */
|
/* Tick timer period */
|
unsigned long tick_period;
|
unsigned long tick_period;
|
|
|
/* Inform of tick interrupt */
|
/* Inform of tick interrupt */
|
void (*tick_inf)();
|
void (*tick_inf)();
|
|
|
/* Tick interrupt routine */
|
/* Tick interrupt routine */
|
void tick_int()
|
void tick_int()
|
{
|
{
|
/* Call inf routine */
|
/* Call inf routine */
|
(*tick_inf)();
|
(*tick_inf)();
|
|
|
/* Set new counter period iand clear inet pending bit */
|
/* Set new counter period iand clear inet pending bit */
|
/* mtspr(SPR_TTMR, SPR_TTMR_IE | SPR_TTMR_SR | (period & SPR_TTMR_PERIOD));*/
|
/* mtspr(SPR_TTMR, SPR_TTMR_IE | SPR_TTMR_SR | (period & SPR_TTMR_PERIOD));*/
|
}
|
}
|
|
|
/* Initialize routine */
|
/* Initialize routine */
|
int tick_init(unsigned long period, void (* inf)())
|
int tick_init(unsigned long period, void (* inf)())
|
{
|
{
|
/* Save tick timer period and inform routine */
|
/* Save tick timer period and inform routine */
|
tick_period = period;
|
tick_period = period;
|
tick_inf = inf;
|
tick_inf = inf;
|
|
|
/* Add interrupt handler */
|
/* Add interrupt handler */
|
int_add(V_TICK, tick_int, 0/*, INT_HIGH_PRI*/);
|
int_add(V_TICK, tick_int, 0, INT_HIGH_PRI);
|
|
|
/* Set counter period, enable timer and interrupt */
|
/* Set counter period, enable timer and interrupt */
|
mtspr(SPR_TTMR, SPR_TTMR_IE | SPR_TTMR_CR | (period & SPR_TTMR_PERIOD));
|
mtspr(SPR_TTMR, SPR_TTMR_IE | SPR_TTMR_CR | (period & SPR_TTMR_PERIOD));
|
|
|
return 0;
|
return 0;
|
}
|
}
|
|
|