Subversion Repositories shark

Rev

Rev 1590 | 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
 
1590 tullio 21
/* CVS :        $Id: dummy.c,v 1.2 2006-07-03 15:10:15 tullio 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
 
1590 tullio 42
#include "bca.h"
1090 pj 43
 
44
PID crea_soft_dummy_radar()
45
{
46
  SOFT_TASK_MODEL m;
47
  PID pid;
48
 
49
  soft_task_default_model(m);
50
  soft_task_def_level(m,0);
51
  soft_task_def_periodic(m);
52
  soft_task_def_period(m,DUMMY_RADAR_PERIOD);
53
  soft_task_def_wcet(m,DUMMY_RADAR_WCET);
54
  soft_task_def_met(m,DUMMY_RADAR_MET);
55
 
56
  pid = task_create("dummy_radar", dummy_radar, &m, NULL);
57
  return pid;
58
}
59
 
60
TASK dummy_radar(void *argv)
61
{
62
  WORD i,r,r_max,pos;
63
  BYTE red[3]={250, 150,50};
64
  int  d[3]=  {+10,+10,+10};
65
 
66
  r =     0;
67
  r_max = ballframe_radar->r+1;
68
 
69
  while(1){
70
    for(i=0; i<3; i++) {
71
      if (red[i]<50)  d[i]=+10;
72
      if (red[i]>250) d[i]=-50;
73
      red[i] += d[i];
74
      grx_disc(ballframe_lucerossa[i]->cx,
75
               ballframe_lucerossa[i]->cy,
76
               ballframe_lucerossa[i]->r,
77
               FAB_rgb(red[i],50,50));
78
      }
79
    grx_disc(ballframe_radar->cx,
80
             ballframe_radar->cy,
81
             r_max, FAB_blue);
82
    grx_circle(ballframe_radar->cx,
83
               ballframe_radar->cy,
84
               (r+9)%r_max, FAB_white);
85
    grx_circle(ballframe_radar->cx,
86
               ballframe_radar->cy,
87
               (r+5)%r_max, FAB_rgb(200,200,255));
88
    grx_circle(ballframe_radar->cx,
89
               ballframe_radar->cy,
90
               r%r_max, FAB_rgb(100,100,255));
91
    for (i=0; i<AEREO_N_MAX; i++) {
92
      if (aereo_table[i].status
93
         &&aereo_table[i].x>X0
94
         &&aereo_table[i].y>Y0) {
95
            pos = ballframe_radar->cx - ballframe_radar->r
96
                + (aereo_table[i].x-X0)*2*ballframe_radar->r/500;
97
            grx_plot(pos,ballframe_radar->cy,FAB_yellow);
98
            }
99
      }
100
    r++;
101
 
102
  task_endcycle();
103
  }
104
}