Subversion Repositories shark

Rev

Rev 1090 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1090 pj 1
/*
2
 * Project: S.Ha.R.K.
3
 *
4
 * Coordinators:
5
 *   Giorgio Buttazzo    <giorgio@sssup.it>
6
 *   Paolo Gai           <pj@gandalf.sssup.it>
7
 *
8
 * Authors     :
9
 *   Paolo Gai           <pj@gandalf.sssup.it>
10
 *   Massimiliano Giorgi <massy@gandalf.sssup.it>
11
 *   Luca Abeni          <luca@gandalf.sssup.it>
12
 *   (see the web pages for full authors list)
13
 *
14
 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)
15
 *
16
 * http://www.sssup.it
17
 * http://retis.sssup.it
18
 * http://shark.sssup.it
19
 */
20
 
1468 giacomo 21
/* CVS :        $Id: aereo.c,v 1.2 2004-05-25 18:24:59 giacomo Exp $ */
1090 pj 22
 
23
/*
24
 * Copyright (C) 2000 Fabio Calabrese <fabiocalabrese77@yahoo.it>
25
 *
26
 * This program is free software; you can redistribute it and/or modify
27
 * it under the terms of the GNU General Public License as published by
28
 * the Free Software Foundation; either version 2 of the License, or
29
 * (at your option) any later version.
30
 *
31
 * This program is distributed in the hope that it will be useful,
32
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
33
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
34
 * GNU General Public License for more details.
35
 *
36
 * You should have received a copy of the GNU General Public License
37
 * along with this program; if not, write to the Free Software
38
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
39
 *
40
 */
41
 
42
//************************
43
//* file:        aereo.c *
44
//* included by: bca.c   *
45
//************************
46
 
47
TASK aereo_creator(void * arg)
48
{ int             i, index, last;
49
  WORD            count;
50
  PID             pid=-1;
51
  COLOR           col;
52
  double          vel;
53
  int             dir;
54
  WORD            h;
55
  double          l;
56
  WORD            x, y;
57
 
58
  while(1){
59
 
60
    count=0;
61
    index=-1;
62
    last=-1;
63
 
64
    for (i=0; i<AEREO_N_MAX; i++)  // Conteggio aerei attivi
65
      if (aereo_table[i].status) {
66
         count++;
67
         last=i;          //...ultima posizione occupata in tabella...
68
         }
69
      else {
70
         if (index==-1) index=i;   //...prima posizione libera in tabella...
71
         }
72
 
73
    if (count<aereo_count && index!=-1) { // Richiesta nuovo aereo
74
      aereo_table[index].status =  1;     //...occupa posizione...
75
      aereo_table[index].killing = 0;     //...disattiva richiesta di kill...
76
      col = FAB_rgb(FAB_int_rand(50,255), //...nuovo colore...
77
                    FAB_int_rand(50,255),
78
                    FAB_int_rand(50,255));
79
      vel = FAB_double_rand(AEREO_V_MIN,AEREO_V_MAX); //...velocita'...
80
      dir = FAB_sign_rand();                          //...direzione...
81
      h   = FAB_int_rand(AEREO_H_MIN,AEREO_H_MAX);    //...altezza...
82
      y   = Y0 + 500 - h*500/BASE_H;
83
      l   = (dir>0) ? AEREO_L_MIN : AEREO_L_MAX;      //...posizione iniz...
84
      x   = (dir>0) ? AEREO_X_MIN : AEREO_X_MAX;
85
      // ... settaggio valori in tabella ...
86
      aereo_table[index].color = col;
87
      if (index>0) {
88
        if (dir>0) FAB_image_copy(image_aereo[0],aereo_table[index].image);
89
        else       FAB_image_copy(image_aereo[1],aereo_table[index].image);
90
        }
91
      else {
92
        if (dir>0) FAB_image_copy(image_aereo[2],aereo_table[index].image);
93
        else       FAB_image_copy(image_aereo[3],aereo_table[index].image);
94
        }
95
      FAB_image_color_change(aereo_table[index].image,AEREO_BASE_COL,col);
96
      aereo_table[index].vel = vel;
97
      aereo_table[index].dir = dir;
98
      aereo_table[index].h   = h;
99
      aereo_table[index].l   = l;
100
      aereo_table[index].x   = x;
101
      aereo_table[index].y   = y;
102
      if (index==0) pid = crea_hard_aereo(index); // sempre il 1ø hard
103
      else          pid = crea_soft_aereo(index); // tutti gli altri soft
104
      aereo_table[index].pid = pid;
105
      if (pid!=NIL) task_activate(pid);
106
      else {           //ripristino il posto libero in tabella;
107
        aereo_table[index].status =  0;
108
        aereo_table[index].killing = 0;
109
        }
110
      }
111
 
112
    else if (count>aereo_count) {       // Richiesta cancellazione aereo
113
      aereo_table[last].killing = 1;
114
      }
115
 
116
    task_endcycle();
117
    }
118
  return NULL;
119
}
120
 
121
TASK aereo(void *arg)
122
{
123
  int        index;    // indice nella aereo_table
124
  FAB_IMAGE* image;
125
  int        xx0,yy0,xx1,yy1;
126
  int        y;
127
  double     x;
128
  double     old_x;    // [pixel]: conserva valore x prima di aggiornare
129
  double     dx;       // [pixel/us]: spostamento periodico
130
  int        first_time;
131
 
132
  index = (int)arg;
133
  image =      aereo_table[index].image;
134
  y = aereo_table[index].y;
135
  x = aereo_table[index].x;
136
  dx = aereo_table[index].vel * (AEREO_X_MAX-AEREO_X_MIN) / (double)BASE_L
137
       * (AEREO_PERIOD / (60*60*1000000.0))
138
       * aereo_table[index].dir;
139
  first_time = 1;
140
 
141
  while(1){
142
 
143
   old_x = x;
144
   x += dx;
145
 
146
   xx0 = old_x - AEREO_LX/2;
147
   yy0 = y - AEREO_LY/2;
148
   xx1 = xx0   + AEREO_LX - 1;
149
   yy1 = yy0   + AEREO_LY - 1;
150
 
151
   aereo_table[index].x = x;   //...aggiornamento posizione in tabella...
152
 
153
   if (x<AEREO_X_MIN || x>AEREO_X_MAX) {
154
      aereo_table[index].killing = 1;
155
      }
156
 
157
   if (aereo_table[index].killing) {
158
      if (!first_time) {
159
          mutex_lock(&grx_mutex);
160
          FAB_image_put_within(image_bca,X0,Y0,xx0,yy0,xx1,yy1);
161
          mutex_unlock(&grx_mutex);
162
          }
163
      aereo_table[index].status=0;
164
      aereo_table[index].pid=-2;
165
      aereo_table[index].killing=0;
166
      //il task aereo_creator si accorge che c'Š un aereo in meno
167
      // quindi ne ricreer… uno nuovo!!!
168
      return NULL;
169
      }
170
 
171
   if(aereo_table[index].x!=(int)old_x) {//...se c'Š lo spostamento reale
172
                                         //        di almeno un pixel...
173
     mutex_lock(&grx_mutex);   //...aggiorna disegno...
174
     if (first_time) {
175
         first_time=0;
176
         }
177
     else {
178
         FAB_image_put_within(image_bca,X0,Y0,xx0,yy0,xx1,yy1);
179
         }
180
 
181
     FAB_image_put_within(image, x - AEREO_LX/2, y - AEREO_LY/2,
182
                                 X0, Y0, X1, Y1);
183
     mutex_unlock(&grx_mutex);
184
     }
185
 
186
   task_endcycle();
187
 }
188
 
189
return NULL;
190
}
191
 
192
PID crea_soft_aereo_creator()
193
{
194
  SOFT_TASK_MODEL m;
195
  PID pid;
196
 
197
  soft_task_default_model(m);
198
  soft_task_def_periodic(m);
199
  soft_task_def_period(m,AEREO_CREATOR_PERIOD);
200
  soft_task_def_wcet(m,AEREO_CREATOR_WCET);
201
  soft_task_def_met(m,AEREO_CREATOR_MET);
202
 
203
  pid = task_create("aereo_creator", aereo_creator, &m, NULL);
204
  return pid;
205
}
206
 
207
PID crea_hard_aereo(int index)
208
{
209
  HARD_TASK_MODEL m;
210
  PID pid;
211
 
212
  hard_task_default_model(m);
1468 giacomo 213
  hard_task_def_level(m,1);
1090 pj 214
  hard_task_def_arg(m,(void*)index);
215
  hard_task_def_periodic(m);
216
  hard_task_def_wcet(m, AEREO_WCET);
217
  hard_task_def_mit(m,AEREO_PERIOD);
218
  hard_task_def_usemath(m);
219
 
220
  pid = task_create("hard_aereo", aereo, &m, NULL);
221
  return pid;
222
}
223
 
224
PID crea_soft_aereo(int index)
225
{
226
  SOFT_TASK_MODEL m;
227
  PID pid;
228
 
229
  soft_task_default_model(m);
1468 giacomo 230
  soft_task_def_level(m,2);
1090 pj 231
  soft_task_def_arg(m,(void*)index);
232
  soft_task_def_periodic(m);
233
  soft_task_def_period(m,AEREO_PERIOD);
234
  soft_task_def_wcet(m, AEREO_WCET);
235
  soft_task_def_met(m,AEREO_MET);
236
  soft_task_def_usemath(m);
237
 
238
  pid = task_create("soft aereo", aereo, &m, NULL);
239
  return pid;
240
}
241