Subversion Repositories shark

Compare Revisions

Ignore whitespace Rev 867 → Rev 868

/shark/trunk/ports/first/first-server.c
17,16 → 17,24
#include <modules/hartport.h>
#include <modules/cabs.h>
 
#include "fsf_contract.h"
#include "fsf_basic_types.h"
#include "fsf_configuration_parameters.h"
#include "fsf_core.h"
#include "fsf_server.h"
#include "fsf_service_task.h"
#include "fsf_hierarchical.h"
#include "message.h"
 
#include "posixstar.h"
#include "edfstar.h"
#include "nonestar.h"
#include "rmstar.h"
 
#include <pthread.h>
#include <stdlib.h>
#include "pistar.h"
#include <modules/comm_message.h>
 
 
//#define FSF_DEBUG
 
int current_server=0;
34,12 → 42,17
bandwidth_t fsf_max_bw = 0;
int fsf_server_level;
int fsf_posix_level = -1;
int shared_object_level;
 
PID server_task;
fsf_contract_parameters_t contract;
 
 
PORT channel[2];
 
fsf_server_id_t service_server = -1;
fsf_contract_parameters_t service_contract;
 
int FSF_register_shared_object_module(void) {
fsf_register_shared_object();
return PISTAR_register_module();
50,11 → 63,12
return shared_object_level;
}
 
int FSF_register_module(int server_level, bandwidth_t max_bw)
int FSF_register_module(int posix_level, int server_level, bandwidth_t max_bw)
{
printk("FSF Module\n");
current_server=0;
fsf_server_level = server_level;
fsf_posix_level = posix_level;
fsf_max_bw = max_bw;
shared_object_level = FSF_register_shared_object_module();
62,8 → 76,15
 
}
 
void FSF_start_service_task(SOFT_TASK_MODEL *model) {
void FSF_start_service_task(void) {
 
int err;
struct timespec default_period = {0,50000000};
struct timespec default_budget = {0,1000000};
DUMMY_TASK_MODEL m;
 
dummy_task_default_model(m);
 
// create the service task
// create the communication channel for negotiation and renegotiation
71,8 → 92,14
 
channel[0] = port_create("CHANR",sizeof(struct mess),1,STREAM,READ);
 
server_task = task_create("stask",service_task,model,NULL);
if (server_task == -1) {
fsf_initialize_contract(&service_contract);
 
fsf_set_contract_basic_parameters(&service_contract,&default_budget,&default_period,FSF_DEFAULT_WORKLOAD);
negotiate_contract(&service_contract,&service_server);
 
//server_task = task_create("stask",service_task,model,NULL);
err = fsf_create_thread(service_server,&server_task,NULL,service_task,NULL,&m);
if (err) {
cprintf("error creating service task\n");
sys_shutdown_message("Could not create service_task");
sys_end();
94,17 → 121,17
 
int local_scheduler_level = 0;
 
switch (contract->local_scheduler_id) {
case FSF_SCHEDULER_POSIX:
switch (contract->policy) {
case FSF_POSIX:
local_scheduler_level = POSIXSTAR_register_level(fsf_server_level,5000,32);
break;
case FSF_SCHEDULER_EDF:
case FSF_EDF:
local_scheduler_level = EDFSTAR_register_level(fsf_server_level);
break;
case FSF_SCHEDULER_RM:
case FSF_RM:
local_scheduler_level = RMSTAR_register_level(fsf_server_level);
break;
case FSF_SCHEDULER_NONE:
case FSF_NONE:
local_scheduler_level = NONESTAR_register_level(fsf_server_level);
break;
}
114,13 → 141,13
TIMESPEC2USEC(&(contract->budget_min)),
TIMESPEC2USEC(&(contract->period_max)),
TIMESPEC2USEC(&(contract->period_max)),
local_scheduler_level,contract->local_scheduler_id);
local_scheduler_level,contract->policy);
} else {
*budget = SERVER_setbudget(fsf_server_level,
TIMESPEC2USEC(&(contract->budget_min)),
TIMESPEC2USEC(&(contract->period_max)),
TIMESPEC2USEC(&(contract->deadline)),
local_scheduler_level,contract->local_scheduler_id);
local_scheduler_level,contract->policy);
}
 
return 0;
264,7 → 291,23
 
}
 
int
fsf_get_renegotiation_status
(fsf_server_id_t server,
fsf_renegotiation_status_t *renegotiation_status)
{
 
if (SERVER_get_renegotiation_status(fsf_server_level,server))
*renegotiation_status=FSF_IN_PROGRESS;
else
*renegotiation_status=FSF_ADMITTED;
 
return 0;
 
 
}
 
 
int fsf_negotiate_contract
(const fsf_contract_parameters_t *contract,
fsf_server_id_t *server)
278,7 → 321,7
port_send(channel[1],&message,BLOCK);
port_receive(channel[0], &message, BLOCK);
 
if (message.server==-1)
return FSF_ERR_CONTRACT_REJECTED;
 
288,6 → 331,106
 
}
 
int fsf_unbind_thread_from_server
(pthread_t thread)
{
 
int local_scheduler_level, scheduler_id;
 
/* Move thread from the local scheduler module to posix level */
 
#ifdef FSF_DEBUG
kern_printf("(UnBind thread = %d)",thread);
#endif
 
/* Check if thread exsists */
if (thread == -1)
return FSF_ERR_BAD_ARGUMENT;
 
local_scheduler_level = SERVER_get_local_scheduler_level_from_pid(fsf_server_level,thread);
scheduler_id = SERVER_get_local_scheduler_id_from_pid(fsf_server_level,thread);
 
/* Check if thread is already bind */
if (scheduler_id == FSF_NONE) {
/* Check if it is bind to a server */
if (NONESTAR_getbudget(local_scheduler_level,thread) == -1)
return FSF_ERR_BAD_ARGUMENT;
else {
STD_command_message *msg;
NRT_TASK_MODEL nrt;
 
nrt_task_default_model(nrt);
nrt_task_def_save_arrivals(nrt);
 
/* Send change level command to local scheduler */
msg = (STD_command_message *)malloc(sizeof(STD_command_message));
 
msg->command = STD_SET_NEW_MODEL;
msg->param = (void *)(&nrt);
level_table[fsf_posix_level]->public_message(fsf_posix_level,thread,msg);
 
msg->command = STD_SET_NEW_LEVEL;
msg->param = (void *)(fsf_posix_level);
task_message(msg,thread,0);
 
free(msg);
}
}
 
return 0;
 
}
 
 
int fsf_bind_thread_to_server
(fsf_server_id_t server,
pthread_t thread)
{
 
STD_command_message *msg;
int local_scheduler_level,scheduler_id;
 
/* Move thread from the posix module to local scheduler */
 
#ifdef FSF_DEBUG
kern_printf("(Bind thread = %d to Server = %d)",thread,server);
#endif
 
/* Check if server and thread exsist */
if (server == -1 || thread == -1)
return FSF_ERR_BAD_ARGUMENT;
 
local_scheduler_level = SERVER_get_local_scheduler_level_from_budget(fsf_server_level,server);
scheduler_id = SERVER_get_local_scheduler_id_from_budget(fsf_server_level,server);
 
/* Check if thread is already bind */
if (scheduler_id == FSF_NONE) {
DUMMY_TASK_MODEL rt_arg;
if (NONESTAR_getbudget(local_scheduler_level,thread) != -1)
return FSF_ERR_BAD_ARGUMENT;
 
/* Set server on local scheduler */
NONESTAR_setbudget(local_scheduler_level,thread,(int)(server));
 
/* Send change level command to posix level */
msg = (STD_command_message *)malloc(sizeof(STD_command_message));
 
msg->command = STD_SET_NEW_MODEL;
msg->param = (void *)(&rt_arg);
level_table[local_scheduler_level]->public_message(local_scheduler_level,thread,msg);
 
msg->command = STD_SET_NEW_LEVEL;
msg->param = (void *)(local_scheduler_level);
task_message(msg,thread,0);
free(msg);
} else return FSF_ERR_BAD_ARGUMENT;
 
return 0;
}
 
int fsf_create_thread
(fsf_server_id_t server,
pthread_t *thread,
305,10 → 448,12
 
local_scheduler_level = SERVER_get_local_scheduler_level_from_budget(fsf_server_level,server);
scheduler_id = SERVER_get_local_scheduler_id_from_budget(fsf_server_level,server);
 
#ifdef FSF_DEBUG
kern_printf("sched policy %d", scheduler_id);
#endif
/* Check if thread is already bind */
switch (scheduler_id) {
case FSF_SCHEDULER_POSIX:
case FSF_POSIX:
 
nrt_task_def_arg(*(NRT_TASK_MODEL *)(local_scheduler_arg),arg);
nrt_task_def_level(*(NRT_TASK_MODEL *)(local_scheduler_arg),local_scheduler_level);
324,7 → 469,7
POSIXSTAR_setbudget(local_scheduler_level, *thread, (int)(server));
 
break;
case FSF_SCHEDULER_EDF:
case FSF_EDF:
 
hard_task_def_arg(*(HARD_TASK_MODEL *)(local_scheduler_arg),arg);
hard_task_def_level(*(HARD_TASK_MODEL *)(local_scheduler_arg),local_scheduler_level);
337,7 → 482,7
 
break;
 
case FSF_SCHEDULER_RM:
case FSF_RM:
 
hard_task_def_arg(*(HARD_TASK_MODEL *)(local_scheduler_arg),arg);
hard_task_def_level(*(HARD_TASK_MODEL *)(local_scheduler_arg),local_scheduler_level);
349,10 → 494,10
RMSTAR_setbudget(local_scheduler_level, *thread, (int)(server));
 
break;
case FSF_SCHEDULER_NONE:
case FSF_NONE:
hard_task_def_arg(*(HARD_TASK_MODEL *)(local_scheduler_arg),arg);
hard_task_def_level(*(HARD_TASK_MODEL *)(local_scheduler_arg),local_scheduler_level);
//dummy_task_def_arg(*( DUMMY_TASK_MODEL *)(local_scheduler_arg),arg);
dummy_task_def_level(*( DUMMY_TASK_MODEL *)(local_scheduler_arg),local_scheduler_level);
*thread = task_create("NONESTAR", thread_code, local_scheduler_arg, NULL);
if (*thread == NIL)
385,19 → 530,19
scheduler_id = SERVER_get_local_scheduler_id_from_pid(fsf_server_level, thread);
 
switch (scheduler_id) {
case FSF_SCHEDULER_POSIX:
case FSF_POSIX:
POSIXSTAR_set_nopreemtive_current(local_scheduler_level);
return 1;
break;
case FSF_SCHEDULER_EDF:
case FSF_EDF:
EDFSTAR_set_nopreemtive_current(local_scheduler_level);
return 1;
break;
case FSF_SCHEDULER_RM:
case FSF_RM:
RMSTAR_set_nopreemtive_current(local_scheduler_level);
return 1;
break;
case FSF_SCHEDULER_NONE:
case FSF_NONE:
break;
default:
return -1;
416,19 → 561,19
scheduler_id = SERVER_get_local_scheduler_id_from_pid(fsf_server_level, thread);
 
switch (scheduler_id) {
case FSF_SCHEDULER_POSIX:
case FSF_POSIX:
POSIXSTAR_unset_nopreemtive_current(local_scheduler_level);
return 1;
break;
case FSF_SCHEDULER_EDF:
case FSF_EDF:
EDFSTAR_unset_nopreemtive_current(local_scheduler_level);
return 1;
break;
case FSF_SCHEDULER_RM:
case FSF_RM:
RMSTAR_unset_nopreemtive_current(local_scheduler_level);
return 1;
break;
case FSF_SCHEDULER_NONE:
case FSF_NONE:
break;
default:
return -1;
440,8 → 585,8
 
 
int fsf_get_server
(fsf_server_id_t *server,
pthread_t thread)
(pthread_t thread,
fsf_server_id_t *server)
{
int local_scheduler_level, scheduler_id;
 
449,16 → 594,16
scheduler_id = SERVER_get_local_scheduler_id_from_pid(fsf_server_level, thread);
switch (scheduler_id) {
case FSF_SCHEDULER_POSIX:
case FSF_POSIX:
*server = POSIXSTAR_getbudget(local_scheduler_level,thread);
return 0;
case FSF_SCHEDULER_EDF:
case FSF_EDF:
*server = EDFSTAR_getbudget(local_scheduler_level,thread);
return 0;
case FSF_SCHEDULER_RM:
case FSF_RM:
*server = RMSTAR_getbudget(local_scheduler_level,thread);
return 0;
case FSF_SCHEDULER_NONE:
case FSF_NONE:
*server = NONESTAR_getbudget(local_scheduler_level,thread);
return 0;
default:
477,7 → 622,7
}
 
int fsf_cancel_contract
(fsf_server_id_t *server)
(fsf_server_id_t server)
{
 
int local_scheduler_level, scheduler_id;
486,40 → 631,40
int i=0;
 
#ifdef FSF_DEBUG
kern_printf("(Remove server %d)",*server);
kern_printf("(Remove server %d)",server);
#endif
 
/* Check server id */
if (*server < 0)
if (server < 0)
return FSF_ERR_INVALID_SERVER;
 
local_scheduler_level = SERVER_get_local_scheduler_level_from_budget(fsf_server_level,*server);
scheduler_id = SERVER_get_local_scheduler_id_from_budget(fsf_server_level,*server);
local_scheduler_level = SERVER_get_local_scheduler_level_from_budget(fsf_server_level,server);
scheduler_id = SERVER_get_local_scheduler_id_from_budget(fsf_server_level,server);
 
switch (scheduler_id) {
case FSF_SCHEDULER_POSIX:
case FSF_POSIX:
/* Check if some thread use the server */
if(POSIXSTAR_budget_has_thread(local_scheduler_level,*server))
if(POSIXSTAR_budget_has_thread(local_scheduler_level,server))
return FSF_ERR_SERVER_USED;
break;
case FSF_SCHEDULER_EDF:
case FSF_EDF:
/* Check if some thread use the server */
if(EDFSTAR_budget_has_thread(local_scheduler_level,*server))
if(EDFSTAR_budget_has_thread(local_scheduler_level,server))
return FSF_ERR_SERVER_USED;
break;
 
case FSF_SCHEDULER_RM:
case FSF_RM:
/* Check if some thread use the server */
if(RMSTAR_budget_has_thread(local_scheduler_level,*server))
if(RMSTAR_budget_has_thread(local_scheduler_level,server))
return FSF_ERR_SERVER_USED;
 
break;
 
case FSF_SCHEDULER_NONE:
case FSF_NONE:
/* Check if some thread use the server */
if(NONESTAR_budget_has_thread(local_scheduler_level,*server))
if(NONESTAR_budget_has_thread(local_scheduler_level,server))
return FSF_ERR_SERVER_USED;
break;
526,11 → 671,11
 
}
 
SERVER_removebudget(fsf_server_level,*server);
SERVER_removebudget(fsf_server_level,server);
 
level_free_descriptor(local_scheduler_level);
remove_contract(*server);
remove_contract(server);
f=kern_fsave();
if (recalculate_contract(fsf_max_bw)==-1) {
573,7 → 718,6
}
 
 
*server = -1;
kern_frestore(f);
 
return 0;
586,7 → 730,9
int Qt;
int isok=0;
int i=0;
int target_importance=1;
int target_importance=FSF_DEFAULT_IMPORTANCE;
 
#define MAX_IMPORTANCE 5
#ifdef FSF_DEBUG
int temp;
608,14 → 754,14
&& server_list[i].U<server_list[i].Umax && server_list[i].Qs>0)
Qt+=server_list[i].Qs;
current_bandwidth+=server_list[i].U;
#ifdef FSF_DEBUG
#ifdef FSF_DEBUG
kern_printf("(Qs %d, Qt %d, Is %d)", server_list[i].Qs, Qt,server_list[i].Is);
#endif
#endif
}
 
#ifdef FSF_DEBUG
#ifdef FSF_DEBUG
kern_printf("(Total Quality %d)", Qt);
#endif
#endif
isok=1;
for (i=0; i<current_server; i++) {
if (server_list[i].Is==target_importance && server_list[i].U<server_list[i].Umax && server_list[i].Qs>0) {
638,7 → 784,7
}
}
target_importance++;
} while (!isok && target_importance<6);
} while (!isok && target_importance<=MAX_IMPORTANCE);
return 0;
}
664,6 → 810,29
return 0;
}
 
int fsf_request_contract_renegotiation
(const fsf_contract_parameters_t *new_contract,
fsf_server_id_t server,
int sig_notify,
union sigval sig_value)
{
struct mess message;
 
// send response server is -1 if the operation fail
message.type=REQUEST_RENEGOTIATE_CONTRACT;
memmove(&message.contract,new_contract, sizeof(fsf_contract_parameters_t));
message.server = server;
 
port_send(channel[1],&message,BLOCK);
 
port_receive(channel[0], &message, BLOCK);
 
if (message.server==-1) return FSF_ERR_CONTRACT_REJECTED;
return 0;
}
 
void print_server_list()
{
 
684,3 → 853,49
 
return SERVER_get_remain_capacity(fsf_server_level, server);
}
 
int fsf_get_budget_and_period
(fsf_server_id_t server,
struct timespec *budget,
struct timespec *period) {
TIME bg;
TIME pd;
 
if (!SERVER_getbudgetinfo(fsf_server_level, &bg, &pd, NULL, server)) {
if (budget) {
NULL_TIMESPEC(budget);
ADDUSEC2TIMESPEC(bg, budget);
}
if (period) {
NULL_TIMESPEC(period);
ADDUSEC2TIMESPEC(pd, period);
}
return 0;
}
return FSF_ERR_BAD_ARGUMENT;
}
 
int
fsf_set_service_thread_data
(const struct timespec *budget,
const struct timespec *period,
bool *accepted) {
 
if (budget==NULL && period==NULL) return FSF_ERR_BAD_ARGUMENT;
fsf_set_contract_basic_parameters(&service_contract,budget,period,FSF_DEFAULT_WORKLOAD);
*accepted = !fsf_renegotiate_contract(&service_contract,service_server)?true:false;
return 0;
 
}
 
 
 
int fsf_get_service_thread_data
(struct timespec *budget,
struct timespec *period) {
 
return fsf_get_budget_and_period(service_server, budget, period);
 
}