mstimer.c

Go to the documentation of this file.

 
#include "simpletools.h"                      // Include simpletools
#include "mstimer.h"
 
static volatile int t, dt, cog;               // Global var for cogs to share
static unsigned int stack[40 + 25];           // Stack vars for other cog
 
void ms_timer(void *par);                 
 
int mstime_start()
{
  mstime_stop();
  cog = 1 + cogstart(ms_timer, NULL, stack, sizeof(stack));
}
 
void mstime_stop()
{
  if(cog)
  {
    cogstop(cog -1);
    cog = 0;
  }    
}
 
int mstime_get()
{
  return t;
}
 
void mstime_reset()
{
  t = 0;
}
 
void mstime_set(int newTime)
{
  t = newTime;
}
 
// Function runs in another cog
void ms_timer(void *par)                      
{
  dt = CLKFREQ/1000;
  int ticks = CNT;
  while(1)                                   
  {
    waitcnt(ticks+=dt);                              
    t++;                                     
  }                            
}