Subversion Repositories shark

/*****************************************************************************
* Filename:       test_dac.c                                                   *
* Author:         Marco Ziglioli (Doctor Stein)                              *
* Date:           12/06/2001                                                 *
* Description:    Little test program for Analog Output section of PCI6025E  *
*----------------------------------------------------------------------------*
* Notes:          Connect a multimeter to DAC1 output (pin 21) and watch     *
*                 tension value. Use '+' and '-' on numeric pad to increase  *
*                 and decrise voltage                                        *
*                 With this program it's possible to point out possible      *
*                 offset errors. To correct them no software are written but *
*                 in National board package there's the program to calibrate *
*                 the board. Otherwise you can see how much is the offset    *
*                 and you can compensate it through software value           *
*****************************************************************************/

/* 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/dac.h>

#define  TASK_VOLT_PERIOD     150E3
#define  TASK_VOLT_WCET       080E3
#define  TASK_DAC_PERIOD      050E3
#define  TASK_DAC_WCET        020E3

#define  CONV                 10/2048

#define  TASK_GROUP           1

WORD  dac0_value = 0,
      dac1_value = 0;

BYTE  sys = 0;
BYTE  dac = 0;

//some colors
int   black = rgb16(0, 0, 0),
      white = rgb16(255, 255, 255);

void drawInterface(void);
void endfun(KEY_EVT *);
void inc(KEY_EVT *);
void dec(KEY_EVT *);
void change_dac(KEY_EVT *);
void close_event(void *);
TASK Voltage_body(int);
TASK DAC_Check_body(int);

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

   sys_atrunlevel(close_event, NULL, RUNLEVEL_BEFORE_EXIT);

   keyb_set_map(itaMap);
   k.flag  =  CNTR_BIT;
   k.scan  =  KEY_X;
   k.ascii =  'x';
   keyb_hook(k, endfun);

   k.flag  =  CNTL_BIT;
   keyb_hook(k, endfun);

   k.flag  =  0;
   k.scan  =  78;
   k.ascii =  43;
   keyb_hook(k, inc);

   k.flag  =  0;
   k.scan  =  74;
   k.ascii =  45;
   keyb_hook(k, dec);

   k.flag  =  0;
   k.scan  =  KEY_V;
   k.ascii =  'v';
   keyb_hook(k, change_dac);

   hard_task_default_model(m);
   hard_task_def_wcet(m, TASK_VOLT_WCET);
   hard_task_def_mit(m, TASK_VOLT_PERIOD);
   hard_task_def_group(m, TASK_GROUP);
   pid_m = task_create("Voltage", Voltage_body, &m, NULL);
   if(pid_m == NIL){
      sys = 30;
      sys_end();
   }

   hard_task_default_model(d);
   hard_task_def_wcet(d, TASK_DAC_WCET);
   hard_task_def_mit(d, TASK_DAC_PERIOD);
   hard_task_def_group(d, TASK_GROUP);
   pid_d = task_create("DAC Check", DAC_Check_body, &d, NULL);
   if(pid_d == NIL){
      sys = 31;
      sys_end();
   }

        //Check if PCI bus is present
   if(pci_init()==-1){
      sys = 10;
      sys_end();
   }
        //Check if a NI board is on PCI bus
   if(!reMap()){
      sys = 11;
      sys_end();
   }

   if(grx_init()==-1){
      sys = 20;
      sys_end();
   }

   modenum = grx_getmode(800, 600, 16);
   if(modenum == -1){
      sys = 21;
      sys_end();
   }
   grx_setmode(modenum);

   drawInterface();

   //Analog output section set up
   DAC_Init();

        /*
        *AI_TIMEBASE div by 2; OUT_TIMEBASE div by 2;  single DAC mode
        *TMRDACWR = 3 OUT_TIMEBASE period; FIFO flags polarity active low
        *TMRDACWR disabled; DMA PIO control = FIFO DATA interface mode
        *UPDATE signal timebase = AO_UPDATE pulse width
        *UPDATE pulsewidth = 3-3.5 OUT_TIMEBASE period
        *UPDATE signal polarity = HIGH Z
        */
   DAC_boardInit(0x02, 0x4000);
        /*
        *LDAC0 source = UPDATE
        *DAC0 update immediately
        *LDAC1 source = UPDATE
        *DAC1 update immediately
        */
   DAC_LDACSourceUpdate(0x00);
        //End of Analog output section setup

   group_activate(TASK_GROUP);

   return 0;
}

/*
* Every time operator select a new value to send to a DAc this TASK makes
* actions needed to perform the operation
*/
TASK Voltage_body(int dac_work)
{
   WORD old0_value, old1_value;
   char buf[6];
   float volt;

   old0_value = dac0_value;
   old1_value = dac1_value;
   while(1){
      if(dac){
         if(dac1_value != old1_value){
            DAC_output(DAC1, dac1_value);
            old1_value = dac1_value;
            sprintf(buf, "%04d", dac1_value);
            grx_text(buf, 70, 120, rgb16(180, 0, 0), rgb16(255,255,140));
            sprintf(buf, "%04x", dac1_value);
            grx_text(buf, 300, 120, rgb16(180, 0, 0), rgb16(255,255,140));
            if( (dac1_value & 0x0800) == 0 )
               volt = (float)dac1_value * (float)CONV;
            else
               volt = (float)(dac1_value-0x0FFF) * (float)CONV;
            sprintf(buf, "%05.2f", volt);
            grx_text(buf, 70, 177, rgb16(180, 40, 180), black);
         }
      } else {
         if(dac0_value != old0_value){
            DAC_output(DAC0, dac0_value);
            old0_value = dac0_value;
            sprintf(buf, "%04d", dac0_value);
            grx_text(buf, 521, 120, rgb16(180, 0, 0), rgb16(255,255,140));
            sprintf(buf, "%04x", dac0_value);
            grx_text(buf, 754, 120, rgb16(180, 0, 0), rgb16(255,255,140));
            if( (dac0_value & 0x0800) == 0 )
               volt = (float)dac0_value * (float)CONV;
            else
               volt = (float)(dac0_value-0x0FFF) * (float)CONV;
            sprintf(buf, "%05.2f", volt);
            grx_text(buf, 521, 177, rgb16(180, 40, 180), black);
         }
      }
      task_endcycle();
   }
}

/*
* This TASK show which is the DAC active
*/
TASK DAC_Check_body(int dummy)
{
   BYTE old = dac;
   char buf[8];

   while(1){
      if(dac != old){
         old = dac;
         sprintf(buf, "DAC %d", dac);
         grx_text(buf, 385, 90, rgb16(255*dac, 255*(1-dac), 0), black);
      }
      task_endcycle();
   }
}

void drawInterface(void)
{
   grx_rect(1, 1, 799, 69, rgb16(105, 0, 0));
   grx_rect(2, 2, 798, 68, rgb16(155, 0, 0));
   grx_rect(3, 3, 797, 67, rgb16(205, 0, 0));
   grx_rect(4, 4, 796, 66, rgb16(255, 0, 0));

   grx_text("Test program for Analog output section of PCI6025E",
            7, 10, rgb16(50, 255, 50), black);
   grx_text("Use '+' and '-' on numeric pad to change tension",
            7, 25, rgb16(0, 255, 255), black);
   grx_text("Connect a tester to DAC1 output (pin21) or to DAC0 output (pin20)",
            7, 33, rgb16(0, 255, 255), black);
   grx_text("Use 'v' to alternate change active DAC",
            7, 40, rgb16(0, 255, 255), black);

   grx_text("CTRL-X for Exit", 7, 55, rgb16(200, 200, 0), black);

   grx_rect(1, 80, 355, 150, rgb16(0, 105, 0));
   grx_rect(2, 81, 354, 149, rgb16(0, 155, 0));
   grx_rect(3, 82, 353, 148, rgb16(0, 205, 0));
   grx_rect(4, 83, 352, 147, rgb16(0, 255, 0));

   grx_rect(1, 160, 355, 199, rgb16(0, 105, 0));
   grx_rect(2, 161, 354, 198, rgb16(0, 155, 0));
   grx_rect(3, 162, 353, 197, rgb16(0, 205, 0));
   grx_rect(4, 163, 352, 196, rgb16(0, 255, 0));

   grx_rect(455, 80, 799, 150, rgb16(105, 105, 0));
   grx_rect(456, 81, 798, 149, rgb16(155, 155, 0));
   grx_rect(457, 82, 797, 148, rgb16(205, 205, 0));
   grx_rect(458, 83, 796, 147, rgb16(255, 255, 0));

   grx_rect(455, 160, 799, 199, rgb16(105, 105, 0));
   grx_rect(456, 161, 798, 198, rgb16(155, 155, 0));
   grx_rect(457, 162, 797, 197, rgb16(205, 205, 0));
   grx_rect(458, 163, 796, 196, rgb16(255, 255, 0));

   grx_rect(360, 80, 450, 105, rgb16(85, 85, 255));
   grx_rect(361, 81, 449, 104, rgb16(125, 125, 255));
   grx_rect(362, 82, 448, 103, rgb16(175, 175, 255));
   grx_rect(363, 83, 447, 102, rgb16(225, 225, 255));

   grx_rect(153, 93, 195, 103, rgb16(255, 0, 0));
   grx_text("DAC 1", 155, 95, rgb16(255, 170, 170), black);

   grx_rect(607, 93, 649, 103, rgb16(255, 0, 0));
   grx_text("DAC 0", 609, 95, rgb16(255, 255, 210), black);

   grx_text("Decimal", 7, 120, rgb16(120, 120, 255), black);
   grx_text("Hexadecimal", 200, 120, rgb16(120, 120, 255), black);
   grx_text("Tension", 7, 177, rgb16(120, 120, 255), black);

   grx_text("Decimal", 461, 120, rgb16(255, 120, 120), black);
   grx_text("Hexadecimal", 654, 120, rgb16(255, 120, 120), black);
   grx_text("Tension", 461, 177, rgb16(255, 120, 120), black);
}

void close_event(void *arg)
{
   grx_close();
   switch(sys){
      case 0 : cprintf("Regular End\n"); break;
      case 1 : cprintf("End fun invoked\n"); break;
      case 10: cprintf("Pci bus not found\n"); break;
      case 11: cprintf("No National board found\n"); break;
      case 20: cprintf("Cannot initialize graphic envirorment\n"); break;
      case 21: cprintf("Cannot start envirorment in 800x600x16\n"); break;
      case 30: cprintf("Cannot create task <voltage>\n"); break;
      case 31: cprintf("Canot create task <DAC Check>\n"); break;
      case 40: cprintf("Break on clock end event\n"); break;
      default: cprintf("Unkwon exit event\n"); break;
   }
}

void endfun(KEY_EVT *k)
{
   sys = 1;
   sys_end();
}

/*
* Capture correct key event and increase output tension of active DAC
*/
void inc(KEY_EVT *k)
{
   if(dac){
      if( (dac1_value & 0x0800) == 0 && dac1_value > 0x07FF )
         dac1_value = 0;
      else
         dac1_value++;
   } else {
      if( (dac0_value & 0x0800) == 0 && dac0_value > 0x07FF )
         dac0_value = 0;
      else
         dac0_value++;
   }
}

/*
* Same as above but decrease tension
*/
void dec(KEY_EVT *k)
{
   if(dac){
      if(dac1_value < 1)
         dac1_value = 0x0FFF;
      else
         dac1_value -= 1;
   } else {
      if(dac0_value < 1)
         dac0_value = 0x0FFF;
      else
         dac0_value -= 1;
   }
}

/*
* Capture correct key event and change active DAC
*/
void change_dac(KEY_EVT *k)
{
   if(dac)  dac = 0;
   else     dac = 1;
}