WebSVN - shark - Blame - Rev 1385 - /demos/trunk/base/fly.c

Rev	Author	Line No.	Line
1085	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	* (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	------------
1385	giacomo	21	CVS : $Id: fly.c,v 1.6 2004-04-19 13:54:16 giacomo Exp $
1085	pj	22
		23	File: $File$
1385	giacomo	24	Revision: $Revision: 1.6 $
		25	Last update: $Date: 2004-04-19 13:54:16 $
1085	pj	26	------------
		27	**/
		28
		29	/*
		30	* Copyright (C) 2000 Paolo Gai and Giorgio Buttazzo
		31	*
		32	* This program is free software; you can redistribute it and/or modify
		33	* it under the terms of the GNU General Public License as published by
		34	* the Free Software Foundation; either version 2 of the License, or
		35	* (at your option) any later version.
		36	*
		37	* This program is distributed in the hope that it will be useful,
		38	* but WITHOUT ANY WARRANTY; without even the implied warranty of
		39	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		40	* GNU General Public License for more details.
		41	*
		42	* You should have received a copy of the GNU General Public License
		43	* along with this program; if not, write to the Free Software
		44	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
		45	*
		46	*/
		47
		48	/--------------------------------------------------------------/
		49	/* SIMULATION OF RANDOM FLIES */
		50	/--------------------------------------------------------------/
		51
		52	#include <kernel/kern.h>
		53	#include <stdlib.h>
		54	#include <math.h>
		55
1382	giacomo	56	#include <drivers/shark_keyb26.h>
1377	giacomo	57	#include <drivers/shark_fb26.h>
		58
1085	pj	59	#define YMENU 10 /* menu level */
		60	#define XMIN 50
		61	#define XMAX 600
		62	#define YMIN 100
		63	#define YMAX 450
		64	#define VEL 5 /* linear velocity (def. = 5) */
		65	#define ANG 30 /* angolo massimo sterzata (30) */
		66	#define D 3 /* raggio mosca */
1377	giacomo	67	#undef ESC
1085	pj	68	#define ESC 27 /* ASCII code of ESCAPE key */
		69	#define MAX_P 35 /* max number of flies */
		70	#define FLYGROUP 1
		71
		72	double tick = 1.0; /* system tick = 1 ms */
		73	int fly_period = 40000; /* task period */
		74	int fly_wcet = 1000; /* task wcet */
		75	PID pid;
		76
		77	/--------------------------------------------------------------/
		78
		79	void draw_fly(int x, int y, int c)
		80	{
		81	grx_disc(x, y, D, c);
		82	}
		83
		84	/******************************************************************/
		85
		86	TASK fly(void *arg)
		87	{
		88	int x, y;
		89	int ox, oy;
		90	int dx, dy, da;
		91	int teta, col;
		92	int outx, outy;
		93	double r;
		94	int i = (int)arg;
		95
		96	x = ox = (XMIN+XMAX)/2;
		97	y = oy = (YMIN+YMAX)/2;
		98	teta = 0;
		99	col = 2 + i; /* colore fly */
		100
		101	while (1) {
		102
		103	da = rand()%(2ANG) - ANG; / da = [-ANG,ANG] */
		104	teta += da;
		105
		106	if (teta > 360) teta -= 360;
		107	if (teta < 0) teta += 360;
		108	r = (double)teta * PI / 180.;
		109
		110	dx = (float)(VEL * cos(r));
		111	dy = (float)(VEL * sin(r));
		112	x += dx;
		113	y += dy;
		114
		115	outx = (x >= XMAX) \|\| (x <= XMIN);
		116	outy = (y >= YMAX) \|\| (y <= YMIN);
		117
		118	if (outx \|\| outy) {
		119	x = x - dx;
		120	y = y - dy;
		121	if (outx) teta = 180 - teta;
		122	if (outy) teta = -teta;
		123	if (teta > 360) teta -= 360;
		124	if (teta < 0) teta += 360;
		125	r = (double)teta * PI / 180.;
		126
		127	dx = (float)(VEL * cos(r));
		128	dy = (float)(VEL * sin(r));
		129
		130	x += dx;
		131	y += dy;
		132	}
		133
		134	draw_fly(ox, oy, 0);
		135	draw_fly(x, y, col);
		136	ox = x; oy = y;
		137
		138	task_endcycle();
		139	}
		140	}
		141
		142	/**************************** MAIN ****************************/
		143
		144	int main(int argc, char **argv)
		145	{
		146	HARD_TASK_MODEL m;
		147
		148	char c; /* character from keyboard */
		149	int i = 0; /* number of tasks created */
		150	TIME seme; /* used to init the random seed */
		151
		152	/* The scenario */
		153	grx_rect(XMIN-D-1, YMIN-D-1, XMAX+D+1, YMAX+D+1, 14);
		154	grx_text("Simulation of Random Flies", XMIN, YMENU+10, 13, 0);
		155	grx_text("SPACE create a fly" , XMIN, YMENU+20, 12, 0);
		156	grx_text("ESC exit to DOS" , XMIN, YMENU+30, 12, 0);
		157
		158	/* The program waits a space to create a fly */
		159	c = keyb_getch(BLOCK);
		160
		161	/* randomize!!!! */
		162	seme = sys_gettime(NULL);
		163	srand(seme);
		164
		165	do {
		166	if ((c == ' ') && (i < MAX_P)) {
		167	hard_task_default_model(m);
		168	hard_task_def_ctrl_jet (m);
		169	hard_task_def_arg (m, (void *)i);
		170	hard_task_def_wcet (m, fly_wcet);
		171	hard_task_def_mit (m, fly_period);
		172	hard_task_def_group (m, FLYGROUP);
		173	hard_task_def_usemath (m);
		174	pid = task_create("fly", fly, &m, NULL);
		175	if (pid == NIL) {
1377	giacomo	176	sys_shutdown_message("Could not create task <fly>");
1382	giacomo	177	sys_end();
1377	giacomo	178	return 0;
1085	pj	179	}
		180	task_activate(pid);
		181	i++;
		182	}
		183	c = keyb_getch(BLOCK);
		184
		185	} while (c != ESC);
		186
1382	giacomo	187	sys_end();
1085	pj	188
		189	return 0;
1377	giacomo	190
1085	pj	191	}
		192
		193	/--------------------------------------------------------------/

Subversion Repositories shark

(root)/demos/trunk/base/fly.c @ 1547 - Rev 1385