Subversion Repositories shark

/*
 * Project: S.Ha.R.K.
 *
 * Coordinators:
 *   Giorgio Buttazzo    <giorgio@sssup.it>
 *   Paolo Gai           <pj@gandalf.sssup.it>
 *
 * Authors     :
 *   Paolo Gai           <pj@gandalf.sssup.it>
 *   (see the web pages for full authors list)
 *
 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)
 *
 * http://www.sssup.it
 * http://retis.sssup.it
 * http://shark.sssup.it
 */

/**
 ------------
 CVS :        $Id: ptest3.c,v 1.2 2004-05-23 09:05:51 giacomo Exp $

 File:        $File$
 Revision:    $Revision: 1.2 $
 Last update: $Date: 2004-05-23 09:05:51 $
 ------------

 Posix test 3:

   timers...
   it creates two periodic timers that queues signals, a periodic timer
   that create tasks and an one-shot timer.

 non standard function used:
   cprintf
   sys_gettime
   keyboard stuffs
   sys_end

**/

/*
 * Copyright (C) 2000 Paolo Gai
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * 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.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 */

#include <sys/types.h>
#include <pthread.h>
#include <time.h>

#include <kernel/kern.h>
#include <drivers/keyb.h>

int count25 = 0, count26 = 0;

void signal_handler(int signo, siginfo_t *info, void *extra)
{
  switch (signo) {
    case 25:
      count25++;
      break;
    case 26:
      count26++;
      break;
  }

  cprintf("Signal %d code=%s value=%d task=%d count25=%d count26=%d time=%ldusec\n",
              info->si_signo,
              (info->si_code == SI_TIMER) ? "Timer" : "Other",
              info->si_value.sival_int,
              info->si_task,
              count25,
              count26,
              sys_gettime(NULL));
}

void task_timer(union sigval value)
{
  cprintf("task_timer: value = %d, time = %ldusec\n",
              value.sival_int, sys_gettime(NULL));
}

int main(int argc, char **argv)
{
  int err;
  timer_t timer1, timer2, timer3;
  struct itimerspec timeout1, timeout2, timeout3, nulltimeout;
  struct sigaction sig_act;
  struct sigevent ev25, ev26, evtask;
  pthread_attr_t task_attr;
  struct sched_param task_param;

  sig_act.sa_sigaction = (void *) signal_handler;
  sig_act.sa_flags = SA_SIGINFO;
  sigemptyset(&sig_act.sa_mask);

  sigaction(25, &sig_act, NULL);
  sigaction(26, &sig_act, NULL);

  // set ev25, ev26, evtask
  ev25.sigev_notify           = SIGEV_SIGNAL;
  ev25.sigev_signo            = 25;
  ev25.sigev_value.sival_int  = 555;

  ev26.sigev_notify           = SIGEV_SIGNAL;
  ev26.sigev_signo            = 26;
  ev26.sigev_value.sival_int  = 666;

  evtask.sigev_notify            = SIGEV_THREAD;
  evtask.sigev_value.sival_int   = 777;
  evtask.sigev_notify_function   = task_timer;
  evtask.sigev_notify_attributes = &task_attr;

  pthread_attr_init(&task_attr);
  pthread_attr_setdetachstate(&task_attr, PTHREAD_CREATE_DETACHED);
  pthread_attr_setschedpolicy(&task_attr, SCHED_FIFO);
  task_param.sched_priority = 10;
  pthread_attr_setschedparam(&task_attr, &task_param);

  // set timeout1, timeout2, nulltimeout
  timeout1.it_interval.tv_sec  = 0;
  timeout1.it_interval.tv_nsec = 500000000;
  timeout1.it_value.tv_sec     = 3;
  timeout1.it_value.tv_nsec    = 0;

  timeout2.it_interval.tv_sec  = 0;
  timeout2.it_interval.tv_nsec = 200000000;
  timeout2.it_value.tv_sec     = 7;
  timeout2.it_value.tv_nsec    = 0;

  timeout3.it_interval.tv_sec  = 0;
  timeout3.it_interval.tv_nsec = 300000000;
  timeout3.it_value.tv_sec     = 5;
  timeout3.it_value.tv_nsec    = 0;

  NULL_TIMESPEC(&nulltimeout.it_value);
  NULL_TIMESPEC(&nulltimeout.it_interval);

  // create the timers
  err = timer_create(CLOCK_REALTIME, &ev25, &timer1);
  if (err == -1) { cprintf("main: unable to create timer 1\n"); }

  err = timer_create(CLOCK_REALTIME, &ev26, &timer2);
  if (err == -1) { cprintf("main: unable to create timer 2\n"); }

  err = timer_create(CLOCK_REALTIME, &evtask, &timer3);
  if (err == -1) { cprintf("main: unable to create timer 3\n"); }

  // arm the timers
  err = timer_settime(timer1, TIMER_ABSTIME, &timeout1, NULL);
  if (err == -1) { cprintf("main: unable to set timer 1\n"); }

  err = timer_settime(timer2, 0, &timeout2, NULL);
  if (err == -1) { cprintf("main: unable to set timer 2\n"); }

  err = timer_settime(timer3, TIMER_ABSTIME, &timeout3, NULL);
  if (err == -1) { cprintf("main: unable to set timer 3\n"); }

  cprintf("main: waiting signals...\n");
  while (sys_gettime(NULL) < 8500000) {
    //kern_deliver_pending_signals();
  }

  cprintf("main: disarm the timer2\n");
  err = timer_settime(timer2, 0, &nulltimeout, &timeout2);
  if (err == -1) { cprintf("main: unable to disarm timer 2\n"); }

  cprintf("main: timer2 disarmed, itvalue=%ld.%ld\n",
              timeout2.it_value.tv_sec,timeout2.it_value.tv_nsec/1000);

  while (sys_gettime(NULL) < 10000000) {
    //kern_deliver_pending_signals();
  }

  cprintf("main: disarm the timer1\n");
  err = timer_settime(timer1, TIMER_ABSTIME, &nulltimeout, &timeout1);
  if (err == -1) { cprintf("main: unable to disarm timer 1\n"); }

  cprintf("main: timer1 disarmed, itvalue=%ld.%ld\n",
              timeout1.it_value.tv_sec,timeout1.it_value.tv_nsec/1000);

  while (sys_gettime(NULL) < 12000000) {
    //kern_deliver_pending_signals();
  }

  cprintf("main: arm timer1\n");
  timeout1.it_interval.tv_sec  = 0;
  timeout1.it_interval.tv_nsec = 0;
  timeout1.it_value.tv_sec     = 13;
  timeout1.it_value.tv_nsec    = 0;
  err = timer_settime(timer1, TIMER_ABSTIME, &timeout1, NULL);
  if (err == -1) { cprintf("main: unable to arm timer 1\n"); }

  while (sys_gettime(NULL) < 14000000) {
    //kern_deliver_pending_signals();
  }

  cprintf("main: ending...\n");

  return 0;
}