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); |
|
} |
|