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 Giorgio Buttazzo, 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
 *
 *
 * CVS :        $Id: server-task.c,v 1.9 2004-11-16 09:24:45 trimarchi Exp $
 */

#include "ll/i386/64bit.h"
#include "fsf_configuration_parameters.h"
#include "fsf.h"
#include "fsf_service_task.h"
#include "message.h"
#include <kernel/kern.h>
#include <modules/sem.h>
#include <modules/hartport.h>
#include <modules/cabs.h>

//#define FSF_DEBUG
extern fsf_server_id_t service_server;

TASK service_task(void) {
 
  struct mess msg;
  fsf_renegotiation_status_t status;
  int wait_renegotiation=0;
  struct timespec next_act;
  struct timespec period;
  struct timespec act_time;
  PORT rec,tra;
 
  rec = port_connect("CHANW",sizeof(struct mess),STREAM,READ);
 
  tra = port_connect("CHANR",sizeof(struct mess),STREAM,WRITE);
 
  while(1) {
    // wait for operation
    if (wait_renegotiation) {
      if (!fsf_get_renegotiation_status(msg.server,&status)) {
        if (status==FSF_ADMITTED) {
          // send response server is -1 if the operation fail
#ifdef FSF_DEBUG
          kern_printf("ADM");
#endif
          wait_renegotiation=0;
          port_send(tra,&msg,BLOCK);
          //kern_gettime(&act_time);
          //fsf_get_budget_and_period(service_server,NULL,&period);
          //ADDTIMESPEC(&act_time, &period, &next_act);
          //fsf_schedule_next_timed_job(&next_act,NULL,NULL,NULL,NULL);
          continue;
        } else
#ifdef FSF_DEBUG
          kern_printf("WAIT")
#endif
;
      }
    } else {
      port_receive(rec,&msg,BLOCK);
#ifdef FSF_DEBUG
      kern_printf("Message ");
#endif
      switch (msg.type) {
       
      case NEGOTIATE_CONTRACT:
        if (negotiate_contract(&msg.contract, &msg.server)==FSF_ERR_CONTRACT_REJECTED)
          msg.server=-1;       
        else {
          wait_renegotiation=1;
          //task_endcycle();
          continue;
        }
        break;

      case REQUEST_RENEGOTIATE_CONTRACT:
        if (renegotiate_contract(&msg.contract, msg.server)==FSF_ERR_CONTRACT_REJECTED)
          msg.server=-1;
        break;
       
      case RENEGOTIATE_CONTRACT:
        if (renegotiate_contract(&msg.contract, msg.server)==FSF_ERR_CONTRACT_REJECTED)
          msg.server=-1;
        else {
          wait_renegotiation=1;
          //task_endcycle();
          continue;
        }
        break;                   
       
      default :
        break;
       
      }
      // send response server is -1 if the operation fail
      port_send(tra,&msg,BLOCK);
      //kern_gettime(&act_time);
      //fsf_get_budget_and_period(service_server,NULL,&period);
      //ADDTIMESPEC(&act_time, &period, &next_act);
      //fsf_schedule_next_timed_job(&next_act,NULL,NULL,NULL,NULL);
      //task_endcycle();
      //kern_printf("(ES)");
    }
  }
}


static __inline void set_contract_parameter(void) {

  int i=0;
  TIME T,Q;
   
  for (i=0; i<current_server; i++) {
      mul32div32to32(MAX_BANDWIDTH,server_list[i].Cmin,server_list[i].U,T);
      if (T > server_list[i].Tmin ) {
         server_list[i].actual_budget = server_list[i].Cmin;
         server_list[i].actual_period = T;
      #ifdef FSF_DEBUG
         kern_printf("(1 - Q %ld T %ld)", server_list[i].actual_budget, server_list[i].actual_period);
      #endif
         if (server_list[i].d_equals_t == TRUE)
           adjust_SERVER_budget(server_list[i].server,server_list[i].Cmin, T, T);
         else
           adjust_SERVER_budget(server_list[i].server,server_list[i].Cmin, T, server_list[i].deadline);

      } else {
        mul32div32to32(server_list[i].Tmin,server_list[i].U,MAX_BANDWIDTH,Q);
        server_list[i].actual_budget = Q;
        server_list[i].actual_period = server_list[i].Tmin;
      #ifdef FSF_DEBUG
         kern_printf("(2 - Q %ld T %ld)", server_list[i].actual_budget, server_list[i].actual_period);
      #endif
                   
         if (server_list[i].d_equals_t == TRUE)
           adjust_SERVER_budget(server_list[i].server,server_list[i].Cmin, server_list[i].Tmin, server_list[i].Tmin);
         else
           adjust_SERVER_budget(server_list[i].server,server_list[i].Cmin, server_list[i].Tmin, server_list[i].deadline);                                                                                                        
     }
                                                                                                                             
     server_list[i].U=server_list[i].Umin;
   }
 
}


int renegotiate_contract
  (const fsf_contract_parameters_t *new_contract,
   fsf_server_id_t                 server)
{
 
  #ifdef FSF_DEBUG
    kern_printf("(Renegotiate for server %d)",server);
  #endif

  if (!new_contract)
    return  FSF_ERR_BAD_ARGUMENT;

  if (server < 0)
    return  FSF_ERR_BAD_ARGUMENT;
 
   // change the parameter
   relink_contract_to_server(new_contract, server);
   if (recalculate_contract(fsf_max_bw)==-1)  {
       return  FSF_ERR_CONTRACT_REJECTED;
   }
   
   set_contract_parameter();

   return 0;
}

int negotiate_contract
  (const fsf_contract_parameters_t *contract,
   fsf_server_id_t                 *server)
{
  /* Check if contract is initialized */
  if (!contract) return  FSF_ERR_BAD_ARGUMENT;

  /* Admission Test */
  if (FSF_ADMISSION_TEST_IS_ENABLED)
    if (add_contract(contract))
      return FSF_ERR_CONTRACT_REJECTED;

  /* SERVER => BUDGET */    
  set_SERVER_budget_from_contract(contract,server);

#ifdef FSF_DEBUG
  kern_printf("(New Server %d)",*server);
#endif

  if (*server >= 0) {
    link_contract_to_server(contract,*server);
    if (recalculate_contract(fsf_max_bw)==-1)  {
      remove_contract(server);
      return  FSF_ERR_CONTRACT_REJECTED;
    }
    set_contract_parameter();
#ifdef  FSF_DEBUG
    kern_printf("(Adjust budget)");
#endif    
   
  }
  else  {
    return  FSF_ERR_CONTRACT_REJECTED;
  }
  //kern_printf("(ENCR)");
  return 0;

}