Subversion Repositories shark

/*****************************************************************************
* Filename:    Test_dio.c                                                    *
* Author:      Marco Ziglioli (Doctor Stein)                                 *
* Date:        22/03/2001                                                    *
* Last update: 22/03/2001                                                    *
* Description: Test STC digital lines (8 lines)                              *
*----------------------------------------------------------------------------*
* Notes:       Configure DIO 4 5 6 7 in input and DIO 0 1 2 3 in output      *
*              Two way to test this 8 lines:                                 *
*              1) Connect 4 LEDs to output lines and check LEDs lights       *
*                 themselves in counting order. Connect input lines to Vcc   *
*                 or GND and check on video that STC has readed the right    *
*                 nibble                                                     *
*              2) Connect 4 output lines with 4 input lines and check on     *
*                 video that the nibble readed by STC change in counting     *
*                 order                                                      *
*****************************************************************************/

/* This file is part of the S.Ha.R.K. Project - http://shark.sssup.it
 *
 * Copyright (C) 2001 Marco Ziglioli
 *
 * 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
 *
 */

#include <drivers/glib.h>
#include <drivers/keyb.h>
#include <drivers/pci6025e/dio_ppi.h>

BYTE system = 0;

void close_event(void *);
TASK test_DIO(int dummy);
void exit_fun(KEY_EVT *);
void draw_screen(void);


int main(int argc, char **argv)
{
   HARD_TASK_MODEL   m;
   KEY_EVT k;
   PID pid_m;
   int modenum;

   sys_atrunlevel(close_event, NULL, RUNLEVEL_BEFORE_EXIT);

   keyb_set_map(itaMap);
   k.flag = CNTL_BIT;
   k.scan = KEY_C;
   k.ascii = 'c';
   keyb_hook(k, exit_fun);
   k.flag = CNTR_BIT;
   k.scan = KEY_C;
   k.ascii = 'c';
   keyb_hook(k, exit_fun);

   hard_task_default_model(m);
   hard_task_def_wcet(m, 90000);
   hard_task_def_mit(m, 250000);
   pid_m = task_create("TEST DIO", test_DIO, &m, NULL);
   if(pid_m == NIL){
      system = 10;
      sys_end();
   }

        //Check if PCI bus is present
   if(pci_init() == -1){
      system = 20;
      sys_end();
   }

        //Look for a National board on PCI bus
   if(!reMap()){
      system = 21;
      sys_end();
   }

        //Start configuring DIO module
   DIO_init();

   grx_init();
   modenum = grx_getmode(640, 480, 16);
   if(modenum == -1){
      system = 30;
      sys_end();
   }
   grx_setmode(modenum);

   draw_screen();

   task_activate(pid_m);

   return 0;
}

void draw_screen(void)
{
   grx_rect(5, 5, 405, 130, rgb16(255, 0, 0));
   grx_rect(4, 4, 406, 131, rgb16(0,255,255));
   grx_rect(3, 3, 407, 132, rgb16(255, 0, 0));
   grx_rect(15, 45, 195, 100, rgb16(255, 0, 0));
   grx_rect(215, 45, 395, 100, rgb16(0, 255, 0));
   grx_text("Test of PCI6025E DIO function",
            9, 7, rgb16(0, 255, 0), rgb16(0, 0, 0));
   grx_text("DIO 4-5-6-7 are configured in input mode",
            9, 20, rgb16(255, 70, 70), rgb16(0, 0, 0));
   grx_text("DIO 0-1-2-3 are configured in output mode",
            9, 28, rgb16(255, 70, 70), rgb16(0, 0, 0));
   grx_text("Output bits", 35, 50, rgb16(200, 0, 0), rgb16(0, 0, 0));
   grx_text("input bits", 235, 50, rgb16(30,255,30), rgb16(0, 0, 0));
   grx_text("CTRL + C to exit", 9, 115, rgb16(255,255,0), rgb16(0,0,0));
}

/*
* At each activation this task change output value of lowest digitals line
* and read value on highest digital lines, showing them at video
*/
TASK test_DIO(int dummy)
{
   BYTE  out_val = 0x00,
         in_val = 0;
   int i;
   char buf[10];

        //DIO 0..3 configured as output
        //DIO 4..7 configured as input
   DIO_setup(0x0F);

   while(1){
      DIO_write(out_val);       //sends out value
      in_val = DIO_read() >> 4; //reads value

      for(i=3; i>=0; i--){
         if( (out_val>>i)%2 )
            grx_text("1", 25+10*(3-i), 75, rgb16(255,0,0), rgb16(0,0,0));
         else
            grx_text("0", 25+10*(3-i), 75, rgb16(255,0,0), rgb16(0,0,0));
         if( (in_val>>i)%2 )
            grx_text("1", 225+10*(3-i), 75, rgb16(0,255,0), rgb16(0,0,0));
         else
            grx_text("0", 225+10*(3-i), 75, rgb16(0,255,0), rgb16(0,0,0));
      }
      sprintf(buf, "%03d", out_val);
      grx_text(buf, 80, 75, rgb16(255,0,0), rgb16(0,0,0));
      sprintf(buf, "%03d", in_val);
      grx_text(buf, 280, 75, rgb16(0,255,0), rgb16(0,0,0));

      out_val = (out_val+1)%16;
      task_endcycle();
   }
}

void close_event(void *arg)
{
   grx_close();
   switch(system){
      case 0: kern_printf("Regular end\n"); break;
      case 10:kern_printf("Cannot create task TEST DIO\n"); break;
      case 20:kern_printf("Pci bus don't find\n"); break;
      case 21:kern_printf("No National board on PC\n"); break;
      case 30:kern_printf("Cannot start graphic envirorment\n"); break;
      default: kern_printf("Unknown exit\n"); break;
   }
}

void exit_fun(KEY_EVT *k)
{
   system = 0;
   sys_end();
}