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

#include "mpegstar.h"

#include "fsf_server.h"

//#define MPEGSTAR_DEBUG

/*+ Status used in the level +*/

#define MPEGSTAR_READY   MODULE_STATUS_BASE

/*+ the level redefinition for the Round Robin level +*/

typedef struct {

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

  int server_Q;

  int server_T;

  int budget;

  int current;

  int scheduling_level;

  int cap_lev;

} MPEGSTAR_level_des;

static void capacity_handler(void *l)

{

  MPEGSTAR_level_des *lev = l;

  lev->cap_lev = NIL;

  event_need_reschedule();

}

static int MPEGSTAR_public_eligible(LEVEL l, PID p)

{

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

  return level_table[ lev->scheduling_level ]->

      private_eligible(lev->scheduling_level,p);

  return 0;

}

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

{

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

  #ifdef MPEGSTAR_DEBUG

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

  #endif

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

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

  lev->current = p;

  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 MPEGSTAR_public_dispatch(LEVEL l, PID p, int nostop)

{

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

  struct timespec ty;

  #ifdef MPEGSTAR_DEBUG

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

  #endif

  if (!nostop) {

  TIMESPEC_ASSIGN(&ty, &schedule_time);

  /* ...and finally, we have to post a capacity event on exec task because the shadow_task consume

   *        capacity on exe task always */

  ADDUSEC2TIMESPEC(proc_table[p].avail_time ,&ty);

  lev->cap_lev = kern_event_post(&ty,capacity_handler, lev);

  level_table[ lev->scheduling_level ] ->

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

  }

}

static void MPEGSTAR_public_epilogue(LEVEL l, PID p)

{

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

  if (lev->cap_lev!=NIL) {

        kern_event_delete(lev->cap_lev);

        lev->cap_lev=NIL;

  }

  #ifdef MPEGSTAR_DEBUG

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

  #endif

  level_table[ lev->scheduling_level ] ->

    private_epilogue(lev->scheduling_level,p);

}

static void MPEGSTAR_public_activate(LEVEL l, PID p)

{

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

  BUDGET_TASK_MODEL b;

  budget_task_default_model(b, lev->budget);

  #ifdef MPEGSTAR_DEBUG

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

  #endif

  level_table[ lev->scheduling_level ]->

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

}

static void MPEGSTAR_public_unblock(LEVEL l, PID p)

{

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

}

static void MPEGSTAR_public_block(LEVEL l, PID p)

{  

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

}

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

{

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

  switch ((long)(m)) {

    /* Task EndCycle */

    case (long)(NULL):

      lev->current = NIL;

      kern_printf("(Ext %d)",p);

      if (lev->cap_lev != NIL) {

        kern_event_delete(lev->cap_lev);

        lev->cap_lev = NIL;

      }

      level_table[ lev->scheduling_level ]->

        private_extract(lev->scheduling_level, p);

      level_table[ lev->scheduling_level ]->

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

      break;

    /* Task Disable */

    case (long)(1):

      break;

    default:

      break;

  }

  return 0;

}

static void MPEGSTAR_public_end(LEVEL l, PID p)

{

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

}

/* Registration functions */

/*+ Registration function:

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

LEVEL MPEGSTAR_register_level(int master)

{

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

  MPEGSTAR_level_des *lev;  /* for readableness only */

  l = level_alloc_descriptor(sizeof(MPEGSTAR_level_des));

  lev = (MPEGSTAR_level_des *)level_table[l];

  lev->l.public_guarantee = NULL;

  lev->l.public_create    = MPEGSTAR_public_create;

  lev->l.public_end       = MPEGSTAR_public_end;

  lev->l.public_dispatch  = MPEGSTAR_public_dispatch;

  lev->l.public_epilogue  = MPEGSTAR_public_epilogue;

  lev->l.public_activate  = MPEGSTAR_public_activate;

  lev->l.public_unblock   = MPEGSTAR_public_unblock;

  lev->l.public_block     = MPEGSTAR_public_block;

  lev->l.public_message   = MPEGSTAR_public_message;

  lev->l.public_eligible  = MPEGSTAR_public_eligible;

  lev->budget = NIL;

  lev->current = NIL;

  lev->scheduling_level = master;

  return l;

}

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

{

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

  lev->budget = budget;

  return 0;

}

int MPEGSTAR_getbudget(LEVEL l, PID p)

{

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

  return lev->budget;

}

int MPEGSTAR_budget_has_thread(LEVEL l, int budget)

{                                                                                                                            

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

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

  return 0;

}

int MPEGSTAR_rescale(LEVEL l, TIME Q, TIME T)

{

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

  SERVER_adjust_budget(lev->scheduling_level,Q,T,lev->budget);

  lev->server_Q = Q;

  lev->server_T = T;

  if (lev->current != NIL) {

    proc_table[lev->current].avail_time = Q;

    proc_table[lev->current].wcet = Q;

  }

  return 0;

}