#include "../lib.h"

 #define TMU_CHANNEL 2

 #define TOCR 0xFFD80000  /* Output control register */

 #define TSTR 0xFFD80004  /* Start register */

 #define TCOR(c) (0xFFD80008 + (c*12))  /* Constant register */

 #define TCNT(c) (0xFFD8000C + (c*12))  /* Count register */

 #define TCR(c)  (0xFFD80010 + (c*12))  /* Control register */

 /**

  * Initialize the on-chip timer controller. We snag TMU channel 2 in its

  * highest resolution mode, and start it counting down from max_int. 

  */

 void timer_start() {

     unsigned int val = long_read(TSTR);

     long_write( TSTR, val & (~(1<<TMU_CHANNEL)) ); /* Stop counter */

     long_write( TCOR(TMU_CHANNEL), 0xFFFFFFFF );

     long_write( TCNT(TMU_CHANNEL), 0xFFFFFFFF );

     long_write( TCR(TMU_CHANNEL), 0x00000000 );

     long_write( TSTR, val | (1<<TMU_CHANNEL) );

 }

 /**

  * Report the current value of TMU2.

  */

 long timer_gettime() {

     return long_read(TCNT(TMU_CHANNEL));

 }

 /**

  * Stop TMU2 and report the current value.

  */

 long timer_stop() {

     long_write( TSTR, long_read(TSTR) & (~(1<<TMU_CHANNEL)) );

     return long_read( TCNT(TMU_CHANNEL) );

 }

 /**

  * Convert the supplied timer value to a number of micro seconds since the timer

  * was started.

  */

 long timer_to_microsecs( long value ) {

     return value;

 }