Subversion Repositories or1k

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