sig_timedsem.c

fsmlabs的real time linux的内核

/*
 * Added user signals to timed semaphores test,
 * Dec, 2002 Josep Vidal <[e-mail]> (OCERA)
 */

#include <rtl.h>
#include <rtl_sema.h>
#include <rtl_sched.h>

#define NTASKS 3
#define ONEMILISEC (long long)1000*1000

static pthread_t thread[NTASKS];
long long start_time=0;
static sem_t sem;

static void sig_handler(int sig_rec){
  unsigned int thread_no;
  
  thread_no=(unsigned int)(sig_rec-RTL_SIGRTMIN); 
  rtl_printf("I'm thread %d, temporally blocked (sem_timedwait) on a semaphore...\n",thread_no);
  rtl_printf("but signals handlers are executed regardless being blocked in a sem\n");  
  rtl_printf("After finishing handler execution for signal:%d, I will exit from the semaphore\n",sig_rec);

}

static void *start_routine(void *arg)
{
  struct sched_param p;
  struct sigaction sa;
  int signal=0,err=0,j;
  int param=(unsigned) arg;
  rtl_sigset_t mask;
  
  p . sched_priority =1;//param;
  pthread_setschedparam (pthread_self(), SCHED_FIFO, &p);
  
  sa.sa_handler=sig_handler;
  sa.sa_mask=0;
  sa.sa_flags=0;
  
  // Block all signals except the ones you want to receive.
  if (param){
    rtl_sigfillset(&mask);
    signal=RTL_SIGRTMIN+param;
    
    rtl_sigdelset(&mask,signal);
    pthread_sigmask(SIG_SETMASK,&mask,NULL);
    
    rtl_printf("I am thread %d, programing handler for signal:%d\n",param,signal);
    if ((err=sigaction(signal,&sa,NULL))<0 ){
      rtl_printf("sigaction(%d,&sa,NULL) FAILING, err:%d.\n",signal,err);
    }
  }
  
  if (!param){
    sem_wait(&sem);
    usleep(1000);
    rtl_printf("\n\n\n\n -- WAITING FOR THE OTHER TASKS -- \n\n\n");
    rtl_printf("THREAD %d--> I want to signal not odd threads\n",param);
    
    for (j=1;j<NTASKS;j++) {
      if(thread[j]->magic!=RTL_THREAD_MAGIC) 
	rtl_printf("TEST PANIC!!!!!! thread %d not a valid thread\n",j);
      
      // Send signals only to not odd numbers.
      if (!(j%2)) pthread_kill(thread[j],RTL_SIGRTMIN+j);
    }
    
  } else {
    
    rtl_sigfillset(&mask);
    rtl_sigdelset(&mask,signal);
    pthread_sigmask(SIG_SETMASK,&mask,NULL);
    
    rtl_printf("THREAD %d. Just before adquiring the sem and getting blocked.\n",param);
    /* Ten seconds */
      err = sem_timedwait (&sem, hrt2ts(clock_gethrtime(CLOCK_REALTIME) + 1000*1000*1000LL * 2));
      rtl_printf("THREAD %d. Something has take me from my timed wait ->errno:%d.\n",param,errno);
      if (!(param % 2)){
	if (errno == EINTR){
	  rtl_printf("\n\n TEST SUCCESFULLY PASSED!!!! A signal has take thread %d out from the semaphore errno %d \n\n",param,errno); 
	} else {
	  rtl_printf("\n\n TEST NOT PASSED for thread %d\n\n",param);
	}
      }
  }

  pthread_make_periodic_np(pthread_self(), gethrtime(),1000*1000*1000);
  while(1) pthread_wait_np();
  
  return 0;
}

int init_module(void) {
  int i;

  sem_init(&sem,0,1); 
  
  start_time=gethrtime()+1000*ONEMILISEC;
  
  // Threads creation.
  for (i=0;i<NTASKS;i++)
    pthread_create (&thread[i], NULL, start_routine,(void *) i); 
  
 return 0;
}

void cleanup_module(void) {
  int i;
  
  for (i=0;i<NTASKS;i++){
      pthread_cancel (thread[i]);
      pthread_join (thread[i], NULL);

      //pthread_delete_np (thread[i]);
  }

  sem_destroy(&sem);    

}