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: static.c,v 1.3 2002-11-11 07:55:13 pj Exp $

 File:        $File$

 Revision:    $Revision: 1.3 $

 Last update: $Date: 2002-11-11 07:55:13 $

 ------------

**/

/*

 * Copyright (C) 2001 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 "static.h"

#include <ll/stdio.h>

#include <ll/string.h>

#include <kernel/model.h>

#include <kernel/descr.h>

#include <kernel/var.h>

#include <kernel/func.h>

#include <kernel/trace.h>

#define STATIC_printf kern_printf

//#define STATIC_printf printk

/*+ Status used in the level +*/

#define STATIC_READY         MODULE_STATUS_BASE    /*+ - Ready status        +*/

#define STATIC_IDLE          MODULE_STATUS_BASE+4  /*+ to wait the deadline  +*/

/*+ flags +*/

#define STATIC_FLAG_NORAISEEXC  2

/*+ the level redefinition for the Earliest Deadline First level +*/

typedef struct {

  level_des l;     /*+ the standard level descriptor          +*/

  IQUEUE mytable;

  PID currenttask;

  struct timespec hp;

  struct timespec ref;

} STATIC_level_des;

static void STATIC_offset_activate(void *par)

{

  PID p = (PID) par;

  STATIC_level_des *lev;

  lev = (STATIC_level_des *)level_table[proc_table[p].task_level];

  lev->currenttask = p;

  event_need_reschedule();

  //  STATIC_printf("(o p%d t%d)", p, (int)proc_table[p].timespec_priority.tv_sec);

}

static void STATIC_activateall(STATIC_level_des *lev)

{

  PID my_table_index;

  struct timespec x;

  STATIC_printf("(A ");

  for (my_table_index = iq_query_first(&lev->mytable);

       my_table_index != NIL;

       my_table_index = iq_query_next(my_table_index, &lev->mytable)) {

    ADDTIMESPEC(&lev->ref,iq_query_timespec(my_table_index, &lev->mytable),&x);

    kern_event_post(&x, STATIC_offset_activate,(void *)my_table_index);

    STATIC_printf("|p%d t%d ",

                  my_table_index,

                  (int)iq_query_timespec(my_table_index, &lev->mytable)->tv_sec);

  }

  STATIC_printf(")");

}

static void STATIC_hyperperiod(void *par)

{

  STATIC_level_des *lev;

  struct timespec x;

  lev = (STATIC_level_des *)level_table[(LEVEL)par];

  STATIC_printf("(hp %d)", (int)lev->ref.tv_sec);

  STATIC_activateall(lev);

  ADDTIMESPEC(&lev->ref, &lev->hp, &x);

  lev->ref = x;

  kern_event_post(&x, STATIC_hyperperiod, par);

}

static int STATIC_level_accept_task_model(LEVEL l, TASK_MODEL *m)

{

  if (m->pclass == STATIC_PCLASS || m->pclass == (STATIC_PCLASS | l))

    return 0;

  return -1;

}

static int STATIC_level_accept_guest_model(LEVEL l, TASK_MODEL *m)

{

  return -1;

}

static void STATIC_level_status(LEVEL l)

{ kern_raise(XINVALID_TASK,exec_shadow); }

/* The scheduler only gets the first task in the queue */

static PID STATIC_level_scheduler(LEVEL l)

{

  STATIC_level_des *lev = (STATIC_level_des *)(level_table[l]);

  return lev->currenttask;

}

/* The on-line guarantee is enabled only if the appropriate flag is set... */

static int STATIC_level_guarantee(LEVEL l, bandwidth_t *freebandwidth)

{

  return 1;

}

static int STATIC_task_create(LEVEL l, PID p, TASK_MODEL *m)

{

  STATIC_level_des *lev = (STATIC_level_des *)(level_table[l]);

  /* if the STATIC_task_create is called, then the pclass must be a

     valid pclass. */

  STATIC_TASK_MODEL *h = (STATIC_TASK_MODEL *)m;

  iq_query_timespec(p, &lev->mytable)->tv_sec = h->offset.tv_sec;

  iq_query_timespec(p, &lev->mytable)->tv_nsec = h->offset.tv_nsec;

  iq_timespec_insert(p,&lev->mytable);

  return 0; /* OK, also if the task cannot be guaranteed... */

}

static void STATIC_task_detach(LEVEL l, PID p)

{

}

static int STATIC_task_eligible(LEVEL l, PID p)

{

  return 0; /* if the task p is chosen, it is always eligible */

}

static void STATIC_task_dispatch(LEVEL l, PID p, int nostop)

{

}

static void STATIC_task_epilogue(LEVEL l, PID p)

{

}

static void STATIC_task_activate(LEVEL l, PID p)

{

}

static void STATIC_task_insert(LEVEL l, PID p)

{

}

static void STATIC_task_extract(LEVEL l, PID p)

{

}

static void STATIC_task_endcycle(LEVEL l, PID p)

{

  STATIC_level_des *lev = (STATIC_level_des *)(level_table[l]);

  lev->currenttask = NIL;

}

static void STATIC_task_end(LEVEL l, PID p)

{

  STATIC_level_des *lev = (STATIC_level_des *)(level_table[l]);

  lev->currenttask = NIL;

  iq_extract(p,&lev->mytable);

  /* we finally put the task in the ready queue */

  proc_table[p].status = FREE;

  iq_insertfirst(p,&freedesc);

}

static void STATIC_task_sleep(LEVEL l, PID p)

{ kern_raise(XINVALID_TASK,exec_shadow); }

/* Guest Functions

   These functions manages a JOB_TASK_MODEL, that is used to put

   a guest task in the STATIC ready queue. */

static int STATIC_guest_create(LEVEL l, PID p, TASK_MODEL *m)

{ kern_raise(XINVALID_GUEST,exec_shadow); return 0; }

static void STATIC_guest_detach(LEVEL l, PID p)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

static void STATIC_guest_dispatch(LEVEL l, PID p, int nostop)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

static void STATIC_guest_epilogue(LEVEL l, PID p)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

static void STATIC_guest_activate(LEVEL l, PID p)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

static void STATIC_guest_insert(LEVEL l, PID p)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

static void STATIC_guest_extract(LEVEL l, PID p)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

static void STATIC_guest_endcycle(LEVEL l, PID p)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

static void STATIC_guest_end(LEVEL l, PID p)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

static void STATIC_guest_sleep(LEVEL l, PID p)

{ kern_raise(XINVALID_GUEST,exec_shadow); }

/* Registration functions */

/*+ Registration function:

    int flags                 the init flags ... see STATIC.h +*/

void STATIC_register_level()

{

  LEVEL l;            /* the level that we register */

  STATIC_level_des *lev;  /* for readableness only */

  printk("STATIC_register_level\n");

  /* request an entry in the level_table */

  l = level_alloc_descriptor();

  printk("    alloco descrittore %d %d\n",l,(int)sizeof(STATIC_level_des));

  /* alloc the space needed for the STATIC_level_des */

  lev = (STATIC_level_des *)kern_alloc(sizeof(STATIC_level_des));

  printk("    lev=%d\n",(int)lev);

  /* update the level_table with the new entry */

  level_table[l] = (level_des *)lev;

  /* fill the standard descriptor */

  strncpy(lev->l.level_name,  STATIC_LEVELNAME, MAX_LEVELNAME);

  lev->l.level_code               = STATIC_LEVEL_CODE;

  lev->l.level_version            = STATIC_LEVEL_VERSION;

  lev->l.level_accept_task_model  = STATIC_level_accept_task_model;

  lev->l.level_accept_guest_model = STATIC_level_accept_guest_model;

  lev->l.level_status             = STATIC_level_status;

  lev->l.level_scheduler          = STATIC_level_scheduler;

  lev->l.level_guarantee        = NULL;

  lev->l.task_create              = STATIC_task_create;

  lev->l.task_detach              = STATIC_task_detach;

  lev->l.task_eligible            = STATIC_task_eligible;

  lev->l.task_dispatch            = STATIC_task_dispatch;

  lev->l.task_epilogue            = STATIC_task_epilogue;

  lev->l.task_activate            = STATIC_task_activate;

  lev->l.task_insert              = STATIC_task_insert;

  lev->l.task_extract             = STATIC_task_extract;

  lev->l.task_endcycle            = STATIC_task_endcycle;

  lev->l.task_end                 = STATIC_task_end;

  lev->l.task_sleep               = STATIC_task_sleep;

  lev->l.guest_create             = STATIC_guest_create;

  lev->l.guest_detach             = STATIC_guest_detach;

  lev->l.guest_dispatch           = STATIC_guest_dispatch;

  lev->l.guest_epilogue           = STATIC_guest_epilogue;

  lev->l.guest_activate           = STATIC_guest_activate;

  lev->l.guest_insert             = STATIC_guest_insert;

  lev->l.guest_extract            = STATIC_guest_extract;

  lev->l.guest_endcycle           = STATIC_guest_endcycle;

  lev->l.guest_end                = STATIC_guest_end;

  lev->l.guest_sleep              = STATIC_guest_sleep;

  /* fill the STATIC descriptor part */

  iq_init(&lev->mytable, &freedesc, 0);

  lev->currenttask = NIL;

  NULL_TIMESPEC(&lev->hp);

  NULL_TIMESPEC(&lev->ref);

}

void STATIC_start(LEVEL l, struct timespec *h, struct timespec *o)

{

  STATIC_level_des *lev = (STATIC_level_des *)(level_table[l]);

  struct timespec x;

  kern_cli();

  ll_gettime(TIME_EXACT, &x);

  lev->hp = *h;

  ADDTIMESPEC(&x,o,&lev->ref);

  STATIC_printf("(ST: ref:%d.%d x:%d.%d)\n",

                (int)lev->ref.tv_sec, (int)lev->ref.tv_nsec,

                (int)x.tv_sec, (int)x.tv_nsec);

  kern_event_post(&x, STATIC_hyperperiod,(void *)l);

  kern_sti();

}