Subversion Repositories shark

Rev

Rev 1655 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1655 giacomo 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
 *   (see the web pages for full authors list)
11
 *
12
 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)
13
 *
14
 * http://www.sssup.it
15
 * http://retis.sssup.it
16
 * http://shark.sssup.it
17
 */
18
 
19
/**
20
 ------------
21
 CVS :        $Id: draw.c,v 1.1.1.1 2004-05-24 18:03:47 giacomo Exp $
22
 
23
 File:        $File$
24
 Revision:    $Revision: 1.1.1.1 $
25
 Last update: $Date: 2004-05-24 18:03:47 $
26
 ------------
27
 
28
 This file is similar to the configuration of Hartik 3.3.1
29
 
30
**/
31
 
32
/*
33
 * Copyright (C) 2000 Paolo Gai and ALLEN-DESTRO
34
 *
35
 * This program is free software; you can redistribute it and/or modify
36
 * it under the terms of the GNU General Public License as published by
37
 * the Free Software Foundation; either version 2 of the License, or
38
 * (at your option) any later version.
39
 *
40
 * This program is distributed in the hope that it will be useful,
41
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
42
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
43
 * GNU General Public License for more details.
44
 *
45
 * You should have received a copy of the GNU General Public License
46
 * along with this program; if not, write to the Free Software
47
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
48
 *
49
 */
50
 
51
#include "eli.h"
52
 
53
void draw_static()
54
{
55
  int i;
56
  /************************************/
57
  /* Sezione esecutiva della funzione */
58
  /************************************/
59
 
60
  grx_rect(X0min,Y0min,X0max,Y0max,COL_CORNICE);
61
  //       grx_rect(X0min+100,Y0min+100,X0max,Y0max,COL_CORNICE);
62
  grx_line(X0min,Y0min+100,X0min+100,Y0min+100,COL_CORNICE);
63
  //       grx_line(X0min,Y0min+350,X0min+100,Y0min+350,COL_CORNICE);
64
 
65
  grx_line(X0min+25,Y0min+100,X0min+25,Y0max,COL_CORNICE);
66
  grx_line(X0min+50,Y0min+100,X0min+50,Y0max,COL_CORNICE);
67
  grx_line(X0min+75,Y0min+100,X0min+75,Y0max,COL_CORNICE);
68
 
69
  grx_line(X0min,Y0min+100+127,X0min+25,Y0min+100+127,LIGHTBLUE);
70
  grx_line(X0min+50,Y0min+100+127,X0min+100,Y0min+100+127,LIGHTBLUE);
71
  grx_line(X0min+50,Y0min+100+127+250,X0min+100,Y0min+100+127+250,LIGHTBLUE);
72
 
73
 
74
  grx_box(X0min+101+50,400,X0min+230+50,Y0max-1,BROWN);
75
  for(i=1;i<6;i++){
76
    grx_box(X0min+101+50+38,400+35*i-10,X0min+101+50+48,400+35*i,CYAN);
77
    grx_box(X0min+101+50+81,400+35*i-10,X0min+101+50+91,400+35*i,CYAN);
78
  }
79
  grx_box(X0min+101+50+60,Y0max-30,X0min+101+50+70,Y0max-1,GREEN);
80
 
81
 
82
  grx_box(700,520,X0max-1,Y0max-1,CYAN);
83
 
84
 
85
 
86
  grx_text("Fx", X0min+5, Y0min+90, COL_TESTO, COL_SFONDO);
87
  grx_text("Fy", X0min+30, Y0min+90, COL_TESTO, COL_SFONDO);
88
  grx_text("Ax", X0min+55, Y0min+90, COL_TESTO, COL_SFONDO);
89
  grx_text("Ay", X0min+80, Y0min+90, COL_TESTO, COL_SFONDO);
90
  //       grx_text("M", X0min+10, Y0min+351, COL_TESTO, COL_SFONDO);
91
  //       grx_text("P", X0min+35, Y0min+351, COL_TESTO, COL_SFONDO);
92
  grx_text("Vx", X0min+55, Y0min+351, COL_TESTO, COL_SFONDO);
93
  grx_text("Vy", X0min+80, Y0min+351, COL_TESTO, COL_SFONDO);
94
 
95
  grx_text("S   : Su", X0min+110, Y0min+15, COL_TESTO, COL_SFONDO);
96
  grx_text("Z   : Sinistra", X0min+110, Y0min+25, COL_TESTO, COL_SFONDO);
97
  grx_text("X   : Giu", X0min+110, Y0min+35, COL_TESTO, COL_SFONDO);
98
  grx_text("C   : Destra", X0min+110, Y0min+45, COL_TESTO, COL_SFONDO);
99
  grx_text("P   : aggancia Peso", X0min+110, Y0min+55, COL_TESTO, COL_SFONDO);
100
  grx_text("L   : Libera peso", X0min+110, Y0min+65, COL_TESTO, COL_SFONDO);
101
  grx_text("Esc : Usita Programma", X0min+110, Y0min+75, COL_TESTO, COL_SFONDO);
102
 
103
 
104
}       // Fine della funzione draw_static
105
 
106
TASK disegna_stato(int i)
107
{ //double j;
108
 
109
  while (1)
110
    {
111
 
112
      sem_wait(&mutex);
113
 
114
      grx_rect(X0min+100,Y0min+100,X0max,Y0max,COL_CORNICE);
115
 
116
      grx_box(700,565,770,Y0max-1,LIGHTCYAN);
117
 
118
      grx_box(X0min+101+50,400,X0min+230+50,420,BROWN);
119
 
120
 
121
      //####################### FORZA X #############################
122
      if ( 0.25<=Forza_x)  grx_box(7,Y0min+210,26,Y0min+220,GREEN);
123
      else      grx_box(7,Y0min+210,26,Y0min+220,COL_SFONDO);
124
      if ( 0.5<=Forza_x)  grx_box(7,Y0min+195,26,Y0min+205,GREEN);
125
      else      grx_box(7,Y0min+195,26,Y0min+205,COL_SFONDO);
126
      if ( 0.75<=Forza_x) grx_box(7,Y0min+180,26,Y0min+190,GREEN);
127
      else      grx_box(7,Y0min+180,26,Y0min+190,COL_SFONDO);
128
      if ( 1<=Forza_x)    grx_box(7,Y0min+165,26,Y0min+175,GREEN);
129
      else      grx_box(7,Y0min+165,26,Y0min+175,COL_SFONDO);
130
      if ( 1.25<=Forza_x)  grx_box(7,Y0min+150,26,Y0min+160,GREEN);
131
      else      grx_box(7,Y0min+150,26,Y0min+160,COL_SFONDO);
132
      if ( 1.50<=Forza_x)  grx_box(7,Y0min+135,26,Y0min+145,YELLOW);
133
      else      grx_box(7,Y0min+135,26,Y0min+145,COL_SFONDO);
134
      if ( 1.75<=Forza_x)  grx_box(7,Y0min+120,26,Y0min+130,RED);
135
      else      grx_box(7,Y0min+120,26,Y0min+130,COL_SFONDO);
136
      if ( 2<=Forza_x)  grx_box(7,Y0min+105,26,Y0min+115,RED);
137
      else      grx_box(7,Y0min+105,26,Y0min+115,COL_SFONDO);
138
      //###########  ------       
139
      if (-0.25>=Forza_x)  grx_box(7,Y0min+230,26,Y0min+240,GREEN);
140
      else      grx_box(7,Y0min+230,26,Y0min+240,COL_SFONDO);
141
      if ( -0.5>=Forza_x)  grx_box(7,Y0min+245,26,Y0min+255,GREEN);
142
      else      grx_box(7,Y0min+245,26,Y0min+255,COL_SFONDO);
143
      if ( -0.75>=Forza_x) grx_box(7,Y0min+260,26,Y0min+270,GREEN);
144
      else      grx_box(7,Y0min+260,26,Y0min+270,COL_SFONDO);
145
      if ( -1>=Forza_x)    grx_box(7,Y0min+275,26,Y0min+285,GREEN);
146
      else      grx_box(7,Y0min+275,26,Y0min+285,COL_SFONDO);
147
      if ( -1.25>=Forza_x) grx_box(7,Y0min+290,26,Y0min+300,GREEN);
148
      else      grx_box(7,Y0min+290,26,Y0min+300,COL_SFONDO);
149
      if ( -1.50>=Forza_x) grx_box(7,Y0min+305,26,Y0min+315,YELLOW);
150
      else      grx_box(7,Y0min+305,26,Y0min+315,COL_SFONDO);
151
      if ( -1.75>=Forza_x) grx_box(7,Y0min+320,26,Y0min+330,RED);
152
      else      grx_box(7,Y0min+320,26,Y0min+330,COL_SFONDO);
153
      if ( -2>=Forza_x)    grx_box(7,Y0min+335,26,Y0min+345,RED);
154
      else      grx_box(7,Y0min+335,26,Y0min+345,COL_SFONDO);
155
      //####################### FORZA Y #############################         
156
      if ( -0.5>=Forza_y)  grx_box(32,Y0min+340,51,Y0min+345,GREEN);
157
      else  grx_box(32,Y0min+340,51,Y0min+345,COL_SFONDO);
158
      if ( -1>=Forza_y)  grx_box(32,Y0min+333,51,Y0min+338,GREEN);
159
      else  grx_box(32,Y0min+333,51,Y0min+338,COL_SFONDO);
160
      if ( -1.5>=Forza_y)  grx_box(32,Y0min+326,51,Y0min+331,GREEN);
161
      else  grx_box(32,Y0min+326,51,Y0min+331,COL_SFONDO);
162
      if ( -2>=Forza_y)  grx_box(32,Y0min+319,51,Y0min+324,GREEN);
163
      else  grx_box(32,Y0min+319,51,Y0min+324,COL_SFONDO);
164
      if ( -2.5>=Forza_y)  grx_box(32,Y0min+312,51,Y0min+317,GREEN);
165
      else  grx_box(32,Y0min+312,51,Y0min+317,COL_SFONDO);
166
      if ( -3>=Forza_y)  grx_box(32,Y0min+305,51,Y0min+310,GREEN);
167
      else  grx_box(32,Y0min+305,51,Y0min+310,COL_SFONDO);
168
      if ( -3.5>=Forza_y)  grx_box(32,Y0min+298,51,Y0min+303,GREEN);
169
      else  grx_box(32,Y0min+298,51,Y0min+303,COL_SFONDO);
170
      if ( -4>=Forza_y)  grx_box(32,Y0min+291,51,Y0min+296,GREEN);
171
      else  grx_box(32,Y0min+291,51,Y0min+296,COL_SFONDO);
172
      if ( -4.5>=Forza_y)  grx_box(32,Y0min+284,51,Y0min+289,GREEN);
173
      else  grx_box(32,Y0min+284,51,Y0min+289,COL_SFONDO);
174
      if ( -5>=Forza_y) grx_box(32,Y0min+277,51,Y0min+282,GREEN);
175
      else  grx_box(32,Y0min+277,51,Y0min+282,COL_SFONDO);
176
      if ( -5.5>=Forza_y) grx_box(32,Y0min+270,51,Y0min+275,GREEN);
177
      else  grx_box(32,Y0min+270,51,Y0min+275,COL_SFONDO);
178
      if ( -6>=Forza_y) grx_box(32,Y0min+263,51,Y0min+268,GREEN);
179
      else  grx_box(32,Y0min+263,51,Y0min+268,COL_SFONDO);
180
      if ( -6.5>=Forza_y) grx_box(32,Y0min+256,51,Y0min+261,GREEN);
181
      else  grx_box(32,Y0min+256,51,Y0min+261,COL_SFONDO);
182
      if ( -7>=Forza_y) grx_box(32,Y0min+249,51,Y0min+254,GREEN);
183
      else  grx_box(32,Y0min+249,51,Y0min+254,COL_SFONDO);
184
      if ( -7.5>=Forza_y) grx_box(32,Y0min+242,51,Y0min+247,GREEN);
185
      else  grx_box(32,Y0min+242,51,Y0min+247,COL_SFONDO);
186
      if ( -8>=Forza_y) grx_box(32,Y0min+235,51,Y0min+240,GREEN);
187
      else  grx_box(32,Y0min+235,51,Y0min+240,COL_SFONDO);
188
      if ( -8.5>=Forza_y) grx_box(32,Y0min+228,51,Y0min+233,GREEN);
189
      else  grx_box(32,Y0min+228,51,Y0min+233,COL_SFONDO);
190
      if ( -9>=Forza_y) grx_box(32,Y0min+221,51,Y0min+226,GREEN);
191
      else  grx_box(32,Y0min+221,51,Y0min+226,COL_SFONDO);
192
      if ( -9.5>=Forza_y) grx_box(32,Y0min+214,51,Y0min+219,GREEN);
193
      else  grx_box(32,Y0min+214,51,Y0min+219,COL_SFONDO);
194
      if ( -10>=Forza_y) grx_box(32,Y0min+207,51,Y0min+212,GREEN);
195
      else  grx_box(32,Y0min+207,51,Y0min+212,COL_SFONDO);
196
      if ( -10.5>=Forza_y) grx_box(32,Y0min+200,51,Y0min+205,GREEN);
197
      else  grx_box(32,Y0min+200,51,Y0min+205,COL_SFONDO);
198
      if ( -11>=Forza_y) grx_box(32,Y0min+193,51,Y0min+198,GREEN);
199
      else  grx_box(32,Y0min+193,51,Y0min+198,COL_SFONDO);
200
      if ( -11.5>=Forza_y) grx_box(32,Y0min+186,51,Y0min+191,GREEN);
201
      else  grx_box(32,Y0min+186,51,Y0min+191,COL_SFONDO);
202
      if ( -12>=Forza_y) grx_box(32,Y0min+179,51,Y0min+184,GREEN);
203
      else  grx_box(32,Y0min+179,51,Y0min+184,COL_SFONDO);
204
      if ( -12.5>=Forza_y) grx_box(32,Y0min+172,51,Y0min+177,GREEN);
205
      else  grx_box(32,Y0min+172,51,Y0min+177,COL_SFONDO);
206
      if ( -13>=Forza_y) grx_box(32,Y0min+165,51,Y0min+170,GREEN);
207
      else  grx_box(32,Y0min+165,51,Y0min+170,COL_SFONDO);
208
      if ( -13.5>=Forza_y) grx_box(32,Y0min+158,51,Y0min+163,GREEN);
209
      else  grx_box(32,Y0min+158,51,Y0min+163,COL_SFONDO);
210
      if ( -14>=Forza_y) grx_box(32,Y0min+151,51,Y0min+156,GREEN);
211
      else  grx_box(32,Y0min+151,51,Y0min+156,COL_SFONDO);
212
      if ( -14.5>=Forza_y) grx_box(32,Y0min+144,51,Y0min+149,GREEN);
213
      else  grx_box(32,Y0min+144,51,Y0min+149,COL_SFONDO);
214
      if ( -15>=Forza_y) grx_box(32,Y0min+137,51,Y0min+142,YELLOW);
215
      else  grx_box(32,Y0min+137,51,Y0min+142,COL_SFONDO);
216
      if ( -15.5>=Forza_y) grx_box(32,Y0min+130,51,Y0min+135,YELLOW);
217
      else  grx_box(32,Y0min+130,51,Y0min+135,COL_SFONDO);
218
      if ( -16>=Forza_y) grx_box(32,Y0min+123,51,Y0min+128,RED);
219
      else  grx_box(32,Y0min+123,51,Y0min+128,COL_SFONDO);
220
      if ( -16.5>=Forza_y) grx_box(32,Y0min+116,51,Y0min+121,RED);
221
      else  grx_box(32,Y0min+116,51,Y0min+121,COL_SFONDO);
222
      if ( -17>=Forza_y) grx_box(32,Y0min+109,51,Y0min+114,RED);
223
      else  grx_box(32,Y0min+109,51,Y0min+114,COL_SFONDO);
224
      if ( -17.5>=Forza_y) grx_box(32,Y0min+102,51,Y0min+107,RED);
225
      else  grx_box(32,Y0min+102,51,Y0min+107,COL_SFONDO);
226
 
227
      //####################### ACCELERAZIONE X #############################         
228
      if ( -2.125>=Acc_x)grx_box(56,Y0min+340,75,Y0min+345,RED);
229
      else  grx_box(55,Y0min+340,75,Y0min+345,COL_SFONDO);
230
      if ( -2>=Acc_x)  grx_box(56,Y0min+333,75,Y0min+338,RED);
231
      else  grx_box(56,Y0min+333,75,Y0min+338,COL_SFONDO);
232
      if ( -1.875>=Acc_x)grx_box(56,Y0min+326,75,Y0min+331,RED);
233
      else  grx_box(56,Y0min+326,75,Y0min+331,COL_SFONDO);
234
      if ( -1.750>=Acc_x)  grx_box(56,Y0min+319,75,Y0min+324,YELLOW);
235
      else  grx_box(56,Y0min+319,75,Y0min+324,COL_SFONDO);
236
      if ( -1.625>=Acc_x)grx_box(56,Y0min+312,75,Y0min+317,YELLOW);
237
      else  grx_box(56,Y0min+312,75,Y0min+317,COL_SFONDO);
238
      if ( -1.5>=Acc_x)  grx_box(56,Y0min+305,75,Y0min+310,GREEN);
239
      else  grx_box(56,Y0min+305,75,Y0min+310,COL_SFONDO);
240
      if ( -1.375>=Acc_x)grx_box(56,Y0min+298,75,Y0min+303,GREEN);
241
      else  grx_box(56,Y0min+298,75,Y0min+303,COL_SFONDO);
242
      if ( -1.250>=Acc_x)  grx_box(56,Y0min+291,75,Y0min+296,GREEN);
243
      else  grx_box(56,Y0min+291,75,Y0min+296,COL_SFONDO);
244
      if ( -1.125>=Acc_x)grx_box(56,Y0min+284,75,Y0min+289,GREEN);
245
      else  grx_box(56,Y0min+284,75,Y0min+289,COL_SFONDO);
246
      if ( -1>=Acc_x)  grx_box(56,Y0min+277,75,Y0min+282,GREEN);
247
      else  grx_box(56,Y0min+277,75,Y0min+282,COL_SFONDO);
248
      if ( -0.875>=Acc_x)grx_box(56,Y0min+270,75,Y0min+275,GREEN);
249
      else  grx_box(56,Y0min+270,75,Y0min+275,COL_SFONDO);
250
      if ( -0.750>=Acc_x)  grx_box(56,Y0min+263,75,Y0min+268,GREEN);
251
      else  grx_box(56,Y0min+263,75,Y0min+268,COL_SFONDO);
252
      if ( -0.625>=Acc_x)grx_box(56,Y0min+256,75,Y0min+261,GREEN);
253
      else  grx_box(56,Y0min+256,75,Y0min+261,COL_SFONDO);
254
      if ( -0.5>=Acc_x)  grx_box(56,Y0min+249,75,Y0min+254,GREEN);
255
      else  grx_box(56,Y0min+249,75,Y0min+254,COL_SFONDO);
256
      if ( -0.375>=Acc_x)grx_box(56,Y0min+242,75,Y0min+247,GREEN);
257
      else  grx_box(56,Y0min+242,75,Y0min+247,COL_SFONDO);
258
      if ( -0.250>=Acc_x)  grx_box(56,Y0min+235,75,Y0min+240,GREEN);
259
      else  grx_box(56,Y0min+235,75,Y0min+240,COL_SFONDO);
260
      if ( -0.125>=Acc_x)grx_box(56,Y0min+228,75,Y0min+233,GREEN);
261
      else  grx_box(56,Y0min+228,75,Y0min+233,COL_SFONDO);
262
      //#############  ------ 
263
      if ( 0.125<=Acc_x)  grx_box(56,Y0min+221,75,Y0min+226,GREEN);
264
      else  grx_box(56,Y0min+221,75,Y0min+226,COL_SFONDO);
265
      if ( 0.250<=Acc_x)grx_box(56,Y0min+214,75,Y0min+219,GREEN);
266
      else  grx_box(56,Y0min+214,75,Y0min+219,COL_SFONDO);
267
      if ( 0.375<=Acc_x) grx_box(56,Y0min+207,75,Y0min+212,GREEN);
268
      else  grx_box(56,Y0min+207,75,Y0min+212,COL_SFONDO);
269
      if (0.5<=Acc_x)grx_box(56,Y0min+200,75,Y0min+205,GREEN);
270
      else  grx_box(56,Y0min+200,75,Y0min+205,COL_SFONDO);
271
      if ( 0.625<=Acc_x) grx_box(56,Y0min+193,75,Y0min+198,GREEN);
272
      else  grx_box(56,Y0min+193,75,Y0min+198,COL_SFONDO);
273
      if (0.750<=Acc_x)grx_box(56,Y0min+186,75,Y0min+191,GREEN);
274
      else  grx_box(56,Y0min+186,75,Y0min+191,COL_SFONDO);
275
      if (0.875<=Acc_x)  grx_box(56,Y0min+179,75,Y0min+184,GREEN);
276
      else  grx_box(56,Y0min+179,75,Y0min+184,COL_SFONDO);
277
      if (1<=Acc_x)grx_box(56,Y0min+172,75,Y0min+177,GREEN);
278
      else  grx_box(56,Y0min+172,75,Y0min+177,COL_SFONDO);
279
      if (1.125<=Acc_x)  grx_box(56,Y0min+165,75,Y0min+170,GREEN);
280
      else  grx_box(56,Y0min+165,75,Y0min+170,COL_SFONDO);
281
      if (1.250<=Acc_x)grx_box(56,Y0min+158,75,Y0min+163,GREEN);
282
      else  grx_box(56,Y0min+158,75,Y0min+163,COL_SFONDO);
283
      if (1.375<=Acc_x)  grx_box(56,Y0min+151,75,Y0min+156,GREEN);
284
      else  grx_box(56,Y0min+151,75,Y0min+156,COL_SFONDO);
285
      if (1.5<=Acc_x)grx_box(56,Y0min+144,75,Y0min+149,GREEN);
286
      else  grx_box(56,Y0min+144,75,Y0min+149,COL_SFONDO);
287
      if (1.625<=Acc_x)  grx_box(56,Y0min+137,75,Y0min+142,YELLOW);
288
      else  grx_box(56,Y0min+137,75,Y0min+142,COL_SFONDO);
289
      if (1.750<=Acc_x)grx_box(56,Y0min+130,75,Y0min+135,YELLOW);
290
      else  grx_box(56,Y0min+130,75,Y0min+135,COL_SFONDO);
291
      if (1.875<=Acc_x)  grx_box(56,Y0min+123,75,Y0min+128,RED);
292
      else  grx_box(56,Y0min+123,75,Y0min+128,COL_SFONDO);
293
      if (2<=Acc_x)grx_box(56,Y0min+116,75,Y0min+121,RED);
294
      else  grx_box(56,Y0min+116,75,Y0min+121,COL_SFONDO);
295
      if (2.125<=Acc_x)  grx_box(56,Y0min+109,75,Y0min+114,RED);
296
      else  grx_box(56,Y0min+109,75,Y0min+114,COL_SFONDO);
297
      //####################### ACCELERAZIONE Y  #############################         
298
      if ( 2.5<=Acc_y)  {  grx_box(81,Y0min+340,100,Y0min+345,RED);
299
      grx_box(81+5,Y0min+340+1,100-5,Y0min+345-1,BLUE);
300
      }
301
      else    grx_box(81,Y0min+340,100,Y0min+345,COL_SFONDO);
302
      if ( 2.200<=Acc_y)      grx_box(81,Y0min+333,100,Y0min+338,RED);
303
      else    grx_box(81,Y0min+333,100,Y0min+338,COL_SFONDO);
304
      if ( 1.950<=Acc_y)  grx_box(81,Y0min+326,100,Y0min+331,RED);
305
      else    grx_box(81,Y0min+326,100,Y0min+331,COL_SFONDO);
306
      if ( 1.750<=Acc_y)  grx_box(81,Y0min+319,100,Y0min+324,YELLOW);
307
      else    grx_box(81,Y0min+319,100,Y0min+324,COL_SFONDO);
308
      if ( 1.625<=Acc_y)  grx_box(81,Y0min+312,100,Y0min+317,YELLOW);
309
      else    grx_box(81,Y0min+312,100,Y0min+317,COL_SFONDO);
310
      if ( 1.5<=Acc_y)    grx_box(81,Y0min+305,100,Y0min+310,GREEN);
311
      else    grx_box(81,Y0min+305,100,Y0min+310,COL_SFONDO);
312
      if ( 1.375<=Acc_y)  grx_box(81,Y0min+298,100,Y0min+303,GREEN);
313
      else    grx_box(81,Y0min+298,100,Y0min+303,COL_SFONDO);
314
      if ( 1.250<=Acc_y)  grx_box(81,Y0min+291,100,Y0min+296,GREEN);
315
      else    grx_box(81,Y0min+291,100,Y0min+296,COL_SFONDO);
316
      if ( 1.125<=Acc_y)  grx_box(81,Y0min+284,100,Y0min+289,GREEN);
317
      else    grx_box(81,Y0min+284,100,Y0min+289,COL_SFONDO);
318
      if ( 1<=Acc_y)      grx_box(81,Y0min+277,100,Y0min+282,GREEN);
319
      else    grx_box(81,Y0min+277,100,Y0min+282,COL_SFONDO);
320
      if ( 0.875<=Acc_y)  grx_box(81,Y0min+270,100,Y0min+275,GREEN);
321
      else    grx_box(81,Y0min+270,100,Y0min+275,COL_SFONDO);
322
      if ( 0.750<=Acc_y)  grx_box(81,Y0min+263,100,Y0min+268,GREEN);
323
      else    grx_box(81,Y0min+263,100,Y0min+268,COL_SFONDO);
324
      if ( 0.625<=Acc_y)  grx_box(81,Y0min+256,100,Y0min+261,GREEN);
325
      else    grx_box(81,Y0min+256,100,Y0min+261,COL_SFONDO);
326
      if ( 0.5<=Acc_y)    grx_box(81,Y0min+249,100,Y0min+254,GREEN);
327
      else    grx_box(81,Y0min+249,100,Y0min+254,COL_SFONDO);
328
      if ( 0.375<=Acc_y)  grx_box(81,Y0min+242,100,Y0min+247,GREEN);
329
      else    grx_box(81,Y0min+242,100,Y0min+247,COL_SFONDO);
330
      if ( 0.25<=Acc_y)  grx_box(81,Y0min+235,100,Y0min+240,GREEN);
331
      else    grx_box(81,Y0min+235,100,Y0min+240,COL_SFONDO);
332
      if ( 0.125<=Acc_y)  grx_box(81,Y0min+228,100,Y0min+233,GREEN);
333
      else    grx_box(81,Y0min+228,100,Y0min+233,COL_SFONDO);
334
      //#############  ------
335
      if ( -0.125>=Acc_y)   grx_box(81,Y0min+221,100,Y0min+226,GREEN);
336
      else    grx_box(81,Y0min+221,100,Y0min+226,COL_SFONDO);
337
      if ( -0.250>=Acc_y)   grx_box(81,Y0min+214,100,Y0min+219,GREEN);
338
      else    grx_box(81,Y0min+214,100,Y0min+219,COL_SFONDO);
339
      if ( -0.375>=Acc_y)       grx_box(81,Y0min+207,100,Y0min+212,GREEN);
340
      else    grx_box(81,Y0min+207,100,Y0min+212,COL_SFONDO);
341
      if (-0.5>=Acc_y)    grx_box(81,Y0min+200,100,Y0min+205,GREEN);
342
      else    grx_box(81,Y0min+200,100,Y0min+205,COL_SFONDO);
343
      if ( -0.625>=Acc_y)   grx_box(81,Y0min+193,100,Y0min+198,GREEN);
344
      else    grx_box(81,Y0min+193,100,Y0min+198,COL_SFONDO);
345
      if (-0.750>=Acc_y)        grx_box(81,Y0min+186,100,Y0min+191,GREEN);
346
      else    grx_box(81,Y0min+186,100,Y0min+191,COL_SFONDO);
347
      if (-0.875>=Acc_y)    grx_box(81,Y0min+179,100,Y0min+184,GREEN);
348
      else    grx_box(81,Y0min+179,100,Y0min+184,COL_SFONDO);
349
      if (-1>=Acc_y)    grx_box(81,Y0min+172,100,Y0min+177,GREEN);
350
      else    grx_box(81,Y0min+172,100,Y0min+177,COL_SFONDO);
351
      if (-1.125>=Acc_y)        grx_box(81,Y0min+165,100,Y0min+170,YELLOW);
352
      else    grx_box(81,Y0min+165,100,Y0min+170,COL_SFONDO);
353
      if (-1.250>=Acc_y)    grx_box(81,Y0min+158,100,Y0min+163,YELLOW);
354
      else    grx_box(81,Y0min+158,100,Y0min+163,COL_SFONDO);
355
      if (-1.375>=Acc_y)    grx_box(81,Y0min+151,100,Y0min+156,YELLOW);
356
      else    grx_box(81,Y0min+151,100,Y0min+156,COL_SFONDO);
357
      if (-1.5>=Acc_y)        grx_box(81,Y0min+144,100,Y0min+149,YELLOW);
358
      else    grx_box(81,Y0min+144,100,Y0min+149,COL_SFONDO);
359
      if (-1.625>=Acc_y)    grx_box(81,Y0min+137,100,Y0min+142,RED);
360
      else    grx_box(81,Y0min+137,100,Y0min+142,COL_SFONDO);
361
      if (-1.750>=Acc_y)    grx_box(81,Y0min+130,100,Y0min+135,RED);
362
      else    grx_box(81,Y0min+130,100,Y0min+135,COL_SFONDO);
363
      if (-1.875>=Acc_y)       grx_box(81,Y0min+123,100,Y0min+128,RED);
364
      else    grx_box(81,Y0min+123,100,Y0min+128,COL_SFONDO);
365
      if (-2>=Acc_y)   grx_box(81,Y0min+116,100,Y0min+121,RED);
366
      else    grx_box(81,Y0min+116,100,Y0min+121,COL_SFONDO);
367
      if (-2.3>=Acc_y)   grx_box(81,Y0min+109,100,Y0min+114,RED);
368
      else    grx_box(81,Y0min+109,100,Y0min+114,COL_SFONDO);
369
      //####################### VELOCITA X #############################         
370
      //if ( -21.25>=Velocita_x)grx_box(56,Y0min+340+250,75,Y0min+345+250,RED);
371
      //else  grx_box(55,Y0min+340+250,75,Y0min+345+250,COL_SFONDO);
372
      if ( -20>=Velocita_x)    grx_box(56,Y0min+333+250,75,Y0min+338+250,RED);
373
      else  grx_box(56,Y0min+333+250,75,Y0min+338+250,COL_SFONDO);
374
      if ( -18.75>=Velocita_x)grx_box(56,Y0min+326+250,75,Y0min+331+250,RED);
375
      else  grx_box(56,Y0min+326+250,75,Y0min+331+250,COL_SFONDO);
376
      if ( -17.50>=Velocita_x)grx_box(56,Y0min+319+250,75,Y0min+324+250,YELLOW);
377
      else  grx_box(56,Y0min+319+250,75,Y0min+324+250,COL_SFONDO);
378
      if ( -16.25>=Velocita_x)grx_box(56,Y0min+312+250,75,Y0min+317+250,YELLOW);
379
      else  grx_box(56,Y0min+312+250,75,Y0min+317+250,COL_SFONDO);
380
      if ( -15>=Velocita_x)  grx_box(56,Y0min+305+250,75,Y0min+310+250,GREEN);
381
      else  grx_box(56,Y0min+305+250,75,Y0min+310+250,COL_SFONDO);
382
      if ( -13.75>=Velocita_x)grx_box(56,Y0min+298+250,75,Y0min+303+250,GREEN);
383
      else  grx_box(56,Y0min+298+250,75,Y0min+303+250,COL_SFONDO);
384
      if ( -12.50>=Velocita_x)grx_box(56,Y0min+291+250,75,Y0min+296+250,GREEN);
385
      else  grx_box(56,Y0min+291+250,75,Y0min+296+250,COL_SFONDO);
386
      if ( -11.25>=Velocita_x)grx_box(56,Y0min+284+250,75,Y0min+289+250,GREEN);
387
      else  grx_box(56,Y0min+284+250,75,Y0min+289+250,COL_SFONDO);
388
      if ( -10>=Velocita_x)    grx_box(56,Y0min+277+250,75,Y0min+282+250,GREEN);
389
      else  grx_box(56,Y0min+277+250,75,Y0min+282+250,COL_SFONDO);
390
      if ( -8.75>=Velocita_x)grx_box(56,Y0min+270+250,75,Y0min+275+250,GREEN);
391
      else  grx_box(56,Y0min+270+250,75,Y0min+275+250,COL_SFONDO);
392
      if ( -7.50>=Velocita_x)grx_box(56,Y0min+263+250,75,Y0min+268+250,GREEN);
393
      else  grx_box(56,Y0min+263+250,75,Y0min+268+250,COL_SFONDO);
394
      if ( -6.25>=Velocita_x)grx_box(56,Y0min+256+250,75,Y0min+261+250,GREEN);
395
      else  grx_box(56,Y0min+256+250,75,Y0min+261+250,COL_SFONDO);
396
      if ( -5>=Velocita_x)  grx_box(56,Y0min+249+250,75,Y0min+254+250,GREEN);
397
      else  grx_box(56,Y0min+249+250,75,Y0min+254+250,COL_SFONDO);
398
      if ( -3.75>=Velocita_x)grx_box(56,Y0min+242+250,75,Y0min+247+250,GREEN);
399
      else  grx_box(56,Y0min+242+250,75,Y0min+247+250,COL_SFONDO);
400
      if ( -2.50>=Velocita_x)grx_box(56,Y0min+235+250,75,Y0min+240+250,GREEN);
401
      else  grx_box(56,Y0min+235+250,75,Y0min+240+250,COL_SFONDO);
402
      if ( -1.25>=Velocita_x)grx_box(56,Y0min+228+250,75,Y0min+233+250,GREEN);
403
      else  grx_box(56,Y0min+228+250,75,Y0min+233+250,COL_SFONDO);
404
      //#############  ------ 
405
      if ( 1.25<=Velocita_x) grx_box(56,Y0min+221+250,75,Y0min+226+250,GREEN);
406
      else  grx_box(56,Y0min+221+250,75,Y0min+226+250,COL_SFONDO);
407
      if ( 2.50<=Velocita_x) grx_box(56,Y0min+214+250,75,Y0min+219+250,GREEN);
408
      else  grx_box(56,Y0min+214+250,75,Y0min+219+250,COL_SFONDO);
409
      if ( 3.75<=Velocita_x) grx_box(56,Y0min+207+250,75,Y0min+212+250,GREEN);
410
      else  grx_box(56,Y0min+207+250,75,Y0min+212+250,COL_SFONDO);
411
      if (5<=Velocita_x)    grx_box(56,Y0min+200+250,75,Y0min+205+250,GREEN);
412
      else  grx_box(56,Y0min+200+250,75,Y0min+205+250,COL_SFONDO);
413
      if ( 6.25<=Velocita_x) grx_box(56,Y0min+193+250,75,Y0min+198+250,GREEN);
414
      else  grx_box(56,Y0min+193+250,75,Y0min+198+250,COL_SFONDO);
415
      if (7.50<=Velocita_x)  grx_box(56,Y0min+186+250,75,Y0min+191+250,GREEN);
416
      else  grx_box(56,Y0min+186+250,75,Y0min+191+250,COL_SFONDO);
417
      if (8.75<=Velocita_x)  grx_box(56,Y0min+179+250,75,Y0min+184+250,GREEN);
418
      else  grx_box(56,Y0min+179+250,75,Y0min+184+250,COL_SFONDO);
419
      if (10<=Velocita_x)      grx_box(56,Y0min+172+250,75,Y0min+177+250,GREEN);
420
      else  grx_box(56,Y0min+172+250,75,Y0min+177+250,COL_SFONDO);
421
      if (11.25<=Velocita_x)  grx_box(56,Y0min+165+250,75,Y0min+170+250,GREEN);
422
      else  grx_box(56,Y0min+165+250,75,Y0min+170+250,COL_SFONDO);
423
      if (12.50<=Velocita_x)  grx_box(56,Y0min+158+250,75,Y0min+163+250,GREEN);
424
      else  grx_box(56,Y0min+158+250,75,Y0min+163+250,COL_SFONDO);
425
      if (13.75<=Velocita_x)  grx_box(56,Y0min+151+250,75,Y0min+156+250,GREEN);
426
      else  grx_box(56,Y0min+151+250,75,Y0min+156+250,COL_SFONDO);
427
      if (15<=Velocita_x)    grx_box(56,Y0min+144+250,75,Y0min+149+250,GREEN);
428
      else  grx_box(56,Y0min+144+250,75,Y0min+149+250,COL_SFONDO);
429
      if (16.25<=Velocita_x)  grx_box(56,Y0min+137+250,75,Y0min+142+250,YELLOW);
430
      else  grx_box(56,Y0min+137+250,75,Y0min+142+250,COL_SFONDO);
431
      if (17.50<=Velocita_x)  grx_box(56,Y0min+130+250,75,Y0min+135+250,YELLOW);
432
      else  grx_box(56,Y0min+130+250,75,Y0min+135+250,COL_SFONDO);
433
      if (18.75<=Velocita_x)  grx_box(56,Y0min+123+250,75,Y0min+128+250,RED);
434
      else  grx_box(56,Y0min+123+250,75,Y0min+128+250,COL_SFONDO);
435
      if (20<=Velocita_x)      grx_box(56,Y0min+116+250,75,Y0min+121+250,RED);
436
      else  grx_box(56,Y0min+116+250,75,Y0min+121+250,COL_SFONDO);
437
      if (21.25<=Velocita_x)  grx_box(56,Y0min+109+250,75,Y0min+114+250,RED);
438
      else  grx_box(56,Y0min+109+250,75,Y0min+114+250,COL_SFONDO);
439
 
440
      //####################### VELOCITA Y #############################         
441
      // if ( 160<=Velocita_y)grx_box(81,Y0min+340+250,100,Y0min+345+250,RED);
442
      // else       grx_box(81,Y0min+340+250,100,Y0min+345+250,COL_SFONDO);
443
      if ( 40<=Velocita_y)   grx_box(81,Y0min+333+250,100,Y0min+338+250,RED);
444
      else       grx_box(81,Y0min+333+250,100,Y0min+338+250,COL_SFONDO);
445
      if ( 37.5<=Velocita_y)grx_box(81,Y0min+326+250,100,Y0min+331+250,RED);
446
      else       grx_box(81,Y0min+326+250,100,Y0min+331+250,COL_SFONDO);
447
      if ( 35<=Velocita_y)grx_box(81,Y0min+319+250,100,Y0min+324+250,YELLOW);
448
      else       grx_box(81,Y0min+319+250,100,Y0min+324+250,COL_SFONDO);
449
      if ( 32.5<=Velocita_y)grx_box(81,Y0min+312+250,100,Y0min+317+250,YELLOW);
450
      else       grx_box(81,Y0min+312+250,100,Y0min+317+250,COL_SFONDO);
451
      if ( 30<=Velocita_y)   grx_box(81,Y0min+305+250,100,Y0min+310+250,GREEN);
452
      else       grx_box(81,Y0min+305+250,100,Y0min+310+250,COL_SFONDO);
453
      if ( 27.5<=Velocita_y)grx_box(81,Y0min+298+250,100,Y0min+303+250,GREEN);
454
      else       grx_box(81,Y0min+298+250,100,Y0min+303+250,COL_SFONDO);
455
      if ( 25<=Velocita_y)grx_box(81,Y0min+291+250,100,Y0min+296+250,GREEN);
456
      else       grx_box(81,Y0min+291+250,100,Y0min+296+250,COL_SFONDO);
457
      if ( 22.5<=Velocita_y)grx_box(81,Y0min+284+250,100,Y0min+289+250,GREEN);
458
      else       grx_box(81,Y0min+284+250,100,Y0min+289+250,COL_SFONDO);
459
      if ( 20<=Velocita_y)   grx_box(81,Y0min+277+250,100,Y0min+282+250,GREEN);
460
      else       grx_box(81,Y0min+277+250,100,Y0min+282+250,COL_SFONDO);
461
      if ( 17.5<=Velocita_y) grx_box(81,Y0min+270+250,100,Y0min+275+250,GREEN);
462
      else       grx_box(81,Y0min+270+250,100,Y0min+275+250,COL_SFONDO);
463
      if ( 15<=Velocita_y) grx_box(81,Y0min+263+250,100,Y0min+268+250,GREEN);
464
      else       grx_box(81,Y0min+263+250,100,Y0min+268+250,COL_SFONDO);
465
      if ( 12.5<=Velocita_y) grx_box(81,Y0min+256+250,100,Y0min+261+250,GREEN);
466
      else       grx_box(81,Y0min+256+250,100,Y0min+261+250,COL_SFONDO);
467
      if ( 10<=Velocita_y)    grx_box(81,Y0min+249+250,100,Y0min+254+250,GREEN);
468
      else       grx_box(81,Y0min+249+250,100,Y0min+254+250,COL_SFONDO);
469
      if ( 7.5<=Velocita_y) grx_box(81,Y0min+242+250,100,Y0min+247+250,GREEN);
470
      else       grx_box(81,Y0min+242+250,100,Y0min+247+250,COL_SFONDO);
471
      if ( 5<=Velocita_y) grx_box(81,Y0min+235+250,100,Y0min+240+250,GREEN);
472
      else       grx_box(81,Y0min+235+250,100,Y0min+240+250,COL_SFONDO);
473
      if ( 2.5<=Velocita_y) grx_box(81,Y0min+228+250,100,Y0min+233+250,GREEN);
474
      else       grx_box(81,Y0min+228+250,100,Y0min+233+250,COL_SFONDO);
475
      //#############  ------
476
      if (-2.5>=Velocita_y)  grx_box(81,Y0min+221+250,100,Y0min+226+250,GREEN);
477
      else       grx_box(81,Y0min+221+250,100,Y0min+226+250,COL_SFONDO);
478
      if (-5>=Velocita_y)  grx_box(81,Y0min+214+250,100,Y0min+219+250,GREEN);
479
      else       grx_box(81,Y0min+214+250,100,Y0min+219+250,COL_SFONDO);
480
      if (-7.5>=Velocita_y)  grx_box(81,Y0min+207+250,100,Y0min+212+250,GREEN);
481
      else       grx_box(81,Y0min+207+250,100,Y0min+212+250,COL_SFONDO);
482
      if (-10>=Velocita_y)      grx_box(81,Y0min+200+250,100,Y0min+205+250,GREEN);
483
      else       grx_box(81,Y0min+200+250,100,Y0min+205+250,COL_SFONDO);
484
      if (-12.5>=Velocita_y)  grx_box(81,Y0min+193+250,100,Y0min+198+250,GREEN);
485
      else      grx_box(81,Y0min+193+250,100,Y0min+198+250,COL_SFONDO);
486
      if (-15>=Velocita_y)   grx_box(81,Y0min+186+250,100,Y0min+191+250,GREEN);
487
      else       grx_box(81,Y0min+186+250,100,Y0min+191+250,COL_SFONDO);
488
      if (-17.5>=Velocita_y)   grx_box(81,Y0min+179+250,100,Y0min+184+250,GREEN);
489
      else       grx_box(81,Y0min+179+250,100,Y0min+184+250,COL_SFONDO);
490
      if (-20>=Velocita_y)     grx_box(81,Y0min+172+250,100,Y0min+177+250,GREEN);
491
      else       grx_box(81,Y0min+172+250,100,Y0min+177+250,COL_SFONDO);
492
      if (-22.5>=Velocita_y)  grx_box(81,Y0min+165+250,100,Y0min+170+250,GREEN);
493
      else       grx_box(81,Y0min+165+250,100,Y0min+170+250,COL_SFONDO);
494
      if (-25>=Velocita_y)  grx_box(81,Y0min+158+250,100,Y0min+163+250,GREEN);
495
      else       grx_box(81,Y0min+158+250,100,Y0min+163+250,COL_SFONDO);
496
      if (-27.5>=Velocita_y)  grx_box(81,Y0min+151+250,100,Y0min+156+250,GREEN);
497
      else       grx_box(81,Y0min+151+250,100,Y0min+156+250,COL_SFONDO);
498
      if (-30>=Velocita_y)     grx_box(81,Y0min+144+250,100,Y0min+149+250,GREEN);
499
      else       grx_box(81,Y0min+144+250,100,Y0min+149+250,COL_SFONDO);
500
      if (-32.5>=Velocita_y)  grx_box(81,Y0min+137+250,100,Y0min+142+250,YELLOW);
501
      else       grx_box(81,Y0min+137+250,100,Y0min+142+250,COL_SFONDO);
502
      if (-35>=Velocita_y)  grx_box(81,Y0min+130+250,100,Y0min+135+250,YELLOW);
503
      else       grx_box(81,Y0min+130+250,100,Y0min+135+250,COL_SFONDO);
504
      if (-37.5>=Velocita_y)  grx_box(81,Y0min+123+250,100,Y0min+128+250,RED);
505
      else       grx_box(81,Y0min+123+250,100,Y0min+128+250,COL_SFONDO);
506
      if (-40>=Velocita_y)     grx_box(81,Y0min+116+250,100,Y0min+121+250,RED);
507
      else       grx_box(81,Y0min+116+250,100,Y0min+121+250,COL_SFONDO);
508
      if (-42.5>=Velocita_y)  grx_box(81,Y0min+109+250,100,Y0min+114+250,RED);
509
      else       grx_box(81,Y0min+109+250,100,Y0min+114+250,COL_SFONDO);
510
 
511
 
512
      sem_post(&mutex);
513
 
514
 
515
      task_endcycle();
516
    }
517
}
518
 
519