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;

}