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: ptest6.c,v 1.3 2005-01-08 14:36:11 pj Exp $

 File:        $File$
 Revision:    $Revision: 1.3 $
 Last update: $Date: 2005-01-08 14:36:11 $
 ------------

 Posix test 6:

   message queues

   main thread:
     set a sigevent to sigev_thread on a mailbox (that creates thread 2)
     creates thread 1
     waits t=3.5 sec.
     pthread_cancel(T4)

   thread 1:
     send a msg to the mailbox (the event fires and thread 2 is created)

   thread 2:
     receive the msg sent by thread 1
     set the event to a signal
     creates thread 3 and 4
     waits t = 1 sec
     send another msg

   thread 3:
     receive the msg sent by 2 (it blocks!)
     waits t = 2 sec
     send 5 msgs (with different priorities!!!

   thread 4:
     receives 5 msgs every 0.5 sec.
     then receive another message that never will arrive...

 non standard function used:
   cprintf
   sys_gettime
   keyboard stuffs

**/

/*
 * 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 <mqueue.h>

#include <kernel/kern.h>

struct sigevent ev25, evtask;
pthread_attr_t task_attr;
struct sched_param task_param;
mqd_t mq;
pthread_t T1,T2,T3,T4,T5;

#define MESSAGE_LENGTH 100

void *t1(void *arg)
{
  cprintf("T1: started, sending a message\n");
  if (mq_send(mq,"Donald Duck",12,1))
  { cprintf("T1: mq_send returns errno %d\n",errno); return 0; }

  cprintf("T1: ending...\n");
  return 0;
}

void *t4(void *arg);
void *t3(void *arg);

void t2(union sigval value)
{
  ssize_t x;
  char buf[MESSAGE_LENGTH];
  int prio;

  cprintf("T2: value = %d, receiving a message\n", value.sival_int);

  x = mq_receive(mq,buf,MESSAGE_LENGTH,&prio);

  cprintf("T2: received message: length=%ld, prio=%d, text=°%s°, notify...\n",
              x,prio,buf);

  if (mq_notify(mq, &ev25))
  { cprintf("T2: mq_notify returns errno %d\n",errno); exit(1); }

  cprintf("T2: waiting t = 1 sec.\n");
  while (sys_gettime(NULL)<1000000);
  cprintf("T2: 1 sec. reached, sending another message and creating T3 and T4, \n");

  if (mq_send(mq,"Mickey Mouse",13,1))
  { cprintf("T2: mq_send returns errno %d\n",errno); exit(1); }

  pthread_create(&T3, NULL, t3, NULL);
  pthread_create(&T4, NULL, t4, NULL);

  cprintf("T2: ending...\n");
}

void *t3(void *arg)
{
  ssize_t x;
  char buf[MESSAGE_LENGTH];
  int prio;

  cprintf("T3: waiting a message...\n");

  x = mq_receive(mq,buf,MESSAGE_LENGTH,&prio);

  // mickey mouse
  cprintf("T3: received message: length=%ld, prio=%d, text=°%s°\n",
              x,prio,buf);

  cprintf("T3: waiting t = 1.5 sec.\n");
  while (sys_gettime(NULL)<1500000);
  cprintf("T3: 2 sec. reached, sending 5 messages\n");

  if (mq_send(mq,"Goofy",6,1))
  { cprintf("T3: mq_send1 returns errno %d\n",errno); exit(1); }
  cprintf("Û");

  if (mq_send(mq,"Minnie",7,1))
  { cprintf("T3: mq_send2 returns errno %d\n",errno); exit(1); }
  cprintf("Û");

  if (mq_send(mq,"Pluto",6,2))  // NB: different priority!!!
  { cprintf("T3: mq_send3 returns errno %d\n",errno); exit(1); }
  cprintf("Û");

  if (mq_send(mq,"Rocker Duck",12,2))  // NB: different priority!!!
  { cprintf("T3: mq_send4 returns errno %d\n",errno); exit(1); }
  cprintf("Û");

  if (mq_send(mq,"Oncle Scroodge",15,2))  // NB: different priority!!!
  { cprintf("T3: mq_send5 returns errno %d\n",errno); exit(1); }
  cprintf("Û");

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

  return 0;
}

void t4exit(void *arg)
{
  cprintf("T4: AAAARRRRGGGHHH!!! killed by someone...\n");
}

void *t4(void *arg)
{
  ssize_t x;
  char buf[MESSAGE_LENGTH];
  int prio;

  cprintf("T4: waiting t = 2.2 sec.\n");

  while (sys_gettime(NULL)<2200000);
  x = mq_receive(mq,buf,MESSAGE_LENGTH,&prio);
  cprintf("T4: received message: length=%ld, prio=%d, text=°%s°\n",x,prio,buf);

  while (sys_gettime(NULL)<2400000);
  x = mq_receive(mq,buf,MESSAGE_LENGTH,&prio);
  cprintf("T4: received message: length=%ld, prio=%d, text=°%s°\n",x,prio,buf);
  while (sys_gettime(NULL)<2600000);

  x = mq_receive(mq,buf,MESSAGE_LENGTH,&prio);
  cprintf("T4: received message: length=%ld, prio=%d, text=°%s°\n",x,prio,buf);
  while (sys_gettime(NULL)<2800000);

  x = mq_receive(mq,buf,MESSAGE_LENGTH,&prio);
  cprintf("T4: received message: length=%ld, prio=%d, text=°%s°\n",x,prio,buf);
  while (sys_gettime(NULL)<3000000);

  x = mq_receive(mq,buf,MESSAGE_LENGTH,&prio);
  cprintf("T4: received message: length=%ld, prio=%d, text=°%s°\n",x,prio,buf);

  pthread_cleanup_push(t4exit,NULL);
  x = mq_receive(mq,buf,MESSAGE_LENGTH,&prio);
  cprintf("T4: received message: length=%ld, prio=%d, text=°%s°\n",x,prio,buf);
  pthread_cleanup_pop(0);

  return 0;
}

void signal_handler(int signo, siginfo_t *info, void *extra)
{
  cprintf("Signal %d code=%s value=%d task=%d time=%ldusec\n",
              info->si_signo,
              (info->si_code == SI_TIMER) ? "Timer" : "Other",
              info->si_value.sival_int,
              info->si_task,
              sys_gettime(NULL));
}

int main(int argc, char **argv)
{
//  int err;
  struct sigaction sig_act;
  struct mq_attr attr;

  sig_act.sa_sigaction = (void *) signal_handler;
  sig_act.sa_flags = SA_SIGINFO;
  sigemptyset(&sig_act.sa_mask);
  sigaction(25, &sig_act, NULL);

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

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

  // set pthread attributes
  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 mqueue attributes
  attr.mq_flags   = 0;
  attr.mq_maxmsg  = 3;
  attr.mq_msgsize = MESSAGE_LENGTH;

  // create the message queue
  if ((mq = mq_open("mq", O_CREAT|O_RDWR, 0, &attr)) == -1)
  { cprintf("main: mq_open returns errno %d\n",errno); return 0; }

  if (mq_notify(mq, &evtask))
  { cprintf("main: mq_notify returns errno %d\n",errno); return 0; }

  cprintf("main: created mq, creating T1...\n");

  pthread_create(&T1, NULL, t1, NULL);

  cprintf("main: waiting t= 3.5 sec., then kill T4...\n");

  while (sys_gettime(NULL)<3500000);

  pthread_cancel(T4);

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

  return 0;
}