WebSVN - shark - Rev 1664 - /unsupported/trunk/imit2004/train/train

#include "train.h"

/******************************************************************/

void init_display()
{
int i,j;
for (i = 0; i < MAX_CITY; i++)
grx_disc(graph[i][0],graph[i][1],10,14);

for (i = 0; i < MAX_CITY; i++)
for (j = 0; j < MAX_CITY; j++)
{
if(i!=j)
grx_line(source[i][0],source[i][1],destination[j][0],destination[j][1],5);

}

}// display ends here

void geninfo(int identi)
{
int src,des,track;
int flag;

track =rand() % 12;

if(track==0 || track ==6)
{
// flag= rand()%2;
if(track==0){
src = 0;
des = 1;
}
else{
src = 1;
des = 0;
}
}

if(track==1 || track ==7)
{

//flag= rand()%2;
if(track==1){
src = 1;
des = 2;
}
else{
src = 2;
des = 1;
}
}

if(track==2 || track ==8)
{

//flag= rand()%2;
if(track==2){
src = 2;
des = 3;
}
else{
src = 3;
des = 2;
}
}

if(track==3 || track ==9)
{

//flag= rand()%2;
if(track==3){
src = 3;
des = 0;
}
else{
src = 0;
des = 3;
}
}

if(track==4 || track ==10)
{

//flag= rand()%2;
if(track==4){
src = 0;
des = 2;
}
else{
src = 2;
des = 0;
}
}

if(track==5 || track ==11)
{
if(track==5){
src = 1;
des = 3;
}
else{
src = 3;
des = 1;
}
}

train[identi].tracknum = track;
train[identi].source= src;
train[identi].desti = des;

if(track==0 || track==2 )
train[identi].check = 0;
if(track==6 ||track==8 )
train[identi].check = 1;
if(track==1 || track==4 ||track==5 ||track==9 )
train[identi].check = 2;
if(track==3 || track==11 ||track==10 ||track==7 )
train[identi].check = 3;

}//geninfo ends here

int check_reach(int ox1,int oy1,int ox2,int oy2,int f)
{
if(f==0 )
{
if( ox1 >= ox2)
return 0; // reached the destination
else return 1;

}

if(f==1 )
{
if( ox1 <= ox2)
return 0; // reached the destination
else return 1;

}
else if(f==2 )
{
if( oy1 >= oy2)
return 0; // reached the destination
else return 1;
}
else if(f==3 )
{
if( oy1 <= oy2)
return 0; // reached the destination
else return 1;
}

}// check if train reached destination

TASK display(void *arg){

char temp1[200];
char temp2[200];
char temp3[200];
int i,j;
int pos = 30;
int gposx = 700;
int gposy = 40;
int cab_val;
char *c;
char rbuf[2];

while(1){
j=1;
if(start){
for(i=0;i<count;i++) {
c = cab_getmes(cid[i]);
memcpy(rbuf,c,2*sizeof(char));
sscanf(rbuf,"%2d",&cab_val);
cab_unget(cid[i], c);
pos+=10;
sprintf(temp1," ");
sprintf(temp1,"TRAIN NO %d is At X %d Y %d GOING CITY %d TO CITY %d ON TRACK %d BLOCKTIME %f",i,traininfo[i].cx,traininfo[i].cy,traininfo[i].source,traininfo[i].destination,cab_val,_i_blocking[i]);
grx_text(temp1, 30,pos,15,0);
}// for1

// display status here
for(i=0;i<count;i++) {

j++;

if(status[i]==0){
// display red;
sprintf(temp2,"NO %d ",i);
grx_text(temp2, gposx,gposy,15,0);
gposx +=60;
grx_disc(gposx,gposy,10,12);
gposx += 35;

if((j%3)==0){
gposy+=40;
gposx =700;
}//if

}// outer

else {

// display green;
sprintf(temp2,"NO %d",i);
grx_text(temp2, gposx,gposy,15,0);
gposx +=60;
grx_disc(gposx,gposy,10,10);
gposx += 35;

if((j%3)==0){
gposy+=40;
gposx = 700;
}//if

}//else

}// for2
}// if
pos = 30;
gposx= 700;
gposy = 40;
j = 1;
task_endcycle();
} //while
}// display

////////////////display task ends here

TASK controls(void *arg){

char temp1[200];
char temp2[200];
char temp3[200];
int i,j;
int pos = 30;
int gposx = 700;
int gposy = 40;
int cab_val;
char *c;
char rbuf[2];

while(1){
j=1;
if(start){
for(i=0;i<count;i++) {
c = cab_getmes(cid[i]);
memcpy(rbuf,c,2*sizeof(char));
sscanf(rbuf,"%2d",&cab_val);
cab_unget(cid[i], c);
pos+=10;
sprintf(temp1," ");
sprintf(temp1,"TRAIN NO %d is At X %d Y %d GOING FROM CITY %d TO CITY %d ON TRACK %d ",i,traininfo[i].cx,traininfo[i].cy,traininfo[i].source,traininfo[i].destination,cab_val);
grx_text(temp1, 30,pos,15,0);
}// for1

// display status here
for(i=0;i<count;i++) {

j++;

if(status[i]==0){
// display red;
sprintf(temp2,"NO %d ",i);
grx_text(temp2, gposx,gposy,15,0);
gposx +=60;
grx_disc(gposx,gposy,10,12);
gposx += 35;

if((j%3)==0){
gposy+=40;
gposx =700;
}//if

}// outer

else {

// display green;
sprintf(temp2,"NO %d",i);
grx_text(temp2, gposx,gposy,15,0);
gposx +=60;
grx_disc(gposx,gposy,10,10);
gposx += 35;

if((j%3)==0){
gposy+=40;
gposx = 700;
}//if

}//else

}// for2
}// if
pos = 30;
gposx= 700;
gposy = 40;
j = 1;
task_endcycle();
} //while
}// contoller

TASK fly(void *arg)
{

//int x, y;
char *p,*c;
char wbuf[2],rbuf[2];
char temp1[600];
char temp2[650];
char temp3[650];
char cab_str[200];
int ox1, ox2,oy1,oy2,cab_val;
int dx, dy, da;
int teta, col,cur_col,id;
int outx, outy;
double r,step_vel;
int src,des;
int i=0;
int no_of_times,dt;
int stepx,stepy,track;
int semval,wait;
int go = 1;

int _i_distance,_i_speed,_i_time_required,cur_speed;
//Time t;
TIME _time_this,_time_unblock;
float _i_waiting_time;
id = (int) arg;
status[id] = 0;
_i_blocking[id]=0.0;
_i_speed = rand() % 3+1;

geninfo(id);
cid[id] = cab_create(cname[id], 2*sizeof(char), 2);
track = train[id].tracknum;
src = train[id].source;
des = train[id].desti;

ox1 =source[src][0];
ox2 =destination[des][0];
oy1 = source[src][1];
oy2 = destination[des][1];
//convert(&ox1,&ox2,&oy1,&oy2,src,des);
traininfo[id].source=src;
traininfo[id].destination=des;
traininfo[id].track= track;
traininfo[id].cx= ox1;
traininfo[id].cy= oy1;
/// getting the distance;

//sys_gettime(&_time_this);

_i_distance = (int)sqrt((abs(ox1 - ox2)*abs(ox1 - ox2))+(abs(oy1-oy2)*abs(oy1-oy2)));
_i_time_required = (int)( _i_distance / _i_speed );

step_vel = _i_speed / _i_time_required;
///
grx_text(" in the fly",15,20,10,14);
dy = oy2 - oy1;
dx = ox2 - ox1;

if (dy < 0) { dy = -dy; stepy = -1; } else { stepy = 1; }
if (dx < 0) { dx = -dx; stepx = -1; } else { stepx = 1; }
dy <<= 1; // dy is now 2*dy
dx <<= 1; // dx is now 2*dx
//grx_text(temp1,ox1,oy1+5,15,0);
if(id==0) col=15;
else col =10;
cur_col = col; // if the train is delayed the coler of the train will be shown diffrent

while(1)
{

p = cab_reserve(cid[id]);
sprintf(wbuf,"%2d",track);
//grx_text(temp1,350,700+(id*8),15,0);
memcpy(p,wbuf,2*sizeof(char));
cab_putmes(cid[id], p);

sys_gettime(&_time_this);

sem_wait(&mx_track[track]);

if(flag[track]==1)
{
sem_post(&mx_track[track]);
go = 0;
status[id]=0;

}
else
if(flag[track]==0)
{
flag[track]=1;
go = 1;
sem_post(&mx_track[track]);
}

if(go){
sys_gettime(&_time_unblock);
_i_waiting_time = (float) (_time_unblock - _time_this);

_i_blocking[id] = _i_waiting_time;

cur_speed = _i_speed + (step_vel * _i_blocking[id]);
/****
if(_i_blocking[id] >= 0.010)
{
grx_text(" train is late",15,620,10,14);
cur_col = 4;
}
*/ status[id] = 1;

if (dx > dy)
{
int fraction = dy - (dx >> 1);
while (src!=des) {

grx_disc(ox1,oy1,2,0);
if(check_reach(ox1,oy1,ox2,oy2,train[id].check) == 0 )
{
flag[track]=0;
geninfo(id);

track = train[id].tracknum;
src = train[id].source;
des = train[id].desti;

/*ox1 =graph[src][0];
ox2 =graph[des][0];
oy1 = graph[src][1];
oy2 = graph[des][1];*/
ox1 =source[src][0];
ox2 =destination[des][0];
oy1 = source[src][1];
oy2 = destination[des][1];
traininfo[id].source=src;
traininfo[id].destination=des;
traininfo[id].track= track;
traininfo[id].cx= ox1;
traininfo[id].cy= oy1;

// grx_text(" in the fly",15,20,10,14);
dy = oy2 - oy1;
dx = ox2 - ox1;

if (dy < 0) { dy = -dy; stepy = -1; } else { stepy = 1; }
if (dx < 0) { dx = -dx; stepx = -1; } else { stepx = 1; }
dy <<= 1; // dy is now 2*dy
dx <<= 1; // dx is now 2*dx

break;
//src = des;
}
if (fraction >= 0)
{
oy1 += stepy * cur_speed;
fraction -= dx; // same as fraction -= 2*dx
}// if

ox1 += stepx * cur_speed;
fraction += dy; // same as fraction -= 2*dy

traininfo[id].cx= ox1;
traininfo[id].cy= oy1;
grx_line(source[src][0],source[src][1],destination[des][0],destination[des][1],5);
grx_disc(ox1,oy1,2,cur_col);

task_endcycle();
continue;
}//while

}// main if (dx > dy)

else
{
int fraction = dx - (dy >> 1);
sem_wait(&mx_track[track]);
if(flag[track]==1)
{
sem_post(&mx_track[track]);
task_endcycle();
//continue;
}
else if(flag[track]==0)
{
flag[track]=1;
sem_post(&mx_track[track]);
}

while (src!=des)
{
grx_disc(ox1,oy1,2,0);
if(check_reach(ox1,oy1,ox2,oy2,train[id].check) == 0)
{
flag[track]=0;
geninfo(id);
track = train[id].tracknum;
src = train[id].source;
des = train[id].desti;

ox1 =source[src][0];
ox2 =destination[des][0];
oy1 = source[src][1];
oy2 = destination[des][1];

traininfo[id].source=src;
traininfo[id].destination=des;
traininfo[id].track= track;
traininfo[id].cx= ox1;
traininfo[id].cy= oy1;
//grx_text(" in the fly",15,20,10,14);
dy = oy2 - oy1;
dx = ox2 - ox1;

if (dy < 0) { dy = -dy; stepy = -1; } else { stepy = 1; }
if (dx < 0) { dx = -dx; stepx = -1; } else { stepx = 1; }
dy <<= 1; // dy is now 2*dy
dx <<= 1; // dx is now 2*dx

break;
}
if (fraction >= 0) {
ox1 += stepx * cur_speed;
fraction -= dy;
}
oy1 += stepy * cur_speed;
fraction += dx;
traininfo[id].cx= ox1;
traininfo[id].cy= oy1;
grx_line(source[src][0],source[src][1],destination[des][0],destination[des][1],5);
grx_disc(ox1,oy1,2,cur_col);
task_endcycle();
continue;
}// while
}
}// else
task_endcycle();
}// outer while
}// main
/****************************************************************/

/* This function is called when the system exits */
void byebye(void *arg)
{
grx_close();
cprintf("!!!!!!!!!!!!!!!!HAVE A NICE DAY !!!!!!!!!!!\n");
}

/****************************** MAIN ******************************/

int main(int argc, char **argv)
{
HARD_TASK_MODEL m;
SOFT_TASK_MODEL mp;

int j,sg,val;
char c; /* character from keyboard */
int i = 0; /* number of tasks created */
TIME seme; /* used to init the random seed */
char temp1[200];

/* Set the closing function */
sys_atrunlevel(byebye, NULL, RUNLEVEL_BEFORE_EXIT);

/* graphic card Initialization */
if (grx_init() < 1) {
sys_abort(1);
}

if (grx_open(1024,768, 8) < 0) {
cprintf("GRX Err\n");
sys_abort(1);
}
for(i=0;i<MAX_TRACK;i++)
sem_init(&mx_track[i],0,1);

for(i=0;i<MAX_TRACK;i++)
flag[i]=0;

/* The scenario */
grx_rect(XMIN-D-1, YMIN-D-1, XMAX+D+1, YMAX+D+1, 14);
grx_text("Simulation of Train Status", XMIN, YMENU+10, 13, 0);
grx_text("SPACE create a Train" , XMIN, YMENU+20, 12, 0);
grx_text("ESC exit to DOS" , XMIN, YMENU+30, 12, 0);
init_display();

soft_task_default_model(mp);
soft_task_def_level(mp,1);
soft_task_def_ctrl_jet(mp);
soft_task_def_arg(mp, (void *)count);
// soft_task_def_group(mp, FLYGROUP);
soft_task_def_met(mp, S_fly_wcet);
soft_task_def_period(mp,S_fly_period);
soft_task_def_usemath(mp);
controller = task_create("controller",controls,&mp,NULL);
task_activate(controller);
if (controller == NIL) {
grx_close();
perror("Could not create controller ");
sys_abort(1);
}
//grx_text(" contoller here ",15,30,10,14);
/* The program waits a space to create a fly */
c = keyb_getch(BLOCK);

/* randomize!!!! */
seme = sys_gettime(NULL);
srand(seme);

do {
if (c == ' ') {

//itoa(count,train_str+5);
if(count == 0){
param.id = count;
param.col = RED;
hard_task_default_model(m);
hard_task_def_ctrl_jet (m);
hard_task_def_arg (m, (void *)count);
hard_task_def_wcet (m, H_fly_wcet);
hard_task_def_mit (m, H_fly_period);
hard_task_def_group (m, FLYGROUP);
hard_task_def_usemath (m);
//pid = task_create("fly", fly, &m, NULL);
ptas_for_train[count] = task_create("train",fly,&m,NULL);
}

else{
param.id = count;
param.col = 15;
soft_task_default_model(mp);
soft_task_def_level(mp,1);
soft_task_def_ctrl_jet(mp);
soft_task_def_arg(mp, (void *)count);
soft_task_def_group(mp, FLYGROUP);
soft_task_def_met(mp, S_fly_wcet);
soft_task_def_period(mp,S_fly_period);
soft_task_def_usemath(mp);
ptas_for_train[count] = task_create("train",fly,&mp,NULL);
// grx_text(" soft returned ",15,30,10,14);
}

i++;

if (ptas_for_train[count] == NIL) {
grx_close();
perror("Could not create task <train>");
sys_abort(1);
}
task_activate(ptas_for_train[count]);

sprintf(temp1," PID = %d ",ptas_for_train[count]);
grx_text(temp1,75,40,15,12);
count++;

if (count == 1) {
start = 1;
}
}
c = keyb_getch(BLOCK);

} while (c != ESC);

sys_end();

return 0;}

Subversion Repositories shark

(root)/unsupported/trunk/imit2004/train/train_cs1.c @ 1671 - Rev 1664