/**********************************************************
 * Paulo Pedreiras, Set/2009
 * DETI/UA - Sistemas de Tempo-Real
 *
 * Calcula a diferenca entre os tempos de
 *  activacao consecutivas de um "loop de controlo"
 *
 *  Historia:
 *  	21/Set/2009: Versão 1.0
 *
 ***********************************************************/

#include <stdio.h>
#include <sched.h>
#include <stdlib.h>
#include <signal.h>
#include <sys/time.h>

#define TINTERVAL_US 50000 /* Intervalo entre activacoes, em micro-segundo */
char pexit = 0;


/*
 * Handler do CTRL+C
 */
static void endme(int dummy)
{
  pexit = 1;
}

/*
 * Tarefa de "controlo". Activada periódicamente, com intrevalo TINTERVAL_US
 */
static void timer_tick(int signo)
{
	static struct timeval tcur, tant;
	static first=1;
	long long tantus, tcurus,tdifus,tmaxus,tminus;

	if(first) { /* Primeira activação? */
		gettimeofday(&tant,NULL);
		tmaxus=0;
		tminus=TINTERVAL_US*100;
		first=0;
	} else { /* Activações seguintes */
		gettimeofday(&tcur,NULL);
		tantus=tant.tv_sec*1000000+tant.tv_usec;
		tcurus=tcur.tv_sec*1000000+tcur.tv_usec;
		tdifus=tcurus-tantus;

		if(tdifus>tmaxus)
			tmaxus=tdifus;

		if(tdifus<tminus)
			tminus=tdifus;

		printf("Last activation = %6lld Maximum = %6lld Minumum = %6lld (us)\n",tdifus,tmaxus,tminus);
		tant=tcur;
	}
	return;
}


/*
 * Main
 */
int main(int argc, char *argv[])
{

  struct sched_param proc_sched;
  struct itimerval it1, it2;
  struct sigaction s1,s2;
  int res,i;


  printf("\n\n Control+C to stop\n\n");
  signal(SIGINT, endme);

  /* Define o sigalarm handler (evento gerado pelo itimer) */
  s1.sa_handler=timer_tick;
  sigemptyset(&s1.sa_mask);
  s1.sa_flags=0;
  sigaction( SIGALRM, &s1, &s2);

  /* Define o itimer para activar a tarefa periodicamente */
  it1.it_value.tv_usec=TINTERVAL_US;
  it1.it_value.tv_sec=0;
  it1.it_interval.tv_usec=TINTERVAL_US;
  it1.it_interval.tv_sec=0;
  setitimer (ITIMER_REAL, &it1, &it2);

  /* Espera pelo "CTRL+C" */
  while(!pexit ) {
    sleep(1);
  }

  /* Finito */
  printf("\nDone!\n");
  return 0;

}