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
 */

/*
 * Copyright (C) 2000 Giorgio Buttazzo, Paolo Gai, Massimiliano Giorgi
 *
 * 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
 *
 *
 * CVS :        $Id: aster7.c,v 1.3 2004-04-17 11:36:12 giacomo Exp $

 this is a part of the classic Hartik demo Aster.

 it is based on test 10(A), and test the PS with RM.

 The JetControl is served by a dedicated Polling Server, too.

 There are APER_MAX tasks sleeping, and when an asteroide task finish
 the current activation, it activate also an aperiodic task chosen
 randomly (if the task chosen is already active, the task_activate do
 nothing!)

*/

#include "kernel/kern.h"
#include "modules/edf.h"

#include <drivers/shark_linuxc26.h>
#include <drivers/shark_input26.h>
#include <drivers/shark_keyb26.h>

int num_aster = 0;
#define ASTER_LIM       60
#define DISPLAY_MAX     15
#define ASTER_MAX       70
#define STAT_Y           9

#define APER_MAX         8

/* Pentium 133 / Celeron 366 */
#define PER_WCET     25000 /* 7800 */
#define APER_WCET     5500 /* 1400 */
#define CLOCK_WCET     500 /* 200 */
#define ASTER_WCET     500 /* 200 */

#define APER_REP     2200

PID aper_table[APER_MAX];

PID shutdown_task_PID = -1;

int device_drivers_init() {
       
        KEYB_PARMS kparms = BASE_KEYB;
                                                                                                                     
        LINUXC26_register_module();

        keyb_def_ctrlC(kparms, NULL);
                                                                                                                             
        INPUT26_init();

        KEYB26_init(&kparms);

        return 0;
                                                                                                                             
}

int device_drivers_close() {

        KEYB26_close();

        INPUT26_close();

        return 0;

}

TASK shutdown_task_body(void *arg) {

        device_drivers_close();

        sys_shutdown_message("-- S.Ha.R.K. Closed --\n");

        sys_end();

        return NULL;

}

void set_shutdown_task() {

        NRT_TASK_MODEL nrt;

        nrt_task_default_model(nrt);

        shutdown_task_PID = task_create("Shutdown Task",shutdown_task_body,&nrt,NULL);
        if (shutdown_task_PID == NIL) {
                sys_shutdown_message("Error: Cannot create shutdown task\n");
                sys_end();
        }

}

TASK asteroide(void)
{
    int i;
    int y = rand() % 7 + 1;

    int load1,j;

    char s[2];

    s[0] = '*'; s[1] = 0;

    /*for (;;)*/ {
      i = 1;
      while (i < ASTER_LIM) {
        load1 = 10000; //8000 + rand()%2000;
        for (j=0; j<load1; j++) {
          s[0] = '*' + rand() % 100;
          puts_xy(i,y,rand()%15+1,s);
        }

        task_activate(aper_table[rand()%APER_MAX]);
        task_endcycle();

        puts_xy(i,y,WHITE," ");
        i++;
      }
    }
    num_aster--;
    return 0;
}

TASK aper_asteroid(void *a)
{
    int i;
    int y = rand() % 7 + 1;

    int load1,j;
    int c;

    char s[2];

    c = (int)a;
    s[0] = '*'; s[1] = 0;

    for (;;) {
      i = 1;
      while (i < ASTER_LIM) {
        load1 = APER_REP; //8000 + rand()%2000;
        for (j=0; j<load1; j++) {
          s[0] = '*' + rand() % 100;
          puts_xy(i,y,rand()%15+1,s);
        }
        s[0] = c;
        puts_xy(i,y,rand()%15+1,s);

        task_endcycle();

        puts_xy(i,y,WHITE," ");
        i++;
      }
    }
}

TASK aster()
{
    PID p;

    HARD_TASK_MODEL m;
    int r;
    int x; // adaptive bandwidth...

    hard_task_default_model(m);
    hard_task_def_wcet(m,PER_WCET);
    hard_task_def_ctrl_jet(m);

    x = 200;

    srand(7);
    while (1) {
        if (num_aster < ASTER_MAX) {
            r = (rand() % 200);

            hard_task_def_arg(m,(void *)((rand() % 7)+1));
            hard_task_def_mit(m, (x+r)*1000);
            p = task_create("aaa",asteroide,&m,NULL);
            if (p == -1)
            {
              if (x < 500 && errno != ENO_AVAIL_TASK)  x += 1;
              printf_xy(62,3,WHITE,"adapt=%3u err=%d",
                        iq_query_first(&freedesc),errno);
            }
            else {
              num_aster++;
              printf_xy(62,3,WHITE,"adapt=%3u           ",x);//,errno);
              task_activate(p);
              x /= 2;
              if (x<50) x = 50;
            }
        }
        task_endcycle();
    }
}

TASK clock()
{
    int s = 0, m = 0;

    while(1) {
        printf_xy(62,1,WHITE,"%2d:%2d ast=%d",m,s, num_aster);
        printf_xy(62,2,WHITE,"U=%12u",EDF_usedbandwidth(0));
        task_endcycle();

        if (++s > 59) {
            s = 0;
            m++;
        }
        printf_xy(62,1,WHITE,"%2d:%2d ast=%d",m,s, num_aster);
        printf_xy(62,2,WHITE,"U=%12u",EDF_usedbandwidth(0));
        task_endcycle();
    }
}



/* we consider the first ASTER_MAX + 2 tasks from the PID 2
   and plot on the screen the elapsed times... */
TASK jetcontrol()
{
  int i;  /* a counter */
  TIME sum, max, curr, last[5];
  int nact;
  int j; /* the elements set by jet_gettable */
  PID p;


  kern_cli();
  printf_xy(0,STAT_Y,WHITE,"PID ³ Mean T.³ Max T. ³ N.A. ³ Curr.   ³ Last1 ³ Last2 ³ Last3 ³ Last4 ³ Last5");
  kern_sti();

  for (;;) {
    for (i=0,p=0; i<DISPLAY_MAX+5 && p<MAX_PROC; p++) {
       if (jet_getstat(p, &sum, &max, &nact, &curr) == -1) continue;

       for (j=0; j<5; j++) last[j] = 0;
       jet_gettable(p, &last[0], 5);
       kern_cli();
       printf_xy(0,STAT_Y+i+1,WHITE,"%-3d ³ %-6d ³ %-6d ³ %-4d ³ %-7d ³ %-5d ³ %-5d ³ %-5d ³ %-5d ³ %-5d",
                 p, (int)sum/(nact==0 ? 1 : nact), (int)max, nact, (int)curr, (int)last[0], (int)last[1], (int)last[2], (int)last[3], (int)last[4]);
       kern_sti();
       i++;
    }
  }
}


void fine(KEY_EVT *e)
{
  task_activate(shutdown_task_PID);
}


int main(int argc, char **argv)
{
    PID p1,p2,p3; //,p4,p5,p6;
    HARD_TASK_MODEL m;
    NRT_TASK_MODEL m_nrt;
    SOFT_TASK_MODEL m_aper;
    int i;

    set_shutdown_task();

    device_drivers_init();

    KEY_EVT emerg;

    clear();

    cprintf("Press Alt-x to end the demo...");

    //keyb_set_map(itaMap);
    emerg.ascii = 'x';
    emerg.scan = KEY_X;
    emerg.flag = ALTL_BIT;
    emerg.status = KEY_PRESSED;
    keyb_hook(emerg,fine,FALSE);

    hard_task_default_model(m);
    hard_task_def_wcet(m,ASTER_WCET);
    hard_task_def_mit(m,10000);
    hard_task_def_group(m,1);
    hard_task_def_ctrl_jet(m);

    nrt_task_default_model(m_nrt);
    nrt_task_def_group(m_nrt,1);
    nrt_task_def_ctrl_jet(m_nrt);

    p1 = task_create("Aster",aster,&m,NULL);
    if (p1 == -1) {
        sys_shutdown_message("test7.c(main): Could not create task <aster> ...");
        task_activate(shutdown_task_PID);
        return 0;
    }

    hard_task_def_mit(m,500000);
    hard_task_def_wcet(m,CLOCK_WCET);
    p2 = task_create("Clock",clock,&m,NULL);
    if (p2 == -1) {
        sys_shutdown_message("test7.c(main): Could not create task <Clock> ...");
        task_activate(shutdown_task_PID);
        return 0;
    }

    soft_task_default_model(m_aper);
    soft_task_def_ctrl_jet(m_aper);
    soft_task_def_level(m_aper, 1);
    soft_task_def_group(m_aper,1);
    soft_task_def_aperiodic(m_aper);
    p3 = task_create("JetControl",jetcontrol,&m_aper,NULL);
    if (p3 == -1) {
        sys_shutdown_message("test7.c(main): Could not create task <JetControl> ...");
        task_activate(shutdown_task_PID);
        return 0;
    }

    soft_task_def_wcet(m_aper,APER_WCET);
    soft_task_def_ctrl_jet(m_aper);
    soft_task_def_aperiodic(m_aper);

    for (i=0; i<APER_MAX; i++) {
      soft_task_def_level(m_aper, i/4 + 3);
      soft_task_def_arg(m_aper, (void *)(i/4 ? 'Û' : '±'));
      aper_table[i] = task_create("aper",aper_asteroid,&m_aper,NULL);
      if (aper_table[i] == -1) {
        sys_shutdown_message("test7.c(main): Could not create task <aper> ...");
        task_activate(shutdown_task_PID);
        return 0;
      }
    }

    group_activate(1);
    return 0;
}