Subversion Repositories shark

/*

 * Project: S.Ha.R.K.

 *

 * Coordinators:

 *   Giorgio Buttazzo    <giorgio@sssup.it>

 *   Paolo Gai           <pj@gandalf.sssup.it>

 *

 * Authors     :

 *   Trimarchi Michael   <trimarchi@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 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 WARR2ANTY; without even the implied waRR2anty 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 <arch/stdio.h>

#include <arch/string.h>

#include <kernel/model.h>

#include <kernel/descr.h>

#include <kernel/var.h>

#include <kernel/func.h>

#include "nonestar.h"

#include "fsf_configuration_parameters.h"

#include "fsf_core.h"

#include "fsf_server.h"

#include "tracer.h"

#include <posix/posix/comm_message.h>

//#define NONESTAR_DEBUG

#define NONESTAR_CHANGE_LEVEL 1

/*+ Status used in the level +*/

#define NONESTAR_READY   MODULE_STATUS_BASE

#define NONESTAR_IDLE 0

typedef struct {

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

  int server_Q;

  int server_T;

  int budget;

  int current;

  int status;

  int flag;

  int scheduling_level;

  int new_level[MAX_PROC];

} NONESTAR_level_des;

static int NONESTAR_public_eligible(LEVEL l, PID p)

{

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

  return level_table[ lev->scheduling_level ]->

      private_eligible(lev->scheduling_level,p);

  return 0;

}

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

{

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

  if (m->pclass != DUMMY_PCLASS) return -1;

  if (m->level != 0 && m->level != l) return -1;

  if (lev->current != NIL) return -1;

#ifdef NONESTAR_DEBUG

  kern_printf("(NN:Crt:%d)",p);

#endif

  lev->current = p;

  lev->flag = 0;

  lev->status = NONESTAR_IDLE;

  proc_table[p].avail_time = lev->server_Q;

  proc_table[p].wcet       = lev->server_Q;                                                                                    

  proc_table[p].control = (proc_table[p].control & ~CONTROL_CAP);                  

  return 0; /* OK */

}

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

{

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

  #ifdef NONESTAR_DEBUG

     kern_printf("(NN:Dsp:%d)",p);

  #endif

  if (!nostop) {

    level_table[ lev->scheduling_level ] ->

      private_dispatch(lev->scheduling_level, p, nostop);

  }

}

static int NONESTAR_change_level(LEVEL l, PID p)

{

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

  /* Change task level */

  if (lev->flag & NONESTAR_CHANGE_LEVEL) {

    STD_command_message msg;

    if (lev->current!=NIL && lev->status!=NONESTAR_IDLE) {

       level_table[ lev->scheduling_level ]->

          private_extract(lev->scheduling_level, p);

    }

    lev->current = NIL;

    lev->budget = -1;

    proc_table[p].task_level = lev->new_level[p];

    lev->flag=0;

    /* Send change level command to local scheduler */

    msg.command = STD_ACTIVATE_TASK;

    msg.param = NULL;

    level_table[ lev->new_level[p] ]->public_message(lev->new_level[p],p,&msg);

    return 1;

  }

  return 0;

}

static void NONESTAR_public_epilogue(LEVEL l, PID p)

{

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

  //int r;

  #ifdef NONESTAR_DEBUG

     kern_printf("(NN:Epi:%d)",p);

  #endif

  if (NONESTAR_change_level(l, p)) return;

  level_table[ lev->scheduling_level ] ->

    private_epilogue(lev->scheduling_level,p);

/*

  r = SERVER_get_remain_capacity(lev->scheduling_level,lev->budget);

  if (r < 0) {

    #ifdef NONESTAR_DEBUG

      kern_printf("(NN:NONE END %d)",p);

    #endif

    lev->status = NONESTAR_IDLE;

    level_table[ lev->scheduling_level ]->

        private_extract(lev->scheduling_level, p);

  }  

*/

}

static void NONESTAR_public_activate(LEVEL l, PID p, struct timespec *o)

{

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

  BUDGET_TASK_MODEL b;

  TIME Q;

  budget_task_default_model(b, lev->budget);

  #ifdef NONESTAR_DEBUG

    kern_printf("(NN:Act:%d:%d)",p,lev->budget);

  #endif

  GRUBSTAR_getbudgetinfo(lev->scheduling_level, &Q, NULL, NULL, lev->budget);

  lev->server_Q=Q;

  proc_table[p].avail_time = lev->server_Q;

  proc_table[p].wcet       = lev->server_Q;                                                                              

  lev->status = NONESTAR_READY;

  level_table[ lev->scheduling_level ]->

    private_insert(lev->scheduling_level, p, (TASK_MODEL *)&b);

}

static void NONESTAR_public_unblock(LEVEL l, PID p)

{

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

  BUDGET_TASK_MODEL b;

#ifdef NONESTAR_DEBUG

  kern_printf("(NS:pu %d)",p);

#endif

  lev->current=p;

  budget_task_default_model(b, lev->budget);

  lev->status=NONESTAR_READY;

  level_table[ lev->scheduling_level ]->

    private_insert(lev->scheduling_level, p, (TASK_MODEL *)&b);

}

static void NONESTAR_public_block(LEVEL l, PID p)

{  

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

#ifdef NONESTAR_DEBUG

  kern_printf("(NN:pb %d)", p);

#endif

  lev->status=NONESTAR_IDLE;

  /* the task is blocked on a synchronization primitive. we have to

     remove it from the master module -and- from the local queue! */

  lev->current=NIL;

  level_table[ lev->scheduling_level ]->

     private_extract(lev->scheduling_level, p);

}

static int NONESTAR_public_message(LEVEL l, PID p, void *m)

{

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

  STD_command_message *msg;

  DUMMY_TASK_MODEL    *h;

  switch ((long)(m)) {

    /* Task EndCycle */

    case (long)(NULL):

      #ifdef NONESTAR_DEBUG

        kern_printf("(NN:EndCycle:%d)",p);

      #endif

      if (NONESTAR_change_level(l, p)) return 0;

      lev->status = NONESTAR_IDLE;

      level_table[ lev->scheduling_level ]->

        private_extract(lev->scheduling_level, p);

      level_table[ lev->scheduling_level ]->

        public_message(lev->scheduling_level, p, NULL);

      TRACER_LOGEVENT(FTrace_EVT_task_end_cycle,proc_table[p].context,proc_table[p].task_level);

      jet_update_endcycle(); /* Update the Jet data... */

      break;

    /* Task Disable */

    case (long)(1):

      break;

    default:

      msg = (STD_command_message *)m;

      switch(msg->command) {

      case STD_SET_NEW_MODEL:

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

           valid pclass. */

        /* now we know that m is a valid model */

        lev->flag = 0;      

        lev->current = p;

        lev->status = NONESTAR_IDLE;

        break;

      case STD_SET_NEW_LEVEL:

        lev->flag |= NONESTAR_CHANGE_LEVEL;

        lev->new_level[p] = (int)(msg->param);

        break;

      case STD_ACTIVATE_TASK:

      /* Enable wcet check */

        proc_table[p].avail_time = lev->server_Q;

        proc_table[p].wcet       = lev->server_Q;

        proc_table[p].control = (proc_table[p].control & ~CONTROL_CAP);                

        NONESTAR_public_activate(l, p, NULL);

        break;

      }

      break;

  }

  return 0;

}

static void NONESTAR_public_end(LEVEL l, PID p)

{

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

  #ifdef NONESTAR_DEBUG

    kern_printf("(NN:End:%d)", p);

  #endif

  lev->current = NIL;

  lev->status = NONESTAR_IDLE;

  proc_table[p].status = FREE;

}

/* Registration functions */

/*+ Registration function:

    TIME slice                the slice for the Round Robin queue +*/

LEVEL NONESTAR_register_level(int master)

{

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

  NONESTAR_level_des *lev;  /* for readableness only */

  int i=0;

  l = level_alloc_descriptor(sizeof(NONESTAR_level_des));

  lev = (NONESTAR_level_des *)level_table[l];

  lev->l.public_guarantee = NULL;

  lev->l.public_create    = NONESTAR_public_create;

  lev->l.public_end       = NONESTAR_public_end;

  lev->l.public_dispatch  = NONESTAR_public_dispatch;

  lev->l.public_epilogue  = NONESTAR_public_epilogue;

  lev->l.public_activate  = NONESTAR_public_activate;

  lev->l.public_unblock   = NONESTAR_public_unblock;

  lev->l.public_block     = NONESTAR_public_block;

  lev->l.public_message   = NONESTAR_public_message;

  lev->l.public_eligible  = NONESTAR_public_eligible;

  lev->budget = NIL;

  lev->current = NIL;

  lev->flag = 0;

  lev->status = NONESTAR_IDLE;

  lev->server_Q = 0;

  lev->server_T = 0;

  lev->scheduling_level = master;

  for(i=0; i<MAX_PROC; i++)

    lev->new_level[i]      = -1;

  return l;

}

int NONESTAR_setbudget(LEVEL l, PID p, int budget)

{

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

  lev->budget = budget;

  return 0;

}

int NONESTAR_getbudget(LEVEL l, PID p)

{

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

  return lev->budget;

}

int NONESTAR_budget_has_thread(LEVEL l, int budget)

{                                                                                                                            

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

  if (lev->budget == budget) return 1;                                                                                                            

  return 0;

}

int NONESTAR_get_current(LEVEL l) {

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

  return lev->current;

}

int NONESTAR_get_remain_capacity(int budget)

{

  return SERVER_get_remain_capacity(fsf_get_server_level(),budget);

}

int NONESTAR_get_last_reclaiming(int budget)

{

  return SERVER_get_last_reclaiming(fsf_get_server_level(),exec_shadow);

}