Subversion Repositories shark

Rev

Rev 1224 | Blame | Compare with Previous | Last modification | View Log | RSS feed

/*
 * Project: S.Ha.R.K.
 *
 * Coordinators:
 *   Giorgio Buttazzo    <giorgio@sssup.it>
 *   Paolo Gai           <pj@gandalf.sssup.it>
 *
 * Authors     :
 *   Giacomo Guidi       <giacomo@gandalf.sssup.it>
 *
 * 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 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 "kernel/kern.h"

#include "fsf_contract.h"
#include "fsf_server.h"

#include "stdlib.h"
#include "unistd.h"
#include "string.h"

#include "pthread.h"

#include "drivers/keyb.h"
#include "drivers/glib.h"

/*Init Server Parameters */
#define SERVER_I_PERIOD 50000
#define SERVER_I_BUDGET 10000
#define SERVER_P_PERIOD 50000
#define SERVER_P_BUDGET 10000
#define SERVER_B_PERIOD 50000
#define SERVER_B_BUDGET 10000

struct timespec server_I_period = {0,SERVER_I_PERIOD*1000};
struct timespec server_I_budget = {0,SERVER_I_BUDGET*1000};
struct timespec server_P_period = {0,SERVER_P_PERIOD*1000};
struct timespec server_P_budget = {0,SERVER_P_BUDGET*1000};
struct timespec server_B_period = {0,SERVER_B_PERIOD*1000};
struct timespec server_B_budget = {0,SERVER_B_BUDGET*1000};

fsf_server_id_t server_I, server_P, server_B;
fsf_contract_parameters_t contract_I, contract_P, contract_B;

/* Decoder PID */
pthread_t pI,pP,pB;

#define FRAME_I 0
#define FRAME_P 1
#define FRAME_B 2

struct decoder_arg {

   int frame_number;
   int frame_type;
   int fx,fy,fd;
   void *input_buffer_newdata;
   void *input_buffer_pastframe;
   void *output_buffer_newframe;
   int server_id;

};

typedef struct decoder_arg *decoder_arg_ptr;

#define MAX_DECODER_NUMBER 10

/* Table of pointer to decoder_ard struct */
decoder_arg_ptr decoder_arg_table[MAX_DECODER_NUMBER];

/* Decoder TASK */
TASK decoder(void *arg)
{

  decoder_arg_ptr darg = (decoder_arg_ptr)(arg);
  int i,Q,R;
  struct timespec current;

  while(1) {

    cprintf("Decoder Start %d Frame %d\n",exec_shadow,darg->frame_number);

    for (i=0;i<100;i++) {
      if (MPEGSTAR_is_frame_skipped(darg->server_id)) {
        kern_printf("Skipping this frame\n");
        break;
      }  
      kern_gettime(&current);
    }

    Q = MPEGSTAR_get_remain_capacity(darg->server_id);
    R = MPEGSTAR_get_last_reclaiming(darg->server_id);
    printf_xy(55,10+exec_shadow,WHITE,"[S%02d:Q%06d:R%06d]",darg->server_id,Q,R);

    cprintf("Decoder End %d\n",exec_shadow);

    task_endcycle();

  }

  return NULL;

}

int init_mpeg_server() {

  int err;
  HARD_TASK_MODEL ht;

  fsf_initialize_contract(&contract_I);
  fsf_set_contract_basic_parameters(&contract_I,&server_I_budget,&server_I_period,NULL,NULL,FSF_DEFAULT_WORKLOAD);
  fsf_set_local_scheduler_parameter(&contract_I, FSF_SCHEDULER_MPEG);

  fsf_initialize_contract(&contract_P);
  fsf_set_contract_basic_parameters(&contract_P,&server_P_budget,&server_P_period,NULL,NULL,FSF_DEFAULT_WORKLOAD);
  fsf_set_local_scheduler_parameter(&contract_P, FSF_SCHEDULER_MPEG);

  fsf_initialize_contract(&contract_B);
  fsf_set_contract_basic_parameters(&contract_B,&server_B_budget,&server_B_period,NULL,NULL,FSF_DEFAULT_WORKLOAD);
  fsf_set_local_scheduler_parameter(&contract_B, FSF_SCHEDULER_MPEG);

  err = fsf_negotiate_contract(&contract_I,&server_I);
  if (err) cprintf("(FSF ERROR %d)",err);
  err = fsf_negotiate_contract(&contract_P,&server_P);
  if (err) cprintf("(FSF ERROR %d)",err);
  err = fsf_negotiate_contract(&contract_B,&server_B);
  if (err) cprintf("(FSF ERROR %d)",err);

  hard_task_default_model(ht);

  decoder_arg_table[server_I] = (decoder_arg_ptr)malloc(sizeof(struct decoder_arg));
  decoder_arg_table[server_I]->server_id = server_I;
  fsf_create_thread(server_I, &pI, NULL, decoder, decoder_arg_table[server_I], &ht);
  cprintf("Decoder I PID %d\n",pI);

  decoder_arg_table[server_P] = (decoder_arg_ptr)malloc(sizeof(struct decoder_arg));
  decoder_arg_table[server_P]->server_id = server_P;
  fsf_create_thread(server_P, &pP, NULL, decoder, decoder_arg_table[server_P], &ht);
  cprintf("Decoder P PID %d\n",pP);
 
  decoder_arg_table[server_B] = (decoder_arg_ptr)malloc(sizeof(struct decoder_arg));
  decoder_arg_table[server_B]->server_id = server_B;
  fsf_create_thread(server_B, &pB, NULL, decoder, decoder_arg_table[server_B], &ht);
  cprintf("Decoder B PID %d\n",pB);

  return 0;
 
}

/* Decoder Manager TASK */
TASK decoder_manager(void *arg) {

  TIME T,Q;

  T = 50000;
  Q = 10000;
  MPEGSTAR_rescale(server_I,Q,T);
  decoder_arg_table[server_I]->frame_number = 0;
  decoder_arg_table[server_I]->frame_type = FRAME_I;
  task_activate(pI);
                                                                                                                             
  T = 150000;
  Q = 10000;
  MPEGSTAR_rescale(server_P,Q,T);
  decoder_arg_table[server_P]->frame_number = 2;
  decoder_arg_table[server_P]->frame_type = FRAME_P;
  task_activate(pP);
                                                                                                                             
  T = 100000;
  Q = 10000;
  MPEGSTAR_rescale(server_B,Q,T);
  decoder_arg_table[server_B]->frame_number = 1;
  decoder_arg_table[server_B]->frame_type = FRAME_B;
  task_activate(pB);

  return 0;
 
}

int main () {

  HARD_TASK_MODEL ht_manager;
  PID dm;

  init_mpeg_server();

  hard_task_default_model(ht_manager);
  hard_task_def_mit(ht_manager,10000);
  hard_task_def_wcet(ht_manager,5000);
  hard_task_def_arg(ht_manager,NULL);
 
  dm = task_create("Manager", decoder_manager, &ht_manager, NULL);
  if (dm == NIL) {
    cprintf("Error creating decoder manager\n");
    sys_end();
  }

  cprintf("Control-C to exit\n");

  task_activate(dm);

  while(1);

  return 0;

}