WebSVN - shark - Rev 1377 - /demos/trunk/base/cabs.c

/*
* Project: S.Ha.R.K.
*
* Coordinators:
* Giorgio Buttazzo <giorgio@sssup.it>
* Paolo Gai <pj@gandalf.sssup.it>
*
* Authors :
* Paolo Gai <pj@gandalf.sssup.it>
* (see the web pages for full authors list)
*
* ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)
*
* http://www.sssup.it
* http://retis.sssup.it
* http://shark.sssup.it
*/

/*
* Copyright (C) 2000 Giorgio Buttazzo, Paolo Gai
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*
*
* CVS : $Id: cabs.c,v 1.4 2004-04-17 11:36:13 giacomo Exp $
*/

/*--------------------------------------------------------------*/
/* TEST ON CABS */
/*--------------------------------------------------------------*/

#include <kernel/kern.h>
#include <modules/cabs.h>
#include <string.h>

#include <drivers/shark_linuxc26.h>
#include <drivers/shark_pci26.h>
#include <drivers/shark_fb26.h>
#include <drivers/shark_input26.h>
#include <drivers/shark_keyb26.h>

#define FRAME_BUFFER_DEVICE 0

#define NCAB 4 /* max number of CABs */
#define NCAR 26 /* generated characters */

#define YP 32 /* level of arrows */
#define R 20 /* task radius */
#define YY (YP+R+32) /* level of writing */
#define DELTA (2*R+72) /* total channel hight */
#define X1 120 /* start column for P1 */
#define X2 360 /* start column for P2 */

#define XP1 (X1+64) /* X position of task 1 */
#define XP2 (X2+64) /* X position of task 2 */
#define XC (XP1+96) /* X position of CAB */
#define L 52 /* CAB rectangle length */

void my_exit(KEY_EVT *k);
void draw_channel(int i);
void create_channel(int i);
void get_data();

TASK producer(void *arg);
TASK consumer(void *arg);

char *cname[NCAB] = {"cab1", "cab2", "cab3", "cab4"};
char *pname1[NCAB] = {"wr1", "wr2", "wr3", "wr4"};
char *pname2[NCAB] = {"rd1", "rd2", "rd3", "rd4"};

CAB cid[NCAB]; /* CAB identifiers */
PID p1[NCAB], p2[NCAB]; /* task identifiers */

/* Task Periods */
TIME t1[NCAB] = {200000, 100000, 300000, 800000};
TIME t2[NCAB] = {400000, 400000, 150000, 200000};

/* Task WCETS */
TIME w1[NCAB] = {10000, 10000, 10000, 10000};
TIME w2[NCAB] = {10000, 10000, 10000, 10000};

PID shutdown_task_PID = -1;

int device_drivers_init() {

KEYB_PARMS kparms = BASE_KEYB;

LINUXC26_register_module();

PCI26_init();

keyb_def_ctrlC(kparms, NULL);

INPUT26_init();

KEYB26_init(&kparms);

FB26_init();

FB26_open(FRAME_BUFFER_DEVICE);

FB26_use_grx(FRAME_BUFFER_DEVICE);

FB26_setmode(FRAME_BUFFER_DEVICE,"640x480-16");

return 0;

}

int device_drivers_close() {

FB26_close(FRAME_BUFFER_DEVICE);

KEYB26_close();

INPUT26_close();

return 0;

}

TASK shutdown_task_body(void *arg) {

device_drivers_close();

sys_shutdown_message("-- S.Ha.R.K. Closed --\n");

sys_end();

return NULL;

}

void set_shutdown_task() {

NRT_TASK_MODEL nrt;

nrt_task_default_model(nrt);

shutdown_task_PID = task_create("Shutdown Task",shutdown_task_body,&nrt,NULL);
if (shutdown_task_PID == NIL) {
sys_shutdown_message("Error: Cannot create shutdown task\n");
sys_end();
}

}

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

/* This function is called when Alt-X is pressed.
*/
void my_end(KEY_EVT* e)
{
task_activate(shutdown_task_PID);
}

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

/* This function is called when the system exit correctly after Alt-X.
It exits from the graphic mode and then it prints a small greeting.
Note that:
- The function calls grx_exit, so it must be registered using
RUNLEVEL_BEFORE_EXIT (RUNLEVEL_AFTER_EXIT does not work because
at that point the kernel is already returned in real mode!!!)
- When an exception is raised, the exception handler is called.
Since the exception handler already exits from the graphic mode,
this funcion has not to be called. For this reason:
. we registered byebye using the flag NO_AT_ABORT
. the exception handler exits using sys_abort; in that way byebye is
NOT called
*/

/*--------------------------------------------------------------*/
/* Main task */
/*--------------------------------------------------------------*/

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

int main(int argc, char **argv)
{
char c = 0; /* character from keyboard */

set_shutdown_task();

device_drivers_init();

grx_clear(BLACK);

grx_text("Press a key [1-4]", 10, 16, 7, 0);
grx_text("to create a pair", 10, 24, 7, 0);
grx_text("ESC to exit demo", 10, 48, 7, 0);

while (c != 27) {
c = keyb_getch(BLOCK);
if ((c >= '1') && (c <= '1'+NCAB-1))
create_channel(c-'1');
}

task_activate(shutdown_task_PID);

return 0;
}

/*--------------------------------------------------------------*/
/* write data in a cab */
/*--------------------------------------------------------------*/

TASK producer(void *arg)
{
int i = (int)arg;
char c; /* message character */
char *p; /* pointer to a cab buffer */
char s[2]; /* string to display */
int k = 0;
int x, y;
int col = 13;
int ybase = YY + i*DELTA;

x = X1;
y = ybase;
s[1] = 0;

k = 0;
while (1) {
c = 'A' + k;
p = cab_reserve(cid[i]);
*p = c;
cab_putmes(cid[i], p);

s[0] = c;
k = (k + 1) % NCAR;
grx_text(s,x,y,col,0);

x += 8;
if (x >= (X1 + NCAR*8)) {
x = X1;
y = y + 8;
if (y >= ybase+16) {
y = ybase;
col = col % 15 + 1;
}
}

task_endcycle();
}
}

/*--------------------------------------------------------------*/
/* read data from a cab */
/*--------------------------------------------------------------*/

TASK consumer(void *arg)
{
int i = (int)arg;
char *p;
char s[2];
int x, y;
int col = 13;
int ybase = YY + i*DELTA;

x = X2;
y = ybase;
s[1] = 0;

while (1) {
p = cab_getmes(cid[i]);
s[0] = *p - 'A' + 'a';
cab_unget(cid[i], p);

grx_text(s,x,y,col,0);
x += 8;

if (x >= (X2 + NCAR*8)) {
x = X2;
y = y + 8;
if (y >= ybase+16) {
y = ybase;
col = col % 15 + 1;
}
}
task_endcycle();
}
}

/*--------------------------------------------------------------*/
/* create the two tasks and a channel */
/*--------------------------------------------------------------*/

void create_channel(int i)
{
HARD_TASK_MODEL m;

draw_channel(i);
cid[i] = cab_create(cname[i], 1, 2);

hard_task_default_model(m);
hard_task_def_ctrl_jet (m);
hard_task_def_arg (m, (void *)i);
hard_task_def_wcet (m, w1[i]);
hard_task_def_mit (m, t1[i]);
hard_task_def_usemath (m);
p1[i] = task_create(pname1[i], producer, &m, NULL);
if (p1[i] == NIL) {
sys_shutdown_message("Could not create task <producer>");
task_activate(shutdown_task_PID);
return;
}
task_activate(p1[i]);

hard_task_default_model(m);
hard_task_def_ctrl_jet (m);
hard_task_def_arg (m, (void *)i);
hard_task_def_wcet (m, w2[i]);
hard_task_def_mit (m, t2[i]);
hard_task_def_usemath (m);
p2[i] = task_create(pname2[i], consumer, &m, NULL);
if (p2[i] == NIL) {
sys_shutdown_message("Could not create task <consumer>");
task_activate(shutdown_task_PID);
return;
}
task_activate(p2[i]);
}

/*--------------------------------------------------------------*/
/* Disegna i processi e il canale di comunicazione */
/*--------------------------------------------------------------*/

void draw_channel(int i)
{
char buffer[32]; /* buffer per sprintf */
int yc = YP + i*DELTA; /* altezza del canale */

grx_circle(XP1,yc,R,2);
grx_text("P1",XP1-8,yc-4,12,0);

grx_circle(XP2,yc,R,2);
grx_text("P2",XP2-8,yc-4,12,0);

grx_rect(XC,yc-R,XC+L,yc+R,3);
grx_text("CAB",XC+16,yc-4,12,0);

grx_line(XP1+R,yc,XC,yc,4);
grx_line(XC+L,yc,XP2-R,yc,4);

grx_text("T1 = ms",X1+40,yc+R+16,14,0);
sprintf(buffer,"%ld", t1[i]);
grx_text(buffer,X1+88,yc+R+16,14,0);

grx_text("T2 = ms",X2+40,yc+R+16,14,0);
sprintf(buffer,"%ld", t2[i]);
grx_text(buffer,X2+88,yc+R+16,14,0);
}

Subversion Repositories shark

(root)/demos/trunk/base/cabs.c - Rev 1377