Subversion Repositories openrisc_me

/*

 *  timer for the Hitachi SH 704X

 *

 *  This file manages the benchmark timer used by the RTEMS Timing Test

 *  Suite.  Each measured time period is demarcated by calls to

 *  Timer_initialize() and Read_timer().  Read_timer() usually returns

 *  the number of microseconds since Timer_initialize() exitted.

 *

 *  NOTE: It is important that the timer start/stop overhead be

 *        determined when porting or modifying this code.

 *

 *  Authors: Ralf Corsepius (corsepiu@faw.uni-ulm.de) and

 *           Bernd Becker (becker@faw.uni-ulm.de)

 *

 *  COPYRIGHT (c) 1997-1998, FAW Ulm, Germany

 *

 *  This program is distributed in the hope that it will be useful,

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.

 *

 *  COPYRIGHT (c) 1998.

 *  On-Line Applications Research Corporation (OAR).

 *  Copyright assigned to U.S. Government, 1994.

 *

 *  The license and distribution terms for this file may be

 *  found in the file LICENSE in this distribution or at

 *  http://www.OARcorp.com/rtems/license.html.

 *

 *  $Id: timer.c,v 1.2 2001-09-27 12:01:39 chris Exp $

 */

#include <rtems.h>

#include <rtems/score/sh_io.h>

#include <rtems/score/iosh7045.h>

/*

 *  We use a Phi/4 timer

 */

#define SCALE (Timer_MHZ/4)

#define MTU1_STARTMASK  0xfd

#define MTU1_SYNCMASK   0xfd

#define MTU1_MODEMASK   0xc0

#define MTU1_TCRMASK    0x01

#define MTU1_TIORMASK   0x88

#define MTU1_STAT_MASK  0xf8

#define MTU1_TIERMASK   0xfc

#define IPRC_MTU1_MASK  0xfff0

#ifndef MTU1_PRIO

#define MTU1_PRIO 15

#endif

#define MTU1_VECTOR 86

rtems_isr timerisr();

static rtems_unsigned32 Timer_interrupts;

rtems_boolean Timer_driver_Find_average_overhead;

static rtems_unsigned32 Timer_MHZ ;

void Timer_initialize( void )

{

  rtems_unsigned8  temp8;

  rtems_unsigned16 temp16;

  rtems_unsigned32 level;

  rtems_isr        *ignored;

  Timer_MHZ = rtems_cpu_configuration_get_clicks_per_second() / 1000000 ;

  /*

   *  Timer has never overflowed.  This may not be necessary on some

   *  implemenations of timer but ....

   */

  Timer_interrupts /* .i */ = 0;

  _CPU_ISR_Disable( level);

  /*

   *  Somehow start the timer

   */

  /* stop Timer 1  */

  temp8 = read8( MTU_TSTR) & MTU1_STARTMASK;

  write8( temp8, MTU_TSTR);

  /* initialize counter 1 */

  write16( 0, MTU_TCNT1);

  /* Timer 1 is independent of other timers */

  temp8 = read8( MTU_TSYR) & MTU1_SYNCMASK;

  write8( temp8, MTU_TSYR);

  /* Timer 1, normal mode */

  temp8 = read8( MTU_TMDR1) & MTU1_MODEMASK;

  write8( temp8, MTU_TMDR1);

  /* x0000000

   * |||||+++--- Internal Clock

   * |||++------ Count on rising edge

   * |++-------- disable TCNT clear

   * +---------- don`t care

   */

  write8( MTU1_TCRMASK, MTU_TCR1);

  /* gra and grb are not used */

  write8( MTU1_TIORMASK, MTU_TIOR1);

  /* reset all status flags */

  temp8 = read8( MTU_TSR1) & MTU1_STAT_MASK;

  write8( temp8, MTU_TSR1);

  /* enable overflow interrupt */

  write8( MTU1_TIERMASK, MTU_TIER1);

  /* set interrupt priority */

  temp16 = read16( INTC_IPRC) & IPRC_MTU1_MASK;

  temp16 |= MTU1_PRIO;

  write16( temp16, INTC_IPRC);

  /* initialize ISR */

  _CPU_ISR_install_raw_handler( MTU1_VECTOR, timerisr, &ignored );

  _CPU_ISR_Enable( level);

  /* start timer 1 */

  temp8 = read8( MTU_TSTR) | ~MTU1_STARTMASK;

  write8( temp8, MTU_TSTR);

}

/*

 *  The following controls the behavior of Read_timer().

 *

 *  AVG_OVERHEAD is the overhead for starting and stopping the timer.  It

 *  is usually deducted from the number returned.

 *

 *  LEAST_VALID is the lowest number this routine should trust.  Numbers

 *  below this are "noise" and zero is returned.

 */

#define AVG_OVERHEAD      1  /* It typically takes X.X microseconds */

                             /* (Y countdowns) to start/stop the timer. */

                             /* This value is in microseconds. */

#define LEAST_VALID       0 /* 20 */ /* Don't trust a clicks value lower than this */

int Read_timer( void )

{

  rtems_unsigned32 clicks;

  rtems_unsigned32 total ;

  /*

   *  Read the timer and see how many clicks it has been since we started.

   */

  clicks = read16( MTU_TCNT1);   /* XXX: read some HW here */

  /*

   *  Total is calculated by taking into account the number of timer overflow

   *  interrupts since the timer was initialized and clicks since the last

   *  interrupts.

   */

  total = clicks + Timer_interrupts * 65536 ;

  if ( Timer_driver_Find_average_overhead )

    return total / SCALE;          /* in XXX microsecond units */

  else

  {

    if ( total < LEAST_VALID )

      return 0;            /* below timer resolution */

  /*

   *  Somehow convert total into microseconds

   */

    return (total / SCALE - AVG_OVERHEAD) ;

  }

}

/*

 *  Empty function call used in loops to measure basic cost of looping

 *  in Timing Test Suite.

 */

rtems_status_code Empty_function( void )

{

  return RTEMS_SUCCESSFUL;

}

void Set_find_average_overhead(

  rtems_boolean find_flag

)

{

  Timer_driver_Find_average_overhead = find_flag;

}

/* Timer 1 is used */

#pragma interrupt

void timerisr( void )

{

  unsigned8 temp8;

  /* reset the flags of the status register */

  temp8 = read8( MTU_TSR1) & MTU1_STAT_MASK;

  write8( temp8, MTU_TSR1);

  Timer_interrupts += 1;

}